diff options
author | tmk <hasu@tmk-kbd.com> | 2015-06-03 00:03:08 +0900 |
---|---|---|
committer | tmk <hasu@tmk-kbd.com> | 2015-06-03 00:29:36 +0900 |
commit | 49b0c7e5ef1683f001c4c9e1c7516da8c5fe592e (patch) | |
tree | 1e3b831f007e4d1632865acfd529b78d37fe19cc | |
parent | 37af88217d62f22fd5d64a7b58285ce9a94d2176 (diff) |
sun_usb: Fix LED status update at startup
-rw-r--r-- | converter/sun_usb/led.c | 2 | ||||
-rw-r--r-- | converter/sun_usb/matrix.c | 15 |
2 files changed, 17 insertions, 0 deletions
diff --git a/converter/sun_usb/led.c b/converter/sun_usb/led.c index 48c3f1c2b2..809398faa5 100644 --- a/converter/sun_usb/led.c +++ b/converter/sun_usb/led.c @@ -18,6 +18,7 @@ along with this program. If not, see <http://www.gnu.org/licenses/>. #include "stdint.h" #include "serial.h" #include "led.h" +#include "debug.h" void led_set(uint8_t usb_led) @@ -27,6 +28,7 @@ void led_set(uint8_t usb_led) if (usb_led & (1<<USB_LED_COMPOSE)) sun_led |= (1<<1); if (usb_led & (1<<USB_LED_SCROLL_LOCK)) sun_led |= (1<<2); if (usb_led & (1<<USB_LED_CAPS_LOCK)) sun_led |= (1<<3); + xprintf("LED: %02X\n", usb_led); serial_send(0x0E); serial_send(sun_led); diff --git a/converter/sun_usb/matrix.c b/converter/sun_usb/matrix.c index f333f542bd..71c818f5ab 100644 --- a/converter/sun_usb/matrix.c +++ b/converter/sun_usb/matrix.c @@ -72,6 +72,21 @@ void matrix_init(void) // initialize matrix state: all keys off for (uint8_t i=0; i < MATRIX_ROWS; i++) matrix[i] = 0x00; + // wait for keyboard coming up + // otherwise LED status update fails + print("Reseting "); + while (1) { + print("."); + while (serial_recv()); + serial_send(0x01); + _delay_ms(500); + if (serial_recv() == 0xFF) { + _delay_ms(500); + if (serial_recv() == 0x04) + break; + } + } + print(" Done\n"); return; } |