inav-configurator/js/outputMapping.js

/*global bit_check*/
'use strict';

let OutputMappingCollection = function () {
    let self = {},
        data = [];

    const TIM_USE_ANY = 0;
    const TIM_USE_PPM = 0;
    const TIM_USE_PWM = 1;
    const TIM_USE_MC_MOTOR = 2;     // Multicopter motor output
    const TIM_USE_MC_SERVO = 3;     // Multicopter servo output (i.e. TRI)
    const TIM_USE_MC_CHNFW = 4;     // Deprecated and not used after removal of CHANNEL_FORWARDING feature
    const TIM_USE_FW_MOTOR = 5;
    const TIM_USE_FW_SERVO = 6;
    const TIM_USE_LED = 24;
    const TIM_USE_BEEPER = 25;

    const OUTPUT_TYPE_MOTOR = 0;
    const OUTPUT_TYPE_SERVO = 1;

    function getTimerMap(isMR, motors, servos) {
        let timerMap = [],
            motorsToGo = motors,
            servosToGo = servos;

        for (let i = 0; i < data.length; i++) {
            timerMap[i] = null;

            if (isMR) {
                if (servosToGo > 0 && bit_check(data[i], TIM_USE_MC_SERVO)) {
                    servosToGo--;
                    timerMap[i] = OUTPUT_TYPE_SERVO;
                } else if (motorsToGo > 0 && bit_check(data[i], TIM_USE_MC_MOTOR)) {
                    motorsToGo--;
                    timerMap[i] = OUTPUT_TYPE_MOTOR;
                }
            } else {
                if (servosToGo > 0 && bit_check(data[i], TIM_USE_FW_SERVO)) {
                    servosToGo--;
                    timerMap[i] = OUTPUT_TYPE_SERVO;
                } else if (motorsToGo > 0 && bit_check(data[i], TIM_USE_FW_MOTOR)) {
                    motorsToGo--;
                    timerMap[i] = OUTPUT_TYPE_MOTOR;
                }
            }

        }

        return timerMap;
    };

    self.getOutputTable = function (isMR, motors, servos) {
        let currentMotorIndex = 1,
            currentServoIndex = 0,
            timerMap = getTimerMap(isMR, motors, servos.length),
            outputMap = [],
            offset = getFirstOutputOffset();

        for (let i = 0; i < self.getOutputCount(); i++) {
            
            let assignment = timerMap[i + offset];

            if (assignment === null) {
                outputMap[i] = "-";
            } else if (assignment == OUTPUT_TYPE_MOTOR) {
                outputMap[i] = "Motor " + currentMotorIndex;
                currentMotorIndex++;
            } else if (assignment == OUTPUT_TYPE_SERVO) {
                outputMap[i] = "Servo " + servos[currentServoIndex];
                currentServoIndex++;
            }

        }

        return outputMap;
    };

    self.flush = function () {
        data = [];
    };

    self.put = function (element) {
        data.push(element);
    };

    self.getOutputCount = function () {
        let retVal = 0;

        for (let i = 0; i < data.length; i++) {
            if (
                bit_check(data[i], TIM_USE_MC_MOTOR) ||
                bit_check(data[i], TIM_USE_MC_SERVO) ||
                bit_check(data[i], TIM_USE_FW_MOTOR) ||
                bit_check(data[i], TIM_USE_FW_SERVO)
            ) {
                retVal++;
            };
        }

        return retVal;
    }

    function getFirstOutputOffset() {
        for (let i = 0; i < data.length; i++) {
            if (
                bit_check(data[i], TIM_USE_MC_MOTOR) ||
                bit_check(data[i], TIM_USE_MC_SERVO) ||
                bit_check(data[i], TIM_USE_FW_MOTOR) ||
                bit_check(data[i], TIM_USE_FW_SERVO)
            ) {
                return i;
            }
        }
        return 0;
    }

    function getOutput(servoIndex, bit) {

        let offset = getFirstOutputOffset();

        let lastFound = 0;

        for (let i = offset; i < data.length; i++) {
            if (bit_check(data[i], bit)) {
                if (lastFound == servoIndex) {
                    return i - offset + 1;
                } else {
                    lastFound++;
                }
            }
        }

        return null;
    }

    self.getFwServoOutput = function (servoIndex) {
        return getOutput(servoIndex, TIM_USE_FW_SERVO);
    };

    self.getMrServoOutput = function (index) {
        return getOutput(index, TIM_USE_MC_SERVO);
    };

    return self;
}