diff options
Diffstat (limited to 'hid/pico/src')
| -rw-r--r-- | hid/pico/src/CMakeLists.txt | 11 | ||||
| -rw-r--r-- | hid/pico/src/ph_outputs.h | 1 | ||||
| -rw-r--r-- | hid/pico/src/ph_ps2.c | 78 | ||||
| -rw-r--r-- | hid/pico/src/ph_ps2.h | 4 | ||||
| -rw-r--r-- | hid/pico/src/ph_ps2_kbd.c | 223 | ||||
| -rw-r--r-- | hid/pico/src/ph_ps2_mouse.c | 148 |
6 files changed, 417 insertions, 48 deletions
diff --git a/hid/pico/src/CMakeLists.txt b/hid/pico/src/CMakeLists.txt index cb1c7feb..facab804 100644 --- a/hid/pico/src/CMakeLists.txt +++ b/hid/pico/src/CMakeLists.txt @@ -8,24 +8,29 @@ target_sources(${target_name} PRIVATE ph_usb_kbd.c ph_usb_mouse.c ph_ps2.c + ph_ps2_kbd.c + ph_ps2_mouse.c ph_cmds.c ph_com.c ph_com_bridge.c ph_com_spi.c ph_com_uart.c ph_debug.c - # TODO: PS2: ${PS2_PATH}/foo.c + + ${PS2_PATH}/ps2phy.c ) target_link_options(${target_name} PRIVATE -Xlinker --print-memory-usage) target_compile_options(${target_name} PRIVATE -Wall -Wextra) -target_include_directories(${target_name} PRIVATE ${CMAKE_CURRENT_LIST_DIR}) +target_include_directories(${target_name} PRIVATE ${CMAKE_CURRENT_LIST_DIR} ${PS2_PATH}) + +pico_generate_pio_header(${target_name} ${PS2_PATH}/ps2phy.pio) target_link_libraries(${target_name} PRIVATE pico_stdlib pico_unique_id + hardware_pio hardware_spi hardware_watchdog tinyusb_device - # TODO: PS2: ... or make a library ) pico_add_extra_outputs(${target_name}) diff --git a/hid/pico/src/ph_outputs.h b/hid/pico/src/ph_outputs.h index ce68ac30..d2487327 100644 --- a/hid/pico/src/ph_outputs.h +++ b/hid/pico/src/ph_outputs.h @@ -26,6 +26,7 @@ #include "ph_proto.h" +#define PH_O_HAS_PS2 (!!(ph_g_outputs_avail & PH_PROTO_OUT2_HAS_PS2)) #define PH_O_KBD(x_id) ((ph_g_outputs_active & PH_PROTO_OUT1_KBD_MASK) == PH_PROTO_OUT1_KBD_##x_id) #define PH_O_MOUSE(x_id) ((ph_g_outputs_active & PH_PROTO_OUT1_MOUSE_MASK) == PH_PROTO_OUT1_MOUSE_##x_id) #define PH_O_IS_KBD_USB PH_O_KBD(USB) diff --git a/hid/pico/src/ph_ps2.c b/hid/pico/src/ph_ps2.c index 60723a1c..a814103c 100644 --- a/hid/pico/src/ph_ps2.c +++ b/hid/pico/src/ph_ps2.c @@ -25,6 +25,13 @@ #include "ph_types.h" #include "ph_outputs.h" +#include "hardware/gpio.h" + + +#define _LS_POWER_PIN 13 +#define _KBD_DATA_PIN 11 // CLK == 12 +#define _MOUSE_DATA_PIN 14 // CLK == 15 + u8 ph_g_ps2_kbd_leds = 0; bool ph_g_ps2_kbd_online = 0; @@ -32,59 +39,40 @@ bool ph_g_ps2_mouse_online = 0; void ph_ps2_init(void) { - // TODO: PS2: Initialize PS/2 stuff here IF you have at least one PS/2 device, check ph_usb.c for the example - // Use macro PH_O_IS_KBD_PS2 and PH_O_IS_MOUSE_PS2 - if (PH_O_IS_KBD_PS2 || PH_O_IS_MOUSE_PS2) { - // ... + if (PH_O_HAS_PS2) { + gpio_init(_LS_POWER_PIN); + gpio_set_dir(_LS_POWER_PIN, GPIO_OUT); + gpio_put(_LS_POWER_PIN, true); } -} -void ph_ps2_task(void) { - // TODO: PS2: Perform periodic stuff here IF you have at least one PS/2 device, check ph_usb.c - if (PH_O_IS_KBD_PS2 || PH_O_IS_MOUSE_PS2) { - // ... +# 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); \ } - // Here you should update some values: - // - ph_g_ps2_kbd_leds - keyboard LEDs mask like on USB - // - ph_g_ps2_kbd_online - if keyboard online (by clock?) - // - ph_g_ps2_mouse_online if mouse online (by clock?) - // It is important not to have ANY sleep() call inside it. - // There should also be no freezes if the keyboard or mouse is not available. -} -void ph_ps2_kbd_send_key(u8 key, bool state) { - // TODO: PS2: Send keyboard key - // @key - is a USB keycode, modifier keys has range 0xE0...0xE7, check ph_usb_kbd_send_key() - // @state - true if pressed, false if released - // The function should take care not to send duplicate events (if needed for PS/2) - // If the PS2 keyboard is not used (PH_O_IS_KBD_PS2 is false), the function should do nothing. - (void)key; // Remove this - (void)state; // Remove this -} + if (PH_O_IS_KBD_PS2) { + ph_ps2_kbd_init(_KBD_DATA_PIN); + } else { + INIT_STUB(_KBD_DATA_PIN); + } -void ph_ps2_mouse_send_button(u8 button, bool state) { - // TODO: PS2: Send mouse button - // @button - USB button code - // @state - true if pressed, false if released - // The function should take care not to send duplicate events (if needed for PS/2) - // If the PS2 keyboard is not used (PH_O_IS_MOUSE_PS2 is false), the function should do nothing. - (void)button; // Remove this - (void)state; // Remove this -} + if (PH_O_IS_MOUSE_PS2) { + ph_ps2_mouse_init(_MOUSE_DATA_PIN); + } else { + INIT_STUB(_MOUSE_DATA_PIN); + } -void ph_ps2_mouse_send_rel(s8 x, s8 y) { - // TODO: PS2: Send relative move event - // If the PS2 keyboard is not used (PH_O_IS_MOUSE_PS2 is false), the function should do nothing. - (void)x; // Remove this - (void)y; // Remove this +# undef INIT_STUB } -void ph_ps2_mouse_send_wheel(s8 h, s8 v) { - (void)h; - // TODO: PS2: Send wheel. As I understand, PS/2 has no horizontal scrolling, so @h just can be ignored. - // @v - vertical scrolling like on USB - // If the PS2 keyboard is not used (PH_O_IS_MOUSE_PS2 is false), the function should do nothing. - (void)v; // Remove this +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(); + } } void ph_ps2_send_clear(void) { diff --git a/hid/pico/src/ph_ps2.h b/hid/pico/src/ph_ps2.h index 057299f3..6766cbf9 100644 --- a/hid/pico/src/ph_ps2.h +++ b/hid/pico/src/ph_ps2.h @@ -33,8 +33,12 @@ extern bool ph_g_ps2_mouse_online; void ph_ps2_init(void); void ph_ps2_task(void); +void ph_ps2_kbd_init(u8 gpio); +void ph_ps2_kbd_task(void); void ph_ps2_kbd_send_key(u8 key, bool state); +void ph_ps2_mouse_init(u8 gpio); +void ph_ps2_mouse_task(void); void ph_ps2_mouse_send_button(u8 button, bool state); void ph_ps2_mouse_send_rel(s8 x, s8 y); void ph_ps2_mouse_send_wheel(s8 h, s8 v); diff --git a/hid/pico/src/ph_ps2_kbd.c b/hid/pico/src/ph_ps2_kbd.c new file mode 100644 index 00000000..02229e96 --- /dev/null +++ b/hid/pico/src/ph_ps2_kbd.c @@ -0,0 +1,223 @@ +#include "ps2phy.h" + +#include "ph_outputs.h" + +extern u8 ph_g_ps2_kbd_leds; +extern bool ph_g_ps2_kbd_online; + +ps2phy ph_ps2_kbd; +bool ph_ps2_kbd_scanning; +u32 ph_ps2_kbd_repeat_us; +u16 ph_ps2_kbd_delay_ms; +u8 ph_ps2_kbd_repeat = 0; +bool ph_ps2_kbd_repeatmod = false; +alarm_id_t ph_ps2_kbd_repeater; +s8 ph_ps2_is_ctrl = 0; + +u8 const ph_ps2_led2ps2[] = { 0, 4, 1, 5, 2, 6, 3, 7 }; +u8 const ph_ps2_mod2ps2[] = { 0x14, 0x12, 0x11, 0x1f, 0x14, 0x59, 0x11, 0x27 }; +u8 const ph_ps2_hid2ps2[] = { + 0x00, 0x00, 0xfc, 0x00, 0x1c, 0x32, 0x21, 0x23, 0x24, 0x2b, 0x34, 0x33, 0x43, 0x3b, 0x42, 0x4b, + 0x3a, 0x31, 0x44, 0x4d, 0x15, 0x2d, 0x1b, 0x2c, 0x3c, 0x2a, 0x1d, 0x22, 0x35, 0x1a, 0x16, 0x1e, + 0x26, 0x25, 0x2e, 0x36, 0x3d, 0x3e, 0x46, 0x45, 0x5a, 0x76, 0x66, 0x0d, 0x29, 0x4e, 0x55, 0x54, + 0x5b, 0x5d, 0x5d, 0x4c, 0x52, 0x0e, 0x41, 0x49, 0x4a, 0x58, 0x05, 0x06, 0x04, 0x0c, 0x03, 0x0b, + 0x83, 0x0a, 0x01, 0x09, 0x78, 0x07, 0x7c, 0x7e, 0x7e, 0x70, 0x6c, 0x7d, 0x71, 0x69, 0x7a, 0x74, + 0x6b, 0x72, 0x75, 0x77, 0x4a, 0x7c, 0x7b, 0x79, 0x5a, 0x69, 0x72, 0x7a, 0x6b, 0x73, 0x74, 0x6c, + 0x75, 0x7d, 0x70, 0x71, 0x61, 0x2f, 0x37, 0x0f, 0x08, 0x10, 0x18, 0x20, 0x28, 0x30, 0x38, 0x40, + 0x48, 0x50, 0x57, 0x5f +}; +u8 const ph_ps2_maparray = sizeof(ph_ps2_hid2ps2); +u32 const ph_ps2_repeats[] = { + 33333, 37453, 41667, 45872, 48309, 54054, 58480, 62500, + 66667, 75188, 83333, 91743, 100000, 108696, 116279, 125000, + 133333, 149254, 166667, 181818, 200000, 217391, 232558, 250000, + 270270, 303030, 333333, 370370, 400000, 434783, 476190, 500000 +}; +u16 const ph_ps2_delays[] = { 250, 500, 750, 1000 }; + +void ph_ps2_kbd_send(u8 byte) { + queue_try_add(&ph_ps2_kbd.qbytes, &byte); +} + +void ph_ps2_kbd_maybe_send_e0(u8 byte) { + if (byte == 0x46 || + (byte >= 0x49 && byte <= 0x52) || + byte == 0x54 || byte == 0x58 || + byte == 0x65 || byte == 0x66 || + byte >= 0x81) { + ph_ps2_kbd_send(0xe0); + } +} + +int64_t ph_ps2_repeat_callback() { + if (ph_ps2_kbd_repeat) { + if (ph_ps2_kbd_repeatmod) { + + if (ph_ps2_kbd_repeat > 3 && ph_ps2_kbd_repeat != 6) ph_ps2_kbd_send(0xe0); + ph_ps2_kbd_send(ph_ps2_mod2ps2[ph_ps2_kbd_repeat - 1]); + + } else { + + ph_ps2_kbd_maybe_send_e0(ph_ps2_kbd_repeat); + ph_ps2_kbd_send(ph_ps2_hid2ps2[ph_ps2_kbd_repeat]); + + } + + return ph_ps2_kbd_repeat_us; + } + + ph_ps2_kbd_repeater = 0; + return 0; +} + +int64_t ph_ps2_blink_callback() { + ph_g_ps2_kbd_leds = 0; + ph_ps2_kbd_send(0xaa); + return 0; +} + +void ph_ps2_kbd_reset() { + ph_ps2_kbd_scanning = true; + ph_ps2_kbd_repeat_us = 91743; + ph_ps2_kbd_delay_ms = 500; + ph_ps2_kbd_repeat = 0; + ph_g_ps2_kbd_leds = 7; + add_alarm_in_ms(500, ph_ps2_blink_callback, NULL, false); +} + +void ph_ps2_kbd_send_key(u8 key, bool state) { + if (PH_O_IS_KBD_PS2 && ph_ps2_kbd_scanning) { + if (key >= 0xe0 && key <= 0xe7) { + + if (key == 0xe0 || key == 0xe4) { + if (state) { + ph_ps2_is_ctrl++; + } else { + ph_ps2_is_ctrl--; + } + + if (ph_ps2_is_ctrl < 0 || ph_ps2_is_ctrl > 2) { + ph_ps2_is_ctrl = 0; + } + } + + key -= 0xe0; + + if (key > 2 && key != 5) { + ph_ps2_kbd_send(0xe0); + } + + if (state) { + ph_ps2_kbd_repeat = key + 1; + ph_ps2_kbd_repeatmod = true; + + if (ph_ps2_kbd_repeater) { + cancel_alarm(ph_ps2_kbd_repeater); + } + + ph_ps2_kbd_repeater = add_alarm_in_ms(ph_ps2_kbd_delay_ms, ph_ps2_repeat_callback, NULL, false); + } else { + if (ph_ps2_kbd_repeat == key + 1 && ph_ps2_kbd_repeatmod) { + ph_ps2_kbd_repeat = 0; + } + + ph_ps2_kbd_send(0xf0); + } + + ph_ps2_kbd_send(ph_ps2_mod2ps2[key]); + + } else if (key < ph_ps2_maparray) { + + if (key == 0x48) { + ph_ps2_kbd_repeat = 0; + + if (state) { + if (ph_ps2_is_ctrl) { + ph_ps2_kbd_send(0xe0); ph_ps2_kbd_send(0x7e); ph_ps2_kbd_send(0xe0); ph_ps2_kbd_send(0xf0); ph_ps2_kbd_send(0x7e); + } else { + ph_ps2_kbd_send(0xe1); ph_ps2_kbd_send(0x14); ph_ps2_kbd_send(0x77); ph_ps2_kbd_send(0xe1); + ph_ps2_kbd_send(0xf0); ph_ps2_kbd_send(0x14); ph_ps2_kbd_send(0xf0); ph_ps2_kbd_send(0x77); + } + } + } else { + ph_ps2_kbd_maybe_send_e0(key); + + if (state) { + ph_ps2_kbd_repeat = key; + ph_ps2_kbd_repeatmod = false; + + if (ph_ps2_kbd_repeater) { + cancel_alarm(ph_ps2_kbd_repeater); + } + + ph_ps2_kbd_repeater = add_alarm_in_ms(ph_ps2_kbd_delay_ms, ph_ps2_repeat_callback, NULL, false); + } else { + if (ph_ps2_kbd_repeat == key && !ph_ps2_kbd_repeatmod) { + ph_ps2_kbd_repeat = 0; + } + + ph_ps2_kbd_send(0xf0); + } + + ph_ps2_kbd_send(ph_ps2_hid2ps2[key]); + } + } + } +} + +void ph_ps2_kbd_receive(u8 byte, u8 prev_byte) { + switch (prev_byte) { + case 0xed: // Set LEDs + if (byte > 7) byte = 0; + ph_g_ps2_kbd_leds = ph_ps2_led2ps2[byte]; + break; + + case 0xf3: // Set typematic rate and delay + ph_ps2_kbd_repeat_us = ph_ps2_repeats[byte & 0x1f]; + ph_ps2_kbd_delay_ms = ph_ps2_delays[(byte & 0x60) >> 5]; + break; + + default: + switch (byte) { + case 0xff: // Reset + ph_ps2_kbd_reset(); + break; + + case 0xee: // Echo + ph_ps2_kbd_send(0xee); + return; + + case 0xf2: // Identify keyboard + ph_ps2_kbd_send(0xfa); + ph_ps2_kbd_send(0xab); + ph_ps2_kbd_send(0x83); + return; + + case 0xf4: // Enable scanning + ph_ps2_kbd_scanning = true; + break; + + case 0xf5: // Disable scanning, restore default parameters + case 0xf6: // Set default parameters + ph_ps2_kbd_scanning = byte == 0xf6; + ph_ps2_kbd_repeat_us = 91743; + ph_ps2_kbd_delay_ms = 500; + ph_ps2_kbd_repeat = 0; + ph_g_ps2_kbd_leds = 0; + break; + } + break; + } + + ph_ps2_kbd_send(0xfa); +} + +void ph_ps2_kbd_task(void) { + ps2phy_task(&ph_ps2_kbd); + ph_g_ps2_kbd_online = ph_ps2_kbd_scanning && !ph_ps2_kbd.busy; +} + +void ph_ps2_kbd_init(u8 gpio) { + ps2phy_init(&ph_ps2_kbd, pio0, gpio, &ph_ps2_kbd_receive); + ph_ps2_kbd_reset(); +} diff --git a/hid/pico/src/ph_ps2_mouse.c b/hid/pico/src/ph_ps2_mouse.c new file mode 100644 index 00000000..a56b814a --- /dev/null +++ b/hid/pico/src/ph_ps2_mouse.c @@ -0,0 +1,148 @@ +#include "ps2phy.h" + +#include "ph_outputs.h" + +extern bool ph_g_ps2_mouse_online; + +ps2phy ph_ps2_mouse; +bool ph_ps2_mouse_streaming = false; +u32 ph_ps2_mouse_magic_seq = 0; +u8 ph_ps2_mouse_type = 0; +u8 ph_ps2_mouse_buttons = 0; + +void ph_ps2_mouse_send(u8 byte) { + queue_try_add(&ph_ps2_mouse.qbytes, &byte); +} + +void ph_ps2_mouse_pack(s8 x, s8 y, s8 h, s8 v) { + if (ph_ps2_mouse_streaming) { + u8 byte1 = 0x8 | (ph_ps2_mouse_buttons & 0x7); + s8 byte2 = x; + s8 byte3 = 0x100 - y; + s8 byte4 = 0; // = 0x100 - z; + + if (byte2 < 0) byte1 |= 0x10; + if (byte3 < 0) byte1 |= 0x20; + + ph_ps2_mouse_send(byte1); + ph_ps2_mouse_send(byte2); + ph_ps2_mouse_send(byte3); + + if (ph_ps2_mouse_type == 3 || ph_ps2_mouse_type == 4) { + //if (byte4 < -8) byte4 = -8; + //if (byte4 > 7) byte4 = 7; + //if (byte4 < 0) byte4 |= 0xf8; + + if (v < 0) byte4 = 0x01; + if (v > 0) byte4 = 0xff; + if (h < 0) byte4 = 0x02; + if (h > 0) byte4 = 0xfe; + + if (ph_ps2_mouse_type == 4) { + byte4 &= 0xf; + byte4 |= (ph_ps2_mouse_buttons << 1) & 0x30; + } + + ph_ps2_mouse_send(byte4); + } + } +} + +void ph_ps2_mouse_send_button(u8 button, bool state) { + if (PH_O_IS_MOUSE_PS2) { + button--; + + if (state) { + ph_ps2_mouse_buttons = ph_ps2_mouse_buttons | (1 << button); + } else { + ph_ps2_mouse_buttons = ph_ps2_mouse_buttons & ~(1 << button); + } + + ph_ps2_mouse_pack(0, 0, 0, 0); + } +} + +void ph_ps2_mouse_send_rel(s8 x, s8 y) { + if (PH_O_IS_MOUSE_PS2) { + ph_ps2_mouse_pack(x, y, 0, 0); + } +} + +void ph_ps2_mouse_send_wheel(s8 h, s8 v) { + if (PH_O_IS_MOUSE_PS2) { + ph_ps2_mouse_pack(0, 0, h, v); + } +} + +void ph_ps2_mouse_receive(u8 byte, u8 prev_byte) { + switch (prev_byte) { + case 0xf3: // Set Sample Rate + ph_ps2_mouse_magic_seq = ((ph_ps2_mouse_magic_seq << 8) | byte) & 0xffffff; + + if (ph_ps2_mouse_type == 0 && ph_ps2_mouse_magic_seq == 0xc86450) { + ph_ps2_mouse_type = 3; + } else if (ph_ps2_mouse_type == 3 && ph_ps2_mouse_magic_seq == 0xc8c850) { + ph_ps2_mouse_type = 4; + } + break; + + default: + switch (byte) { + case 0xff: // Reset + ph_ps2_mouse_streaming = false; + ph_ps2_mouse_type = 0; + + ph_ps2_mouse_send(0xfa); + ph_ps2_mouse_send(0xaa); + ph_ps2_mouse_send(ph_ps2_mouse_type); + return; + + case 0xf6: // Set Defaults + ph_ps2_mouse_streaming = false; + ph_ps2_mouse_type = 0; + break; + + case 0xf5: // Disable Data Reporting + case 0xea: // Set Stream Mode + ph_ps2_mouse_streaming = false; + break; + + case 0xf4: // Enable Data Reporting + ph_ps2_mouse_streaming = true; + break; + + case 0xf2: // Get Device ID + ph_ps2_mouse_send(0xfa); + ph_ps2_mouse_send(ph_ps2_mouse_type); + return; + + case 0xe9: // Status Request + ph_ps2_mouse_send(0xfa); + ph_ps2_mouse_send(0x00); // Bit6: Mode, Bit 5: Enable, Bit 4: Scaling, Bits[2,1,0] = Buttons[L,M,R] + ph_ps2_mouse_send(0x02); // Resolution + ph_ps2_mouse_send(100); // Sample Rate + return; + + // TODO: Implement (more of) these? + // case 0xf0: // Set Remote Mode + // case 0xee: // Set Wrap Mode + // case 0xec: // Reset Wrap Mode + // case 0xeb: // Read Data + // case 0xe8: // Set Resolution + // case 0xe7: // Set Scaling 2:1 + // case 0xe6: // Set Scaling 1:1 + } + break; + } + + ph_ps2_mouse_send(0xfa); +} + +void ph_ps2_mouse_task(void) { + ps2phy_task(&ph_ps2_mouse); + ph_g_ps2_mouse_online = ph_ps2_mouse_streaming && !ph_ps2_mouse.busy; +} + +void ph_ps2_mouse_init(u8 gpio) { + ps2phy_init(&ph_ps2_mouse, pio0, gpio, &ph_ps2_mouse_receive); +} |