sun_usb: Fix LED status update at startup
This commit is contained in:
parent
37af88217d
commit
49b0c7e5ef
2 changed files with 17 additions and 0 deletions
|
@ -18,6 +18,7 @@ along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||||
#include "stdint.h"
|
#include "stdint.h"
|
||||||
#include "serial.h"
|
#include "serial.h"
|
||||||
#include "led.h"
|
#include "led.h"
|
||||||
|
#include "debug.h"
|
||||||
|
|
||||||
|
|
||||||
void led_set(uint8_t usb_led)
|
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_COMPOSE)) sun_led |= (1<<1);
|
||||||
if (usb_led & (1<<USB_LED_SCROLL_LOCK)) sun_led |= (1<<2);
|
if (usb_led & (1<<USB_LED_SCROLL_LOCK)) sun_led |= (1<<2);
|
||||||
if (usb_led & (1<<USB_LED_CAPS_LOCK)) sun_led |= (1<<3);
|
if (usb_led & (1<<USB_LED_CAPS_LOCK)) sun_led |= (1<<3);
|
||||||
|
xprintf("LED: %02X\n", usb_led);
|
||||||
|
|
||||||
serial_send(0x0E);
|
serial_send(0x0E);
|
||||||
serial_send(sun_led);
|
serial_send(sun_led);
|
||||||
|
|
|
@ -72,6 +72,21 @@ void matrix_init(void)
|
||||||
// initialize matrix state: all keys off
|
// initialize matrix state: all keys off
|
||||||
for (uint8_t i=0; i < MATRIX_ROWS; i++) matrix[i] = 0x00;
|
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;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Reference in a new issue