diff options
Diffstat (limited to 'hid/pico/src/main.c')
| -rw-r--r-- | hid/pico/src/main.c | 24 |
1 files changed, 4 insertions, 20 deletions
diff --git a/hid/pico/src/main.c b/hid/pico/src/main.c index 7f58e876..a1c9531f 100644 --- a/hid/pico/src/main.c +++ b/hid/pico/src/main.c @@ -29,22 +29,12 @@ #include "ph_outputs.h" #include "ph_usb.h" #include "ph_ps2.h" -#include "ph_spi.h" -#include "ph_uart.h" +#include "ph_com.h" #include "ph_proto.h" #include "ph_cmds.h" #include "ph_debug.h" -#define _COMM_PIN 22 - - -static bool _comm_use_spi = true; -#define _COMM(x_func, ...) { \ - if (_comm_use_spi) { ph_spi_##x_func(__VA_ARGS__); } \ - else { ph_uart_##x_func(__VA_ARGS__); } \ - } - static bool _reset_required = false; @@ -104,7 +94,7 @@ static void _send_response(u8 code) { ph_split16(ph_crc16(resp, 6), &resp[6], &resp[7]); - _COMM(write, resp); + ph_com_write(resp); if (_reset_required) { watchdog_reboot(0, 0, 100); // Даем немного времени чтобы отправить ответ, а потом ребутимся @@ -126,19 +116,13 @@ int main(void) { ph_outputs_init(); ph_usb_init(); ph_ps2_init(); - - gpio_init(_COMM_PIN); - gpio_set_dir(_COMM_PIN, GPIO_IN); - gpio_pull_up(_COMM_PIN); - sleep_ms(10); // Нужен небольшой слип для активации pull-up - _comm_use_spi = gpio_get(_COMM_PIN); - _COMM(init, _data_handler, _timeout_handler); + ph_com_init(_data_handler, _timeout_handler); while (true) { ph_usb_task(); ph_ps2_task(); if (!_reset_required) { - _COMM(task); + ph_com_task(); //ph_debug_act_pulse(100); } } |