|
24 | 24 | * THE SOFTWARE.
|
25 | 25 | */
|
26 | 26 |
|
| 27 | +#include "keymap.h" |
27 | 28 | #include "supervisor/board.h"
|
| 29 | +#include "supervisor/shared/serial.h" |
28 | 30 | #include "mpconfigboard.h"
|
29 | 31 | #include "shared-bindings/busio/SPI.h"
|
30 | 32 | #include "shared-bindings/fourwire/FourWire.h"
|
31 | 33 | #include "shared-bindings/microcontroller/Pin.h"
|
32 | 34 | #include "shared-module/displayio/__init__.h"
|
33 | 35 | #include "shared-module/displayio/mipi_constants.h"
|
34 | 36 | #include "shared-bindings/board/__init__.h"
|
| 37 | +#include "shared-bindings/keypad_demux/DemuxKeyMatrix.h" |
| 38 | +#include "shared-bindings/keypad/EventQueue.h" |
| 39 | +#include "shared-bindings/keypad/Event.h" |
| 40 | +#include "supervisor/shared/reload.h" |
| 41 | +#include "py/runtime.h" |
| 42 | +#include "py/ringbuf.h" |
| 43 | +#include "shared/runtime/interrupt_char.h" |
35 | 44 |
|
36 | 45 | fourwire_fourwire_obj_t board_display_obj;
|
| 46 | +keypad_demux_demuxkeymatrix_obj_t board_keyboard; |
| 47 | + |
| 48 | +void update_keyboard(keypad_eventqueue_obj_t *queue); |
| 49 | +void keyboard_seq(const char *seq); |
| 50 | + |
| 51 | +const mcu_pin_obj_t *row_addr_pins[] = { |
| 52 | + &pin_GPIO8, |
| 53 | + &pin_GPIO9, |
| 54 | + &pin_GPIO11, |
| 55 | +}; |
| 56 | + |
| 57 | +const mcu_pin_obj_t *column_pins[] = { |
| 58 | + &pin_GPIO13, |
| 59 | + &pin_GPIO15, |
| 60 | + &pin_GPIO3, |
| 61 | + &pin_GPIO4, |
| 62 | + &pin_GPIO5, |
| 63 | + &pin_GPIO6, |
| 64 | + &pin_GPIO7 |
| 65 | +}; |
| 66 | + |
| 67 | +keypad_event_obj_t event; |
| 68 | + |
| 69 | +char keystate[56]; |
| 70 | +ringbuf_t keyqueue; |
| 71 | +char keybuf[32]; |
37 | 72 |
|
38 | 73 | #define DELAY 0x80
|
39 | 74 |
|
@@ -108,6 +143,105 @@ void board_init(void) {
|
108 | 143 | );
|
109 | 144 | }
|
110 | 145 |
|
| 146 | +void board_serial_init() { |
| 147 | + ringbuf_init(&keyqueue, (uint8_t *)keybuf, sizeof(keybuf)); |
| 148 | + common_hal_keypad_demux_demuxkeymatrix_construct( |
| 149 | + &board_keyboard, // self |
| 150 | + 3, // num_row_addr_pins |
| 151 | + row_addr_pins, // row_addr_pins |
| 152 | + 7, // num_column_pins |
| 153 | + column_pins, // column_pins |
| 154 | + 0.01f, // interval |
| 155 | + 20, // max_events |
| 156 | + 2 // debounce_threshold |
| 157 | + ); |
| 158 | + demuxkeymatrix_never_reset(&board_keyboard); |
| 159 | + common_hal_keypad_eventqueue_set_event_handler(board_keyboard.events, update_keyboard); |
| 160 | + |
| 161 | +} |
| 162 | + |
| 163 | +bool board_serial_connected() { |
| 164 | + return true; |
| 165 | +} |
| 166 | + |
| 167 | +uint32_t board_serial_bytes_available() { |
| 168 | + return ringbuf_num_filled(&keyqueue); |
| 169 | +} |
| 170 | + |
| 171 | +void keyboard_seq(const char *seq) { |
| 172 | + while (*seq) { |
| 173 | + ringbuf_put(&keyqueue, *seq++); |
| 174 | + } |
| 175 | +} |
| 176 | + |
| 177 | +void update_keyboard(keypad_eventqueue_obj_t *queue) { |
| 178 | + uint8_t ascii = 0; |
| 179 | + |
| 180 | + if (common_hal_keypad_eventqueue_get_length(queue) == 0) { |
| 181 | + return; |
| 182 | + } |
| 183 | + |
| 184 | + while (common_hal_keypad_eventqueue_get_into(queue, &event)) { |
| 185 | + if (event.pressed) { |
| 186 | + keystate[event.key_number] = 1; |
| 187 | + |
| 188 | + if (keystate[KEY_CTRL]) { |
| 189 | + if (keystate[KEY_ALT] && keystate[KEY_BACKSPACE]) { |
| 190 | + reload_initiate(RUN_REASON_REPL_RELOAD); |
| 191 | + } |
| 192 | + ascii = keymap[event.key_number]; |
| 193 | + if (ascii >= 'a' && ascii <= 'z') { |
| 194 | + ascii -= 'a' - 1; |
| 195 | + } |
| 196 | + |
| 197 | + if (ascii == mp_interrupt_char) { |
| 198 | + mp_sched_keyboard_interrupt(); |
| 199 | + } |
| 200 | + } else if (keystate[KEY_SHIFT]) { |
| 201 | + ascii = keymap_shifted[event.key_number]; |
| 202 | + } else if (keystate[KEY_FN] && event.key_number != KEY_FN) { |
| 203 | + switch (event.key_number | FN_MOD) { |
| 204 | + case KEY_DOWN: |
| 205 | + keyboard_seq("\e[B"); |
| 206 | + break; |
| 207 | + case KEY_UP: |
| 208 | + keyboard_seq("\e[A"); |
| 209 | + break; |
| 210 | + case KEY_DELETE: |
| 211 | + keyboard_seq("\e[3~"); |
| 212 | + break; |
| 213 | + case KEY_LEFT: |
| 214 | + keyboard_seq("\e[D"); |
| 215 | + break; |
| 216 | + case KEY_RIGHT: |
| 217 | + keyboard_seq("\e[C"); |
| 218 | + break; |
| 219 | + case KEY_ESC: |
| 220 | + ringbuf_put(&keyqueue, '\e'); |
| 221 | + break; |
| 222 | + } |
| 223 | + } else { |
| 224 | + ascii = keymap[event.key_number]; |
| 225 | + } |
| 226 | + |
| 227 | + if (ascii > 0) { |
| 228 | + if (keystate[KEY_ALT]) { |
| 229 | + ringbuf_put(&keyqueue, '\e'); |
| 230 | + } else if (keystate[KEY_OPT]) { |
| 231 | + ringbuf_put(&keyqueue, '\x10'); |
| 232 | + } |
| 233 | + ringbuf_put(&keyqueue, ascii); |
| 234 | + } |
| 235 | + |
| 236 | + } else { |
| 237 | + keystate[event.key_number] = 0; |
| 238 | + } |
| 239 | + } |
| 240 | +} |
| 241 | + |
| 242 | +char board_serial_read() { |
| 243 | + return ringbuf_get(&keyqueue); |
| 244 | +} |
111 | 245 |
|
112 | 246 | // Use the MP_WEAK supervisor/shared/board.c versions of routines not defined here.
|
113 | 247 |
|
|
0 commit comments