JDeadzoneRemover.h

Go to the documentation of this file.

#ifndef J_DEADZONE_REMOVER_H
#define J_DEADZONE_REMOVER_H
#include "JTwoDTransform.h"
#include <Arduino.h>
namespace JDeadzoneRemover {
 
inline float calculate(float value, float start, float max, float deadzone = 0)
{
    value = constrain(value, -1.0, 1.0);
    if (abs(value) <= abs(deadzone)) {
        return 0;
    }
    if (value > deadzone) {
        // return floatMap(value, deadzone, 1.0, start, max);
        return (value - deadzone) * (max - start) / (1.0 - deadzone) + start;
    }
    if (value < -deadzone) {
        // return floatMap(value, -deadzone, -1.0, -start, -max);
        return (value + deadzone) * (-max + start) / (-1.0 + deadzone) - start;
    }
    return 0;
}
 
inline JTwoDTransform calculate(JTwoDTransform value, JTwoDTransform start, JTwoDTransform max, JTwoDTransform deadzone = { 0, 0, 0 })
{
    JTwoDTransform output = { 0, 0, 0 };
    for (int i = 0; i < 3; i++) {
        float currentValue = constrain(value.getByNumber(i), -1.0, 1.0);
        float currentDeadzone = deadzone.getByNumber(i);
        float currentStart = start.getByNumber(i);
        float currentMax = max.getByNumber(i);
        float ret = 0;
        if (abs(currentValue) <= abs(currentDeadzone)) {
            ret = 0;
        }
        if (currentValue > currentDeadzone) {
            // return floatMap(value, deadzone, 1.0, start, max);
            ret = (currentValue - currentDeadzone) * (currentMax - currentStart) / (1.0 - currentDeadzone) + currentStart;
        }
        if (currentValue < -currentDeadzone) {
            // return floatMap(value, -deadzone, -1.0, -start, -max);
            ret = (currentValue + currentDeadzone) * (-currentMax + currentStart) / (-1.0 + currentDeadzone) - currentStart;
        }
        output.setByNumber(i, ret);
    }
    return output;
}
 
}; // end of namespace
#endif