diff options
Diffstat (limited to 'quantum/process_keycode/process_joystick.c')
-rw-r--r-- | quantum/process_keycode/process_joystick.c | 42 |
1 files changed, 18 insertions, 24 deletions
diff --git a/quantum/process_keycode/process_joystick.c b/quantum/process_keycode/process_joystick.c index c12f75685..5778a7434 100644 --- a/quantum/process_keycode/process_joystick.c +++ b/quantum/process_keycode/process_joystick.c | |||
@@ -17,8 +17,7 @@ bool process_joystick(uint16_t keycode, keyrecord_t *record) { | |||
17 | return true; | 17 | return true; |
18 | } | 18 | } |
19 | 19 | ||
20 | __attribute__((weak)) | 20 | __attribute__((weak)) void joystick_task(void) { |
21 | void joystick_task(void) { | ||
22 | if (process_joystick_analogread() && (joystick_status.status & JS_UPDATED)) { | 21 | if (process_joystick_analogread() && (joystick_status.status & JS_UPDATED)) { |
23 | send_joystick_packet(&joystick_status); | 22 | send_joystick_packet(&joystick_status); |
24 | joystick_status.status &= ~JS_UPDATED; | 23 | joystick_status.status &= ~JS_UPDATED; |
@@ -47,16 +46,11 @@ uint16_t savePinState(pin_t pin) { | |||
47 | return ((PORTx_ADDRESS(pin) >> pinNumber) & 0x1) << 1 | ((DDRx_ADDRESS(pin) >> pinNumber) & 0x1); | 46 | return ((PORTx_ADDRESS(pin) >> pinNumber) & 0x1) << 1 | ((DDRx_ADDRESS(pin) >> pinNumber) & 0x1); |
48 | #elif defined(PROTOCOL_CHIBIOS) | 47 | #elif defined(PROTOCOL_CHIBIOS) |
49 | /* | 48 | /* |
50 | The pin configuration is backed up in the following format : | 49 | The pin configuration is backed up in the following format : |
51 | bit 15 9 8 7 6 5 4 3 2 1 0 | 50 | bit 15 9 8 7 6 5 4 3 2 1 0 |
52 | |unused|ODR|IDR|PUPDR|OSPEEDR|OTYPER|MODER| | 51 | |unused|ODR|IDR|PUPDR|OSPEEDR|OTYPER|MODER| |
53 | */ | 52 | */ |
54 | return (( PAL_PORT(pin)->MODER >> (2*PAL_PAD(pin))) & 0x3) | 53 | return ((PAL_PORT(pin)->MODER >> (2 * PAL_PAD(pin))) & 0x3) | (((PAL_PORT(pin)->OTYPER >> (1 * PAL_PAD(pin))) & 0x1) << 2) | (((PAL_PORT(pin)->OSPEEDR >> (2 * PAL_PAD(pin))) & 0x3) << 3) | (((PAL_PORT(pin)->PUPDR >> (2 * PAL_PAD(pin))) & 0x3) << 5) | (((PAL_PORT(pin)->IDR >> (1 * PAL_PAD(pin))) & 0x1) << 7) | (((PAL_PORT(pin)->ODR >> (1 * PAL_PAD(pin))) & 0x1) << 8); |
55 | | (((PAL_PORT(pin)->OTYPER >> (1*PAL_PAD(pin))) & 0x1) << 2) | ||
56 | | (((PAL_PORT(pin)->OSPEEDR >> (2*PAL_PAD(pin))) & 0x3) << 3) | ||
57 | | (((PAL_PORT(pin)->PUPDR >> (2*PAL_PAD(pin))) & 0x3) << 5) | ||
58 | | (((PAL_PORT(pin)->IDR >> (1*PAL_PAD(pin))) & 0x1) << 7) | ||
59 | | (((PAL_PORT(pin)->ODR >> (1*PAL_PAD(pin))) & 0x1) << 8); | ||
60 | #else | 54 | #else |
61 | return 0; | 55 | return 0; |
62 | #endif | 56 | #endif |
@@ -68,12 +62,12 @@ void restorePinState(pin_t pin, uint16_t restoreState) { | |||
68 | PORTx_ADDRESS(pin) = (PORTx_ADDRESS(pin) & ~_BV(pinNumber)) | (((restoreState >> 1) & 0x1) << pinNumber); | 62 | PORTx_ADDRESS(pin) = (PORTx_ADDRESS(pin) & ~_BV(pinNumber)) | (((restoreState >> 1) & 0x1) << pinNumber); |
69 | DDRx_ADDRESS(pin) = (DDRx_ADDRESS(pin) & ~_BV(pinNumber)) | ((restoreState & 0x1) << pinNumber); | 63 | DDRx_ADDRESS(pin) = (DDRx_ADDRESS(pin) & ~_BV(pinNumber)) | ((restoreState & 0x1) << pinNumber); |
70 | #elif defined(PROTOCOL_CHIBIOS) | 64 | #elif defined(PROTOCOL_CHIBIOS) |
71 | PAL_PORT(pin)->MODER = (PAL_PORT(pin)->MODER & ~(0x3<< (2*PAL_PAD(pin)))) | (restoreState & 0x3) << (2*PAL_PAD(pin)); | 65 | PAL_PORT(pin)->MODER = (PAL_PORT(pin)->MODER & ~(0x3 << (2 * PAL_PAD(pin)))) | (restoreState & 0x3) << (2 * PAL_PAD(pin)); |
72 | PAL_PORT(pin)->OTYPER = (PAL_PORT(pin)->OTYPER & ~(0x1<< (1*PAL_PAD(pin)))) | ((restoreState>>2) & 0x1) << (1*PAL_PAD(pin)); | 66 | PAL_PORT(pin)->OTYPER = (PAL_PORT(pin)->OTYPER & ~(0x1 << (1 * PAL_PAD(pin)))) | ((restoreState >> 2) & 0x1) << (1 * PAL_PAD(pin)); |
73 | PAL_PORT(pin)->OSPEEDR= (PAL_PORT(pin)->OSPEEDR & ~(0x3<< (2*PAL_PAD(pin)))) | ((restoreState>>3) & 0x3) << (2*PAL_PAD(pin)); | 67 | PAL_PORT(pin)->OSPEEDR = (PAL_PORT(pin)->OSPEEDR & ~(0x3 << (2 * PAL_PAD(pin)))) | ((restoreState >> 3) & 0x3) << (2 * PAL_PAD(pin)); |
74 | PAL_PORT(pin)->PUPDR = (PAL_PORT(pin)->PUPDR & ~(0x3<< (2*PAL_PAD(pin)))) | ((restoreState>>5) & 0x3) << (2*PAL_PAD(pin)); | 68 | PAL_PORT(pin)->PUPDR = (PAL_PORT(pin)->PUPDR & ~(0x3 << (2 * PAL_PAD(pin)))) | ((restoreState >> 5) & 0x3) << (2 * PAL_PAD(pin)); |
75 | PAL_PORT(pin)->IDR = (PAL_PORT(pin)->IDR & ~(0x1<< (1*PAL_PAD(pin)))) | ((restoreState>>7) & 0x1) << (1*PAL_PAD(pin)); | 69 | PAL_PORT(pin)->IDR = (PAL_PORT(pin)->IDR & ~(0x1 << (1 * PAL_PAD(pin)))) | ((restoreState >> 7) & 0x1) << (1 * PAL_PAD(pin)); |
76 | PAL_PORT(pin)->ODR = (PAL_PORT(pin)->ODR & ~(0x1<< (1*PAL_PAD(pin)))) | ((restoreState>>8) & 0x1) << (1*PAL_PAD(pin)); | 70 | PAL_PORT(pin)->ODR = (PAL_PORT(pin)->ODR & ~(0x1 << (1 * PAL_PAD(pin)))) | ((restoreState >> 8) & 0x1) << (1 * PAL_PAD(pin)); |
77 | #else | 71 | #else |
78 | return; | 72 | return; |
79 | #endif | 73 | #endif |
@@ -132,21 +126,21 @@ bool process_joystick_analogread_quantum() { | |||
132 | int16_t axis_val = joystick_axes[axis_index].mid_digit; | 126 | int16_t axis_val = joystick_axes[axis_index].mid_digit; |
133 | # endif | 127 | # endif |
134 | 128 | ||
135 | //test the converted value against the lower range | 129 | // test the converted value against the lower range |
136 | int32_t ref = joystick_axes[axis_index].mid_digit; | 130 | int32_t ref = joystick_axes[axis_index].mid_digit; |
137 | int32_t range = joystick_axes[axis_index].min_digit; | 131 | int32_t range = joystick_axes[axis_index].min_digit; |
138 | int32_t ranged_val = ((axis_val - ref) * -127) / (range - ref) ; | 132 | int32_t ranged_val = ((axis_val - ref) * -127) / (range - ref); |
139 | 133 | ||
140 | if (ranged_val > 0) { | 134 | if (ranged_val > 0) { |
141 | //the value is in the higher range | 135 | // the value is in the higher range |
142 | range = joystick_axes[axis_index].max_digit; | 136 | range = joystick_axes[axis_index].max_digit; |
143 | ranged_val = ((axis_val - ref) * 127) / (range - ref); | 137 | ranged_val = ((axis_val - ref) * 127) / (range - ref); |
144 | } | 138 | } |
145 | 139 | ||
146 | //clamp the result in the valid range | 140 | // clamp the result in the valid range |
147 | ranged_val = ranged_val < -127 ? -127 : ranged_val; | 141 | ranged_val = ranged_val < -127 ? -127 : ranged_val; |
148 | ranged_val = ranged_val > 127 ? 127 : ranged_val; | 142 | ranged_val = ranged_val > 127 ? 127 : ranged_val; |
149 | 143 | ||
150 | if (ranged_val != joystick_status.axes[axis_index]) { | 144 | if (ranged_val != joystick_status.axes[axis_index]) { |
151 | joystick_status.axes[axis_index] = ranged_val; | 145 | joystick_status.axes[axis_index] = ranged_val; |
152 | joystick_status.status |= JS_UPDATED; | 146 | joystick_status.status |= JS_UPDATED; |