feat: initial
This commit is contained in:
216
zh_avr_i2c.c
Normal file
216
zh_avr_i2c.c
Normal file
@@ -0,0 +1,216 @@
|
||||
#include "zh_avr_i2c.h"
|
||||
|
||||
#define ZH_ERROR_CHECK(cond, err, ...) \
|
||||
if (!(cond)) \
|
||||
{ \
|
||||
return err; \
|
||||
}
|
||||
|
||||
#define I2C_OK 0x01
|
||||
#define I2C_NACK 0x02
|
||||
#define I2C_COLLISION 0x04
|
||||
#define I2C_BUS_FAIL 0x08
|
||||
|
||||
#define I2C_START ((1 << TWINT) | (1 << TWEN) | (1 << TWIE))
|
||||
#define I2C_MASTER_READ 1
|
||||
#define I2C_MASTER_WRITE 0
|
||||
|
||||
typedef enum
|
||||
{
|
||||
MASTER_WRITE,
|
||||
MASTER_READ,
|
||||
MASTER_WRITE_REG,
|
||||
MASTER_READ_REG
|
||||
} _work_mode_t;
|
||||
|
||||
avr_err_t _zh_avr_i2c_master_start(TickType_t xTicksToWait);
|
||||
|
||||
static EventGroupHandle_t _event_group_handle = NULL;
|
||||
static uint8_t _target_i2c_address = 0;
|
||||
volatile static uint8_t _work_mode = 0;
|
||||
volatile static uint8_t *_master_data = NULL;
|
||||
volatile static uint8_t _master_data_size = 0;
|
||||
static bool _master_is_initialized = false;
|
||||
|
||||
avr_err_t zh_avr_i2c_master_init(const bool pullup)
|
||||
{
|
||||
_event_group_handle = xEventGroupCreate();
|
||||
ZH_ERROR_CHECK(_event_group_handle != NULL, AVR_ERR_NO_MEM);
|
||||
cli();
|
||||
DDRC &= ~(1 << PORTC5 | 1 << PORTC4);
|
||||
if (pullup == true)
|
||||
{
|
||||
PORTC |= 1 << PORTC5 | 1 << PORTC4;
|
||||
}
|
||||
TWBR = ((F_CPU / 100000) - 16) / 2;
|
||||
TWSR = 0xF8;
|
||||
sei();
|
||||
_master_is_initialized = true;
|
||||
return AVR_OK;
|
||||
}
|
||||
|
||||
avr_err_t zh_avr_i2c_master_probe(const uint8_t addr, TickType_t xTicksToWait)
|
||||
{
|
||||
uint8_t temp = 0;
|
||||
return zh_avr_i2c_master_transmit(addr, &temp, sizeof(temp), xTicksToWait);
|
||||
}
|
||||
|
||||
avr_err_t zh_avr_i2c_master_transmit(const uint8_t addr, uint8_t *data, uint8_t size, TickType_t xTicksToWait)
|
||||
{
|
||||
ZH_ERROR_CHECK(data != NULL || size > 0, AVR_ERR_INVALID_ARG);
|
||||
ZH_ERROR_CHECK(_master_is_initialized == true, AVR_ERR_INVALID_STATE);
|
||||
_work_mode = MASTER_WRITE;
|
||||
_target_i2c_address = addr;
|
||||
_master_data = data;
|
||||
_master_data_size = size;
|
||||
return _zh_avr_i2c_master_start(xTicksToWait);
|
||||
}
|
||||
|
||||
avr_err_t zh_avr_i2c_master_receive(const uint8_t addr, uint8_t *data, uint8_t size, TickType_t xTicksToWait)
|
||||
{
|
||||
ZH_ERROR_CHECK(data != NULL || size > 0, AVR_ERR_INVALID_ARG);
|
||||
ZH_ERROR_CHECK(_master_is_initialized == true, AVR_ERR_INVALID_STATE);
|
||||
_work_mode = MASTER_READ;
|
||||
_target_i2c_address = addr;
|
||||
_master_data = data;
|
||||
_master_data_size = size;
|
||||
return _zh_avr_i2c_master_start(xTicksToWait);
|
||||
}
|
||||
|
||||
avr_err_t zh_avr_i2c_master_transmit_register(const uint8_t addr, uint16_t *reg, uint8_t *data, uint8_t size, TickType_t xTicksToWait)
|
||||
{
|
||||
// To Do.
|
||||
return AVR_OK;
|
||||
}
|
||||
avr_err_t zh_avr_i2c_master_receive_register(const uint8_t addr, uint16_t *reg, uint8_t *data, uint8_t size, TickType_t xTicksToWait)
|
||||
{
|
||||
// To Do.
|
||||
return AVR_OK;
|
||||
}
|
||||
|
||||
avr_err_t _zh_avr_i2c_master_start(TickType_t xTicksToWait)
|
||||
{
|
||||
TWCR = I2C_START | (1 << TWSTA);
|
||||
EventBits_t bits = xEventGroupWaitBits(_event_group_handle, I2C_OK | I2C_NACK | I2C_COLLISION | I2C_BUS_FAIL, pdTRUE, pdFALSE, xTicksToWait);
|
||||
if ((bits & I2C_OK) != 0)
|
||||
{
|
||||
return AVR_OK;
|
||||
}
|
||||
else if ((bits & I2C_NACK) != 0)
|
||||
{
|
||||
return AVR_ERR_INVALID_RESPONSE;
|
||||
}
|
||||
else
|
||||
{
|
||||
return AVR_FAIL;
|
||||
}
|
||||
}
|
||||
|
||||
ISR(TWI_vect)
|
||||
{
|
||||
BaseType_t xHigherPriorityTaskWoken = pdFALSE;
|
||||
switch (TWSR & 0xF8)
|
||||
{
|
||||
case 0x00: // Bus error.
|
||||
TWCR = I2C_START | (1 << TWSTO);
|
||||
xEventGroupSetBitsFromISR(_event_group_handle, I2C_BUS_FAIL, &xHigherPriorityTaskWoken);
|
||||
break;
|
||||
case 0x08: // A START condition has been transmitted.
|
||||
switch (_work_mode)
|
||||
{
|
||||
case MASTER_WRITE:
|
||||
case MASTER_WRITE_REG:
|
||||
case MASTER_READ_REG:
|
||||
TWDR = (_target_i2c_address << 1) | I2C_MASTER_WRITE;
|
||||
break;
|
||||
case MASTER_READ:
|
||||
TWDR = (_target_i2c_address << 1) | I2C_MASTER_READ;
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
TWCR = I2C_START;
|
||||
break;
|
||||
case 0x10: // A repeated START condition has been transmitted.
|
||||
// To Do.
|
||||
break;
|
||||
case 0x18: // SLA+W has been transmitted. ACK has been received.
|
||||
TWDR = *(_master_data++);
|
||||
--_master_data_size;
|
||||
TWCR = I2C_START;
|
||||
break;
|
||||
case 0x20: // SLA+W has been transmitted. NACK has been received.
|
||||
TWCR = I2C_START | (1 << TWSTO);
|
||||
xEventGroupSetBitsFromISR(_event_group_handle, I2C_NACK, &xHigherPriorityTaskWoken);
|
||||
break;
|
||||
case 0x28: // Data byte has been transmitted. ACK has been received.
|
||||
if (_master_data_size-- == 0)
|
||||
{
|
||||
TWCR = I2C_START | (1 << TWSTO);
|
||||
xEventGroupSetBitsFromISR(_event_group_handle, I2C_OK, &xHigherPriorityTaskWoken);
|
||||
}
|
||||
else
|
||||
{
|
||||
TWDR = *(_master_data++);
|
||||
TWCR = I2C_START;
|
||||
}
|
||||
break;
|
||||
case 0x30: // Data byte has been transmitted. NACK has been received.
|
||||
TWCR = I2C_START | (1 << TWSTO);
|
||||
xEventGroupSetBitsFromISR(_event_group_handle, I2C_NACK, &xHigherPriorityTaskWoken);
|
||||
break;
|
||||
case 0x38: // Arbitration lost in SLA+W or data bytes. Arbitration lost in SLA+R or NACK bit.
|
||||
TWCR = I2C_START | (1 << TWSTO);
|
||||
xEventGroupSetBitsFromISR(_event_group_handle, I2C_COLLISION, &xHigherPriorityTaskWoken);
|
||||
break;
|
||||
case 0x40: // SLA+R has been transmitted. ACK has been received.
|
||||
switch (_work_mode)
|
||||
{
|
||||
case MASTER_WRITE:
|
||||
break;
|
||||
case MASTER_READ:
|
||||
if (_master_data_size == 1)
|
||||
{
|
||||
TWCR = I2C_START;
|
||||
}
|
||||
else
|
||||
{
|
||||
TWCR = I2C_START | (1 << TWEA);
|
||||
}
|
||||
break;
|
||||
case MASTER_WRITE_REG:
|
||||
break;
|
||||
case MASTER_READ_REG:
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case 0x48: // SLA+R has been transmitted. NACK has been received.
|
||||
TWCR = I2C_START | (1 << TWSTO);
|
||||
xEventGroupSetBitsFromISR(_event_group_handle, I2C_NACK, &xHigherPriorityTaskWoken);
|
||||
break;
|
||||
case 0x50: // Data byte has been received. ACK has been returned.
|
||||
*(_master_data++) = TWDR;
|
||||
if (--_master_data_size == 1)
|
||||
{
|
||||
TWCR = I2C_START;
|
||||
}
|
||||
else
|
||||
{
|
||||
TWCR = I2C_START | (1 << TWEA);
|
||||
}
|
||||
break;
|
||||
case 0x58: // Data byte has been received. NACK has been returned.
|
||||
*(_master_data) = TWDR;
|
||||
TWCR = I2C_START | (1 << TWSTO);
|
||||
xEventGroupSetBitsFromISR(_event_group_handle, I2C_OK, &xHigherPriorityTaskWoken);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
if (xHigherPriorityTaskWoken == pdTRUE)
|
||||
{
|
||||
portYIELD();
|
||||
};
|
||||
}
|
Reference in New Issue
Block a user