Driver for STM32F4xx I2C peripheral
This commit is contained in:
parent
bfc9f8c77f
commit
07ee9a3369
|
|
@ -212,6 +212,7 @@ stm32f405_src = ['platform/mcu/STM32F4xx/boot/startup.cpp',
|
|||
'platform/mcu/STM32F4xx/drivers/USART3.cpp',
|
||||
'platform/mcu/STM32F4xx/drivers/flash.c',
|
||||
'platform/mcu/STM32F4xx/drivers/rng.c',
|
||||
'platform/mcu/STM32F4xx/drivers/i2c_stm32.c',
|
||||
'platform/drivers/audio/stm32_dac.cpp',
|
||||
'platform/drivers/audio/stm32_adc.cpp',
|
||||
'platform/drivers/audio/stm32_pwm.cpp',
|
||||
|
|
|
|||
|
|
@ -0,0 +1,209 @@
|
|||
/***************************************************************************
|
||||
* Copyright (C) 2024 by Federico Amedeo Izzo IU2NUO, *
|
||||
* Niccolò Izzo IU2KIN *
|
||||
* Frederik Saraci IU2NRO *
|
||||
* Silvano Seva IU2KWO *
|
||||
* Morgan Diepart ON4MOD *
|
||||
* *
|
||||
* 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/> *
|
||||
***************************************************************************/
|
||||
|
||||
#include <stm32f4xx.h>
|
||||
#include <pthread.h>
|
||||
#include <errno.h>
|
||||
#include "i2c_stm32.h"
|
||||
|
||||
int i2c_init(const struct i2cDevice *dev, const uint8_t speed)
|
||||
{
|
||||
I2C_TypeDef *i2c = (I2C_TypeDef *) dev->periph;
|
||||
uint32_t apbMask = 0;
|
||||
|
||||
switch((uint32_t) i2c)
|
||||
{
|
||||
case I2C1_BASE:
|
||||
apbMask = RCC_APB1ENR_I2C1EN;
|
||||
break;
|
||||
|
||||
case I2C2_BASE:
|
||||
apbMask = RCC_APB1ENR_I2C2EN;
|
||||
break;
|
||||
|
||||
case I2C3_BASE:
|
||||
apbMask = RCC_APB1ENR_I2C3EN;
|
||||
break;
|
||||
|
||||
default:
|
||||
return -ENODEV;
|
||||
break;
|
||||
}
|
||||
|
||||
RCC->APB1ENR |= apbMask;
|
||||
__DSB();
|
||||
|
||||
RCC->APB1RSTR |= apbMask;
|
||||
RCC->APB1RSTR &= ~apbMask;
|
||||
|
||||
switch(speed)
|
||||
{
|
||||
case I2C_SPEED_LOW:
|
||||
i2c->CR2 = 42; /* No interrupts, APB1 clock is 42MHz */
|
||||
i2c->CCR = 1050; /* Freq = 20kHz */
|
||||
i2c->TRISE = 63; /* Max possible rise time */
|
||||
break;
|
||||
|
||||
case I2C_SPEED_100kHz:
|
||||
i2c->CR2 = 42; /* No interrupts, APB1 clock is 42MHz */
|
||||
i2c->CCR = 210; /* Freq = 100kHz */
|
||||
i2c->TRISE = 43; /* Conforms to max rise time of 1000 ns */
|
||||
break;
|
||||
|
||||
default:
|
||||
return -EINVAL;
|
||||
break;
|
||||
}
|
||||
|
||||
i2c->CR1 = I2C_CR1_PE; /* Enable peripheral */
|
||||
|
||||
if(dev->mutex != NULL)
|
||||
pthread_mutex_init((pthread_mutex_t *) dev->mutex, NULL);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void i2c_terminate(const struct i2cDevice *dev)
|
||||
{
|
||||
I2C_TypeDef *i2c = (I2C_TypeDef *) dev->periph;
|
||||
|
||||
i2c_acquire(dev);
|
||||
|
||||
i2c->CR1 &= ~I2C_CR1_PE;
|
||||
RCC->APB1ENR &= ~RCC_APB1ENR_I2C1EN;
|
||||
__DSB();
|
||||
|
||||
if(dev->mutex != NULL)
|
||||
pthread_mutex_destroy((pthread_mutex_t *) dev->mutex);
|
||||
}
|
||||
|
||||
|
||||
static int i2c_readImpl(const struct i2cDevice *dev, const uint8_t addr,
|
||||
void *data, const size_t length, const bool stop)
|
||||
{
|
||||
I2C_TypeDef *i2c = (I2C_TypeDef *) dev->periph;
|
||||
uint8_t *bytes = (uint8_t *) data;
|
||||
|
||||
if(length == 0 || bytes == NULL)
|
||||
return EINVAL;
|
||||
|
||||
// Send start
|
||||
i2c->CR1 |= I2C_CR1_START;
|
||||
while((i2c->SR1 & I2C_SR1_SB_Msk) == 0) ;
|
||||
|
||||
// Send address (read)
|
||||
i2c->DR = (addr << 1) | 1;
|
||||
|
||||
if(length == 1)
|
||||
i2c->CR1 &= ~I2C_CR1_ACK; // Nack
|
||||
else
|
||||
i2c->CR1 |= I2C_CR1_ACK; // Ack
|
||||
|
||||
// Wait for ADDR bit to be set then read SR1 and SR2
|
||||
while((i2c->SR1 & I2C_SR1_ADDR_Msk) == 0)
|
||||
{
|
||||
// Check if the address was NACKed
|
||||
if((i2c->SR1 & I2C_SR1_AF_Msk) != 0)
|
||||
{
|
||||
i2c->CR1 |= I2C_CR1_STOP;
|
||||
return ENODEV;
|
||||
}
|
||||
}
|
||||
|
||||
// Read SR2 by checking that we are receiver
|
||||
if((i2c->SR2 & I2C_SR2_TRA_Msk) != 0)
|
||||
{
|
||||
i2c->CR1 |= I2C_CR1_STOP;
|
||||
return EPROTO;
|
||||
}
|
||||
|
||||
for(size_t i = 0; i < length; i++)
|
||||
{
|
||||
// Wait for data to be available
|
||||
while((i2c->SR1 & I2C_SR1_RXNE_Msk) == 0) ;
|
||||
|
||||
if((i + 2) >= length)
|
||||
i2c->CR1 &= ~I2C_CR1_ACK; // Nack
|
||||
else
|
||||
i2c->CR1 |= I2C_CR1_ACK; // Ack
|
||||
|
||||
bytes[i] = i2c->DR;
|
||||
}
|
||||
|
||||
if(stop)
|
||||
i2c->CR1 |= I2C_CR1_STOP;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int i2c_writeImpl(const struct i2cDevice *dev, const uint8_t addr,
|
||||
const void *data, const size_t length, const bool stop)
|
||||
{
|
||||
I2C_TypeDef *i2c = (I2C_TypeDef *) dev->periph;
|
||||
const uint8_t *bytes = (const uint8_t *) data;
|
||||
|
||||
if(length == 0 || bytes == NULL)
|
||||
return EINVAL;
|
||||
|
||||
// Send start
|
||||
i2c->CR1 |= I2C_CR1_START;
|
||||
while((i2c->SR1 & I2C_SR1_SB_Msk) == 0) ;
|
||||
|
||||
// Send address (write)
|
||||
i2c->DR = addr << 1;
|
||||
|
||||
// Wait for ADDR bit to be set then read SR1 and SR2
|
||||
while((i2c->SR1 & I2C_SR1_ADDR_Msk) == 0)
|
||||
{
|
||||
// Check if the address was NACKed
|
||||
if((i2c->SR1 & I2C_SR1_AF_Msk) != 0)
|
||||
{
|
||||
i2c->CR1 |= I2C_CR1_STOP;
|
||||
return ENODEV;
|
||||
}
|
||||
}
|
||||
|
||||
// Read SR2 by checking that we are transmitter
|
||||
if((i2c->SR2 & I2C_SR2_TRA_Msk) == 0)
|
||||
{
|
||||
i2c->CR1 |= I2C_CR1_STOP;
|
||||
return EPROTO; // We are not transmitter
|
||||
}
|
||||
|
||||
// Send data
|
||||
for(size_t i = 0; i < length; i++)
|
||||
{
|
||||
i2c->DR = bytes[i]; // Send data
|
||||
// Wait for data to be sent
|
||||
while((i2c->SR1 & I2C_SR1_TXE_Msk) == 0) ;
|
||||
}
|
||||
|
||||
if(stop)
|
||||
i2c->CR1 |= I2C_CR1_STOP;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
const struct i2cApi i2cStm32_driver =
|
||||
{
|
||||
.read = i2c_readImpl,
|
||||
.write = i2c_writeImpl
|
||||
};
|
||||
|
|
@ -0,0 +1,67 @@
|
|||
/***************************************************************************
|
||||
* Copyright (C) 2024 by Federico Amedeo Izzo IU2NUO, *
|
||||
* Niccolò Izzo IU2KIN *
|
||||
* Frederik Saraci IU2NRO *
|
||||
* Silvano Seva IU2KWO *
|
||||
* Morgan Diepart ON4MOD *
|
||||
* *
|
||||
* 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/> *
|
||||
***************************************************************************/
|
||||
|
||||
#ifndef I2C_STM32_H
|
||||
#define I2C_STM32_H
|
||||
|
||||
#include <peripherals/i2c.h>
|
||||
|
||||
/**
|
||||
* Device driver API for STM32 I2C peripheral.
|
||||
*/
|
||||
extern const struct i2cApi i2cStm32_driver;
|
||||
|
||||
/**
|
||||
* Instantiate an STM32 I2C master device.
|
||||
*
|
||||
* @param name: device name.
|
||||
* @param peripheral: underlying MCU peripheral.
|
||||
* @param mutx: pointer to mutex, or NULL.
|
||||
*/
|
||||
#define I2C_STM32_DEVICE_DEFINE(name, peripheral, mutx) \
|
||||
const struct i2cDevice name = \
|
||||
{ \
|
||||
.driver = &i2cStm32_driver, \
|
||||
.periph = peripheral, \
|
||||
.mutex = mutx \
|
||||
};
|
||||
|
||||
|
||||
/**
|
||||
* Initialise an STM32 I2C peripheral with a given bus speed.
|
||||
* This driver does not configure the I2C GPIOs, which have to be put in
|
||||
* the appropriate mode by application code.
|
||||
*
|
||||
* @param dev: device driver handle.
|
||||
* @param speed: bus speed.
|
||||
* @return zero on success, a negative error code otherwise.
|
||||
*/
|
||||
int i2c_init(const struct i2cDevice *dev, const uint8_t speed);
|
||||
|
||||
/**
|
||||
* Shut down an STM32 I2C peripheral.
|
||||
* Is left to application code to change the operating mode of the I2C GPIOs.
|
||||
*
|
||||
* @param dev: device driver handle.
|
||||
*/
|
||||
void i2c_terminate(const struct i2cDevice *dev);
|
||||
|
||||
#endif /* I2C_STM32_H */
|
||||
Loading…
Reference in New Issue