Browse Source

separate commands, m/s updates

muon_light_dc
Jack Humbert 5 years ago
parent
commit
ec0f9db8ad
1 changed files with 45 additions and 31 deletions
  1. +45
    -31
      drivers/qwiic/qwiic_keyboard.c

+ 45
- 31
drivers/qwiic/qwiic_keyboard.c View File

@ -48,12 +48,15 @@ void qwiic_keyboard_write_keymap(uint8_t * pointer);
void qwiic_keyboard_read_keymap(uint8_t * pointer, uint8_t index);
bool qwiic_keyboard_master = false;
bool qwiic_keyboard_received_message = false;
bool qwiic_keyboard_connected[QWIIC_KEYBOARD_MAX_DEVICES] = { false };
uint8_t qwiic_keyboard_keymap_message[QWIIC_KEYBOARD_KEYMAP_MESSAGE_SIZE] = {0};
uint8_t qwiic_keyboard_matrix_message[QWIIC_KEYBOARD_MATRIX_MESSAGE_SIZE] = {0};
twi2c_message_received qwiic_keyboard_message_received_ptr = qwiic_keyboard_message_received;
float song_one_up[][2] = SONG(ONE_UP_SOUND);
float song_zelda[][2] = SONG(ZELDA_PUZZLE);
uint8_t first_message = 0;
uint8_t first_message_slave = 0;
uint16_t qwiic_keyboard_keymap[QWIIC_KEYBOARD_MAX_DEVICES][QWIIC_KEYBOARD_LAYERS][QWIIC_KEYBOARD_ROWS][QWIIC_KEYBOARD_COLS] = {0};
bool qwiic_keyboard_keymap_initialised[QWIIC_KEYBOARD_MAX_DEVICES] = { false };
@ -68,9 +71,23 @@ void qwiic_keyboard_init(void) {
}
void qwiic_keyboard_set_master(void) {
twi2c_stop();
twi2c_start();
qwiic_keyboard_master = true;
if (!qwiic_keyboard_received_message) {
twi2c_stop();
twi2c_start();
qwiic_keyboard_master = true;
if (first_message == 0) {
PLAY_SONG(song_one_up);
}
first_message += 1;
}
}
void qwiic_keyboard_set_slave(void) {
qwiic_keyboard_received_message = true;
if (first_message_slave == 0) {
PLAY_SONG(song_zelda);
}
first_message_slave += 1;
}
static uint8_t keymap_command[1] = { 0x01 };
@ -86,21 +103,24 @@ static uint8_t look_counter = 0;
// }
void qwiic_keyboard_get_matrix(uint8_t device_i) {
msg_t ret = twi2c_transmit_receive(qwiic_keyboard_listening_address[device_i],
matrix_command, 1,
// msg_t ret = twi2c_transmit_receive(qwiic_keyboard_listening_address[device_i],
// matrix_command, 1,
// qwiic_keyboard_matrix_message, QWIIC_KEYBOARD_MATRIX_MESSAGE_SIZE
// );
twi2c_transmit(qwiic_keyboard_listening_address[device_i], matrix_command, 1);
msg_t ret = twi2c_receive(qwiic_keyboard_listening_address[device_i],
qwiic_keyboard_matrix_message, QWIIC_KEYBOARD_MATRIX_MESSAGE_SIZE
);
switch (ret) {
// majority of this is pulled from keyboard.c:keyboard_task()
case I2C_OK:
SEND_STRING("1");
// majority of this is pulled from keyboard.c:keyboard_task()
qwiic_keyboard_processing_slave = device_i;
static qwiic_row_t matrix_prev[QWIIC_KEYBOARD_ROWS];
qwiic_row_t matrix_row = 0;
qwiic_row_t matrix_change = 0;
#ifdef QMK_KEYS_PER_SCAN
uint8_t keys_processed = 0;
#endif
qwiic_keyboard_processing_slave = device_i;
for (uint8_t r = 0; r < QWIIC_KEYBOARD_ROWS; r++) {
matrix_row = qwiic_keyboard_matrix_message[r];
matrix_change = matrix_row ^ matrix_prev[r];
@ -132,7 +152,6 @@ void qwiic_keyboard_get_matrix(uint8_t device_i) {
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);
// }
@ -153,21 +172,19 @@ void qwiic_keyboard_task(void) {
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,
// if (MSG_OK == twi2c_transmit_receive(qwiic_keyboard_listening_address[device_i],
// keymap_command, 1,
// qwiic_keyboard_keymap_message, QWIIC_KEYBOARD_KEYMAP_MESSAGE_SIZE
// )) {
twi2c_transmit(qwiic_keyboard_listening_address[device_i], keymap_command, 1);
if (MSG_OK == twi2c_receive(qwiic_keyboard_listening_address[device_i],
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);
@ -177,15 +194,15 @@ void qwiic_keyboard_task(void) {
// send new address to listen on, expect back keymap
uint8_t new_address = QWIIC_KEYBOARD_LISTENING_ADDRESS_START + (device_i*2);
uint8_t address_copy = 0;
// twi2c_transmit(QWIIC_KEYBOARD_HANDSHAKE_ADDRESS, &new_address, 1);
// if (MSG_OK == twi2c_receive(QWIIC_KEYBOARD_HANDSHAKE_ADDRESS,
// &address_copy, 1
// )) {
if (MSG_OK == twi2c_transmit_receive(QWIIC_KEYBOARD_HANDSHAKE_ADDRESS,
&new_address, 1,
twi2c_transmit(QWIIC_KEYBOARD_HANDSHAKE_ADDRESS, &new_address, 1);
if (MSG_OK == twi2c_receive(QWIIC_KEYBOARD_HANDSHAKE_ADDRESS,
&address_copy, 1
)) {
send_byte(new_address);
// if (MSG_OK == twi2c_transmit_receive(QWIIC_KEYBOARD_HANDSHAKE_ADDRESS,
// &new_address, 1,
// &address_copy, 1
// )) {
send_byte(address_copy);
//if (address_copy == new_address) {
PLAY_SONG(song_one_up);
qwiic_keyboard_connected[device_i] = true;
@ -200,6 +217,7 @@ void qwiic_keyboard_task(void) {
}
void qwiic_keyboard_message_received(I2CDriver *i2cp, uint8_t * body, uint16_t size) {
qwiic_keyboard_set_slave();
switch (body[0]) {
// send keymap
case 0x01:
@ -209,10 +227,6 @@ void qwiic_keyboard_message_received(I2CDriver *i2cp, uint8_t * body, uint16_t s
// 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);
@ -223,12 +237,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:
qwiic_keyboard_listening_address[0] = body[0];
twi2c_add_listening(body[0]);
twi2c_remove_listening(QWIIC_KEYBOARD_HANDSHAKE_ADDRESS);
qwiic_keyboard_connected[0] = true;
//qwiic_keyboard_master = false;
qwiic_keyboard_listening_address[0] = QWIIC_KEYBOARD_LISTENING_ADDRESS_START;
qwiic_keyboard_master = false;
twi2c_reply(i2cp, qwiic_keyboard_listening_address, 1);
twi2c_add_listening(qwiic_keyboard_listening_address[0]);
break;
}
}


Loading…
Cancel
Save