|
|
|
@ -42,25 +42,40 @@ Joystick joystick;
|
|
|
|
|
|
|
|
|
|
#if HAS_JOY_ADC_X
|
|
|
|
|
temp_info_t Joystick::x; // = { 0 }
|
|
|
|
|
#if ENABLED(INVERT_JOY_X)
|
|
|
|
|
#define JOY_X(N) (16383 - (N))
|
|
|
|
|
#else
|
|
|
|
|
#define JOY_X(N) (N)
|
|
|
|
|
#endif
|
|
|
|
|
#endif
|
|
|
|
|
#if HAS_JOY_ADC_Y
|
|
|
|
|
temp_info_t Joystick::y; // = { 0 }
|
|
|
|
|
#if ENABLED(INVERT_JOY_Y)
|
|
|
|
|
#define JOY_Y(N) (16383 - (N))
|
|
|
|
|
#else
|
|
|
|
|
#define JOY_Y(N) (N)
|
|
|
|
|
#endif
|
|
|
|
|
#endif
|
|
|
|
|
#if HAS_JOY_ADC_Z
|
|
|
|
|
temp_info_t Joystick::z; // = { 0 }
|
|
|
|
|
#if ENABLED(INVERT_JOY_Z)
|
|
|
|
|
#define JOY_Z(N) (16383 - (N))
|
|
|
|
|
#else
|
|
|
|
|
#define JOY_Z(N) (N)
|
|
|
|
|
#endif
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
#if ENABLED(JOYSTICK_DEBUG)
|
|
|
|
|
void Joystick::report() {
|
|
|
|
|
SERIAL_ECHOPGM("Joystick");
|
|
|
|
|
#if HAS_JOY_ADC_X
|
|
|
|
|
SERIAL_ECHOPAIR_P(SP_X_STR, x.raw);
|
|
|
|
|
SERIAL_ECHOPAIR_P(SP_X_STR, JOY_X(x.raw));
|
|
|
|
|
#endif
|
|
|
|
|
#if HAS_JOY_ADC_Y
|
|
|
|
|
SERIAL_ECHOPAIR_P(SP_Y_STR, y.raw);
|
|
|
|
|
SERIAL_ECHOPAIR_P(SP_Y_STR, JOY_Y(y.raw));
|
|
|
|
|
#endif
|
|
|
|
|
#if HAS_JOY_ADC_Z
|
|
|
|
|
SERIAL_ECHOPAIR_P(SP_Z_STR, z.raw);
|
|
|
|
|
SERIAL_ECHOPAIR_P(SP_Z_STR, JOY_Z(z.raw));
|
|
|
|
|
#endif
|
|
|
|
|
#if HAS_JOY_ADC_EN
|
|
|
|
|
SERIAL_ECHO_TERNARY(READ(JOY_EN_PIN), " EN=", "HIGH (dis", "LOW (en", "abled)");
|
|
|
|
@ -91,15 +106,15 @@ Joystick joystick;
|
|
|
|
|
|
|
|
|
|
#if HAS_JOY_ADC_X
|
|
|
|
|
static constexpr int16_t joy_x_limits[4] = JOY_X_LIMITS;
|
|
|
|
|
_normalize_joy(norm_jog.x, x.raw, joy_x_limits);
|
|
|
|
|
_normalize_joy(norm_jog.x, JOY_X(x.raw), joy_x_limits);
|
|
|
|
|
#endif
|
|
|
|
|
#if HAS_JOY_ADC_Y
|
|
|
|
|
static constexpr int16_t joy_y_limits[4] = JOY_Y_LIMITS;
|
|
|
|
|
_normalize_joy(norm_jog.y, y.raw, joy_y_limits);
|
|
|
|
|
_normalize_joy(norm_jog.y, JOY_Y(y.raw), joy_y_limits);
|
|
|
|
|
#endif
|
|
|
|
|
#if HAS_JOY_ADC_Z
|
|
|
|
|
static constexpr int16_t joy_z_limits[4] = JOY_Z_LIMITS;
|
|
|
|
|
_normalize_joy(norm_jog.z, z.raw, joy_z_limits);
|
|
|
|
|
_normalize_joy(norm_jog.z, JOY_Z(z.raw), joy_z_limits);
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|