aboutsummaryrefslogtreecommitdiffstats
path: root/os
diff options
context:
space:
mode:
Diffstat (limited to 'os')
-rw-r--r--os/hal/dox/i2c.dox36
-rw-r--r--os/hal/include/i2c.h215
-rw-r--r--os/hal/platforms/STM32/i2c_lld.c1074
-rw-r--r--os/hal/platforms/STM32/i2c_lld.h293
-rw-r--r--os/hal/platforms/STM32F1xx/platform.mk1
-rw-r--r--os/hal/src/i2c.c247
6 files changed, 1727 insertions, 139 deletions
diff --git a/os/hal/dox/i2c.dox b/os/hal/dox/i2c.dox
index 1ffd2da47..8e6f78649 100644
--- a/os/hal/dox/i2c.dox
+++ b/os/hal/dox/i2c.dox
@@ -22,7 +22,12 @@
* @defgroup I2C I2C Driver
* @brief Generic I2C Driver.
* @details This module implements a generic I2C (Inter-Integrated Circuit)
- * driver.
+ * driver. On STM32 platform you can choose method of waiting START
+ * and STOP bits: polling wait or wait using GPT. GPT method use
+ * one timer per I2C interface, on the other hand -- polling is
+ * block function that starts transfer.
+ * @note If you decide to use polling wait -- do NOT start transmit or
+ * receive from callback because it run in ISR context.
* @pre In order to use the I2C driver the @p HAL_USE_I2C option
* must be enabled in @p halconf.h.
*
@@ -31,12 +36,31 @@
* functionalities can be used in any moment, any transition not explicitly
* shown in the following diagram has to be considered an error and shall
* be captured by an assertion (if enabled).
- * @if LATEX_PDF
- * @else
- * @endif
- *
+ * @dot
+ digraph example {
+ rankdir="LR";
+ node [shape=circle, fontname=Helvetica, fontsize=8, fixedsize="false",
+ width="0.9", height="0.9"];
+ edge [fontname=Helvetica, fontsize=8];
+
+ uninit [label="I2C_UNINIT", style="bold"];
+ stop [label="I2C_STOP\nLow Power"];
+ ready [label="I2C_READY\nClock Enabled"];
+ active_tx [label="I2C_ACTIVE_TRANSMIT\nBus TX Active"];
+ active_rx [label="I2C_ACTIVE_RECEIVE\nBus RX Active"];
+
+ uninit -> stop [label="i2cInit()"];
+ stop -> stop [label="i2cStop()"];
+ stop -> ready [label="i2cStart()"];
+ ready -> active_tx [label="i2cMasterTransmit()"];
+ ready -> active_rx [label="i2cMasterReceive()"];
+ active_tx -> ready [label="_i2c_isr_code()"];
+ active_rx -> ready [label="_i2c_isr_code()"];
+ ready -> stop [label="i2cStop()"];
+ }
+ * @enddot
* The driver is not thread safe for performance reasons, if you need to access
- * the I2C bus from multiple thread then use the @p i2cAcquireBus() and
+ * the I2C bus from multiple threads then use the @p i2cAcquireBus() and
* @p i2cReleaseBus() APIs in order to gain exclusive access.
*
* @ingroup IO
diff --git a/os/hal/include/i2c.h b/os/hal/include/i2c.h
index 5f8c971fd..acf09ec9c 100644
--- a/os/hal/include/i2c.h
+++ b/os/hal/include/i2c.h
@@ -34,7 +34,24 @@
/*===========================================================================*/
/* Driver constants. */
/*===========================================================================*/
-
+/*===========================================================================*/
+/* Driver constants. */
+/*===========================================================================*/
+#define I2CD_NO_ERROR 0
+/** @brief Bus Error.*/
+#define I2CD_BUS_ERROR 0x01
+/** @brief Arbitration Lost (master mode).*/
+#define I2CD_ARBITRATION_LOST 0x02
+/** @brief Acknowledge Failure.*/
+#define I2CD_ACK_FAILURE 0x04
+/** @brief Overrun/Underrun.*/
+#define I2CD_OVERRUN 0x08
+/** @brief PEC Error in reception.*/
+#define I2CD_PEC_ERROR 0x10
+/** @brief Timeout or Tlow Error.*/
+#define I2CD_TIMEOUT 0x20
+/** @brief SMBus Alert.*/
+#define I2CD_SMB_ALERT 0x40
/*===========================================================================*/
/* Driver pre-compile time settings. */
/*===========================================================================*/
@@ -49,6 +66,9 @@
/*===========================================================================*/
/* Derived constants and error checks. */
/*===========================================================================*/
+#if I2C_USE_MUTUAL_EXCLUSION && !CH_USE_MUTEXES && !CH_USE_SEMAPHORES
+#error "I2C_USE_MUTUAL_EXCLUSION requires CH_USE_MUTEXES and/or CH_USE_SEMAPHORES"
+#endif
/*===========================================================================*/
/* Driver data structures and types. */
@@ -58,62 +78,177 @@
* @brief Driver state machine possible states.
*/
typedef enum {
- I2C_UNINIT = 0, /**< Not initialized. */
- I2C_STOP = 1, /**< Stopped. */
- I2C_READY = 2, /**< Ready. */
- I2C_MREADY = 3, /**< START and address sent. */
- I2C_MTRANSMIT = 4, /**< Master transmitting. */
- I2C_MRECEIVE = 5, /**< Master receiving. */
- I2C_MERROR = 6 /**< Error condition. */
+ /* master part */
+ I2C_UNINIT = 0, /**< @brief Not initialized. */
+ I2C_STOP = 1, /**< @brief Stopped. */
+ I2C_READY = 2, /**< @brief Ready. */
+ I2C_ACTIVE_TRANSMIT = 3, /**< @brief Transmit in progress. */
+ I2C_ACTIVE_RECEIVE = 4, /**< @brief Receive in progress. */
+ I2C_ACTIVE_TRANSCEIVE = 5, /**< @brief Receive after transmit in progress. */
+
+ /* Slave part. Not realized. */
+ I2C_SACTIVE = 10,
+ I2C_STRANSMIT = 11,
+ I2C_SRECEIVE = 12,
} i2cstate_t;
+
#include "i2c_lld.h"
+/**
+ * @brief I2C notification callback type.
+ * @details This callback invoked when byte transfer finish event occurs,
+ * No matter sending or reading.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object triggering the
+ * callback
+ * @param[in] i2cscfg pointer to the @p I2CSlaveConfig object triggering the
+ * callback
+ */
+typedef void (*i2ccallback_t)(I2CDriver *i2cp, const I2CSlaveConfig *i2cscfg);
+
+
+/**
+ * @brief I2C error notification callback type.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object triggering the
+ * callback
+ * @param[in] i2cscfg pointer to the @p I2CSlaveConfig object triggering the
+ * callback
+ */
+typedef void (*i2cerrorcallback_t)(I2CDriver *i2cp,
+ const I2CSlaveConfig *i2cscfg);
+
+
+/**
+ * @brief I2C transmission data block size.
+ */
+typedef uint8_t i2cblock_t;
+
+
+/**
+ * @brief Structure representing an I2C slave configuration.
+ * @details Each slave device has its own config structure with input and
+ * output buffers for temporally storing data.
+ */
+struct I2CSlaveConfig{
+ /**
+ * @brief Callback pointer.
+ * @note Transfer finished callback. Invoke when all data transferred.
+ * If set to @p NULL then the callback is disabled.
+ */
+ i2ccallback_t id_callback;
+
+ /**
+ * @brief Callback pointer.
+ * @note This callback will be invoked when error condition occur.
+ * If set to @p NULL then the callback is disabled.
+ */
+ i2cerrorcallback_t id_err_callback;
+#if defined(I2C_SLAVECONFIG_EXT_FIELDS)
+ I2C_SLAVECONFIG_EXT_FIELDS
+#endif
+};
+
+
/*===========================================================================*/
/* Driver macros. */
/*===========================================================================*/
+#if I2C_USE_WAIT || defined(__DOXYGEN__)
/**
- * @brief Read mode.
+ * @brief Waits for operation completion.
+ * @details This function waits for the driver to complete the current
+ * operation.
+ * @pre An operation must be running while the function is invoked.
+ * @note No more than one thread can wait on a I2C driver using
+ * this function.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ *
+ * @notapi
*/
-#define I2C_READ 1
+#define _i2c_wait_s(i2cp) { \
+ chDbgAssert((i2cp)->id_thread == NULL, \
+ "_i2c_wait(), #1", "already waiting"); \
+ chSysLock(); \
+ (i2cp)->id_thread = chThdSelf(); \
+ chSchGoSleepS(THD_STATE_SUSPENDED); \
+ chSysUnlock(); \
+}
/**
- * @brief Write mode.
+ * @brief Wakes up the waiting thread.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ *
+ * @notapi
*/
-#define I2C_WRITE 0
+#define _i2c_wakeup_isr(i2cp) { \
+ if ((i2cp)->id_thread != NULL) { \
+ Thread *tp = (i2cp)->id_thread; \
+ (i2cp)->id_thread = NULL; \
+ chSysLockFromIsr(); \
+ chSchReadyI(tp); \
+ chSysUnlockFromIsr(); \
+ } \
+}
+#else /* !I2C_USE_WAIT */
+#define _i2c_wait_s(i2cp)
+#define _i2c_wakeup_isr(i2cp)
+#endif /* !I2C_USE_WAIT */
/**
- * @brief Seven bits addresses header builder.
+ * @brief Common ISR code.
+ * @details This code handles the portable part of the ISR code:
+ * - Callback invocation.
+ * - Waiting thread wakeup, if any.
+ * - Driver state transitions.
+ *
+ * @note This macro is meant to be used in the low level drivers
+ * implementation only.
*
- * @param[in] addr seven bits address value
- * @param[in] rw read/write flag
+ * @param[in] i2cp pointer to the @p I2CDriver object
*
- * @return A 16 bit value representing the header, the most
- * significant byte is always zero.
+ * @notapi
*/
-#define I2C_ADDR7(addr, rw) (uint16_t)((addr) << 1 | (rw))
-
+#define _i2c_isr_code(i2cp, i2cscfg) { \
+ if(((i2cp)->id_slave_config)->id_callback) { \
+ ((i2cp)->id_slave_config)->id_callback(i2cp, i2cscfg); \
+ (i2cp)->id_state = I2C_READY; \
+ } \
+ else \
+ (i2cp)->id_state = I2C_READY; \
+ _i2c_wakeup_isr(i2cp); \
+}
/**
- * @brief Ten bits addresses header builder.
+ * @brief Error ISR code.
+ * @details This code handles the portable part of the ISR code:
+ * - Error callback invocation.
+ * - Waiting thread wakeup, if any.
+ * - Driver state transitions.
*
- * @param[in] addr ten bits address value
- * @param[in] rw read/write flag
+ * @note This macro is meant to be used in the low level drivers
+ * implementation only.
*
- * @return A 16 bit value representing the header, the most
- * significant byte is the first one to be transmitted.
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ *
+ * @notapi
*/
-#define I2C_ADDR10(addr, rw) \
- (uint16_t)(0xF000 | \
- (((addr) & 0x0300) << 1) | \
- (((rw) << 8)) | \
- ((addr) & 0x00FF))
+#define _i2c_isr_err_code(i2cp, i2cscfg) { \
+ if(((i2cp)->id_slave_config)->id_err_callback) { \
+ ((i2cp)->id_slave_config)->id_err_callback(i2cp, i2cscfg); \
+ (i2cp)->id_state = I2C_READY; \
+ } \
+ else \
+ (i2cp)->id_state = I2C_READY; \
+ _i2c_wakeup_isr(i2cp); \
+}
/*===========================================================================*/
/* External declarations. */
/*===========================================================================*/
-
#ifdef __cplusplus
extern "C" {
#endif
@@ -121,19 +256,21 @@ extern "C" {
void i2cObjectInit(I2CDriver *i2cp);
void i2cStart(I2CDriver *i2cp, const I2CConfig *config);
void i2cStop(I2CDriver *i2cp);
- void i2cMasterStartI(I2CDriver *i2cp,
- uint16_t header,
- i2ccallback_t callback);
- void i2cMasterStopI(I2CDriver *i2cp, i2ccallback_t callback);
- void i2cMasterRestartI(I2CDriver *i2cp, i2ccallback_t callback);
- void i2cMasterTransmitI(I2CDriver *i2cp, size_t n, const uint8_t *txbuf,
- i2ccallback_t callback);
- void i2cMasterReceiveI(I2CDriver *i2cp, size_t n, uint8_t *rxbuf,
- i2ccallback_t callback);
+ void i2cMasterTransmit(I2CDriver *i2cp, const I2CSlaveConfig *i2cscfg,
+ uint16_t slave_addr,
+ uint8_t *txbuf, size_t txbytes,
+ uint8_t *rxbuf, size_t rxbytes);
+ void i2cMasterReceive(I2CDriver *i2cp, const I2CSlaveConfig *i2cscfg,
+ uint16_t slave_addr, uint8_t *rxbuf, size_t rxbytes);
+ void i2cMasterStart(I2CDriver *i2cp);
+ void i2cMasterStop(I2CDriver *i2cp);
+ void i2cAddFlagsI(I2CDriver *i2cp, i2cflags_t mask);
+
#if I2C_USE_MUTUAL_EXCLUSION
void i2cAcquireBus(I2CDriver *i2cp);
void i2cReleaseBus(I2CDriver *i2cp);
#endif /* I2C_USE_MUTUAL_EXCLUSION */
+
#ifdef __cplusplus
}
#endif
diff --git a/os/hal/platforms/STM32/i2c_lld.c b/os/hal/platforms/STM32/i2c_lld.c
new file mode 100644
index 000000000..77d4b7829
--- /dev/null
+++ b/os/hal/platforms/STM32/i2c_lld.c
@@ -0,0 +1,1074 @@
+/**
+ * @file STM32/i2c_lld.c
+ * @brief STM32 I2C subsystem low level driver source. Slave mode not implemented.
+ * @addtogroup I2C
+ * @{
+ */
+
+#include "ch.h"
+#include "hal.h"
+#include "i2c_lld.h"
+
+#if HAL_USE_I2C || defined(__DOXYGEN__)
+
+/*===========================================================================*/
+/* Datasheet notes. */
+/*===========================================================================*/
+/**
+ * From RM0008.pdf
+ *
+ * Note:
+ * When the STOP, START or PEC bit is set, the software must NOT perform
+ * any write access to I2C_CR1 before this bit is cleared by hardware.
+ * Otherwise there is a risk of setting a second STOP, START or PEC request.
+ */
+
+/*===========================================================================*/
+/* Driver constants. */
+/*===========================================================================*/
+/* TODO: may be? move this defines in i2c_lld.h and mcuconf.h */
+#define I2C_STOP_GPT_TIMEOUT 50 /* waiting timer value */
+#define I2C_START_GPT_TIMEOUT 50 /* waiting timer value */
+#define I2C_POLLING_TIMEOUT 0xFFFF
+
+/*===========================================================================*/
+/* Driver exported variables. */
+/*===========================================================================*/
+
+/** @brief I2C1 driver identifier.*/
+#if STM32_I2C_USE_I2C1 || defined(__DOXYGEN__)
+I2CDriver I2CD1;
+#endif
+
+/** @brief I2C2 driver identifier.*/
+#if STM32_I2C_USE_I2C2 || defined(__DOXYGEN__)
+I2CDriver I2CD2;
+#endif
+
+/*===========================================================================*/
+/* Driver local variables. */
+/*===========================================================================*/
+
+/* Debugging variables */
+#if CH_DBG_ENABLE_ASSERTS
+static volatile uint16_t dbgSR1 = 0;
+static volatile uint16_t dbgSR2 = 0;
+static volatile uint16_t dbgCR1 = 0;
+static volatile uint16_t dbgCR2 = 0;
+#endif /* CH_DBG_ENABLE_ASSERTS */
+
+/* defines for convenience purpose */
+#if I2C_SUPPORTS_CALLBACKS
+#define txBuffp (i2cp->txbuff_p)
+#define rxBuffp (i2cp->rxbuff_p)
+#endif /* I2C_SUPPORTS_CALLBACKS */
+
+/*===========================================================================*/
+/* Driver local functions. */
+/*===========================================================================*/
+#if I2C_SUPPORTS_CALLBACKS
+#if !(STM32_I2C_I2C1_USE_POLLING_WAIT)
+/* I2C1 GPT callback. */
+static void i2c1gptcb(GPTDriver *gptp) {
+ (void)gptp;
+ I2CDriver *i2cp = &I2CD1;
+
+ chSysLockFromIsr();
+ i2cp->flags &= ~I2C_FLG_TIMER_ARMED;
+
+ switch(i2cp->id_state){
+ case I2C_ACTIVE_TRANSMIT:
+ i2c_lld_master_transmit(i2cp, i2cp->slave_addr, i2cp->txbuf, i2cp->txbytes, i2cp->rxbuf, i2cp->rxbytes);
+ break;
+
+ case I2C_ACTIVE_RECEIVE:
+ i2c_lld_master_receive(i2cp, i2cp->slave_addr, i2cp->rxbuf, i2cp->rxbytes);
+ break;
+
+ case I2C_ACTIVE_TRANSCEIVE:
+ i2c_lld_master_transceive(i2cp);
+ break;
+
+ default:
+ break;
+ }
+ chSysUnlockFromIsr();
+}
+/* I2C1 GPT configuration. */
+static const GPTConfig i2c1gptcfg = {
+ 1000000, /* 1MHz timer clock.*/
+ i2c1gptcb /* Timer callback.*/
+};
+#endif /* STM32_I2C_I2C1_USE_POLLING_WAIT */
+
+#if !(STM32_I2C_I2C2_USE_POLLING_WAIT)
+/* I2C2 GPT callback. */
+static void i2c2gptcb(GPTDriver *gptp) {
+ (void)gptp;
+ I2CDriver *i2cp = &I2CD2;
+
+ chSysLockFromIsr();
+ i2cp->flags &= ~I2C_FLG_TIMER_ARMED;
+
+ switch(i2cp->id_state){
+ case I2C_ACTIVE_TRANSMIT:
+ i2c_lld_master_transmit(i2cp, i2cp->slave_addr, i2cp->txbuf, i2cp->txbytes, i2cp->rxbuf, i2cp->rxbytes);
+ break;
+
+ case I2C_ACTIVE_RECEIVE:
+ i2c_lld_master_receive(i2cp, i2cp->slave_addr, i2cp->rxbuf, i2cp->rxbytes);
+ break;
+
+ case I2C_ACTIVE_TRANSCEIVE:
+ i2c_lld_master_transceive(i2cp);
+ break;
+
+ default:
+ break;
+ }
+ chSysUnlockFromIsr();
+}
+/* I2C2 GPT configuration. */
+static const GPTConfig i2c2gptcfg = {
+ 1000000, /* 1MHz timer clock.*/
+ i2c2gptcb /* Timer callback.*/
+};
+#endif /* STM32_I2C_I2C2_USE_POLLING_WAIT */
+#endif /* I2C_SUPPORTS_CALLBACKS */
+
+/**
+ * @brief Function for I2C debugging purpose.
+ * @note Internal use only.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ *
+ * @notapi
+ */
+#if CH_DBG_ENABLE_ASSERTS
+void _i2c_unhandled_case(I2CDriver *i2cp){
+ dbgCR1 = i2cp->id_i2c->CR1;
+ dbgCR2 = i2cp->id_i2c->CR2;
+ chDbgAssert((dbgSR1 + dbgSR2) == 0,
+ "i2c_serve_event_interrupt(), #1",
+ "unhandled case");
+}
+#else
+#define _i2c_unhandled_case(i2cp)
+#endif /* CH_DBG_ENABLE_ASSERTS */
+
+#if I2C_SUPPORTS_CALLBACKS
+/**
+ * @brief Return the last event value from I2C status registers.
+ * @note Internal use only.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ *
+ * @notapi
+ */
+static uint32_t i2c_get_event(I2CDriver *i2cp){
+ uint16_t regSR1 = i2cp->id_i2c->SR1;
+ uint16_t regSR2 = i2cp->id_i2c->SR2;
+ #if CH_DBG_ENABLE_ASSERTS
+ dbgSR1 = regSR1;
+ dbgSR2 = regSR2;
+ #endif /* CH_DBG_ENABLE_ASSERTS */
+
+ return (I2C_EV_MASK & (regSR1 | (regSR2 << 16)));
+}
+
+/**
+ * @brief Handle the flags/interrupts.
+ * @note Internal use only.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ *
+ * @notapi
+ */
+void _i2c_ev6_master_rec_mode_selected(I2CDriver *i2cp){
+ I2C_TypeDef *dp = i2cp->id_i2c;
+
+ switch(i2cp->flags & EV6_SUBEV_MASK) {
+
+ case I2C_EV6_3_MASTER_REC_1BTR_MODE_SELECTED: /* only an single byte to receive */
+ dp->CR1 &= (uint16_t)~I2C_CR1_ACK; /* Clear ACK */
+ dp->CR1 |= I2C_CR1_STOP; /* Program the STOP */
+ break;
+
+ case I2C_EV6_1_MASTER_REC_2BTR_MODE_SELECTED: /* only two bytes to receive */
+ dp->CR1 &= (uint16_t)~I2C_CR1_ACK; /* Clear ACK */
+ dp->CR2 &= (uint16_t)~I2C_CR2_ITBUFEN; /* Disable the ITBUF in order to have only the BTF interrupt */
+ break;
+
+ default: /* more than 2 bytes to receive */
+ break;
+ }
+}
+
+/**
+ * @brief Handle cases of 2 or 3 bytes receiving.
+ * @note Internal use only.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ *
+ * @notapi
+ */
+void _i2c_ev7_master_rec_byte_qued(I2CDriver *i2cp){
+ I2C_TypeDef *dp = i2cp->id_i2c;
+
+ switch(i2cp->flags & EV7_SUBEV_MASK) {
+
+ case I2C_EV7_2_MASTER_REC_3BYTES_TO_PROCESS:
+ /* Only for case of three bytes to be received.
+ * DataN-2 and DataN-1 already received. */
+ dp->CR1 &= (uint16_t)~I2C_CR1_ACK; /* Clear ACK */
+ *rxBuffp = dp->DR; /* Read the DataN-2. This clear the RXE & BFT flags and launch the DataN exception in the shift register (ending the SCL stretch) */
+ rxBuffp++;
+ chSysLockFromIsr();
+ dp->CR1 |= I2C_CR1_STOP; /* Program the STOP */
+ *rxBuffp = dp->DR; /* Read the DataN-1 */
+ chSysUnlockFromIsr();
+ rxBuffp++;
+ i2cp->rxbytes -= 2; /* Decrement the number of readed bytes */
+ i2cp->flags = 0;
+ dp->CR2 |= I2C_CR2_ITBUFEN; /* ready for read DataN. Enable interrupt for next (and last) RxNE event*/
+ break;
+
+ case I2C_EV7_3_MASTER_REC_2BYTES_TO_PROCESS:
+ /* only for case of two bytes to be received
+ * DataN-1 and DataN are received */
+ dp->CR2 &= (uint16_t)~I2C_CR2_ITEVTEN;
+ dp->CR2 &= (uint16_t)~I2C_CR2_ITBUFEN;
+ chSysLockFromIsr();
+ dp->CR1 |= I2C_CR1_STOP; /* Program the STOP */
+ *rxBuffp = dp->DR; /* Read the DataN-1*/
+ rxBuffp++;
+ *rxBuffp = dp->DR; /* Read the DataN*/
+ chSysUnlockFromIsr();
+ i2cp->rxbytes = 0;
+ i2cp->flags = 0;
+ _i2c_isr_code(i2cp, i2cp->id_slave_config); /* Portable I2C ISR code defined in the high level driver. */
+ break;
+
+ case I2C_FLG_MASTER_RECEIVER:
+ /* Some times in hi load scenarions it is possible to "miss" interrupt
+ * because STM32 I2C has OR'ed interrupt sources. This case handle that
+ * scenario. */
+ if (i2cp->rxbytes > 3){
+ *rxBuffp = dp->DR;
+ rxBuffp++;
+ (i2cp->rxbytes)--;
+ }
+ else
+ _i2c_unhandled_case(i2cp);
+ break;
+
+ default:
+ _i2c_unhandled_case(i2cp);
+ break;
+ }
+}
+
+/**
+ * @brief Main I2C interrupt handler.
+ * @note Internal use only.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ *
+ * @notapi
+ */
+static void i2c_serve_event_interrupt(I2CDriver *i2cp) {
+ I2C_TypeDef *dp = i2cp->id_i2c;
+
+ switch(i2c_get_event(i2cp)) {
+
+ case I2C_EV5_MASTER_MODE_SELECT:
+ i2cp->flags &= ~I2C_FLG_HEADER_SENT;
+ dp->DR = i2cp->slave_addr1;
+ break;
+
+ case I2C_EV9_MASTER_ADDR_10BIT:
+ if(i2cp->flags & I2C_FLG_MASTER_RECEIVER) {
+ i2cp->slave_addr1 |= 0x01;
+ i2cp->flags |= I2C_FLG_HEADER_SENT;
+ }
+ dp->DR = i2cp->slave_addr2;
+ break;
+
+ /**************************************************************************
+ * Master Transmitter part
+ */
+ case I2C_EV6_MASTER_TRA_MODE_SELECTED:
+ if(i2cp->flags & I2C_FLG_HEADER_SENT){
+ dp->CR1 |= I2C_CR1_START; /* re-send the start in 10-Bit address mode */
+ break;
+ }
+ txBuffp = (uint8_t*)i2cp->txbuf; /* Initialize the transmit buffer pointer */
+ i2cp->txbytes--;
+ if(i2cp->txbytes == 0) { /* If no further data to be sent, disable the I2C ITBUF in order to not have a TxE interrupt */
+ dp->CR2 &= (uint16_t)~I2C_CR2_ITBUFEN;
+ }
+ dp->DR = *txBuffp; /* EV8_1 write the first data */
+ txBuffp++;
+ break;
+
+ case I2C_EV8_MASTER_BYTE_TRANSMITTING:
+ if(i2cp->txbytes > 0) {
+ i2cp->txbytes--;
+ if(i2cp->txbytes == 0) { /* If no further data to be sent, disable the ITBUF in order to not have a TxE interrupt */
+ dp->CR2 &= (uint16_t)~I2C_CR2_ITBUFEN;
+ }
+ dp->DR = *txBuffp;
+ txBuffp++;
+ }
+ break;
+
+ case I2C_EV8_2_MASTER_BYTE_TRANSMITTED:
+ dp->CR2 &= (uint16_t)~I2C_CR2_ITEVTEN; /* Disable ITEVT In order to not have again a BTF IT */
+ if (i2cp->rxbytes == 0){ /* if nothing to read then generate stop */
+ dp->CR1 |= I2C_CR1_STOP;
+ _i2c_isr_code(i2cp, i2cp->id_slave_config); /* Portable I2C ISR code defined in the high level driver. */
+ }
+ else{ /* start reading operation */
+ i2cp->id_i2c->CR1 |= I2C_CR1_START; /* send start bit */
+ i2c_lld_master_transceive(i2cp);
+ }
+ break;
+
+ /**************************************************************************
+ * Master Receiver part
+ */
+ case I2C_EV6_MASTER_REC_MODE_SELECTED:
+ _i2c_ev6_master_rec_mode_selected(i2cp);
+ rxBuffp = i2cp->rxbuf; /* Initialize receive buffer pointer */
+ break;
+
+ case I2C_EV7_MASTER_REC_BYTE_RECEIVED:
+ if(i2cp->rxbytes > 3) {
+ *rxBuffp = dp->DR; /* Read the data register */
+ rxBuffp++;
+ i2cp->rxbytes--;
+ if(i2cp->rxbytes == 3){ /* Disable the ITBUF in order to have only the BTF interrupt */
+ dp->CR2 &= (uint16_t)~I2C_CR2_ITBUFEN;
+ i2cp->flags |= I2C_FLG_3BTR;
+ }
+ }
+ else if (i2cp->rxbytes == 3){ /* Disable the ITBUF in order to have only the BTF interrupt */
+ dp->CR2 &= (uint16_t)~I2C_CR2_ITBUFEN;
+ i2cp->flags |= I2C_FLG_3BTR;
+ }
+ break;
+
+ case I2C_EV7_MASTER_REC_BYTE_QUEUED:
+ _i2c_ev7_master_rec_byte_qued(i2cp);
+ break;
+
+ default: /* only 1 byte must to be read to complete trasfer. Stop already sent to bus. */
+ chDbgAssert((i2cp->rxbytes) == 1,
+ "i2c_serve_event_interrupt(), #1",
+ "more than 1 byte to be received");
+ *rxBuffp = dp->DR; /* Read the data register */
+ i2cp->rxbytes = 0;
+ dp->CR2 &= (uint16_t)~I2C_CR2_ITEVTEN; /* disable interrupts */
+ dp->CR2 &= (uint16_t)~I2C_CR2_ITBUFEN;
+ _i2c_isr_code(i2cp, i2cp->id_slave_config); /* Portable I2C ISR code defined in the high level driver.*/
+ break;
+ }
+}
+#endif /* I2C_SUPPORTS_CALLBACKS */
+
+static void i2c_serve_error_interrupt(I2CDriver *i2cp) {
+ i2cflags_t flags;
+ I2C_TypeDef *reg;
+
+ reg = i2cp->id_i2c;
+ flags = I2CD_NO_ERROR;
+
+ if(reg->SR1 & I2C_SR1_BERR) { /* Bus error */
+ reg->SR1 &= ~I2C_SR1_BERR;
+ flags |= I2CD_BUS_ERROR;
+ }
+ if(reg->SR1 & I2C_SR1_ARLO) { /* Arbitration lost */
+ reg->SR1 &= ~I2C_SR1_ARLO;
+ flags |= I2CD_ARBITRATION_LOST;
+ }
+ if(reg->SR1 & I2C_SR1_AF) { /* Acknowledge fail */
+ reg->SR1 &= ~I2C_SR1_AF;
+ reg->CR1 |= I2C_CR1_STOP; /* setting stop bit */
+ while(i2cp->id_i2c->CR1 & I2C_CR1_STOP)
+ ;
+ flags |= I2CD_ACK_FAILURE;
+ }
+ if(reg->SR1 & I2C_SR1_OVR) { /* Overrun */
+ reg->SR1 &= ~I2C_SR1_OVR;
+ flags |= I2CD_OVERRUN;
+ }
+ if(reg->SR1 & I2C_SR1_PECERR) { /* PEC error */
+ reg->SR1 &= ~I2C_SR1_PECERR;
+ flags |= I2CD_PEC_ERROR;
+ }
+ if(reg->SR1 & I2C_SR1_TIMEOUT) { /* SMBus Timeout */
+ reg->SR1 &= ~I2C_SR1_TIMEOUT;
+ flags |= I2CD_TIMEOUT;
+ }
+ if(reg->SR1 & I2C_SR1_SMBALERT) { /* SMBus alert */
+ reg->SR1 &= ~I2C_SR1_SMBALERT;
+ flags |= I2CD_SMB_ALERT;
+ }
+
+ if(flags != I2CD_NO_ERROR) { /* send communication end signal */
+ chSysLockFromIsr();
+ i2cAddFlagsI(i2cp, flags);
+ chSysUnlockFromIsr();
+ #if I2C_SUPPORTS_CALLBACKS
+ _i2c_isr_err_code(i2cp, i2cp->id_slave_config);
+ #endif /* I2C_SUPPORTS_CALLBACKS */
+ }
+}
+
+
+#if STM32_I2C_USE_I2C1 || defined(__DOXYGEN__)
+/**
+ * @brief I2C1 event interrupt handler.
+ */
+#if I2C_SUPPORTS_CALLBACKS
+CH_IRQ_HANDLER(VectorBC) {
+
+ CH_IRQ_PROLOGUE();
+ i2c_serve_event_interrupt(&I2CD1);
+ CH_IRQ_EPILOGUE();
+}
+#endif /* I2C_SUPPORTS_CALLBACKS */
+/**
+ * @brief I2C1 error interrupt handler.
+ */
+CH_IRQ_HANDLER(VectorC0) {
+
+ CH_IRQ_PROLOGUE();
+ i2c_serve_error_interrupt(&I2CD1);
+ CH_IRQ_EPILOGUE();
+}
+#endif /* STM32_I2C_USE_I2C1 */
+
+#if STM32_I2C_USE_I2C2 || defined(__DOXYGEN__)
+/**
+ * @brief I2C2 event interrupt handler.
+ */
+#if I2C_SUPPORTS_CALLBACKS
+CH_IRQ_HANDLER(VectorC4) {
+
+ CH_IRQ_PROLOGUE();
+ i2c_serve_event_interrupt(&I2CD2);
+ CH_IRQ_EPILOGUE();
+}
+#endif /* I2C_SUPPORTS_CALLBACKS */
+/**
+ * @brief I2C2 error interrupt handler.
+ */
+CH_IRQ_HANDLER(VectorC8) {
+
+ CH_IRQ_PROLOGUE();
+ i2c_serve_error_interrupt(&I2CD2);
+ CH_IRQ_EPILOGUE();
+}
+#endif /* STM32_I2C_USE_I2C2 */
+
+/**
+ * @brief Low level I2C driver initialization.
+ */
+void i2c_lld_init(void) {
+
+#if STM32_I2C_USE_I2C1
+ RCC->APB1RSTR = RCC_APB1RSTR_I2C1RST; /* reset I2C 1 */
+ RCC->APB1RSTR = 0;
+ i2cObjectInit(&I2CD1);
+ I2CD1.id_i2c = I2C1;
+
+#if I2C_SUPPORTS_CALLBACKS
+#if !(STM32_I2C_I2C1_USE_POLLING_WAIT)
+ I2CD1.timer = &(STM32_I2C_I2C1_USE_GPT_TIM);
+ I2CD1.timer_cfg = &i2c1gptcfg;
+#endif /* !(STM32_I2C_I2C1_USE_POLLING_WAIT) */
+#endif /* I2C_SUPPORTS_CALLBACKS */
+
+#endif /* STM32_I2C_USE_I2C */
+
+#if STM32_I2C_USE_I2C2
+ RCC->APB1RSTR = RCC_APB1RSTR_I2C2RST; /* reset I2C 2 */
+ RCC->APB1RSTR = 0;
+ i2cObjectInit(&I2CD2);
+ I2CD2.id_i2c = I2C2;
+
+#if I2C_SUPPORTS_CALLBACKS
+#if !(STM32_I2C_I2C2_USE_POLLING_WAIT)
+ I2CD2.timer = &(STM32_I2C_I2C2_USE_GPT_TIM);
+ I2CD2.timer_cfg = &i2c2gptcfg;
+#endif /* !(STM32_I2C_I2C2_USE_POLLING_WAIT) */
+#endif /* I2C_SUPPORTS_CALLBACKS */
+
+#endif /* STM32_I2C_USE_I2C2 */
+}
+
+/**
+ * @brief Configures and activates the I2C peripheral.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ */
+void i2c_lld_start(I2CDriver *i2cp) {
+ if (i2cp->id_state == I2C_STOP) { /* If in stopped state then enables the I2C clock.*/
+#if STM32_I2C_USE_I2C1
+ if (&I2CD1 == i2cp) {
+#if I2C_SUPPORTS_CALLBACKS
+ NVICEnableVector(I2C1_EV_IRQn,
+ CORTEX_PRIORITY_MASK(STM32_I2C_I2C1_IRQ_PRIORITY));
+#endif /* I2C_SUPPORTS_CALLBACKS */
+ NVICEnableVector(I2C1_ER_IRQn,
+ CORTEX_PRIORITY_MASK(STM32_I2C_I2C1_IRQ_PRIORITY));
+ RCC->APB1ENR |= RCC_APB1ENR_I2C1EN; /* I2C 1 clock enable */
+ }
+#endif
+#if STM32_I2C_USE_I2C2
+ if (&I2CD2 == i2cp) {
+#if I2C_SUPPORTS_CALLBACKS
+ NVICEnableVector(I2C2_EV_IRQn,
+ CORTEX_PRIORITY_MASK(STM32_I2C_I2C1_IRQ_PRIORITY));
+#endif /* I2C_SUPPORTS_CALLBACKS */
+ NVICEnableVector(I2C2_ER_IRQn,
+ CORTEX_PRIORITY_MASK(STM32_I2C_I2C1_IRQ_PRIORITY));
+ RCC->APB1ENR |= RCC_APB1ENR_I2C2EN; /* I2C 2 clock enable */
+ }
+#endif
+ }
+
+ i2cp->id_i2c->CR1 = I2C_CR1_SWRST; /* reset i2c peripherial */
+ i2cp->id_i2c->CR1 = 0;
+ i2c_lld_set_clock(i2cp);
+ i2c_lld_set_opmode(i2cp);
+ i2cp->id_i2c->CR1 |= 1; /* enable interface */
+}
+
+void i2c_lld_reset(I2CDriver *i2cp){
+ chDbgCheck((i2cp->id_state == I2C_STOP)||(i2cp->id_state == I2C_READY),
+ "i2c_lld_reset: invalid state");
+
+ RCC->APB1RSTR = RCC_APB1RSTR_I2C1RST; /* reset I2C 1 */
+ RCC->APB1RSTR = 0;
+}
+
+
+/**
+ * @brief Set clock speed.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ */
+void i2c_lld_set_clock(I2CDriver *i2cp) {
+ volatile uint16_t regCCR, regCR2, freq, clock_div;
+ volatile uint16_t pe_bit_saved;
+ int32_t clock_speed = i2cp->id_config->clock_speed;
+ i2cdutycycle_t duty = i2cp->id_config->duty_cycle;
+
+ chDbgCheck((i2cp != NULL) && (clock_speed > 0) && (clock_speed <= 4000000),
+ "i2c_lld_set_clock");
+
+ /**************************************************************************
+ * CR2 Configuration
+ */
+ regCR2 = i2cp->id_i2c->CR2; /* Get the I2Cx CR2 value */
+ regCR2 &= (uint16_t)~I2C_CR2_FREQ; /* Clear frequency FREQ[5:0] bits */
+ freq = (uint16_t)(STM32_PCLK1 / 1000000); /* Set frequency bits depending on pclk1 value */
+ chDbgCheck((freq >= 2) && (freq <= 36),
+ "i2c_lld_set_clock() : Peripheral clock freq. out of range");
+ regCR2 |= freq;
+ i2cp->id_i2c->CR2 = regCR2;
+
+ /**************************************************************************
+ * CCR Configuration
+ */
+ pe_bit_saved = (i2cp->id_i2c->CR1 & I2C_CR1_PE);
+ i2cp->id_i2c->CR1 &= (uint16_t)~I2C_CR1_PE; /* Disable the selected I2C peripheral to configure TRISE */
+ regCCR = 0; /* Clear F/S, DUTY and CCR[11:0] bits */
+ clock_div = I2C_CCR_CCR;
+
+ if (clock_speed <= 100000) { /* Configure clock_div in standard mode */
+ chDbgAssert(duty == STD_DUTY_CYCLE,
+ "i2c_lld_set_clock(), #1",
+ "Invalid standard mode duty cycle");
+ clock_div = (uint16_t)(STM32_PCLK1 / (clock_speed * 2)); /* Standard mode clock_div calculate: Tlow/Thigh = 1/1 */
+ if (clock_div < 0x04) clock_div = 0x04; /* Test if CCR value is under 0x4, and set the minimum allowed value */
+ regCCR |= (clock_div & I2C_CCR_CCR); /* Set clock_div value for standard mode */
+ i2cp->id_i2c->TRISE = freq + 1; /* Set Maximum Rise Time for standard mode */
+ }
+ else if(clock_speed <= 400000) { /* Configure clock_div in fast mode */
+ chDbgAssert((duty == FAST_DUTY_CYCLE_2) ||
+ (duty == FAST_DUTY_CYCLE_16_9),
+ "i2c_lld_set_clock(), #2",
+ "Invalid fast mode duty cycle");
+ if(duty == FAST_DUTY_CYCLE_2) {
+ clock_div = (uint16_t)(STM32_PCLK1 / (clock_speed * 3)); /* Fast mode clock_div calculate: Tlow/Thigh = 2/1 */
+ }
+ else if(duty == FAST_DUTY_CYCLE_16_9) {
+ clock_div = (uint16_t)(STM32_PCLK1 / (clock_speed * 25)); /* Fast mode clock_div calculate: Tlow/Thigh = 16/9 */
+ regCCR |= I2C_CCR_DUTY; /* Set DUTY bit */
+ }
+ if(clock_div < 0x01) clock_div = 0x01; /* Test if CCR value is under 0x1, and set the minimum allowed value */
+ regCCR |= (I2C_CCR_FS | (clock_div & I2C_CCR_CCR)); /* Set clock_div value and F/S bit for fast mode*/
+ i2cp->id_i2c->TRISE = (freq * 300 / 1000) + 1; /* Set Maximum Rise Time for fast mode */
+ }
+ chDbgAssert((clock_div <= I2C_CCR_CCR),
+ "i2c_lld_set_clock(), #3", "Too low clock clock speed selected");
+
+ i2cp->id_i2c->CCR = regCCR; /* Write to I2Cx CCR */
+ i2cp->id_i2c->CR1 |= pe_bit_saved; /* restore the I2C peripheral enabled state */
+}
+
+/**
+ * @brief Set operation mode of I2C hardware.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ */
+void i2c_lld_set_opmode(I2CDriver *i2cp) {
+ i2copmode_t opmode = i2cp->id_config->op_mode;
+ uint16_t regCR1;
+
+ regCR1 = i2cp->id_i2c->CR1; /* Get the I2Cx CR1 value */
+ switch(opmode){
+ case OPMODE_I2C:
+ regCR1 &= (uint16_t)~(I2C_CR1_SMBUS|I2C_CR1_SMBTYPE);
+ break;
+ case OPMODE_SMBUS_DEVICE:
+ regCR1 |= I2C_CR1_SMBUS;
+ regCR1 &= (uint16_t)~(I2C_CR1_SMBTYPE);
+ break;
+ case OPMODE_SMBUS_HOST:
+ regCR1 |= (I2C_CR1_SMBUS|I2C_CR1_SMBTYPE);
+ break;
+ }
+
+ i2cp->id_i2c->CR1 = regCR1; /* Write to I2Cx CR1 */
+}
+
+/**
+ * @brief Set own address.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ */
+void i2c_lld_set_own_address(I2CDriver *i2cp) {
+ /* TODO: dual address mode */
+
+ i2cp->id_i2c->OAR1 |= 1 << 14;
+
+ if (&(i2cp->id_config->own_addr_10) == NULL){ /* only 7-bit address */
+ i2cp->id_i2c->OAR1 &= (~I2C_OAR1_ADDMODE);
+ i2cp->id_i2c->OAR1 |= i2cp->id_config->own_addr_7 << 1;
+ }
+ else {
+ chDbgAssert((i2cp->id_config->own_addr_10 < 1024),
+ "i2c_lld_set_own_address(), #1", "10-bit address longer then 10 bit")
+ i2cp->id_i2c->OAR1 |= I2C_OAR1_ADDMODE;
+ i2cp->id_i2c->OAR1 |= i2cp->id_config->own_addr_10;
+ }
+}
+
+
+/**
+ * @brief Deactivates the I2C peripheral.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ */
+void i2c_lld_stop(I2CDriver *i2cp) {
+ if (i2cp->id_state == I2C_READY) { /* If in ready state then disables the I2C clock.*/
+#if STM32_I2C_USE_I2C1
+ if (&I2CD1 == i2cp) {
+ NVICDisableVector(I2C1_EV_IRQn);
+ NVICDisableVector(I2C1_ER_IRQn);
+ RCC->APB1ENR &= ~RCC_APB1ENR_I2C1EN;
+ }
+#endif
+#if STM32_I2C_USE_I2C2
+ if (&I2CD2 == i2cp) {
+ NVICDisableVector(I2C2_EV_IRQn);
+ NVICDisableVector(I2C2_ER_IRQn);
+ RCC->APB1ENR &= ~RCC_APB1ENR_I2C2EN;
+ }
+#endif
+ }
+
+ i2cp->id_state = I2C_STOP;
+}
+
+
+#if I2C_SUPPORTS_CALLBACKS
+/**
+ * @brief Transmits data via the I2C bus as master.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ * @param[in] slave_addr Slave device address. Bits 0-9 contain slave
+ * device address. Bit 15 must be set to 1 if 10-bit
+ * addressing modes used. Otherwise keep it cleared.
+ * Bits 10-14 unused.
+ * @param[in] txbuf pointer to the transmit buffer
+ * @param[in] txbytes number of bytes to be transmitted
+ * @param[in] rxbuf pointer to the receive buffer
+ * @param[in] rxbytes number of bytes to be received
+ */
+void i2c_lld_master_transmit(I2CDriver *i2cp, uint16_t slave_addr,
+ uint8_t *txbuf, size_t txbytes, uint8_t *rxbuf, size_t rxbytes) {
+
+ /* "waiting" for STOP bit routine*/
+ #if STM32_I2C_I2C1_USE_POLLING_WAIT
+ uint32_t timeout = I2C_POLLING_TIMEOUT;
+ while((i2cp->id_i2c->CR1 & I2C_CR1_STOP) && timeout)
+ timeout--;
+ chDbgAssert((timeout > 0), "i2c_lld_master_transmit(), #1", "time to STOP is out");
+ #else
+ chDbgAssert(!(i2cp->flags & I2C_FLG_TIMER_ARMED), "i2c_lld_master_transmit(), #1", "time to STOP is out");
+ if ((i2cp->id_i2c->CR1 & I2C_CR1_STOP) && i2cp->timer != NULL && i2cp->timer_cfg != NULL){
+ gptStartOneShotI(i2cp->timer, I2C_STOP_GPT_TIMEOUT);
+ i2cp->flags |= I2C_FLG_TIMER_ARMED;
+ return;
+ }
+ #endif /* STM32_I2C_I2C1_USE_POLLING_WAIT */
+
+ /* init driver fields */
+ i2cp->slave_addr = slave_addr;
+ i2cp->txbytes = txbytes;
+ i2cp->rxbytes = rxbytes;
+ i2cp->txbuf = txbuf;
+ i2cp->rxbuf = rxbuf;
+
+ /* init address fields */
+ if(slave_addr & 0x8000){ /* 10-bit mode used */
+ i2cp->slave_addr1 = ((slave_addr >>7) & 0x0006); /* add the two msb of 10-bit address to the header */
+ i2cp->slave_addr1 |= 0xF0; /* add the header bits with LSB = 0 -> write */
+ i2cp->slave_addr2 = slave_addr & 0x00FF; /* the remaining 8 bit of 10-bit address */
+ }
+ else{
+ i2cp->slave_addr1 = ((slave_addr <<1) & 0x00FE); /* LSB = 0 -> write */
+ }
+
+ /* setting flags and register bits */
+ i2cp->flags = 0;
+ i2cp->errors = 0;
+ i2cp->id_i2c->CR1 &= ~I2C_CR1_POS;
+ i2cp->id_i2c->CR1 |= I2C_CR1_START;
+ i2cp->id_i2c->CR2 |= (I2C_CR2_ITERREN|I2C_CR2_ITEVTEN|I2C_CR2_ITBUFEN); /* enable ERR, EVT & BUF ITs */
+}
+
+/**
+ * @brief Receives data from the I2C bus.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ * @param[in] slave_addr Slave device address. Bits 0-9 contain slave
+ * device address. Bit 15 must be set to 1 if 10-bit
+ * addressing modes used. Otherwise keep it cleared.
+ * Bits 10-14 unused.
+ * @param[in] rxbuf pointer to the receive buffer
+ * @param[in] rxbytes number of bytes to be received
+ */
+void i2c_lld_master_receive(I2CDriver *i2cp, uint16_t slave_addr,
+ uint8_t *rxbuf, size_t rxbytes){
+
+ chDbgAssert((i2cp->id_i2c->SR1 + i2cp->id_i2c->SR2) == 0,
+ "i2c_lld_master_receive(), #1",
+ "some interrupt sources not clear");
+
+ /* "waiting" for STOP bit routine*/
+ #if STM32_I2C_I2C1_USE_POLLING_WAIT
+ uint32_t timeout = I2C_POLLING_TIMEOUT;
+ while((i2cp->id_i2c->CR1 & I2C_CR1_STOP) && timeout)
+ timeout--;
+ chDbgAssert((timeout > 0), "i2c_lld_master_receive(), #1", "time to STOP is out");
+ #else
+ chDbgAssert(!(i2cp->flags & I2C_FLG_TIMER_ARMED), "i2c_lld_master_receive(), #1", "time to STOP is out");
+ if ((i2cp->id_i2c->CR1 & I2C_CR1_STOP) && i2cp->timer != NULL && i2cp->timer_cfg != NULL){
+ gptStartOneShotI(i2cp->timer, I2C_STOP_GPT_TIMEOUT);
+ i2cp->flags |= I2C_FLG_TIMER_ARMED;
+ return;
+ }
+ #endif /* STM32_I2C_I2C1_USE_POLLING_WAIT */
+
+ /* init driver fields */
+ i2cp->slave_addr = slave_addr;
+ i2cp->rxbytes = rxbytes;
+ i2cp->rxbuf = rxbuf;
+
+ /* init address fields */
+ if(slave_addr & 0x8000){ /* 10-bit mode used */
+ i2cp->slave_addr1 = ((slave_addr >>7) & 0x0006); /* add the two msb of 10-bit address to the header */
+ i2cp->slave_addr1 |= 0xF0; /* add the header bits (the LSB -> 1 will be add to second */
+ i2cp->slave_addr2 = slave_addr & 0x00FF; /* the remaining 8 bit of 10-bit address */
+ }
+ else{
+ i2cp->slave_addr1 = ((slave_addr <<1) | 0x01); /* LSB = 1 -> receive */
+ }
+
+ /* setting flags and register bits */
+ i2cp->flags |= I2C_FLG_MASTER_RECEIVER;
+ i2cp->errors = 0;
+
+ i2cp->id_i2c->CR1 |= I2C_CR1_ACK; /* acknowledge returned */
+ i2cp->id_i2c->CR1 &= ~I2C_CR1_POS;
+
+ if(i2cp->rxbytes == 1) { /* Only one byte to be received */
+ i2cp->flags |= I2C_FLG_1BTR;
+ }
+ else if(i2cp->rxbytes == 2) { /* Only two bytes to be received */
+ i2cp->flags |= I2C_FLG_2BTR;
+ i2cp->id_i2c->CR1 |= I2C_CR1_POS; /* Acknowledge Position */
+ }
+
+ i2cp->id_i2c->CR1 |= I2C_CR1_START; /* send start bit */
+ i2cp->id_i2c->CR2 |= (I2C_CR2_ITERREN|I2C_CR2_ITEVTEN|I2C_CR2_ITBUFEN); /* enable ERR, EVT & BUF ITs */
+}
+
+
+/**
+ * @brief Realize read-though-write behavior.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ *
+ * @notapi
+ */
+void i2c_lld_master_transceive(I2CDriver *i2cp){
+
+ chDbgAssert((i2cp != NULL) && (i2cp->slave_addr1 != 0) &&\
+ (i2cp->rxbytes > 0) && (i2cp->rxbuf != NULL),
+ "i2c_lld_master_transceive(), #1",
+ "");
+
+ i2cp->id_state = I2C_ACTIVE_TRANSCEIVE;
+
+ /* "waiting" for START bit routine*/
+ #if STM32_I2C_I2C1_USE_POLLING_WAIT
+ uint32_t timeout = I2C_POLLING_TIMEOUT;
+ while((i2cp->id_i2c->CR1 & I2C_CR1_START) && timeout);
+ timeout--;
+ chDbgAssert((timeout > 0), "i2c_lld_master_transceive(), #1", "time to START is out");
+ #else
+ chDbgAssert(!(i2cp->flags & I2C_FLG_TIMER_ARMED), "i2c_lld_master_transceive(), #1", "time to START is out");
+ if ((i2cp->id_i2c->CR1 & I2C_CR1_START) && i2cp->timer != NULL && i2cp->timer_cfg != NULL){
+ gptStartOneShotI(i2cp->timer, I2C_START_GPT_TIMEOUT);
+ i2cp->flags |= I2C_FLG_TIMER_ARMED;
+ return;
+ }
+ #endif /* STM32_I2C_I2C1_USE_POLLING_WAIT */
+
+ /* init address fields */
+ if(i2cp->slave_addr & 0x8000){ /* 10-bit mode used */
+ i2cp->slave_addr1 = ((i2cp->slave_addr >>7) & 0x0006);/* add the two msb of 10-bit address to the header */
+ i2cp->slave_addr1 |= 0xF0; /* add the header bits (the LSB -> 1 will be add to second */
+ i2cp->slave_addr2 = i2cp->slave_addr & 0x00FF; /* the remaining 8 bit of 10-bit address */
+ }
+ else{
+ i2cp->slave_addr1 |= 0x01;
+ }
+
+ /* setting flags and register bits */
+ i2cp->flags |= I2C_FLG_MASTER_RECEIVER;
+ i2cp->errors = 0;
+ i2cp->id_i2c->CR1 |= I2C_CR1_ACK; /* acknowledge returned */
+ i2cp->id_i2c->CR1 &= ~I2C_CR1_POS;
+
+ if(i2cp->rxbytes == 1) { /* Only one byte to be received */
+ i2cp->flags |= I2C_FLG_1BTR;
+ }
+ else if(i2cp->rxbytes == 2) { /* Only two bytes to be received */
+ i2cp->flags |= I2C_FLG_2BTR;
+ i2cp->id_i2c->CR1 |= I2C_CR1_POS; /* Acknowledge Position */
+ }
+
+ i2cp->id_i2c->CR2 |= (I2C_CR2_ITERREN|I2C_CR2_ITEVTEN|I2C_CR2_ITBUFEN); /* enable ERR, EVT & BUF ITs */
+}
+
+#else /*I2C_SUPPORTS_CALLBACKS*/
+
+/**
+ * @brief Synchronously transmits data via the I2C bus as master.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ * @param[in] slave_addr Slave device address. Bits 0-9 contain slave
+ * device address. Bit 15 must be set to 1 if 10-bit
+ * addressing modes used. Otherwise keep it cleared.
+ * Bits 10-14 unused.
+ * @param[in] txbuf pointer to the transmit buffer
+ * @param[in] txbytes number of bytes to be transmitted
+ * @param[in] rxbuf pointer to the receive buffer
+ * @param[in] rxbytes number of bytes to be received
+ */
+void i2c_lld_master_transmit(I2CDriver *i2cp, uint16_t slave_addr,
+ uint8_t *txbuf, size_t txbytes, uint8_t *rxbuf, size_t rxbytes) {
+
+ /* init driver fields */
+ i2cp->slave_addr = slave_addr;
+ i2cp->txbytes = txbytes;
+ i2cp->rxbytes = rxbytes;
+ i2cp->txbuf = txbuf;
+ i2cp->rxbuf = rxbuf;
+
+ /* init address fields */
+ if(slave_addr & 0x8000){ /* 10-bit mode used */
+ i2cp->slave_addr1 = ((slave_addr >>7) & 0x0006); /* add the two msb of 10-bit address to the header */
+ i2cp->slave_addr1 |= 0xF0; /* add the header bits with LSB = 0 -> write */
+ i2cp->slave_addr2 = slave_addr & 0x00FF; /* the remaining 8 bit of 10-bit address */
+ }
+ else{
+ i2cp->slave_addr1 = ((slave_addr <<1) & 0x00FE); /* LSB = 0 -> write */
+ }
+
+ i2cp->flags = 0;
+ i2cp->errors = 0;
+ i2cp->id_i2c->CR1 &= ~I2C_CR1_POS;
+ i2cp->id_i2c->CR2 &= ~I2C_CR2_ITEVTEN; /* disable event interrupts */
+ i2cp->id_i2c->CR2 |= I2C_CR2_ITERREN; /* enable error interrupts */
+
+ i2cp->id_i2c->CR1 |= I2C_CR1_START;
+ while (!(i2cp->id_i2c->SR1 & I2C_SR1_SB))
+ ;
+ i2cp->id_i2c->DR = i2cp->slave_addr1;
+ while (!(i2cp->id_i2c->SR1 & I2C_SR1_ADDR))
+ ;
+ while (!(i2cp->id_i2c->SR2 & I2C_SR2_BUSY))
+ ;
+ i2cp->id_i2c->DR = *txbuf;
+ txbuf++;
+ i2cp->txbytes--;
+ while(i2cp->txbytes > 0){
+ while(!(i2cp->id_i2c->SR1 & I2C_SR1_BTF))
+ ;
+ i2cp->id_i2c->DR = *txbuf;
+ txbuf++;
+ i2cp->txbytes--;
+ }
+ while(!(i2cp->id_i2c->SR1 & I2C_SR1_BTF))
+ ;
+ if(rxbytes == 0){
+ i2cp->id_i2c->CR1 |= I2C_CR1_STOP;
+ while (i2cp->id_i2c->CR1 & I2C_CR1_STOP)
+ ;
+ }
+ else{
+ i2c_lld_master_receive(i2cp, slave_addr, rxbuf, rxbytes);
+ }
+}
+
+
+/**
+ * @brief Synchronously receives data from the I2C bus.
+ *
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ * @param[in] slave_addr Slave device address. Bits 0-9 contain slave
+ * device address. Bit 15 must be set to 1 if 10-bit
+ * addressing modes used. Otherwise keep it cleared.
+ * Bits 10-14 unused.
+ * @param[in] rxbuf pointer to the receive buffer
+ * @param[in] rxbytes number of bytes to be received
+ */
+void i2c_lld_master_receive(I2CDriver *i2cp, uint16_t slave_addr,
+ uint8_t *rxbuf, size_t rxbytes){
+
+ /* init driver fields */
+ i2cp->slave_addr = slave_addr;
+ i2cp->rxbytes = rxbytes;
+ i2cp->rxbuf = rxbuf;
+
+ /* init address fields */
+ if(slave_addr & 0x8000){ /* 10-bit mode used */
+ i2cp->slave_addr1 = ((slave_addr >>7) & 0x0006); /* add the two msb of 10-bit address to the header */
+ i2cp->slave_addr1 |= 0xF0; /* add the header bits (the LSB -> 1 will be add to second */
+ i2cp->slave_addr2 = slave_addr & 0x00FF; /* the remaining 8 bit of 10-bit address */
+ }
+ else{
+ i2cp->slave_addr1 = ((slave_addr <<1) | 0x01); /* LSB = 1 -> receive */
+ }
+
+
+ /* setting flags and register bits */
+ i2cp->flags = 0;
+ i2cp->errors = 0;
+ i2cp->id_i2c->CR1 &= ~I2C_CR1_POS;
+ i2cp->id_i2c->CR2 &= ~I2C_CR2_ITEVTEN; /* disable event interrupts */
+ i2cp->id_i2c->CR2 |= I2C_CR2_ITERREN; /* enable error interrupts */
+
+ i2cp->id_i2c->CR1 |= I2C_CR1_START;
+ while (!(i2cp->id_i2c->SR1 & I2C_SR1_SB))
+ ;
+
+ i2cp->id_i2c->DR = i2cp->slave_addr1;
+ while (!(i2cp->id_i2c->SR1 & I2C_SR1_ADDR))
+ ;
+
+ if(i2cp->rxbytes >= 3){ /* more than 2 bytes receiving procedure */
+ while(!(i2cp->id_i2c->SR2 & I2C_SR2_BUSY)) /* to clear ADDR bit */
+ ;
+ while(i2cp->rxbytes > 3){
+ while(!(i2cp->id_i2c->SR1 & I2C_SR1_BTF))
+ ;
+ *rxbuf = i2cp->id_i2c->DR;
+ rxbuf++;
+ i2cp->rxbytes--;
+ }
+ while(!(i2cp->id_i2c->SR1 & I2C_SR1_BTF)) /* stopping procedure */
+ ;
+ i2cp->id_i2c->CR1 &= ~I2C_CR1_ACK;
+ chSysLock();
+ i2cp->id_i2c->CR1 |= I2C_CR1_STOP;
+ *rxbuf = i2cp->id_i2c->DR;
+ rxbuf++;
+ i2cp->rxbytes--;
+ chSysUnlock();
+ while(!(i2cp->id_i2c->SR1 & I2C_SR1_RXNE))
+ ;
+ *rxbuf = i2cp->id_i2c->DR;
+ rxbuf++;
+ i2cp->rxbytes--;
+ while (i2cp->id_i2c->CR1 & I2C_CR1_STOP)
+ ;
+ i2cp->id_i2c->CR1 |= I2C_CR1_ACK;
+ }
+ else{ /* 1 or 2 bytes receiving procedure */
+ if(i2cp->rxbytes == 2){
+ i2cp->id_i2c->CR1 |= I2C_CR1_POS;
+ chSysLock();
+ while(!(i2cp->id_i2c->SR2 & I2C_SR2_BUSY)) /* to clear ADDR bit */
+ ;
+ i2cp->id_i2c->CR1 &= ~I2C_CR1_ACK;
+ chSysUnlock();
+ while(!(i2cp->id_i2c->SR1 & I2C_SR1_BTF))
+ ;
+ chSysLock();
+ i2cp->id_i2c->CR1 |= I2C_CR1_STOP;
+ *rxbuf = i2cp->id_i2c->DR;
+ rxbuf++;
+ i2cp->rxbytes--;
+ chSysUnlock();
+ *rxbuf = i2cp->id_i2c->DR;
+ rxbuf++;
+ i2cp->rxbytes--;
+ while (i2cp->id_i2c->CR1 & I2C_CR1_STOP)
+ ;
+ i2cp->id_i2c->CR1 &= ~I2C_CR1_POS;
+ i2cp->id_i2c->CR1 |= I2C_CR1_ACK;
+ }
+ else{ /* 1 byte */
+ i2cp->id_i2c->CR1 &= ~I2C_CR1_ACK;
+ chSysLock();
+ while(!(i2cp->id_i2c->SR2 & I2C_SR2_BUSY)) /* to clear ADDR bit */
+ ;
+ i2cp->id_i2c->CR1 |= I2C_CR1_STOP;
+ chSysUnlock();
+ while(!(i2cp->id_i2c->SR1 & I2C_SR1_RXNE))
+ ;
+ *rxbuf = i2cp->id_i2c->DR;
+ rxbuf++;
+ i2cp->rxbytes--;
+ while (i2cp->id_i2c->CR1 & I2C_CR1_STOP)
+ ;
+ i2cp->id_i2c->CR1 |= I2C_CR1_ACK;
+ }
+ }
+}
+#endif /* I2C_SUPPORTS_CALLBACKS */
+
+#undef rxBuffp
+#undef txBuffp
+
+#endif /* HAL_USE_I2C */
diff --git a/os/hal/platforms/STM32/i2c_lld.h b/os/hal/platforms/STM32/i2c_lld.h
new file mode 100644
index 000000000..9bf56985c
--- /dev/null
+++ b/os/hal/platforms/STM32/i2c_lld.h
@@ -0,0 +1,293 @@
+/**
+ * @file STM32/i2c_lld.h
+ * @brief STM32 I2C subsystem low level driver header.
+ * @addtogroup I2C
+ * @{
+ */
+
+#ifndef _I2C_LLD_H_
+#define _I2C_LLD_H_
+
+#if HAL_USE_I2C || defined(__DOXYGEN__)
+
+/*===========================================================================*/
+/* Driver constants. */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver pre-compile time settings. */
+/*===========================================================================*/
+/**
+ * @brief Switch between callback based and synchronouse driver.
+ * @note The default is synchronouse.
+ */
+#if !defined(I2C_SUPPORTS_CALLBACKS) || defined(__DOXYGEN__)
+#define I2C_SUPPORTS_CALLBACKS TRUE
+#endif
+
+/**
+ * @brief I2C1 driver synchronization choice between GPT and polling.
+ * @note The default is polling wait.
+ */
+#if !defined(STM32_I2C_I2C1_USE_GPT_TIM) || \
+ !defined(STM32_I2C_I2C1_USE_POLLING_WAIT) || \
+ defined(__DOXYGEN__)
+#define STM32_I2C_I2C1_USE_POLLING_WAIT TRUE
+#endif
+
+/**
+ * @brief I2C2 driver synchronization choice between GPT and polling.
+ * @note The default is polling wait.
+ */
+#if !defined(STM32_I2C_I2C2_USE_GPT_TIM) || \
+ !defined(STM32_I2C_I2C2_USE_POLLING_WAIT) || \
+ defined(__DOXYGEN__)
+#define STM32_I2C_I2C2_USE_POLLING_WAIT TRUE
+#endif
+
+/**
+ * @brief I2C1 driver enable switch.
+ * @details If set to @p TRUE the support for I2C1 is included.
+ * @note The default is @p TRUE.
+ */
+#if !defined(STM32_I2C_USE_I2C1) || defined(__DOXYGEN__)
+#define STM32_I2C_USE_I2C1 TRUE
+#endif
+
+/**
+ * @brief I2C2 driver enable switch.
+ * @details If set to @p TRUE the support for I2C2 is included.
+ * @note The default is @p TRUE.
+ */
+#if !defined(STM32_I2C_USE_I2C2) || defined(__DOXYGEN__)
+#define STM32_I2C_USE_I2C2 TRUE
+#endif
+
+/**
+ * @brief I2C1 interrupt priority level setting.
+ * @note @p BASEPRI_KERNEL >= @p STM32_I2C_I2C1_IRQ_PRIORITY > @p PRIORITY_PENDSV.
+ */
+#if !defined(STM32_I2C_I2C1_IRQ_PRIORITY) || defined(__DOXYGEN__)
+#define STM32_I2C_I2C1_IRQ_PRIORITY 0xA0
+#endif
+
+/**
+ * @brief I2C2 interrupt priority level setting.
+ * @note @p BASEPRI_KERNEL >= @p STM32_I2C_I2C2_IRQ_PRIORITY > @p PRIORITY_PENDSV.
+ */
+#if !defined(STM32_I2C_I2C2_IRQ_PRIORITY) || defined(__DOXYGEN__)
+#define STM32_I2C_I2C2_IRQ_PRIORITY 0xA0
+#endif
+
+/*===========================================================================*/
+/* Derived constants and error checks. */
+/*===========================================================================*/
+
+/** @brief EV5 */
+#define I2C_EV5_MASTER_MODE_SELECT ((uint32_t)(((I2C_SR2_MSL|I2C_SR2_BUSY)<< 16)|I2C_SR1_SB)) /* BUSY, MSL and SB flag */
+/** @brief EV6 */
+#define I2C_EV6_MASTER_TRA_MODE_SELECTED ((uint32_t)(((I2C_SR2_MSL|I2C_SR2_BUSY|I2C_SR2_TRA)<< 16)|I2C_SR1_ADDR|I2C_SR1_TXE)) /* BUSY, MSL, ADDR, TXE and TRA flags */
+#define I2C_EV6_MASTER_REC_MODE_SELECTED ((uint32_t)(((I2C_SR2_MSL|I2C_SR2_BUSY)<< 16)|I2C_SR1_ADDR)) /* BUSY, MSL and ADDR flags */
+/** @brief EV7 */
+#define I2C_EV7_MASTER_REC_BYTE_RECEIVED ((uint32_t)(((I2C_SR2_MSL|I2C_SR2_BUSY)<< 16)|I2C_SR1_RXNE)) /* BUSY, MSL and RXNE flags */
+#define I2C_EV7_MASTER_REC_BYTE_QUEUED ((uint32_t)(((I2C_SR2_MSL|I2C_SR2_BUSY)<< 16)|I2C_SR1_BTF|I2C_SR1_RXNE)) /* BUSY, MSL, RXNE and BTF flags*/
+/** @brief EV8 */
+#define I2C_EV8_MASTER_BYTE_TRANSMITTING ((uint32_t)(((I2C_SR2_MSL|I2C_SR2_BUSY|I2C_SR2_TRA)<< 16)|I2C_SR1_TXE)) /* TRA, BUSY, MSL, TXE flags */
+/** @brief EV8_2 */
+#define I2C_EV8_2_MASTER_BYTE_TRANSMITTED ((uint32_t)(((I2C_SR2_MSL|I2C_SR2_BUSY|I2C_SR2_TRA)<< 16)|I2C_SR1_BTF|I2C_SR1_TXE)) /* TRA, BUSY, MSL, TXE and BTF flags */
+/** @brief EV9 */
+#define I2C_EV9_MASTER_ADDR_10BIT ((uint32_t)(((I2C_SR2_MSL|I2C_SR2_BUSY)<< 16)|I2C_SR1_ADD10)) /* BUSY, MSL and ADD10 flags */
+#define I2C_EV_MASK 0x00FFFFFF /* First byte zeroed because there is no need of PEC register part from SR2 */
+
+#define I2C_FLG_1BTR 0x01 /* Single byte to be received and processed */
+#define I2C_FLG_2BTR 0x02 /* Two bytes to be received and processed */
+#define I2C_FLG_3BTR 0x04 /* Last three received bytes to be processed */
+#define I2C_FLG_MASTER_RECEIVER 0x10
+#define I2C_FLG_HEADER_SENT 0x80
+#define I2C_FLG_TIMER_ARMED 0x40 /* Used to check locks on the bus */
+
+#define EV6_SUBEV_MASK (I2C_FLG_1BTR|I2C_FLG_2BTR|I2C_FLG_MASTER_RECEIVER)
+#define EV7_SUBEV_MASK (I2C_FLG_2BTR|I2C_FLG_3BTR|I2C_FLG_MASTER_RECEIVER)
+
+#define I2C_EV6_1_MASTER_REC_2BTR_MODE_SELECTED (I2C_FLG_2BTR|I2C_FLG_MASTER_RECEIVER)
+#define I2C_EV6_3_MASTER_REC_1BTR_MODE_SELECTED (I2C_FLG_1BTR|I2C_FLG_MASTER_RECEIVER)
+#define I2C_EV7_2_MASTER_REC_3BYTES_TO_PROCESS (I2C_FLG_3BTR|I2C_FLG_MASTER_RECEIVER)
+#define I2C_EV7_3_MASTER_REC_2BYTES_TO_PROCESS (I2C_FLG_2BTR|I2C_FLG_MASTER_RECEIVER)
+
+/*===========================================================================*/
+/* Driver data structures and types. */
+/*===========================================================================*/
+
+/**
+ * @brief I2C Driver condition flags type.
+ */
+typedef uint32_t i2cflags_t;
+
+typedef enum {
+ OPMODE_I2C = 1,
+ OPMODE_SMBUS_DEVICE = 2,
+ OPMODE_SMBUS_HOST = 3,
+} i2copmode_t;
+
+typedef enum {
+ STD_DUTY_CYCLE = 1,
+ FAST_DUTY_CYCLE_2 = 2,
+ FAST_DUTY_CYCLE_16_9 = 3,
+} i2cdutycycle_t;
+
+/**
+ * @brief Driver configuration structure.
+ */
+typedef struct {
+ i2copmode_t op_mode; /**< @brief Specifies the I2C mode.*/
+ uint32_t clock_speed; /**< @brief Specifies the clock frequency. Must be set to a value lower than 400kHz */
+ i2cdutycycle_t duty_cycle; /**< @brief Specifies the I2C fast mode duty cycle */
+ uint8_t own_addr_7; /**< @brief Specifies the first device 7-bit own address. */
+ uint16_t own_addr_10; /**< @brief Specifies the second part of device own address in 10-bit mode. Set to NULL if not used. */
+ uint16_t ack; /**< @brief Enables or disables the acknowledgment. */
+ uint8_t nbit_own_addr; /**< @brief Specifies if 7-bit or 10-bit address is acknowledged */
+} I2CConfig;
+
+
+/**
+ * @brief Type of a structure representing an I2C driver.
+ */
+typedef struct I2CDriver I2CDriver;
+
+/**
+ * @brief Type of a structure representing an I2C slave config.
+ */
+typedef struct I2CSlaveConfig I2CSlaveConfig;
+
+/**
+ * @brief Structure representing an I2C driver.
+ */
+struct I2CDriver{
+ /**
+ * @brief Driver state.
+ */
+ i2cstate_t id_state;
+
+#if I2C_USE_WAIT
+ /**
+ * @brief Thread waiting for I/O completion.
+ */
+ Thread *id_thread;
+#endif /* I2C_USE_WAIT */
+#if I2C_USE_MUTUAL_EXCLUSION || defined(__DOXYGEN__)
+#if CH_USE_MUTEXES || defined(__DOXYGEN__)
+ /**
+ * @brief Mutex protecting the bus.
+ */
+ Mutex id_mutex;
+#elif CH_USE_SEMAPHORES
+ Semaphore id_semaphore;
+#endif
+#endif /* I2C_USE_MUTUAL_EXCLUSION */
+
+ /**
+ * @brief Current configuration data.
+ */
+ const I2CConfig *id_config;
+ /**
+ * @brief Current slave configuration data.
+ */
+ const I2CSlaveConfig *id_slave_config;
+
+ __IO size_t txbytes; /*!< @brief Number of bytes to be transmitted. */
+ __IO size_t rxbytes; /*!< @brief Number of bytes to be received. */
+ uint8_t *rxbuf; /*!< @brief Pointer to receive buffer. */
+ uint8_t *txbuf; /*!< @brief Pointer to transmit buffer.*/
+ uint8_t *rxbuff_p; /*!< @brief Pointer to the current byte in slave rx buffer. */
+ uint8_t *txbuff_p; /*!< @brief Pointer to the current byte in slave tx buffer. */
+
+ __IO i2cflags_t errors; /*!< @brief Error flags.*/
+ __IO i2cflags_t flags; /*!< @brief State flags.*/
+
+ uint16_t slave_addr; /*!< @brief Current slave address. */
+ uint8_t slave_addr1;/*!< @brief 7-bit address of the slave with r\w bit.*/
+ uint8_t slave_addr2;/*!< @brief Uses in 10-bit address mode. */
+
+#if CH_USE_EVENTS
+ EventSource sevent; /*!< @brief Status Change @p EventSource.*/
+#endif
+
+ /*********** End of the mandatory fields. **********************************/
+
+ /**
+ * @brief Pointer to the I2Cx registers block.
+ */
+ I2C_TypeDef *id_i2c;
+
+#if !(STM32_I2C_I2C1_USE_POLLING_WAIT)
+ /* TODO: capability to switch this GPT fields off */
+ /**
+ * @brief Timer for waiting STOP condition on the bus.
+ * @details This is workaround for STM32 buggy I2C cell.
+ */
+ GPTDriver *timer;
+
+ /**
+ * @brief Config for workaround timer.
+ */
+ const GPTConfig *timer_cfg;
+#endif /* !(STM32_I2C_I2C1_USE_POLLING_WAIT) */
+};
+
+
+/*===========================================================================*/
+/* Driver macros. */
+/*===========================================================================*/
+
+#define i2c_lld_bus_is_busy(i2cp) \
+ (i2cp->id_i2c->SR2 & I2C_SR2_BUSY)
+
+
+/* Wait until BUSY flag is reset: a STOP has been generated on the bus
+ * signaling the end of transmission. Normally this wait function
+ * does not block thread, only if slave not response it does.
+ */
+#define i2c_lld_wait_bus_free(i2cp) { \
+ uint32_t tmo = 0xfffff; \
+ while((i2cp->id_i2c->SR2 & I2C_SR2_BUSY) && tmo--) \
+ ; \
+}
+
+/*===========================================================================*/
+/* External declarations. */
+/*===========================================================================*/
+
+/** @cond never*/
+#if STM32_I2C_USE_I2C1
+extern I2CDriver I2CD1;
+#endif
+
+#if STM32_I2C_USE_I2C2
+extern I2CDriver I2CD2;
+#endif
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+void i2c_lld_init(void);
+void i2c_lld_reset(I2CDriver *i2cp);
+void i2c_lld_set_clock(I2CDriver *i2cp);
+void i2c_lld_set_opmode(I2CDriver *i2cp);
+void i2c_lld_set_own_address(I2CDriver *i2cp);
+void i2c_lld_start(I2CDriver *i2cp);
+void i2c_lld_stop(I2CDriver *i2cp);
+void i2c_lld_master_transmit(I2CDriver *i2cp, uint16_t slave_addr,
+ uint8_t *txbuf, size_t txbytes, uint8_t *rxbuf, size_t rxbytes);
+void i2c_lld_master_receive(I2CDriver *i2cp, uint16_t slave_addr,
+ uint8_t *rxbuf, size_t rxbytes);
+void i2c_lld_master_transceive(I2CDriver *i2cp);
+
+#ifdef __cplusplus
+}
+#endif
+/** @endcond*/
+
+#endif /* CH_HAL_USE_I2C */
+
+#endif /* _I2C_LLD_H_ */
diff --git a/os/hal/platforms/STM32F1xx/platform.mk b/os/hal/platforms/STM32F1xx/platform.mk
index 7708d1a04..010a3f96d 100644
--- a/os/hal/platforms/STM32F1xx/platform.mk
+++ b/os/hal/platforms/STM32F1xx/platform.mk
@@ -4,6 +4,7 @@ PLATFORMSRC = ${CHIBIOS}/os/hal/platforms/STM32F1xx/hal_lld.c \
${CHIBIOS}/os/hal/platforms/STM32/can_lld.c \
${CHIBIOS}/os/hal/platforms/STM32/gpt_lld.c \
${CHIBIOS}/os/hal/platforms/STM32/icu_lld.c \
+ ${CHIBIOS}/os/hal/platforms/STM32/i2c_lld.c \
${CHIBIOS}/os/hal/platforms/STM32/pwm_lld.c \
${CHIBIOS}/os/hal/platforms/STM32/serial_lld.c \
${CHIBIOS}/os/hal/platforms/STM32/GPIOv1/pal_lld.c \
diff --git a/os/hal/src/i2c.c b/os/hal/src/i2c.c
index 86bfc16f6..974f65a08 100644
--- a/os/hal/src/i2c.c
+++ b/os/hal/src/i2c.c
@@ -55,7 +55,6 @@
* @init
*/
void i2cInit(void) {
-
i2c_lld_init();
}
@@ -68,8 +67,26 @@ void i2cInit(void) {
*/
void i2cObjectInit(I2CDriver *i2cp) {
- i2cp->i2c_state = I2C_STOP;
- i2cp->i2c_config = NULL;
+ i2cp->id_state = I2C_STOP;
+ i2cp->id_config = NULL;
+ i2cp->rxbuff_p = NULL;
+ i2cp->txbuff_p = NULL;
+ i2cp->rxbuf = NULL;
+ i2cp->txbuf = NULL;
+ i2cp->id_slave_config = NULL;
+
+#if I2C_USE_WAIT
+ i2cp->id_thread = NULL;
+#endif /* I2C_USE_WAIT */
+
+#if I2C_USE_MUTUAL_EXCLUSION
+#if CH_USE_MUTEXES
+ chMtxInit(&i2cp->id_mutex);
+#else
+ chSemInit(&i2cp->id_semaphore, 1);
+#endif /* CH_USE_MUTEXES */
+#endif /* I2C_USE_MUTUAL_EXCLUSION */
+
#if defined(I2C_DRIVER_EXT_INIT_HOOK)
I2C_DRIVER_EXT_INIT_HOOK(i2cp);
#endif
@@ -86,14 +103,18 @@ void i2cObjectInit(I2CDriver *i2cp) {
void i2cStart(I2CDriver *i2cp, const I2CConfig *config) {
chDbgCheck((i2cp != NULL) && (config != NULL), "i2cStart");
-
- chSysLock();
- chDbgAssert((i2cp->i2c_state == I2C_STOP) || (i2cp->i2c_state == I2C_READY),
+ chDbgAssert((i2cp->id_state == I2C_STOP) || (i2cp->id_state == I2C_READY),
"i2cStart(), #1",
"invalid state");
- i2cp->i2c_config = config;
+
+#if (!(STM32_I2C_I2C2_USE_POLLING_WAIT) && I2C_SUPPORTS_CALLBACKS)
+ gptStart(i2cp->timer, i2cp->timer_cfg);
+#endif /* !(STM32_I2C_I2C2_USE_POLLING_WAIT) */
+
+ chSysLock();
+ i2cp->id_config = config;
i2c_lld_start(i2cp);
- i2cp->i2c_state = I2C_READY;
+ i2cp->id_state = I2C_READY;
chSysUnlock();
}
@@ -107,133 +128,172 @@ void i2cStart(I2CDriver *i2cp, const I2CConfig *config) {
void i2cStop(I2CDriver *i2cp) {
chDbgCheck(i2cp != NULL, "i2cStop");
-
- chSysLock();
- chDbgAssert((i2cp->i2c_state == I2C_STOP) || (i2cp->i2c_state == I2C_READY),
+ chDbgAssert((i2cp->id_state == I2C_STOP) || (i2cp->id_state == I2C_READY),
"i2cStop(), #1",
"invalid state");
+
+#if (!(STM32_I2C_I2C2_USE_POLLING_WAIT) && I2C_SUPPORTS_CALLBACKS)
+ gptStop(i2cp->timer);
+#endif /* !(STM32_I2C_I2C2_USE_POLLING_WAIT) */
+
+ chSysLock();
i2c_lld_stop(i2cp);
- i2cp->i2c_state = I2C_STOP;
+ i2cp->id_state = I2C_STOP;
chSysUnlock();
}
/**
- * @brief Initiates a master bus transaction.
- * @details This function sends a start bit followed by an one or two bytes
- * header.
+ * @brief Sends data via the I2C bus.
*
- * @param[in] i2cp pointer to the @p I2CDriver object
- * @param[in] header transaction header
- * @param[in] callback operation complete callback
+ * @details Function designed to realize "read-through-write" transfer
+ * paradigm. If you want transmit data without any further read,
+ * than set @b rxbuf field to 0.
*
- * @iclass
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ * @param[in] i2cscfg pointer to the @p I2C slave config
+ * @param[in] slave_addr Slave device address. Bits 0-9 contain slave
+ * device address. Bit 15 must be set to 1 if 10-bit
+ * addressing mode used. Otherwise keep it cleared.
+ * Bits 10-14 unused.
+ * @param[in] txbuf pointer to transmit buffer
+ * @param[in] txbytes number of bytes to be transmitted
+ * @param[in] rxbuf pointer to receive buffer
+ * @param[in] rxbytes number of bytes to be received, set it to 0 if
+ * you want transmit only
*/
-void i2cMasterStartI(I2CDriver *i2cp,
- uint16_t header,
- i2ccallback_t callback) {
-
- chDbgCheck((i2cp != NULL) && (callback != NULL), "i2cMasterStartI");
- chDbgAssert(i2cp->i2c_state == I2C_READY,
- "i2cMasterStartI(), #1", "invalid state");
-
- i2cp->id_callback = callback;
- i2c_lld_master_start(i2cp, header);
+void i2cMasterTransmit(I2CDriver *i2cp,
+ const I2CSlaveConfig *i2cscfg,
+ uint16_t slave_addr,
+ uint8_t *txbuf,
+ size_t txbytes,
+ uint8_t *rxbuf,
+ size_t rxbytes) {
+
+ chDbgCheck((i2cp != NULL) && (i2cscfg != NULL) &&\
+ (slave_addr != 0) &&\
+ (txbytes > 0) &&\
+ (txbuf != NULL),
+ "i2cMasterTransmit");
+
+ /* init slave config field in driver */
+ i2cp->id_slave_config = i2cscfg;
+
+ i2c_lld_wait_bus_free(i2cp);
+ chDbgAssert(!(i2c_lld_bus_is_busy(i2cp)), "i2cMasterReceive(), #1", "time is out");
+
+ chDbgAssert(i2cp->id_state == I2C_READY,
+ "i2cMasterTransmit(), #1", "not ready");
+
+ i2cp->id_state = I2C_ACTIVE_TRANSMIT;
+ i2c_lld_master_transmit(i2cp, slave_addr, txbuf, txbytes, rxbuf, rxbytes);
+#if I2C_SUPPORTS_CALLBACKS
+ _i2c_wait_s(i2cp);
+#else
+ i2cp->id_state = I2C_READY;
+#endif /* I2C_SUPPORTS_CALLBACKS */
}
/**
- * @brief Terminates a master bus transaction.
- *
- * @param[in] i2cp pointer to the @p I2CDriver object
- * @param[in] callback operation complete callback
+ * @brief Receives data from the I2C bus.
*
- * @iclass
+ * @param[in] i2cp pointer to the @p I2CDriver object
+ * @param[in] i2cscfg pointer to the @p I2C slave config
+ * @param[in] slave_addr Slave device address. Bits 0-9 contain slave
+ * device address. Bit 15 must be set to 1 if 10-bit
+ * addressing mode used. Otherwise keep it cleared.
+ * Bits 10-14 unused.
+ * @param[in] rxbytes number of bytes to be received
+ * @param[in] rxbuf pointer to receive buffer
*/
-void i2cMasterStopI(I2CDriver *i2cp, i2ccallback_t callback) {
+void i2cMasterReceive(I2CDriver *i2cp,
+ const I2CSlaveConfig *i2cscfg,
+ uint16_t slave_addr,
+ uint8_t *rxbuf,
+ size_t rxbytes){
+
+ chDbgCheck((i2cp != NULL) && (i2cscfg != NULL) &&\
+ (slave_addr != 0) &&\
+ (rxbytes > 0) && \
+ (rxbuf != NULL),
+ "i2cMasterReceive");
+
+ /* init slave config field in driver */
+ i2cp->id_slave_config = i2cscfg;
+
+ i2c_lld_wait_bus_free(i2cp);
+ chDbgAssert(!(i2c_lld_bus_is_busy(i2cp)), "i2cMasterReceive(), #1", "time is out");
+
+ chDbgAssert(i2cp->id_state == I2C_READY,
+ "i2cMasterReceive(), #1", "not ready");
+
+ i2cp->id_state = I2C_ACTIVE_RECEIVE;
+ i2c_lld_master_receive(i2cp, slave_addr, rxbuf, rxbytes);
+#if I2C_SUPPORTS_CALLBACKS
+ _i2c_wait_s(i2cp);
+#else
+ i2cp->id_state = I2C_READY;
+#endif /* I2C_SUPPORTS_CALLBACKS */
+}
- chDbgCheck((i2cp != NULL) && (callback != NULL), "i2cMasterStopI");
- chDbgAssert(i2cp->i2c_state == I2C_MREADY,
- "i2cMasterStopI(), #1", "invalid state");
- i2cp->id_callback = callback;
- i2c_lld_master_stop(i2cp);
+/* FIXME: I do not know what this function must do. And can not test it
+uint16_t i2cSMBusAlertResponse(I2CDriver *i2cp, I2CSlaveConfig *i2cscfg) {
+ i2cMasterReceive(i2cp, i2cscfg);
+ return i2cp->id_slave_config->slave_addr;
}
-
+*/
/**
- * @brief Sends a restart bit.
- * @details Restart bits are required by some types of I2C transactions.
+ * @brief Handles communication events/errors.
+ * @details Must be called from the I/O interrupt service routine in order to
+ * notify I/O conditions as errors, signals change etc.
*
- * @param[in] i2cp pointer to the @p I2CDriver object
- * @param[in] callback operation complete callback
+ * @param[in] i2cp pointer to a @p I2CDriver structure
+ * @param[in] mask condition flags to be added to the mask
*
* @iclass
*/
-void i2cMasterRestartI(I2CDriver *i2cp, i2ccallback_t callback) {
+void i2cAddFlagsI(I2CDriver *i2cp, i2cflags_t mask) {
- chDbgCheck((i2cp != NULL) && (callback != NULL), "i2cMasterRestartI");
- chDbgAssert(i2cp->i2c_state == I2C_MREADY,
- "i2cMasterRestartI(), #1", "invalid state");
+ chDbgCheck(i2cp != NULL, "i2cAddFlagsI");
- i2cp->id_callback = callback;
- i2c_lld_master_restart(i2cp);
+ i2cp->errors |= mask;
+ chEvtBroadcastI(&i2cp->sevent);
}
/**
- * @brief Master transmission.
+ * @brief Returns and clears the errors mask associated to the driver.
*
- * @param[in] i2cp pointer to the @p I2CDriver object
- * @param[in] n number of bytes to be transmitted
- * @param[in] txbuf transmit data buffer pointer
- * @param[in] callback operation complete callback
+ * @param[in] i2cp pointer to a @p I2CDriver structure
+ * @return The condition flags modified since last time this
+ * function was invoked.
*
- * @iclass
+ * @api
*/
-void i2cMasterTransmitI(I2CDriver *i2cp, size_t n, const uint8_t *txbuf,
- i2ccallback_t callback) {
+i2cflags_t i2cGetAndClearFlags(I2CDriver *i2cp) {
+ i2cflags_t mask;
- chDbgCheck((i2cp != NULL) && (n > 0) &&
- (txbuf != NULL) && (callback != NULL), "i2cMasterTransmitI");
- chDbgAssert(i2cp->i2c_state == I2C_MREADY,
- "i2cMasterTransmitI(), #1", "invalid state");
+ chDbgCheck(i2cp != NULL, "i2cGetAndClearFlags");
- i2cp->id_callback = callback;
- i2c_lld_master_transmit(i2cp, n, txbuf);
+ chSysLock();
+ mask = i2cp->errors;
+ i2cp->errors = I2CD_NO_ERROR;
+ chSysUnlock();
+ return mask;
}
-/**
- * @brief Master receive.
- *
- * @param[in] i2cp pointer to the @p I2CDriver object
- * @param[in] n number of bytes to be transmitted
- * @param[in] rxbuf receive data buffer pointer
- * @param[in] callback operation complete callback
- *
- * @iclass
- */
-void i2cMasterReceiveI(I2CDriver *i2cp, size_t n, uint8_t *rxbuf,
- i2ccallback_t callback) {
- chDbgCheck((i2cp != NULL) && (n > 0) &&
- (rxbuf != NULL) && (callback != NULL), "i2cMasterReceiveI");
- chDbgAssert(i2cp->i2c_state == I2C_MREADY,
- "i2cMasterReceiveI(), #1", "invalid state");
-
- i2cp->id_callback = callback;
- i2c_lld_master_receive(i2cp, n, rxbuf);
-}
#if I2C_USE_MUTUAL_EXCLUSION || defined(__DOXYGEN__)
/**
- * @brief Gains exclusive access to the I2C bus.
+ * @brief Gains exclusive access to the I2C bus.
* @details This function tries to gain ownership to the I2C bus, if the bus
* is already being used then the invoking thread is queued.
- * @pre In order to use this function the option @p I2C_USE_MUTUAL_EXCLUSION
- * must be enabled.
*
* @param[in] i2cp pointer to the @p I2CDriver object
*
- * @api
- *
+ * @note This function is only available when the @p I2C_USE_MUTUAL_EXCLUSION
+ * option is set to @p TRUE.
*/
void i2cAcquireBus(I2CDriver *i2cp) {
@@ -247,13 +307,12 @@ void i2cAcquireBus(I2CDriver *i2cp) {
}
/**
- * @brief Releases exclusive access to the I2C bus.
- * @pre In order to use this function the option @p I2C_USE_MUTUAL_EXCLUSION
- * must be enabled.
+ * @brief Releases exclusive access to the I2C bus.
*
* @param[in] i2cp pointer to the @p I2CDriver object
*
- * @api
+ * @note This function is only available when the @p I2C_USE_MUTUAL_EXCLUSION
+ * option is set to @p TRUE.
*/
void i2cReleaseBus(I2CDriver *i2cp) {