Files
zh_avr_i2c/zh_avr_i2c.c
2025-08-10 20:18:55 +03:00

216 lines
5.7 KiB
C

#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();
};
}