diff options
| -rw-r--r-- | hid/pico/src/ph_ps2.c | 17 |
1 files changed, 14 insertions, 3 deletions
diff --git a/hid/pico/src/ph_ps2.c b/hid/pico/src/ph_ps2.c index ec74dc22..a814103c 100644 --- a/hid/pico/src/ph_ps2.c +++ b/hid/pico/src/ph_ps2.c @@ -44,21 +44,32 @@ void ph_ps2_init(void) { gpio_set_dir(_LS_POWER_PIN, GPIO_OUT); gpio_put(_LS_POWER_PIN, true); } - + +# define INIT_STUB(x_pin) { \ + gpio_init(x_pin); gpio_set_dir(x_pin, GPIO_IN); \ + gpio_init(x_pin + 1); gpio_set_dir(x_pin + 1, GPIO_IN); \ + } + if (PH_O_IS_KBD_PS2) { ph_ps2_kbd_init(_KBD_DATA_PIN); + } else { + INIT_STUB(_KBD_DATA_PIN); } - + if (PH_O_IS_MOUSE_PS2) { ph_ps2_mouse_init(_MOUSE_DATA_PIN); + } else { + INIT_STUB(_MOUSE_DATA_PIN); } + +# undef INIT_STUB } void ph_ps2_task(void) { if (PH_O_IS_KBD_PS2) { ph_ps2_kbd_task(); } - + if (PH_O_IS_MOUSE_PS2) { ph_ps2_mouse_task(); } |