|
|
|
@ -68,15 +68,14 @@ void qwiic_keyboard_init(void) {
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void qwiic_keyboard_set_master(void) {
|
|
|
|
|
//twi2c_stop();
|
|
|
|
|
//twi2c_start();
|
|
|
|
|
twi2c_remove_listening(QWIIC_KEYBOARD_HANDSHAKE_ADDRESS);
|
|
|
|
|
twi2c_stop();
|
|
|
|
|
twi2c_start();
|
|
|
|
|
qwiic_keyboard_master = true;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
uint8_t keymap_command[1] = { 0x01 };
|
|
|
|
|
uint8_t matrix_command[1] = { 0x02 };
|
|
|
|
|
uint8_t look_counter = 0;
|
|
|
|
|
static uint8_t keymap_command[1] = { 0x01 };
|
|
|
|
|
static uint8_t matrix_command[1] = { 0x02 };
|
|
|
|
|
static uint8_t look_counter = 0;
|
|
|
|
|
|
|
|
|
|
// uint8_t get_available_device_index(void) {
|
|
|
|
|
// for (uint8_t i = 0; i < QWIIC_KEYBOARD_MAX_DEVICES; i++) {
|
|
|
|
@ -86,31 +85,14 @@ uint8_t look_counter = 0;
|
|
|
|
|
// return 255;
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
void qwiic_keyboard_task(void) {
|
|
|
|
|
if (USB_DRIVER.state == USB_ACTIVE)
|
|
|
|
|
qwiic_keyboard_set_master();
|
|
|
|
|
if (qwiic_keyboard_master) {
|
|
|
|
|
for (uint8_t device_i = 0; device_i < QWIIC_KEYBOARD_MAX_DEVICES; device_i++) {
|
|
|
|
|
if (qwiic_keyboard_connected[device_i]) {
|
|
|
|
|
// send empty message, expecting matrix info
|
|
|
|
|
// twi2c_transmit(qwiic_keyboard_listening_address[device_i], command, 1);
|
|
|
|
|
// if (MSG_OK == twi2c_receive(qwiic_keyboard_listening_address[device_i],
|
|
|
|
|
// qwiic_keyboard_matrix_message, QWIIC_KEYBOARD_MATRIX_MESSAGE_SIZE
|
|
|
|
|
// )) {
|
|
|
|
|
if (!qwiic_keyboard_keymap_initialised[device_i]) {
|
|
|
|
|
if (MSG_OK == twi2c_transmit_receive(qwiic_keyboard_listening_address[device_i],
|
|
|
|
|
keymap_command, 1,
|
|
|
|
|
qwiic_keyboard_keymap_message, QWIIC_KEYBOARD_KEYMAP_MESSAGE_SIZE
|
|
|
|
|
)) {
|
|
|
|
|
// load keymap into memory
|
|
|
|
|
qwiic_keyboard_keymap_initialised[device_i] = true;
|
|
|
|
|
qwiic_keyboard_read_keymap(qwiic_keyboard_keymap_message, device_i);
|
|
|
|
|
}
|
|
|
|
|
} else {
|
|
|
|
|
if (MSG_OK == twi2c_transmit_receive(qwiic_keyboard_listening_address[device_i],
|
|
|
|
|
void qwiic_keyboard_get_matrix(uint8_t device_i) {
|
|
|
|
|
msg_t ret = twi2c_transmit_receive(qwiic_keyboard_listening_address[device_i],
|
|
|
|
|
matrix_command, 1,
|
|
|
|
|
qwiic_keyboard_matrix_message, QWIIC_KEYBOARD_MATRIX_MESSAGE_SIZE
|
|
|
|
|
)) {
|
|
|
|
|
);
|
|
|
|
|
switch (ret) {
|
|
|
|
|
case I2C_OK:
|
|
|
|
|
SEND_STRING("1");
|
|
|
|
|
// majority of this is pulled from keyboard.c:keyboard_task()
|
|
|
|
|
static qwiic_row_t matrix_prev[QWIIC_KEYBOARD_ROWS];
|
|
|
|
|
qwiic_row_t matrix_row = 0;
|
|
|
|
@ -150,11 +132,45 @@ void qwiic_keyboard_task(void) {
|
|
|
|
|
action_exec(TICK);
|
|
|
|
|
QWIIC_MATRIX_LOOP_END:
|
|
|
|
|
qwiic_keyboard_processing_slave = QWIIC_KEYBOARD_NOT_PROCESSING;
|
|
|
|
|
SEND_STRING("2");
|
|
|
|
|
// if (first_message == 100) {
|
|
|
|
|
// PLAY_SONG(song_one_up);
|
|
|
|
|
// }
|
|
|
|
|
// first_message += 1;
|
|
|
|
|
break;
|
|
|
|
|
case I2C_ERROR:
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
twi2c_start();
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void qwiic_keyboard_task(void) {
|
|
|
|
|
if (USB_DRIVER.state == USB_ACTIVE)
|
|
|
|
|
qwiic_keyboard_set_master();
|
|
|
|
|
if (qwiic_keyboard_master) {
|
|
|
|
|
for (uint8_t device_i = 0; device_i < QWIIC_KEYBOARD_MAX_DEVICES; device_i++) {
|
|
|
|
|
if (qwiic_keyboard_connected[device_i]) {
|
|
|
|
|
// send empty message, expecting matrix info
|
|
|
|
|
// twi2c_transmit(qwiic_keyboard_listening_address[device_i], command, 1);
|
|
|
|
|
// if (MSG_OK == twi2c_receive(qwiic_keyboard_listening_address[device_i],
|
|
|
|
|
// qwiic_keyboard_matrix_message, QWIIC_KEYBOARD_MATRIX_MESSAGE_SIZE
|
|
|
|
|
// )) {
|
|
|
|
|
if (!qwiic_keyboard_keymap_initialised[device_i]) {
|
|
|
|
|
if (MSG_OK == twi2c_transmit_receive(qwiic_keyboard_listening_address[device_i],
|
|
|
|
|
keymap_command, 1,
|
|
|
|
|
qwiic_keyboard_keymap_message, QWIIC_KEYBOARD_KEYMAP_MESSAGE_SIZE
|
|
|
|
|
)) {
|
|
|
|
|
// load keymap into memory
|
|
|
|
|
qwiic_keyboard_keymap_initialised[device_i] = true;
|
|
|
|
|
qwiic_keyboard_read_keymap(qwiic_keyboard_keymap_message, device_i);
|
|
|
|
|
wait_ms(10);
|
|
|
|
|
qwiic_keyboard_get_matrix(device_i);
|
|
|
|
|
SEND_STRING("3");
|
|
|
|
|
}
|
|
|
|
|
} else {
|
|
|
|
|
qwiic_keyboard_get_matrix(device_i);
|
|
|
|
|
} // end else - not init
|
|
|
|
|
} else { // if not connected
|
|
|
|
|
//if (look_counter == 0) {
|
|
|
|
@ -169,13 +185,12 @@ void qwiic_keyboard_task(void) {
|
|
|
|
|
&new_address, 1,
|
|
|
|
|
&address_copy, 1
|
|
|
|
|
)) {
|
|
|
|
|
send_byte(address_copy);
|
|
|
|
|
if (address_copy == new_address) {
|
|
|
|
|
SEND_STRING(".");
|
|
|
|
|
send_byte(new_address);
|
|
|
|
|
//if (address_copy == new_address) {
|
|
|
|
|
PLAY_SONG(song_one_up);
|
|
|
|
|
qwiic_keyboard_connected[device_i] = true;
|
|
|
|
|
qwiic_keyboard_listening_address[device_i] = new_address;
|
|
|
|
|
}
|
|
|
|
|
//}
|
|
|
|
|
}
|
|
|
|
|
//} // end if - look for new
|
|
|
|
|
} // end else - connected
|
|
|
|
@ -193,6 +208,11 @@ void qwiic_keyboard_message_received(I2CDriver *i2cp, uint8_t * body, uint16_t s
|
|
|
|
|
break;
|
|
|
|
|
// send matrix
|
|
|
|
|
case 0x02:
|
|
|
|
|
case 0x00:
|
|
|
|
|
if (first_message == 0) {
|
|
|
|
|
PLAY_SONG(song_one_up);
|
|
|
|
|
}
|
|
|
|
|
first_message += 1;
|
|
|
|
|
for (uint8_t row = 0; row < QWIIC_KEYBOARD_ROWS; row++) {
|
|
|
|
|
if (row < MATRIX_ROWS) {
|
|
|
|
|
qwiic_keyboard_matrix_message[row] = matrix_get_row(row);
|
|
|
|
@ -203,12 +223,12 @@ void qwiic_keyboard_message_received(I2CDriver *i2cp, uint8_t * body, uint16_t s
|
|
|
|
|
twi2c_reply(i2cp, qwiic_keyboard_matrix_message, QWIIC_KEYBOARD_MATRIX_MESSAGE_SIZE);
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
twi2c_remove_listening_i(QWIIC_KEYBOARD_HANDSHAKE_ADDRESS);
|
|
|
|
|
twi2c_remove_listening(QWIIC_KEYBOARD_HANDSHAKE_ADDRESS);
|
|
|
|
|
qwiic_keyboard_connected[0] = true;
|
|
|
|
|
//qwiic_keyboard_master = false;
|
|
|
|
|
qwiic_keyboard_listening_address[0] = body[0];
|
|
|
|
|
twi2c_reply(i2cp, body, size);
|
|
|
|
|
twi2c_add_listening_i(qwiic_keyboard_listening_address[0]);
|
|
|
|
|
qwiic_keyboard_listening_address[0] = QWIIC_KEYBOARD_LISTENING_ADDRESS_START;
|
|
|
|
|
twi2c_reply(i2cp, qwiic_keyboard_listening_address, 1);
|
|
|
|
|
twi2c_add_listening(qwiic_keyboard_listening_address[0]);
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|