1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
|
#include "rev4.h"
//#include "backlight.h"
void matrix_init_kb(void) {
// put your keyboard start-up code here
// runs once when the firmware starts up
matrix_init_user();
led_init_ports();
}
void led_init_ports() {
// Set our LED pins as output
palSetPadMode(GPIOB, 13, PAL_MODE_OUTPUT_PUSHPULL); // LED1
palClearPad(GPIOB, 13);
palSetPadMode(GPIOB, 14, PAL_MODE_OUTPUT_PUSHPULL); // LED2
palClearPad(GPIOB, 14);
palSetPadMode(GPIOA, 8, PAL_MODE_OUTPUT_PUSHPULL); // LED3
palClearPad(GPIOA, 8);
palSetPadMode(GPIOA, 0, PAL_MODE_OUTPUT_PUSHPULL); // Capslock LED
palClearPad(GPIOA, 0);
}
void led_set_kb(uint8_t usb_led) {
if (usb_led & (1<<USB_LED_NUM_LOCK)) {
palSetPad(GPIOB, 13); // LED1
} else {
palClearPad(GPIOB, 13); // LED1
}
if (usb_led & (1<<USB_LED_CAPS_LOCK)) {
palSetPad(GPIOA, 0); // Capslock LED
palSetPad(GPIOB, 14); // LED2
} else {
palClearPad(GPIOA, 0); // Capslock LED
palClearPad(GPIOB, 14); // LED2
}
if (usb_led & (1<<USB_LED_SCROLL_LOCK)) {
palSetPad(GPIOA, 8); // LED3
} else {
palClearPad(GPIOA, 8); // LED3
}
}
|
