|
|
|
@ -83,152 +83,156 @@ KBDReportParser kbd_parser3;
|
|
|
|
|
KBDReportParser kbd_parser4;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
uint8_t matrix_rows(void) { return MATRIX_ROWS; }
|
|
|
|
|
uint8_t matrix_cols(void) { return MATRIX_COLS; }
|
|
|
|
|
bool matrix_has_ghost(void) { return false; }
|
|
|
|
|
void matrix_init(void) {
|
|
|
|
|
// USB Host Shield setup
|
|
|
|
|
usb_host.Init();
|
|
|
|
|
kbd1.SetReportParser(0, (HIDReportParser*)&kbd_parser1);
|
|
|
|
|
kbd2.SetReportParser(0, (HIDReportParser*)&kbd_parser2);
|
|
|
|
|
kbd3.SetReportParser(0, (HIDReportParser*)&kbd_parser3);
|
|
|
|
|
kbd4.SetReportParser(0, (HIDReportParser*)&kbd_parser4);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void or_report(report_keyboard_t report) {
|
|
|
|
|
// integrate reports into keyboard_report
|
|
|
|
|
keyboard_report.mods |= report.mods;
|
|
|
|
|
for (uint8_t i = 0; i < KEYBOARD_REPORT_KEYS; i++) {
|
|
|
|
|
if (IS_ANY(report.keys[i])) {
|
|
|
|
|
for (uint8_t j = 0; j < KEYBOARD_REPORT_KEYS; j++) {
|
|
|
|
|
if (! keyboard_report.keys[j]) {
|
|
|
|
|
keyboard_report.keys[j] = report.keys[i];
|
|
|
|
|
break;
|
|
|
|
|
extern "C"
|
|
|
|
|
{
|
|
|
|
|
uint8_t matrix_rows(void) { return MATRIX_ROWS; }
|
|
|
|
|
uint8_t matrix_cols(void) { return MATRIX_COLS; }
|
|
|
|
|
bool matrix_has_ghost(void) { return false; }
|
|
|
|
|
void matrix_init(void) {
|
|
|
|
|
// USB Host Shield setup
|
|
|
|
|
usb_host.Init();
|
|
|
|
|
kbd1.SetReportParser(0, (HIDReportParser*)&kbd_parser1);
|
|
|
|
|
kbd2.SetReportParser(0, (HIDReportParser*)&kbd_parser2);
|
|
|
|
|
kbd3.SetReportParser(0, (HIDReportParser*)&kbd_parser3);
|
|
|
|
|
kbd4.SetReportParser(0, (HIDReportParser*)&kbd_parser4);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void or_report(report_keyboard_t report) {
|
|
|
|
|
// integrate reports into keyboard_report
|
|
|
|
|
keyboard_report.mods |= report.mods;
|
|
|
|
|
for (uint8_t i = 0; i < KEYBOARD_REPORT_KEYS; i++) {
|
|
|
|
|
if (IS_ANY(report.keys[i])) {
|
|
|
|
|
for (uint8_t j = 0; j < KEYBOARD_REPORT_KEYS; j++) {
|
|
|
|
|
if (! keyboard_report.keys[j]) {
|
|
|
|
|
keyboard_report.keys[j] = report.keys[i];
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
uint8_t matrix_scan(void) {
|
|
|
|
|
static uint16_t last_time_stamp1 = 0;
|
|
|
|
|
static uint16_t last_time_stamp2 = 0;
|
|
|
|
|
static uint16_t last_time_stamp3 = 0;
|
|
|
|
|
static uint16_t last_time_stamp4 = 0;
|
|
|
|
|
|
|
|
|
|
// check report came from keyboards
|
|
|
|
|
if (kbd_parser1.time_stamp != last_time_stamp1 ||
|
|
|
|
|
kbd_parser2.time_stamp != last_time_stamp2 ||
|
|
|
|
|
kbd_parser3.time_stamp != last_time_stamp3 ||
|
|
|
|
|
kbd_parser4.time_stamp != last_time_stamp4) {
|
|
|
|
|
|
|
|
|
|
last_time_stamp1 = kbd_parser1.time_stamp;
|
|
|
|
|
last_time_stamp2 = kbd_parser2.time_stamp;
|
|
|
|
|
last_time_stamp3 = kbd_parser3.time_stamp;
|
|
|
|
|
last_time_stamp4 = kbd_parser4.time_stamp;
|
|
|
|
|
|
|
|
|
|
// clear and integrate all reports
|
|
|
|
|
keyboard_report = {};
|
|
|
|
|
or_report(kbd_parser1.report);
|
|
|
|
|
or_report(kbd_parser2.report);
|
|
|
|
|
or_report(kbd_parser3.report);
|
|
|
|
|
or_report(kbd_parser4.report);
|
|
|
|
|
|
|
|
|
|
matrix_is_mod = true;
|
|
|
|
|
|
|
|
|
|
dprintf("state: %02X %02X", keyboard_report.mods, keyboard_report.reserved);
|
|
|
|
|
for (uint8_t i = 0; i < KEYBOARD_REPORT_KEYS; i++) {
|
|
|
|
|
dprintf(" %02X", keyboard_report.keys[i]);
|
|
|
|
|
|
|
|
|
|
uint8_t matrix_scan(void) {
|
|
|
|
|
static uint16_t last_time_stamp1 = 0;
|
|
|
|
|
static uint16_t last_time_stamp2 = 0;
|
|
|
|
|
static uint16_t last_time_stamp3 = 0;
|
|
|
|
|
static uint16_t last_time_stamp4 = 0;
|
|
|
|
|
|
|
|
|
|
// check report came from keyboards
|
|
|
|
|
if (kbd_parser1.time_stamp != last_time_stamp1 ||
|
|
|
|
|
kbd_parser2.time_stamp != last_time_stamp2 ||
|
|
|
|
|
kbd_parser3.time_stamp != last_time_stamp3 ||
|
|
|
|
|
kbd_parser4.time_stamp != last_time_stamp4) {
|
|
|
|
|
|
|
|
|
|
last_time_stamp1 = kbd_parser1.time_stamp;
|
|
|
|
|
last_time_stamp2 = kbd_parser2.time_stamp;
|
|
|
|
|
last_time_stamp3 = kbd_parser3.time_stamp;
|
|
|
|
|
last_time_stamp4 = kbd_parser4.time_stamp;
|
|
|
|
|
|
|
|
|
|
// clear and integrate all reports
|
|
|
|
|
keyboard_report = {};
|
|
|
|
|
or_report(kbd_parser1.report);
|
|
|
|
|
or_report(kbd_parser2.report);
|
|
|
|
|
or_report(kbd_parser3.report);
|
|
|
|
|
or_report(kbd_parser4.report);
|
|
|
|
|
|
|
|
|
|
matrix_is_mod = true;
|
|
|
|
|
|
|
|
|
|
dprintf("state: %02X %02X", keyboard_report.mods, keyboard_report.reserved);
|
|
|
|
|
for (uint8_t i = 0; i < KEYBOARD_REPORT_KEYS; i++) {
|
|
|
|
|
dprintf(" %02X", keyboard_report.keys[i]);
|
|
|
|
|
}
|
|
|
|
|
dprint("\r\n");
|
|
|
|
|
} else {
|
|
|
|
|
matrix_is_mod = false;
|
|
|
|
|
}
|
|
|
|
|
dprint("\r\n");
|
|
|
|
|
} else {
|
|
|
|
|
matrix_is_mod = false;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
uint16_t timer;
|
|
|
|
|
timer = timer_read();
|
|
|
|
|
usb_host.Task();
|
|
|
|
|
timer = timer_elapsed(timer);
|
|
|
|
|
if (timer > 100) {
|
|
|
|
|
dprintf("host.Task: %d\n", timer);
|
|
|
|
|
}
|
|
|
|
|
uint16_t timer;
|
|
|
|
|
timer = timer_read();
|
|
|
|
|
usb_host.Task();
|
|
|
|
|
timer = timer_elapsed(timer);
|
|
|
|
|
if (timer > 100) {
|
|
|
|
|
dprintf("host.Task: %d\n", timer);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static uint8_t usb_state = 0;
|
|
|
|
|
if (usb_state != usb_host.getUsbTaskState()) {
|
|
|
|
|
usb_state = usb_host.getUsbTaskState();
|
|
|
|
|
dprintf("usb_state: %02X\n", usb_state);
|
|
|
|
|
static uint8_t usb_state = 0;
|
|
|
|
|
if (usb_state != usb_host.getUsbTaskState()) {
|
|
|
|
|
usb_state = usb_host.getUsbTaskState();
|
|
|
|
|
dprintf("usb_state: %02X\n", usb_state);
|
|
|
|
|
|
|
|
|
|
// restore LED state when keyboard comes up
|
|
|
|
|
if (usb_state == USB_STATE_RUNNING) {
|
|
|
|
|
dprintf("speed: %s\n", usb_host.getVbusState()==FSHOST ? "full" : "low");
|
|
|
|
|
keyboard_set_leds(host_keyboard_leds());
|
|
|
|
|
// restore LED state when keyboard comes up
|
|
|
|
|
if (usb_state == USB_STATE_RUNNING) {
|
|
|
|
|
dprintf("speed: %s\n", usb_host.getVbusState()==FSHOST ? "full" : "low");
|
|
|
|
|
keyboard_set_leds(host_keyboard_leds());
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
return 1;
|
|
|
|
|
}
|
|
|
|
|
return 1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
bool matrix_is_modified(void) {
|
|
|
|
|
return matrix_is_mod;
|
|
|
|
|
}
|
|
|
|
|
bool matrix_is_modified(void) {
|
|
|
|
|
return matrix_is_mod;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
bool matrix_is_on(uint8_t row, uint8_t col) {
|
|
|
|
|
uint8_t code = CODE(row, col);
|
|
|
|
|
bool matrix_is_on(uint8_t row, uint8_t col) {
|
|
|
|
|
uint8_t code = CODE(row, col);
|
|
|
|
|
|
|
|
|
|
if (IS_MOD(code)) {
|
|
|
|
|
if (keyboard_report.mods & ROW_BITS(code)) {
|
|
|
|
|
return true;
|
|
|
|
|
if (IS_MOD(code)) {
|
|
|
|
|
if (keyboard_report.mods & ROW_BITS(code)) {
|
|
|
|
|
return true;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
for (uint8_t i = 0; i < KEYBOARD_REPORT_KEYS; i++) {
|
|
|
|
|
if (keyboard_report.keys[i] == code) {
|
|
|
|
|
return true;
|
|
|
|
|
for (uint8_t i = 0; i < KEYBOARD_REPORT_KEYS; i++) {
|
|
|
|
|
if (keyboard_report.keys[i] == code) {
|
|
|
|
|
return true;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
return false;
|
|
|
|
|
}
|
|
|
|
|
return false;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
matrix_row_t matrix_get_row(uint8_t row) {
|
|
|
|
|
uint16_t row_bits = 0;
|
|
|
|
|
matrix_row_t matrix_get_row(uint8_t row) {
|
|
|
|
|
uint16_t row_bits = 0;
|
|
|
|
|
|
|
|
|
|
if (IS_MOD(CODE(row, 0)) && keyboard_report.mods) {
|
|
|
|
|
row_bits |= keyboard_report.mods;
|
|
|
|
|
}
|
|
|
|
|
if (IS_MOD(CODE(row, 0)) && keyboard_report.mods) {
|
|
|
|
|
row_bits |= keyboard_report.mods;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
for (uint8_t i = 0; i < KEYBOARD_REPORT_KEYS; i++) {
|
|
|
|
|
if (IS_ANY(keyboard_report.keys[i])) {
|
|
|
|
|
if (row == ROW(keyboard_report.keys[i])) {
|
|
|
|
|
row_bits |= ROW_BITS(keyboard_report.keys[i]);
|
|
|
|
|
for (uint8_t i = 0; i < KEYBOARD_REPORT_KEYS; i++) {
|
|
|
|
|
if (IS_ANY(keyboard_report.keys[i])) {
|
|
|
|
|
if (row == ROW(keyboard_report.keys[i])) {
|
|
|
|
|
row_bits |= ROW_BITS(keyboard_report.keys[i]);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
return row_bits;
|
|
|
|
|
}
|
|
|
|
|
return row_bits;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
uint8_t matrix_key_count(void) {
|
|
|
|
|
uint8_t count = 0;
|
|
|
|
|
uint8_t matrix_key_count(void) {
|
|
|
|
|
uint8_t count = 0;
|
|
|
|
|
|
|
|
|
|
count += bitpop(keyboard_report.mods);
|
|
|
|
|
for (uint8_t i = 0; i < KEYBOARD_REPORT_KEYS; i++) {
|
|
|
|
|
if (IS_ANY(keyboard_report.keys[i])) {
|
|
|
|
|
count++;
|
|
|
|
|
count += bitpop(keyboard_report.mods);
|
|
|
|
|
for (uint8_t i = 0; i < KEYBOARD_REPORT_KEYS; i++) {
|
|
|
|
|
if (IS_ANY(keyboard_report.keys[i])) {
|
|
|
|
|
count++;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
return count;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void matrix_print(void) {
|
|
|
|
|
print("\nr/c 0123456789ABCDEF\n");
|
|
|
|
|
for (uint8_t row = 0; row < matrix_rows(); row++) {
|
|
|
|
|
xprintf("%02d: ", row);
|
|
|
|
|
print_bin_reverse16(matrix_get_row(row));
|
|
|
|
|
print("\n");
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
return count;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void matrix_print(void) {
|
|
|
|
|
print("\nr/c 0123456789ABCDEF\n");
|
|
|
|
|
for (uint8_t row = 0; row < matrix_rows(); row++) {
|
|
|
|
|
xprintf("%02d: ", row);
|
|
|
|
|
print_bin_reverse16(matrix_get_row(row));
|
|
|
|
|
print("\n");
|
|
|
|
|
|
|
|
|
|
void led_set(uint8_t usb_led)
|
|
|
|
|
{
|
|
|
|
|
kbd1.SetReport(0, 0, 2, 0, 1, &usb_led);
|
|
|
|
|
kbd2.SetReport(0, 0, 2, 0, 1, &usb_led);
|
|
|
|
|
kbd3.SetReport(0, 0, 2, 0, 1, &usb_led);
|
|
|
|
|
kbd4.SetReport(0, 0, 2, 0, 1, &usb_led);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void led_set(uint8_t usb_led)
|
|
|
|
|
{
|
|
|
|
|
kbd1.SetReport(0, 0, 2, 0, 1, &usb_led);
|
|
|
|
|
kbd2.SetReport(0, 0, 2, 0, 1, &usb_led);
|
|
|
|
|
kbd3.SetReport(0, 0, 2, 0, 1, &usb_led);
|
|
|
|
|
kbd4.SetReport(0, 0, 2, 0, 1, &usb_led);
|
|
|
|
|
}
|
|
|
|
|
};
|
|
|
|
|