563 lines
17 KiB
C
563 lines
17 KiB
C
/* This program is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*
|
|
*/
|
|
/** library to communicate using I2C as master (code)
|
|
* @file i2c_master.c
|
|
* @author King Kévin <kingkevin@cuvoodoo.info>
|
|
* @date 2017-2018
|
|
* @note peripherals used: I2C
|
|
*/
|
|
|
|
/* standard libraries */
|
|
#include <stdint.h> // standard integer types
|
|
#include <stdlib.h> // general utilities
|
|
|
|
/* STM32 (including CM3) libraries */
|
|
#include <libopencm3/stm32/rcc.h> // real-time control clock library
|
|
#include <libopencm3/stm32/gpio.h> // general purpose input output library
|
|
#include <libopencm3/stm32/i2c.h> // I2C library
|
|
|
|
/* own libraries */
|
|
#include "global.h" // global utilities
|
|
#include "i2c_master.h" // I2C header and definitions
|
|
|
|
/** get RCC for I2C based on I2C identifier
|
|
* @param[in] i2c I2C base address
|
|
* @return RCC address for I2C peripheral
|
|
*/
|
|
static uint32_t RCC_I2C(uint32_t i2c)
|
|
{
|
|
switch (i2c) {
|
|
case I2C1:
|
|
return RCC_I2C1;
|
|
break;
|
|
case I2C2:
|
|
return RCC_I2C2;
|
|
break;
|
|
default:
|
|
while (true);
|
|
}
|
|
}
|
|
|
|
/** get RCC for GPIO port for SCL pin based on I2C identifier
|
|
* @param[in] i2c I2C base address
|
|
* @return RCC GPIO address
|
|
*/
|
|
static uint32_t RCC_GPIO_PORT_SCL(uint32_t i2c)
|
|
{
|
|
switch (i2c) {
|
|
case I2C1:
|
|
case I2C2:
|
|
return RCC_GPIOB;
|
|
break;
|
|
default:
|
|
while (true);
|
|
}
|
|
}
|
|
|
|
/** get RCC for GPIO port for SDA pin based on I2C identifier
|
|
* @param[in] i2c I2C base address
|
|
* @return RCC GPIO address
|
|
*/
|
|
static uint32_t RCC_GPIO_PORT_SDA(uint32_t i2c)
|
|
{
|
|
switch (i2c) {
|
|
case I2C1:
|
|
case I2C2:
|
|
return RCC_GPIOB;
|
|
break;
|
|
default:
|
|
while (true);
|
|
}
|
|
}
|
|
|
|
/** get GPIO port for SCL pin based on I2C identifier
|
|
* @param[in] i2c I2C base address
|
|
* @return GPIO address
|
|
*/
|
|
static uint32_t GPIO_PORT_SCL(uint32_t i2c)
|
|
{
|
|
switch (i2c) {
|
|
case I2C1:
|
|
if (AFIO_MAPR & AFIO_MAPR_I2C1_REMAP) {
|
|
return GPIO_BANK_I2C1_RE_SCL;
|
|
} else {
|
|
return GPIO_BANK_I2C1_SCL;
|
|
}
|
|
break;
|
|
case I2C2:
|
|
return GPIO_BANK_I2C2_SCL;
|
|
break;
|
|
default:
|
|
while (true);
|
|
}
|
|
}
|
|
|
|
/** get GPIO port for SDA pin based on I2C identifier
|
|
* @param[in] i2c I2C base address
|
|
* @return GPIO address
|
|
*/
|
|
static uint32_t GPIO_PORT_SDA(uint32_t i2c)
|
|
{
|
|
switch (i2c) {
|
|
case I2C1:
|
|
if (AFIO_MAPR & AFIO_MAPR_I2C1_REMAP) {
|
|
return GPIO_BANK_I2C1_RE_SDA;
|
|
} else {
|
|
return GPIO_BANK_I2C1_SDA;
|
|
}
|
|
break;
|
|
case I2C2:
|
|
return GPIO_BANK_I2C2_SDA;
|
|
break;
|
|
default:
|
|
while (true);
|
|
}
|
|
}
|
|
|
|
/** get GPIO pin for SCL pin based on I2C identifier
|
|
* @param[in] i2c I2C base address
|
|
* @return GPIO address
|
|
*/
|
|
static uint32_t GPIO_PIN_SCL(uint32_t i2c)
|
|
{
|
|
switch (i2c) {
|
|
case I2C1:
|
|
if (AFIO_MAPR & AFIO_MAPR_I2C1_REMAP) {
|
|
return GPIO_I2C1_RE_SCL;
|
|
} else {
|
|
return GPIO_I2C1_SCL;
|
|
}
|
|
break;
|
|
case I2C2:
|
|
return GPIO_I2C2_SCL;
|
|
break;
|
|
default:
|
|
while (true);
|
|
}
|
|
}
|
|
|
|
/** get GPIO pin for SDA pin based on I2C identifier
|
|
* @param[in] i2c I2C base address
|
|
* @return GPIO address
|
|
*/
|
|
static uint32_t GPIO_PIN_SDA(uint32_t i2c)
|
|
{
|
|
switch (i2c) {
|
|
case I2C1:
|
|
if (AFIO_MAPR & AFIO_MAPR_I2C1_REMAP) {
|
|
return GPIO_I2C1_RE_SDA;
|
|
} else {
|
|
return GPIO_I2C1_SDA;
|
|
}
|
|
break;
|
|
case I2C2:
|
|
return GPIO_I2C2_SDA;
|
|
break;
|
|
default:
|
|
while (true);
|
|
}
|
|
}
|
|
|
|
void i2c_master_setup(uint32_t i2c, uint16_t frequency)
|
|
{
|
|
// check I2C peripheral
|
|
if (I2C1!=i2c && I2C2!=i2c) {
|
|
while (true);
|
|
}
|
|
|
|
// configure I2C peripheral
|
|
rcc_periph_clock_enable(RCC_GPIO_PORT_SCL(i2c)); // enable clock for I2C I/O peripheral
|
|
gpio_set(GPIO_PORT_SCL(i2c), GPIO_PIN_SCL(i2c)); // already put signal high to avoid small pulse
|
|
gpio_set_mode(GPIO_PORT_SCL(i2c), GPIO_MODE_OUTPUT_10_MHZ, GPIO_CNF_OUTPUT_ALTFN_OPENDRAIN, GPIO_PIN_SCL(i2c)); // setup I2C I/O pins
|
|
rcc_periph_clock_enable(RCC_GPIO_PORT_SDA(i2c)); // enable clock for I2C I/O peripheral
|
|
gpio_set(GPIO_PORT_SDA(i2c), GPIO_PIN_SDA(i2c)); // already put signal high to avoid small pulse
|
|
gpio_set_mode(GPIO_PORT_SDA(i2c), GPIO_MODE_OUTPUT_10_MHZ, GPIO_CNF_OUTPUT_ALTFN_OPENDRAIN, GPIO_PIN_SDA(i2c)); // setup I2C I/O pins
|
|
rcc_periph_clock_enable(RCC_AFIO); // enable clock for alternate function
|
|
rcc_periph_clock_enable(RCC_I2C(i2c)); // enable clock for I2C peripheral
|
|
i2c_reset(i2c); // reset peripheral domain
|
|
i2c_peripheral_disable(i2c); // I2C needs to be disable to be configured
|
|
I2C_CR1(i2c) |= I2C_CR1_SWRST; // reset peripheral
|
|
I2C_CR1(i2c) &= ~I2C_CR1_SWRST; // clear peripheral reset
|
|
if (0==frequency) { // don't allow null frequency
|
|
frequency = 1;
|
|
} else if (frequency>400) { // limit frequency to 400 kHz
|
|
frequency = 400;
|
|
}
|
|
i2c_set_clock_frequency(i2c, rcc_apb1_frequency/1000000); // configure the peripheral clock to the APB1 freq (where it is connected to)
|
|
if (frequency>100) { // use fast mode for frequencies over 100 kHz
|
|
i2c_set_fast_mode(i2c); // set fast mode (Fm)
|
|
i2c_set_ccr(i2c, rcc_apb1_frequency/(frequency*1000*2)); // set Thigh/Tlow to generate frequency (fast duty not used)
|
|
i2c_set_trise(i2c, (300/(1000/(rcc_apb1_frequency/1000000)))+1); // max rise time for Fm mode (< 400) kHz is 300 ns
|
|
} else { // use fast mode for frequencies below 100 kHz
|
|
i2c_set_standard_mode(i2c); // set standard mode (Sm)
|
|
i2c_set_ccr(i2c, rcc_apb1_frequency/(frequency*1000*2)); // set Thigh/Tlow to generate frequency of 100 kHz
|
|
i2c_set_trise(i2c, (1000/(1000/(rcc_apb1_frequency/1000000)))+1); // max rise time for Sm mode (< 100 kHz) is 1000 ns (~1 MHz)
|
|
}
|
|
i2c_peripheral_enable(i2c); // enable I2C after configuration completed
|
|
}
|
|
|
|
void i2c_master_release(uint32_t i2c)
|
|
{
|
|
// check I2C peripheral
|
|
if (I2C1!=i2c && I2C2!=i2c) {
|
|
while (true);
|
|
}
|
|
|
|
i2c_reset(i2c); // reset I2C peripheral configuration
|
|
i2c_peripheral_disable(i2c); // disable I2C peripheral
|
|
rcc_periph_clock_disable(RCC_I2C(i2c)); // disable clock for I2C peripheral
|
|
gpio_set_mode(GPIO_PORT_SCL(i2c), GPIO_MODE_INPUT, GPIO_CNF_INPUT_FLOAT, GPIO_PIN_SCL(i2c)); // put I2C I/O pins back to floating
|
|
gpio_set_mode(GPIO_PORT_SDA(i2c), GPIO_MODE_INPUT, GPIO_CNF_INPUT_FLOAT, GPIO_PIN_SDA(i2c)); // put I2C I/O pins back to floating
|
|
}
|
|
|
|
bool i2c_master_check_signals(uint32_t i2c)
|
|
{
|
|
// check I2C peripheral
|
|
if (I2C1!=i2c && I2C2!=i2c) {
|
|
while (true);
|
|
}
|
|
|
|
return (0!=gpio_get(GPIO_PORT_SCL(i2c), GPIO_PIN_SCL(i2c)) && 0!=gpio_get(GPIO_PORT_SDA(i2c), GPIO_PIN_SDA(i2c)));
|
|
}
|
|
|
|
void i2c_master_reset(uint32_t i2c)
|
|
{
|
|
// check I2C peripheral
|
|
if (I2C1!=i2c && I2C2!=i2c) {
|
|
while (true);
|
|
}
|
|
|
|
// follow procedure described in STM32F10xxC/D/E Errata sheet, Section 2.14.7
|
|
i2c_peripheral_disable(i2c); // disable i2c peripheral
|
|
gpio_set_mode(GPIO_PORT_SCL(i2c), GPIO_MODE_OUTPUT_10_MHZ, GPIO_CNF_OUTPUT_OPENDRAIN, GPIO_PIN_SCL(i2c)); // put I2C I/O pins to general output
|
|
gpio_set(GPIO_PORT_SCL(i2c), GPIO_PIN_SCL(i2c)); // set high
|
|
while (!gpio_get(GPIO_PORT_SCL(i2c), GPIO_PIN_SCL(i2c))); // ensure it is high
|
|
gpio_set_mode(GPIO_PORT_SDA(i2c), GPIO_MODE_OUTPUT_10_MHZ, GPIO_CNF_OUTPUT_OPENDRAIN, GPIO_PIN_SDA(i2c)); // put I2C I/O pins to general output
|
|
gpio_set(GPIO_PORT_SDA(i2c), GPIO_PIN_SDA(i2c)); // set high
|
|
while (!gpio_get(GPIO_PORT_SDA(i2c), GPIO_PIN_SDA(i2c))); // ensure it is high
|
|
gpio_clear(GPIO_PORT_SDA(i2c), GPIO_PIN_SDA(i2c)); // set low (try first transition)
|
|
while (gpio_get(GPIO_PORT_SDA(i2c), GPIO_PIN_SDA(i2c))); // ensure it is low
|
|
gpio_clear(GPIO_PORT_SCL(i2c), GPIO_PIN_SCL(i2c)); // set low (try first transition)
|
|
while (gpio_get(GPIO_PORT_SCL(i2c), GPIO_PIN_SCL(i2c))); // ensure it is low
|
|
gpio_set(GPIO_PORT_SCL(i2c), GPIO_PIN_SCL(i2c)); // set high (try second transition)
|
|
while (!gpio_get(GPIO_PORT_SCL(i2c), GPIO_PIN_SCL(i2c))); // ensure it is high
|
|
gpio_set(GPIO_PORT_SDA(i2c), GPIO_PIN_SDA(i2c)); // set high (try second transition)
|
|
while (!gpio_get(GPIO_PORT_SDA(i2c), GPIO_PIN_SDA(i2c))); // ensure it is high
|
|
gpio_set_mode(GPIO_PORT_SCL(i2c), GPIO_MODE_OUTPUT_10_MHZ, GPIO_CNF_OUTPUT_ALTFN_OPENDRAIN, GPIO_PIN_SCL(i2c)); // set I2C I/O pins back
|
|
gpio_set_mode(GPIO_PORT_SDA(i2c), GPIO_MODE_OUTPUT_10_MHZ, GPIO_CNF_OUTPUT_ALTFN_OPENDRAIN, GPIO_PIN_SDA(i2c)); // set I2C I/O pins back
|
|
I2C_CR1(i2c) |= I2C_CR1_SWRST; // reset device
|
|
I2C_CR1(i2c) &= ~I2C_CR1_SWRST; // reset device
|
|
i2c_peripheral_enable(i2c); // re-enable device
|
|
}
|
|
|
|
bool i2c_master_start(uint32_t i2c)
|
|
{
|
|
// check I2C peripheral
|
|
if (I2C1!=i2c && I2C2!=i2c) {
|
|
while (true);
|
|
}
|
|
|
|
// send (re-)start condition
|
|
if (I2C_CR1(i2c) & (I2C_CR1_START|I2C_CR1_STOP)) { // ensure start or stop operations are not in progress
|
|
return false;
|
|
}
|
|
i2c_send_start(i2c); // send start condition to start transaction
|
|
while (I2C_CR1(i2c) & I2C_CR1_START); // wait until start condition has been accepted and cleared
|
|
while ((I2C_CR1(i2c) & I2C_CR1_START)); // wait until start condition is accepted and cleared
|
|
while (!(I2C_SR1(i2c) & I2C_SR1_SB)); // wait until start condition is transmitted
|
|
if (!(I2C_SR2(i2c) & I2C_SR2_MSL)) { // verify if in master mode
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool i2c_master_select_slave(uint32_t i2c, uint16_t slave, bool address_10bit, bool write)
|
|
{
|
|
// check I2C peripheral
|
|
if (I2C1!=i2c && I2C2!=i2c) {
|
|
while (true);
|
|
}
|
|
|
|
if (!(I2C_SR1(i2c) & I2C_SR1_SB)) { // start condition has not been sent
|
|
if (!i2c_master_start(i2c)) { // send start condition
|
|
return false;
|
|
}
|
|
}
|
|
if (!(I2C_SR2(i2c) & I2C_SR2_MSL)) { // I2C device is not in master mode
|
|
return false;
|
|
}
|
|
|
|
// select slave
|
|
if (!address_10bit) { // 7-bit address
|
|
I2C_SR1(i2c) &= ~(I2C_SR1_AF); // clear acknowledgement failure
|
|
i2c_send_7bit_address(i2c, slave, write ? I2C_WRITE : I2C_READ); // select slave, with read/write flag
|
|
while (!(I2C_SR1(i2c) & (I2C_SR1_ADDR|I2C_SR1_AF))); // wait until address is transmitted
|
|
if (I2C_SR1(i2c) & I2C_SR1_AF) { // address has not been acknowledged
|
|
return false;
|
|
}
|
|
} else { // 10-bit address
|
|
// send first part of address
|
|
I2C_SR1(i2c) &= ~(I2C_SR1_AF); // clear acknowledgement failure
|
|
I2C_DR(i2c) = 11110000 | (((slave>>8)&0x3)<<1); // send first header (11110xx0, where xx are 2 MSb of slave address)
|
|
while (!(I2C_SR1(i2c) & (I2C_SR1_ADD10|I2C_SR1_AF))); // wait until first part of address is transmitted
|
|
if (I2C_SR1(i2c) & I2C_SR1_AF) { // address has not been acknowledged
|
|
return false;
|
|
}
|
|
// send second part of address
|
|
I2C_SR1(i2c) &= ~(I2C_SR1_AF); // clear acknowledgement failure
|
|
I2C_DR(i2c) = (slave&0xff); // send remaining of address
|
|
while (!(I2C_SR1(i2c) & (I2C_SR1_ADDR|I2C_SR1_AF))); // wait until remaining part of address is transmitted
|
|
if (I2C_SR1(i2c) & I2C_SR1_AF) { // address has not been acknowledged
|
|
return false;
|
|
}
|
|
// go into receive mode if necessary
|
|
if (!write) {
|
|
if (!i2c_master_start(i2c)) { // send re-start condition
|
|
return false; // could not send start condition
|
|
}
|
|
// send first part of address with receive flag
|
|
I2C_SR1(i2c) &= ~(I2C_SR1_AF); // clear acknowledgement failure
|
|
I2C_DR(i2c) = 11110001 | (((slave>>8)&0x3)<<1); // send header (11110xx1, where xx are 2 MSb of slave address)
|
|
while (!(I2C_SR1(i2c) & (I2C_SR1_ADDR|I2C_SR1_AF))); // wait until remaining part of address is transmitted
|
|
if (I2C_SR1(i2c) & I2C_SR1_AF) { // address has not been acknowledged
|
|
return false;
|
|
}
|
|
}
|
|
}
|
|
if (write) {
|
|
if (!((I2C_SR2(i2c) & I2C_SR2_TRA))) { // verify we are in transmit mode (and read SR2 to clear ADDR)
|
|
return false;
|
|
}
|
|
} else {
|
|
if ((I2C_SR2(i2c) & I2C_SR2_TRA)) { // verify we are in read mode (and read SR2 to clear ADDR)
|
|
return false;
|
|
}
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool i2c_master_read(uint32_t i2c, uint8_t* data, size_t data_size)
|
|
{
|
|
// check I2C peripheral
|
|
if (I2C1!=i2c && I2C2!=i2c) {
|
|
while (true);
|
|
}
|
|
|
|
// sanity check
|
|
if (data==NULL || data_size==0) { // no data to read
|
|
return true;
|
|
}
|
|
if (!(I2C_SR2(i2c) & I2C_SR2_MSL)) { // I2C device is not master
|
|
return false;
|
|
}
|
|
if ((I2C_SR2(i2c) & I2C_SR2_TRA)) { // I2C device not in receiver mode
|
|
return false;
|
|
}
|
|
|
|
// read data
|
|
for (size_t i=0; i<data_size; i++) { // read bytes
|
|
if (i==data_size-1) { // prepare to sent NACK for last byte
|
|
i2c_disable_ack(i2c); // NACK received to stop slave transmission
|
|
} else {
|
|
i2c_enable_ack(i2c); // ACK received byte to continue slave transmission
|
|
}
|
|
while (!(I2C_SR1(i2c) & I2C_SR1_RxNE)); // wait until byte has been received
|
|
data[i] = i2c_get_data(i2c); // read received byte
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool i2c_master_write(uint32_t i2c, const uint8_t* data, size_t data_size)
|
|
{
|
|
// check I2C peripheral
|
|
if (I2C1!=i2c && I2C2!=i2c) {
|
|
while (true);
|
|
}
|
|
|
|
// sanity check
|
|
if (data==NULL || data_size==0) { // no data to write
|
|
return true;
|
|
}
|
|
if (!(I2C_SR2(i2c) & I2C_SR2_MSL)) { // I2C device is not master
|
|
return false;
|
|
}
|
|
if (!(I2C_SR2(i2c) & I2C_SR2_TRA)) { // I2C device not in transmitter mode
|
|
return false;
|
|
}
|
|
|
|
// write data
|
|
for (size_t i=0; i<data_size; i++) { // write bytes
|
|
I2C_SR1(i2c) &= ~(I2C_SR1_AF); // clear acknowledgement failure
|
|
i2c_send_data(i2c, data[i]); // send byte to be written in memory
|
|
while (!(I2C_SR1(i2c) & (I2C_SR1_TxE|I2C_SR1_AF))); // wait until byte has been transmitted
|
|
if (I2C_SR1(i2c) & I2C_SR1_AF) { // data has not been acknowledged
|
|
return false;
|
|
}
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool i2c_master_stop(uint32_t i2c)
|
|
{
|
|
// check I2C peripheral
|
|
if (I2C1!=i2c && I2C2!=i2c) {
|
|
while (true);
|
|
}
|
|
|
|
// sanity check
|
|
if (!(I2C_SR2(i2c) & I2C_SR2_BUSY)) { // release is not busy
|
|
return true; // bus has probably already been released
|
|
}
|
|
// send stop condition
|
|
if (I2C_CR1(i2c) & (I2C_CR1_START|I2C_CR1_STOP)) { // ensure start or stop operations are not in progress
|
|
return false;
|
|
}
|
|
|
|
i2c_send_stop(i2c); // send stop to release bus
|
|
while ((I2C_CR1(i2c) & I2C_CR1_STOP)); // wait until stop condition is accepted and cleared
|
|
while ((I2C_SR2(i2c) & I2C_SR2_MSL)); // wait until bus released (non master mode)
|
|
|
|
return true;
|
|
}
|
|
|
|
bool i2c_master_slave_read(uint32_t i2c, uint16_t slave, bool address_10bit, uint8_t* data, size_t data_size)
|
|
{
|
|
// check I2C peripheral
|
|
if (I2C1!=i2c && I2C2!=i2c) {
|
|
while (true);
|
|
}
|
|
|
|
bool success = false; // return if read succeeded
|
|
|
|
if (!i2c_master_start(i2c)) { // send (re-)start condition
|
|
return false;
|
|
}
|
|
if (!i2c_master_select_slave(i2c, slave, address_10bit, false)) { // select slave to read
|
|
goto error;
|
|
}
|
|
if (NULL!=data && data_size>0) { // only read data if needed
|
|
if (!i2c_master_read(i2c, data, data_size)) { // read data
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
success = true; // all went well
|
|
error:
|
|
i2c_master_stop(i2c); // sent stop condition
|
|
return success;
|
|
}
|
|
|
|
bool i2c_master_slave_write(uint32_t i2c, uint16_t slave, bool address_10bit, const uint8_t* data, size_t data_size)
|
|
{
|
|
// check I2C peripheral
|
|
if (I2C1!=i2c && I2C2!=i2c) {
|
|
while (true);
|
|
}
|
|
|
|
bool success = false; // return if write succeeded
|
|
|
|
if (!i2c_master_start(i2c)) { // send (re-)start condition
|
|
return false;
|
|
}
|
|
if (!i2c_master_select_slave(i2c, slave, address_10bit, true)) { // select slave to write
|
|
goto error;
|
|
}
|
|
if (NULL!=data && data_size>0) { // write data only is some is available
|
|
if (!i2c_master_write(i2c, data, data_size)) { // write data
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
success = true; // all went well
|
|
error:
|
|
i2c_master_stop(i2c); // sent stop condition
|
|
return success;
|
|
}
|
|
|
|
bool i2c_master_address_read(uint32_t i2c, uint16_t slave, bool address_10bit, const uint8_t* address, size_t address_size, uint8_t* data, size_t data_size)
|
|
{
|
|
// check I2C peripheral
|
|
if (I2C1!=i2c && I2C2!=i2c) {
|
|
while (true);
|
|
}
|
|
|
|
bool success = false; // return if read succeeded
|
|
if (!i2c_master_start(i2c)) { // send (re-)start condition
|
|
return false;
|
|
}
|
|
if (!i2c_master_select_slave(i2c, slave, address_10bit, true)) { // select slave to write
|
|
goto error;
|
|
}
|
|
|
|
// write address
|
|
if (NULL!=address && address_size>0) {
|
|
if (!i2c_master_write(i2c, address, address_size)) { // send memory address
|
|
goto error;
|
|
}
|
|
}
|
|
// read data
|
|
if (NULL!=data && data_size>0) {
|
|
if (!i2c_master_start(i2c)) { // send (re-)start condition
|
|
return false;
|
|
}
|
|
if (!i2c_master_select_slave(i2c, slave, address_10bit, false)) { // select slave to read
|
|
goto error;
|
|
}
|
|
if (!i2c_master_read(i2c, data, data_size)) { // read memory
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
success = true;
|
|
error:
|
|
i2c_master_stop(i2c); // sent stop condition
|
|
return success;
|
|
}
|
|
|
|
bool i2c_master_address_write(uint32_t i2c, uint16_t slave, bool address_10bit, const uint8_t* address, size_t address_size, const uint8_t* data, size_t data_size)
|
|
{
|
|
// check I2C peripheral
|
|
if (I2C1!=i2c && I2C2!=i2c) {
|
|
while (true);
|
|
}
|
|
|
|
bool success = false; // return if write succeeded
|
|
if (!i2c_master_start(i2c)) { // send (re-)start condition
|
|
return false;
|
|
}
|
|
if (!i2c_master_select_slave(i2c, slave, address_10bit, true)) { // select slave to write
|
|
goto error;
|
|
}
|
|
if (NULL!=address && address_size>0) {
|
|
if (!i2c_master_write(i2c, address, address_size)) { // send memory address to write
|
|
goto error;
|
|
}
|
|
}
|
|
if (NULL!=data && data_size>0) {
|
|
if (!i2c_master_write(i2c, data, data_size)) { // write data
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
success = true;
|
|
error:
|
|
i2c_master_stop(i2c); // sent stop condition
|
|
return success;
|
|
}
|