|
|
@@ -23,10 +23,6 @@
|
|
|
#include "printf.h"
|
|
|
#include "matrix.h"
|
|
|
|
|
|
-#ifndef I2C_DRIVER
|
|
|
- #define I2C_DRIVER I2CD1
|
|
|
-#endif
|
|
|
-
|
|
|
/**
|
|
|
* I2C slave test routine.
|
|
|
*
|
|
|
@@ -37,8 +33,13 @@
|
|
|
* b) A write then read transaction - calls a message processor and returns the generated reply.
|
|
|
* Stretches clock until reply available.
|
|
|
*/
|
|
|
+// static const I2CConfig masterI2CConfig = {
|
|
|
+// 400000
|
|
|
+// };
|
|
|
|
|
|
-static const I2CConfig uniI2CConfig = {
|
|
|
+I2CSlaveMsgCB twi2c_slave_message_process, catchError, clearAfterSend;
|
|
|
+
|
|
|
+static const I2CConfig slaveI2CConfig = {
|
|
|
STM32_TIMINGR_PRESC(15U) |
|
|
|
STM32_TIMINGR_SCLDEL(4U) | STM32_TIMINGR_SDADEL(2U) |
|
|
|
STM32_TIMINGR_SCLH(15U) | STM32_TIMINGR_SCLL(21U),
|
|
|
@@ -52,7 +53,7 @@ char initialReplyBody[50] = "Initial reply"; // 'Status' response if read
|
|
|
|
|
|
uint32_t messageCounter = 0; /* Counts number of messages received to return as part of response */
|
|
|
|
|
|
-uint8_t rxBody[240]; /* stores last message master sent us (intentionally a few bytes smaller than txBody) */
|
|
|
+uint8_t rxBody[2]; /* stores last message master sent us (intentionally a few bytes smaller than txBody) */
|
|
|
uint8_t txBody[MATRIX_ROWS/2]; /* Return message buffer for computed replies */
|
|
|
|
|
|
BaseSequentialStream *chp = NULL; // Used for serial logging
|
|
|
@@ -68,16 +69,26 @@ const I2CSlaveMsg echoRx =
|
|
|
};
|
|
|
|
|
|
|
|
|
-// 'Empty' reply when nothing to say, and no message received. In RAM, to allow update
|
|
|
+// // 'Empty' reply when nothing to say, and no message received. In RAM, to allow update
|
|
|
I2CSlaveMsg initialReply =
|
|
|
{
|
|
|
- sizeof(initialReplyBody), /* trailing zero byte will be repeated as needed */
|
|
|
+ sizeof(initialReplyBody), /* trailing zero byte will be repeated as needed */
|
|
|
(uint8_t *)initialReplyBody,
|
|
|
NULL, /* do nothing on address match */
|
|
|
NULL, /* do nothing after reply sent */
|
|
|
catchError /* Error hook */
|
|
|
};
|
|
|
|
|
|
+// // 'Empty' reply when nothing to say, and no message received. In RAM, to allow update
|
|
|
+// I2CSlaveMsg initialReply =
|
|
|
+// {
|
|
|
+// 0, /* trailing zero byte will be repeated as needed */
|
|
|
+// NULL,
|
|
|
+// NULL, /* do nothing on address match */
|
|
|
+// NULL, /* do nothing after reply sent */
|
|
|
+// catchError /* Error hook */
|
|
|
+// };
|
|
|
+
|
|
|
|
|
|
// Response to received messages
|
|
|
I2CSlaveMsg echoReply = { /* this is in RAM so size may be updated */
|
|
|
@@ -129,7 +140,8 @@ void twi2c_slave_message_process(I2CDriver *i2cp) {
|
|
|
|
|
|
// size_t len = i2cSlaveBytes(i2cp); // Number of bytes received
|
|
|
|
|
|
- matrix_copy(txBody);
|
|
|
+ memset(txBody, 0, MATRIX_ROWS / 2 * sizeof(matrix_row_t));
|
|
|
+ // matrix_copy(txBody);
|
|
|
|
|
|
echoReply.size = MATRIX_ROWS / 2;
|
|
|
i2cSlaveReplyI(i2cp, &echoReply);
|
|
|
@@ -162,17 +174,18 @@ void twi2c_slave_init(void) {
|
|
|
palSetPadMode(GPIOB, 8, PAL_MODE_ALTERNATE(4) | PAL_STM32_OTYPE_OPENDRAIN | PAL_STM32_PUPDR_PULLUP);
|
|
|
|
|
|
|
|
|
- i2cStart(&I2C_DRIVER, &uniI2CConfig);
|
|
|
+ i2cStart(&I2C_DRIVER, &slaveI2CConfig);
|
|
|
#if HAL_USE_I2C_SLAVE
|
|
|
I2C_DRIVER.slaveTimeout = MS2ST(100); // Time for complete message
|
|
|
#endif
|
|
|
|
|
|
- i2cSlaveConfigure(&I2C_DRIVER, &echoRx, &initialReply);
|
|
|
+ // i2cSlaveConfigure(&I2C_DRIVER, &echoRx, &initialReply);
|
|
|
+ i2cSlaveConfigure(&I2C_DRIVER, &echoRx, &echoReply);
|
|
|
|
|
|
// Enable match address after everything else set up
|
|
|
i2cMatchAddress(&I2C_DRIVER, slaveI2Caddress/2);
|
|
|
// i2cMatchAddress(&I2C_DRIVER, myOtherI2Caddress/2);
|
|
|
-// i2cMatchAddress(&I2C_DRIVER, 0); /* "all call" */
|
|
|
+ // i2cMatchAddress(&I2C_DRIVER, 0); /* "all call" */
|
|
|
|
|
|
printf("Slave I2C started\n\r");
|
|
|
|
|
|
@@ -186,9 +199,18 @@ void twi2c_slave_task(void) {
|
|
|
}
|
|
|
|
|
|
void twi2c_master_init(void) {
|
|
|
- i2cStart(&I2C_DRIVER, &uniI2CConfig);
|
|
|
-}
|
|
|
|
|
|
-msg_t twi2c_master_send(i2caddr_t address, const uint8_t * txbuf, uint8_t * rxbuf, systime_t timeout) {
|
|
|
- return i2cMasterTransmitTimeout(&I2C_DRIVER, address, txbuf, sizeof(txbuf), rxbuf, sizeof(rxbuf), timeout);
|
|
|
+ palSetGroupMode(GPIOB,8,9, PAL_MODE_INPUT); // Try releasing special pins for a short time
|
|
|
+ chThdSleepMilliseconds(10);
|
|
|
+
|
|
|
+ palSetPadMode(GPIOB, 9, PAL_MODE_ALTERNATE(4) | PAL_STM32_OTYPE_OPENDRAIN | PAL_STM32_PUPDR_PULLUP);
|
|
|
+ palSetPadMode(GPIOB, 8, PAL_MODE_ALTERNATE(4) | PAL_STM32_OTYPE_OPENDRAIN | PAL_STM32_PUPDR_PULLUP);
|
|
|
+
|
|
|
+ i2cStart(&I2C_DRIVER, &slaveI2CConfig);
|
|
|
+
|
|
|
+ // try high drive (from kiibohd)
|
|
|
+ // I2C_DRIVER.i2c->C2 |= I2Cx_C2_HDRS;
|
|
|
+ // try glitch fixing (from kiibohd)
|
|
|
+ // I2C_DRIVER.i2c->FLT = 4;
|
|
|
+
|
|
|
}
|