hulk/gd32e230_uart_ring_buffer
1
0
Fork 0
generated from hulk/gd32e23x_template_cmake_vscode
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

fix iic driver

Browse Source
This commit is contained in:
yelvlab
2025-08-14 19:57:57 +08:00
parent 4e0ad6e8eb
commit 88f79f7eb0
8 changed files with 1853 additions and 959 deletions
Download Patch File Download Diff File Expand all files Collapse all files

759
Src/i2c.c
View File

@@ -1,13 +1,9 @@
//
// Created by dell on 24-12-20.
// Improved I2C driver with better state machine and error handling
//
#include "i2c.h"
/* Private variables */
static uint8_t i2c_retry_count = 0;
/*!
\brief configure the GPIO ports
\param[in] none
@@ -33,81 +29,54 @@ void i2c_gpio_config(void) {
\brief configure the I2CX interface
\param[in] none
\param[out] none
\retval i2c_status_t
\retval none
*/
i2c_status_t i2c_config(void) {
void i2c_config(void) {
/* configure I2C GPIO */
i2c_gpio_config();
/* enable I2C clock */
rcu_periph_clock_enable(RCU_I2C);
/* configure I2C clock */
i2c_clock_config(I2C0, I2C_SPEED, I2C_DTCY_2);
/* configure I2C address - use 0x00 as master doesn't need specific address */
i2c_mode_addr_config(I2C0, I2C_I2CMODE_ENABLE, I2C_ADDFORMAT_7BITS, I2C_MASTER_ADDRESS);
/* configure I2C address */
i2c_mode_addr_config(I2C0, I2C_I2CMODE_ENABLE, I2C_ADDFORMAT_7BITS, 0xA0);
/* enable I2CX */
i2c_enable(I2C0);
/* enable acknowledge */
i2c_ack_config(I2C0, I2C_ACK_ENABLE);
/* reset retry counter */
i2c_retry_count = 0;
return I2C_STATUS_SUCCESS;
}
/*!
\brief reset I2C bus with proper 9-clock recovery
\brief reset I2C bus
\param[in] none
\param[out] none
\retval i2c_status_t
\retval none
*/
i2c_status_t i2c_bus_reset(void) {
uint8_t i;
/* disable I2C peripheral */
i2c_disable(I2C0);
void i2c_bus_reset(void) {
i2c_deinit(I2C0);
/* configure SDA/SCL as GPIO output for manual control */
gpio_mode_set(I2C_SCL_PORT, GPIO_MODE_OUTPUT, GPIO_PUPD_PULLUP, I2C_SCL_PIN);
gpio_mode_set(I2C_SDA_PORT, GPIO_MODE_OUTPUT, GPIO_PUPD_PULLUP, I2C_SDA_PIN);
/* configure SDA/SCL for GPIO */
GPIO_BC(I2C_SCL_PORT) |= I2C_SCL_PIN;
GPIO_BC(I2C_SDA_PORT) |= I2C_SDA_PIN;
gpio_output_options_set(I2C_SCL_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, I2C_SCL_PIN);
gpio_output_options_set(I2C_SDA_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, I2C_SDA_PIN);
__NOP();
__NOP();
__NOP();
__NOP();
__NOP();
GPIO_BOP(I2C_SCL_PORT) |= I2C_SCL_PIN;
__NOP();
__NOP();
__NOP();
__NOP();
__NOP();
GPIO_BOP(I2C_SDA_PORT) |= I2C_SDA_PIN;
/* connect I2C_SCL_PIN to I2C_SCL */
/* connect I2C_SDA_PIN to I2C_SDA */
gpio_output_options_set(I2C_SCL_PORT, GPIO_OTYPE_OD, GPIO_OSPEED_50MHZ, I2C_SCL_PIN);
gpio_output_options_set(I2C_SDA_PORT, GPIO_OTYPE_OD, GPIO_OSPEED_50MHZ, I2C_SDA_PIN);
/* ensure both lines are high initially */
gpio_bit_set(I2C_SCL_PORT, I2C_SCL_PIN);
gpio_bit_set(I2C_SDA_PORT, I2C_SDA_PIN);
delay_10us(I2C_DELAY_10US);
/* generate 9 clock pulses to release any stuck slave */
for (i = 0; i < I2C_RECOVERY_CLOCKS; i++) {
gpio_bit_reset(I2C_SCL_PORT, I2C_SCL_PIN);
delay_10us(I2C_DELAY_10US);
gpio_bit_set(I2C_SCL_PORT, I2C_SCL_PIN);
delay_10us(I2C_DELAY_10US);
}
/* generate stop condition */
gpio_bit_reset(I2C_SDA_PORT, I2C_SDA_PIN);
delay_10us(I2C_DELAY_10US);
gpio_bit_set(I2C_SCL_PORT, I2C_SCL_PIN);
delay_10us(I2C_DELAY_10US);
gpio_bit_set(I2C_SDA_PORT, I2C_SDA_PIN);
delay_10us(I2C_DELAY_10US);
/* reconfigure as I2C pins */
gpio_af_set(I2C_SCL_PORT, I2C_GPIO_AF, I2C_SCL_PIN);
gpio_af_set(I2C_SDA_PORT, I2C_GPIO_AF, I2C_SDA_PIN);
gpio_mode_set(I2C_SCL_PORT, GPIO_MODE_AF, GPIO_PUPD_PULLUP, I2C_SCL_PIN);
gpio_mode_set(I2C_SDA_PORT, GPIO_MODE_AF, GPIO_PUPD_PULLUP, I2C_SDA_PIN);
/* reconfigure the I2CX interface */
return i2c_config();
/* configure the I2CX interface */
i2c_config();
}
/**
@@ -122,13 +91,7 @@ void i2c_scan(void) {
uint8_t address;
int found_devices = 0;
// printf("Scanning I2C bus...\r\n");
const char* msg1 = "Scanning I2C bus...\r\n";
for (uint8_t i = 0; msg1[i] != '\0'; i++) {
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, msg1[i]);
}
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TC) == RESET) {}
printf("Scanning I2C bus...\r\n");
for (address = 1; address < 127; address++) {
timeout = 0;
@@ -156,24 +119,7 @@ void i2c_scan(void) {
timeout++;
if (timeout < I2C_TIME_OUT) {
i2c_flag_clear(I2C0, I2C_FLAG_ADDSEND);
// printf("Found device at 0x%02X\r\n", address);
const char* msg2_prefix = "Found device at 0x";
for (uint8_t i = 0; msg2_prefix[i] != '\0'; i++) {
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, msg2_prefix[i]);
}
// 发送地址的十六进制表示
uint8_t hex_chars[] = "0123456789ABCDEF";
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, hex_chars[(address >> 4) & 0x0F]);
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, hex_chars[address & 0x0F]);
const char* msg2_suffix = "\r\n";
for (uint8_t i = 0; msg2_suffix[i] != '\0'; i++) {
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, msg2_suffix[i]);
}
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TC) == RESET) {}
printf("Found device at 0x%02X\r\n", address);
found_devices++;
}
@@ -182,458 +128,349 @@ void i2c_scan(void) {
timeout = 0;
while ((I2C_CTL0(I2C0) & I2C_CTL0_STOP) && (timeout < I2C_TIME_OUT))
while (i2c_flag_get(I2C0, I2C_FLAG_STPDET) && (timeout < I2C_TIME_OUT))
timeout++;
}
if (found_devices == 0) {
// printf("No I2C devices found.\r\n");
const char* msg3 = "No I2C devices found.\r\n";
for (uint8_t i = 0; msg3[i] != '\0'; i++) {
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, msg3[i]);
}
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TC) == RESET) {}
printf("No I2C devices found.\r\n");
} else {
// printf("Total %d I2C devices found.\r\n", found_devices);
const char* msg4_prefix = "Total ";
for (uint8_t i = 0; msg4_prefix[i] != '\0'; i++) {
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, msg4_prefix[i]);
}
// 发送设备数量
if (found_devices >= 10) {
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, '0' + (found_devices / 10));
}
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, '0' + (found_devices % 10));
const char* msg4_suffix = " I2C devices found.\r\n";
for (uint8_t i = 0; msg4_suffix[i] != '\0'; i++) {
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, msg4_suffix[i]);
}
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TC) == RESET) {}
printf("Total %d I2C devices found.\r\n", found_devices);
}
}
/*!
\brief write 16-bit data to I2C device with improved state machine
\param[in] slave_addr: 7-bit slave address
\param[in] reg_addr: register address
\param[in] data: pointer to 2-byte data array
\param[out] none
\retval i2c_status_t
*/
i2c_status_t i2c_write_16bits(uint8_t slave_addr, uint8_t reg_addr, const uint8_t data[2]) {
i2c_state_t state = I2C_STATE_START;
uint8_t i2c_write_16bits(uint8_t slave_addr, uint8_t reg_addr, uint8_t data[2]) {
uint8_t state = I2C_START;
uint16_t timeout = 0;
uint8_t data_index = 0;
uint8_t retry_count = 0;
uint8_t i2c_timeout_flag = 0;
/* Parameter validation */
if (data == NULL || slave_addr > 0x7F) {
return I2C_STATUS_INVALID_PARAM;
}
/* Enable acknowledge */
/* enable acknowledge */
i2c_ack_config(I2C0, I2C_ACK_ENABLE);
while (retry_count < I2C_MAX_RETRY) {
while (!(i2c_timeout_flag)) {
switch (state) {
case I2C_STATE_START:
timeout = 0;
/* Wait for bus to be idle */
case I2C_START:
/* i2c master sends start signal only when the bus is idle */
while (i2c_flag_get(I2C0, I2C_FLAG_I2CBSY) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
if (timeout < I2C_TIME_OUT) {
i2c_start_on_bus(I2C0);
timeout = 0;
state = I2C_SEND_ADDRESS;
} else {
timeout = 0;
state = I2C_START;
#ifdef DEBUG_VERBOES
printf("i2c bus is busy in WRITE BYTE!\n");
#endif
}
/* Send start condition */
i2c_start_on_bus(I2C0);
state = I2C_STATE_SEND_ADDRESS;
timeout = 0;
break;
case I2C_STATE_SEND_ADDRESS:
/* Wait for start condition to be sent */
case I2C_SEND_ADDRESS:
/* i2c master sends START signal successfully */
while ((!i2c_flag_get(I2C0, I2C_FLAG_SBSEND)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
if (timeout < I2C_TIME_OUT) {
i2c_master_addressing(I2C0, slave_addr << 1, I2C_TRANSMITTER);
timeout = 0;
state = I2C_CLEAR_ADDRESS_FLAG;
} else {
timeout = 0;
state = I2C_START;
#ifdef DEBUG_VERBOES
printf("i2c master sends start signal timeout in WRITE BYTE!\n");
#endif
}
/* Send slave address with write bit */
i2c_master_addressing(I2C0, (slave_addr << 1), I2C_TRANSMITTER);
state = I2C_STATE_CLEAR_ADDRESS;
timeout = 0;
break;
case I2C_STATE_CLEAR_ADDRESS:
/* Wait for address to be acknowledged */
case I2C_CLEAR_ADDRESS_FLAG:
/* address flag set means i2c slave sends ACK */
while ((!i2c_flag_get(I2C0, I2C_FLAG_ADDSEND)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
if (timeout < I2C_TIME_OUT) {
i2c_flag_clear(I2C0, I2C_FLAG_ADDSEND);
timeout = 0;
state = I2C_TRANSMIT_DATA;
} else {
timeout = 0;
state = I2C_START;
#ifdef DEBUG_VERBOES
printf("i2c master clears address flag timeout in WRITE BYTE!\n");
#endif
}
/* Clear address flag */
i2c_flag_clear(I2C0, I2C_FLAG_ADDSEND);
state = I2C_STATE_TRANSMIT_REG;
timeout = 0;
break;
case I2C_STATE_TRANSMIT_REG:
/* Wait for transmit buffer to be empty */
case I2C_TRANSMIT_DATA:
/* wait until the transmit data buffer is empty */
while ((!i2c_flag_get(I2C0, I2C_FLAG_TBE)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
if (timeout < I2C_TIME_OUT) {
/* send IIC register address */
i2c_data_transmit(I2C0, reg_addr);
timeout = 0;
} else {
timeout = 0;
state = I2C_START;
#ifdef DEBUG_VERBOES
printf("i2c master sends data timeout in WRITE BYTE!\n");
#endif
}
/* Send register address */
i2c_data_transmit(I2C0, reg_addr);
state = I2C_STATE_TRANSMIT_DATA;
timeout = 0;
data_index = 0;
break;
case I2C_STATE_TRANSMIT_DATA:
/* Wait for byte transfer complete */
/* wait until BTC bit is set */
while ((!i2c_flag_get(I2C0, I2C_FLAG_BTC)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
if (timeout < I2C_TIME_OUT) {
/* send register MSB value */
i2c_data_transmit(I2C0, data[0]);
timeout = 0;
} else {
timeout = 0;
state = I2C_START;
#ifdef DEBUG_VERBOES
printf("i2c master sends MSB data timeout in WRITE BYTE!\n");
#endif
}
/* Send data bytes */
if (data_index < 2) {
i2c_data_transmit(I2C0, data[data_index]);
data_index++;
/* wait until BTC bit is set */
while ((!i2c_flag_get(I2C0, I2C_FLAG_BTC)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout < I2C_TIME_OUT) {
/* send register LSB value */
i2c_data_transmit(I2C0, data[1]);
timeout = 0;
/* Stay in this state until all data is sent */
state = I2C_STOP;
} else {
/* All data sent, proceed to stop */
state = I2C_STATE_STOP;
timeout = 0;
state = I2C_START;
#ifdef DEBUG_VERBOES
printf("i2c master sends LSB data timeout in WRITE BYTE!\n");
#endif
}
/* wait until BTC bit is set */
while ((!i2c_flag_get(I2C0, I2C_FLAG_BTC)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout < I2C_TIME_OUT) {
state = I2C_STOP;
timeout = 0;
} else {
timeout = 0;
state = I2C_START;
#ifdef DEBUG_VERBOES
printf("i2c master sends data timeout in WRITE BYTE!\n");
#endif
}
break;
case I2C_STATE_STOP:
/* Send stop condition */
case I2C_STOP:
/* send a stop condition to I2C bus */
i2c_stop_on_bus(I2C0);
/* Wait for stop condition to complete */
/* i2c master sends STOP signal successfully */
while ((I2C_CTL0(I2C0) & I2C_CTL0_STOP) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
}
/* Success */
return I2C_STATUS_SUCCESS;
case I2C_STATE_ERROR:
/* Send stop condition to release bus */
i2c_stop_on_bus(I2C0);
/* Increment retry counter */
retry_count++;
if (retry_count >= I2C_MAX_RETRY) {
#ifdef DEBUG_VERBOSE
// printf("I2C write failed after %d retries\r\n", I2C_MAX_RETRY);
const char* msg5_prefix = "I2C write failed after ";
for (uint8_t i = 0; msg5_prefix[i] != '\0'; i++) {
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, msg5_prefix[i]);
}
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, '0' + I2C_MAX_RETRY);
const char* msg5_suffix = " retries\r\n";
for (uint8_t i = 0; msg5_suffix[i] != '\0'; i++) {
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, msg5_suffix[i]);
}
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TC) == RESET) {}
if (timeout < I2C_TIME_OUT) {
timeout = 0;
state = I2C_END;
i2c_timeout_flag = I2C_OK;
} else {
timeout = 0;
state = I2C_START;
#ifdef DEBUG_VERBOES
printf("i2c master sends stop signal timeout in WRITE BYTE!\n");
#endif
return I2C_STATUS_TIMEOUT;
}
/* Reset state machine for retry */
state = I2C_STATE_START;
timeout = 0;
data_index = 0;
/* Small delay before retry */
delay_10us(10);
break;
default:
state = I2C_STATE_ERROR;
state = I2C_START;
i2c_timeout_flag = I2C_OK;
timeout = 0;
#ifdef DEBUG_VERBOES
printf("i2c master sends start signal in WRITE BYTE.\n");
#endif
break;
}
}
return I2C_STATUS_TIMEOUT;
return I2C_END;
}
/*!
\brief read 16-bit data from I2C device with improved state machine
\param[in] slave_addr: 7-bit slave address
\param[in] reg_addr: register address
\param[out] data: pointer to 2-byte data buffer
\retval i2c_status_t
*/
i2c_status_t i2c_read_16bits(uint8_t slave_addr, uint8_t reg_addr, uint8_t *data) {
i2c_state_t state = I2C_STATE_START;
uint8_t i2c_read_16bits(uint8_t slave_addr, uint8_t reg_addr, uint8_t *data) {
uint8_t state = I2C_START;
uint8_t read_cycle = 0;
uint16_t timeout = 0;
uint8_t data_index = 0;
uint8_t retry_count = 0;
bool write_phase = true; /* First phase: write register address */
uint8_t i2c_timeout_flag = 0;
uint8_t number_of_byte = 2;
/* Parameter validation */
if (data == NULL || slave_addr > 0x7F) {
return I2C_STATUS_INVALID_PARAM;
}
/* Enable acknowledge */
/* enable acknowledge */
i2c_ack_config(I2C0, I2C_ACK_ENABLE);
while (retry_count < I2C_MAX_RETRY) {
while (!(i2c_timeout_flag)) {
switch (state) {
case I2C_STATE_START:
timeout = 0;
/* Wait for bus to be idle */
while (i2c_flag_get(I2C0, I2C_FLAG_I2CBSY) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
}
/* Configure ACK position for 2-byte read */
if (!write_phase) {
i2c_ackpos_config(I2C0, I2C_ACKPOS_NEXT);
}
/* Send start condition */
i2c_start_on_bus(I2C0);
state = I2C_STATE_SEND_ADDRESS;
timeout = 0;
break;
case I2C_STATE_SEND_ADDRESS:
/* Wait for start condition to be sent */
while ((!i2c_flag_get(I2C0, I2C_FLAG_SBSEND)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
}
/* Send slave address */
if (write_phase) {
/* Write phase: send address with write bit */
i2c_master_addressing(I2C0, (slave_addr << 1), I2C_TRANSMITTER);
} else {
/* Read phase: send address with read bit */
i2c_master_addressing(I2C0, (slave_addr << 1) | 0x01, I2C_RECEIVER);
/* Disable ACK for last byte */
i2c_ack_config(I2C0, I2C_ACK_DISABLE);
}
state = I2C_STATE_CLEAR_ADDRESS;
timeout = 0;
break;
case I2C_STATE_CLEAR_ADDRESS:
/* Wait for address to be acknowledged */
while ((!i2c_flag_get(I2C0, I2C_FLAG_ADDSEND)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
}
/* Clear address flag */
i2c_flag_clear(I2C0, I2C_FLAG_ADDSEND);
if (write_phase) {
state = I2C_STATE_TRANSMIT_REG;
} else {
/* For single byte read, send stop after clearing address */
if (data_index == 1) {
i2c_stop_on_bus(I2C0);
}
state = I2C_STATE_RECEIVE_DATA;
data_index = 0;
}
timeout = 0;
break;
case I2C_STATE_TRANSMIT_REG:
/* Wait for transmit buffer to be empty */
while ((!i2c_flag_get(I2C0, I2C_FLAG_TBE)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
}
/* Send register address */
i2c_data_transmit(I2C0, reg_addr);
state = I2C_STATE_RESTART;
timeout = 0;
break;
case I2C_STATE_RESTART:
/* Wait for byte transfer complete */
while ((!i2c_flag_get(I2C0, I2C_FLAG_BTC)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
}
/* Switch to read phase */
write_phase = false;
state = I2C_STATE_START;
timeout = 0;
break;
case I2C_STATE_RECEIVE_DATA:
if (data_index < 2) {
if (data_index == 1) {
/* Wait for BTC before sending stop for last byte */
while ((!i2c_flag_get(I2C0, I2C_FLAG_BTC)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
}
/* Send stop condition before reading last byte */
i2c_stop_on_bus(I2C0);
}
/* Wait for receive buffer not empty */
while ((!i2c_flag_get(I2C0, I2C_FLAG_RBNE)) && (timeout < I2C_TIME_OUT)) {
case I2C_START:
if (RESET == read_cycle) {
/* i2c master sends start signal only when the bus is idle */
while (i2c_flag_get(I2C0, I2C_FLAG_I2CBSY) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
if (timeout < I2C_TIME_OUT) {
/* whether to send ACK or not for the next byte */
i2c_ackpos_config(I2C0, I2C_ACKPOS_NEXT);
} else {
// i2c_bus_reset();
timeout = 0;
state = I2C_START;
#ifdef DEBUG_VERBOES
printf("i2c bus is busy in READ!\n");
#endif
}
}
/* send the start signal */
i2c_start_on_bus(I2C0);
timeout = 0;
state = I2C_SEND_ADDRESS;
break;
case I2C_SEND_ADDRESS:
/* i2c master sends START signal successfully */
while ((!i2c_flag_get(I2C0, I2C_FLAG_SBSEND)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout < I2C_TIME_OUT) {
if (RESET == read_cycle) {
i2c_master_addressing(I2C0, slave_addr << 1, I2C_TRANSMITTER);
state = I2C_CLEAR_ADDRESS_FLAG;
} else {
i2c_master_addressing(I2C0, slave_addr << 1, I2C_RECEIVER);
i2c_ack_config(I2C0, I2C_ACK_DISABLE);
state = I2C_CLEAR_ADDRESS_FLAG;
}
/* Read data byte */
data[data_index] = i2c_data_receive(I2C0);
data_index++;
timeout = 0;
if (data_index >= 2) {
state = I2C_STATE_STOP;
}
} else {
state = I2C_STATE_STOP;
timeout = 0;
state = I2C_START;
read_cycle = RESET;
#ifdef DEBUG_VERBOES
printf("i2c master sends start signal timeout in READ!\n");
#endif
}
break;
case I2C_STATE_STOP:
/* Wait for stop condition to complete */
case I2C_CLEAR_ADDRESS_FLAG:
/* address flag set means i2c slave sends ACK */
while ((!i2c_flag_get(I2C0, I2C_FLAG_ADDSEND)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout < I2C_TIME_OUT) {
i2c_flag_clear(I2C0, I2C_FLAG_ADDSEND);
if ((SET == read_cycle) && (1 == number_of_byte)) {
/* send a stop condition to I2C bus */
i2c_stop_on_bus(I2C0);
}
timeout = 0;
state = I2C_TRANSMIT_DATA;
} else {
timeout = 0;
state = I2C_START;
read_cycle = RESET;
#ifdef DEBUG_VERBOES
printf("i2c master clears address flag timeout in READ!\n");
#endif
}
break;
case I2C_TRANSMIT_DATA:
if (RESET == read_cycle) {
/* wait until the transmit data buffer is empty */
while ((!i2c_flag_get(I2C0, I2C_FLAG_TBE)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout < I2C_TIME_OUT) {
/* send the EEPROM's internal address to write to : only one byte address */
i2c_data_transmit(I2C0, reg_addr);
timeout = 0;
} else {
timeout = 0;
state = I2C_START;
read_cycle = RESET;
#ifdef DEBUG_VERBOES
printf("i2c master wait data buffer is empty timeout in READ!\n");
#endif
}
/* wait until BTC bit is set */
while ((!i2c_flag_get(I2C0, I2C_FLAG_BTC)) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout < I2C_TIME_OUT) {
timeout = 0;
state = I2C_START;
read_cycle = SET;
} else {
timeout = 0;
state = I2C_START;
read_cycle = RESET;
#ifdef DEBUG_VERBOES
printf("i2c master sends register address timeout in READ!\n");
#endif
}
} else {
while (number_of_byte) {
timeout++;
if (2 == number_of_byte) {
/* wait until BTC bit is set */
while (!i2c_flag_get(I2C0, I2C_FLAG_BTC));
/* send a stop condition to I2C bus */
i2c_stop_on_bus(I2C0);
}
/* wait until RBNE bit is set */
if (i2c_flag_get(I2C0, I2C_FLAG_RBNE)) {
/* read a byte from the EEPROM */
*data = i2c_data_receive(I2C0);
/* point to the next location where the byte read will be saved */
data++;
/* decrement the read bytes counter */
number_of_byte--;
timeout = 0;
}
if (timeout > I2C_TIME_OUT) {
timeout = 0;
state = I2C_START;
read_cycle = 0;
#ifdef DEBUG_VERBOES
printf("i2c master sends data timeout in READ!\n");
#endif
}
}
timeout = 0;
state = I2C_STOP;
}
break;
case I2C_STOP:
/* i2c master sends STOP signal successfully */
while ((I2C_CTL0(I2C0) & I2C_CTL0_STOP) && (timeout < I2C_TIME_OUT)) {
timeout++;
}
if (timeout >= I2C_TIME_OUT) {
state = I2C_STATE_ERROR;
break;
}
/* Success */
return I2C_STATUS_SUCCESS;
case I2C_STATE_ERROR:
/* Send stop condition to release bus */
i2c_stop_on_bus(I2C0);
/* Increment retry counter */
retry_count++;
if (retry_count >= I2C_MAX_RETRY) {
#ifdef DEBUG_VERBOSE
// printf("I2C read failed after %d retries\r\n", I2C_MAX_RETRY);
const char* msg6_prefix = "I2C read failed after ";
for (uint8_t i = 0; msg6_prefix[i] != '\0'; i++) {
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, msg6_prefix[i]);
}
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, '0' + I2C_MAX_RETRY);
const char* msg6_suffix = " retries\r\n";
for (uint8_t i = 0; msg6_suffix[i] != '\0'; i++) {
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TBE) == RESET) {}
usart_data_transmit(I2C_DEBUG_UART, msg6_suffix[i]);
}
while (usart_flag_get(I2C_DEBUG_UART, USART_FLAG_TC) == RESET) {}
if (timeout < I2C_TIME_OUT) {
timeout = 0;
state = I2C_END;
i2c_timeout_flag = I2C_OK;
} else {
timeout = 0;
state = I2C_START;
read_cycle = 0;
#ifdef DEBUG_VERBOES
printf("i2c master sends stop signal timeout in READ!\n");
#endif
return I2C_STATUS_TIMEOUT;
}
/* Reset state machine for retry */
state = I2C_STATE_START;
write_phase = true;
timeout = 0;
data_index = 0;
/* Small delay before retry */
delay_10us(10);
break;
default:
state = I2C_STATE_ERROR;
state = I2C_START;
read_cycle = 0;
i2c_timeout_flag = I2C_OK;
timeout = 0;
#ifdef DEBUG_VERBOES
printf("i2c master sends start signal in READ.\n");
#endif
break;
}
}
return I2C_STATUS_TIMEOUT;
}
/*!
\brief get status string for debugging
\param[in] status: i2c_status_t value
\param[out] none
\retval const char* status string
*/
const char* i2c_get_status_string(i2c_status_t status) {
switch (status) {
case I2C_STATUS_SUCCESS:
return "SUCCESS";
case I2C_STATUS_TIMEOUT:
return "TIMEOUT";
case I2C_STATUS_NACK:
return "NACK";
case I2C_STATUS_BUS_BUSY:
return "BUS_BUSY";
case I2C_STATUS_ERROR:
return "ERROR";
case I2C_STATUS_INVALID_PARAM:
return "INVALID_PARAM";
default:
return "UNKNOWN";
}
return I2C_END;
}

570
Src/ldc1612.c
View File

@@ -1,367 +1,295 @@
//
// Created by dell on 24-12-3.
// LDC1612 Inductive Sensor Driver Implementation
//
#include "ldc1612.h"
/* Private function prototypes */
static i2c_status_t ldc1612_write_register(uint8_t reg_addr, uint16_t value);
static i2c_status_t ldc1612_read_register(uint8_t reg_addr, uint16_t *value);
static uint16_t ldc1612_calculate_clock_dividers(uint8_t channel);
static uint32_t ldc1612_parse_raw_result(uint32_t raw_result);
/** @brief set conversion interval time.
@param channel LDC1612 has total two channels.
@param result The value to be set.
* */
void ldc1612_set_conversion_time(uint8_t channel, uint16_t result) {
uint8_t data[2] = {0};
data[0] = (result >> 8) & 0xFF;
data[1] = result & 0xFF;
/*!
\brief 初始化LDC1612传感器
\param[in] none
\param[out] none
\retval ldc1612_status_t
*/
ldc1612_status_t ldc1612_init(void) {
i2c_status_t i2c_status;
uint16_t device_id, manufacturer_id;
/* 复位传感器 */
i2c_status = ldc1612_reset();
if (i2c_status != I2C_STATUS_SUCCESS) {
return LDC1612_STATUS_ERROR;
}
/* 等待复位完成 */
delay_ms(10);
/* 验证设备ID */
device_id = ldc1612_get_device_id();
manufacturer_id = ldc1612_get_manufacturer_id();
if (device_id != 0x3055 || manufacturer_id != 0x5449) {
return LDC1612_STATUS_ERROR;
}
return LDC1612_STATUS_SUCCESS;
#ifdef SOFTWARE_IIC
soft_i2c_write_16bits(LDC1612_ADDR, SET_CONVERSION_TIME_REG_START + channel, data);
#else
i2c_write_16bits(LDC1612_ADDR, SET_CONVERSION_TIME_REG_START + channel, data);
#endif
}
/*!
\brief 复位LDC1612传感器
\param[in] none
\param[out] none
\retval ldc1612_status_t
*/
ldc1612_status_t ldc1612_reset(void) {
i2c_status_t status = ldc1612_write_register(LDC1612_RESET_DEV, LDC1612_RESET_VALUE);
return (status == I2C_STATUS_SUCCESS) ? LDC1612_STATUS_SUCCESS : LDC1612_STATUS_ERROR;
/** @brief set conversion offset.
@param channel LDC1612 has total two channels.
@param result The value to be set.
* */
void ldc1612_set_conversion_offset(uint8_t channel, uint16_t result) {
uint8_t data[2] = {0};
data[0] = (result >> 8) & 0xFF;
data[1] = result & 0xFF;
#ifdef SOFTWARE_IIC
soft_i2c_write_16bits(LDC1612_ADDR, SET_CONVERSION_OFFSET_REG_START + channel, data);
#else
i2c_write_16bits(LDC1612_ADDR, SET_CONVERSION_OFFSET_REG_START + channel, data);
#endif
}
/*!
\brief 配置单通道模式
\param[in] channel: 通道号 (0或1)
\param[out] none
\retval ldc1612_status_t
*/
ldc1612_status_t ldc1612_config_single_channel(uint8_t channel) {
i2c_status_t status;
uint16_t clock_dividers;
if (channel > 1) {
return LDC1612_STATUS_INVALID_PARAM;
}
/* 进入休眠模式进行配置 */
status = ldc1612_write_register(LDC1612_CONFIG, LDC1612_SENSOR_CONFIG_SLEEP);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
/* 计算并设置时钟分频 */
clock_dividers = ldc1612_calculate_clock_dividers(channel);
status = ldc1612_write_register(LDC1612_CLOCK_DIVIDERS_CH0 + channel, clock_dividers);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
/* 设置稳定时间 */
status = ldc1612_write_register(LDC1612_SETTLECOUNT_CH0 + channel, LDC1612_SETTLECOUNT_CH0_DEFAULT);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
/* 设置转换时间 */
status = ldc1612_write_register(LDC1612_RCOUNT_CH0 + channel, LDC1612_CONVERSION_TIME_CH0);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
/* 设置错误配置 */
status = ldc1612_write_register(LDC1612_ERROR_CONFIG, LDC1612_ERROR_CONFIG_DEFAULT);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
/* 设置驱动电流 */
status = ldc1612_write_register(LDC1612_DRIVE_CURRENT_CH0 + channel, LDC1612_DRIVE_CURRENT_DEFAULT);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
/* 设置MUX配置 */
status = ldc1612_write_register(LDC1612_MUX_CONFIG, LDC1612_MUX_CONFIG_DEFAULT);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
/* 退出休眠模式，开始转换 */
status = ldc1612_write_register(LDC1612_CONFIG, LDC1612_SENSOR_CONFIG_ACTIVE);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
return LDC1612_STATUS_SUCCESS;
/** @brief Before conversion,wait LC sensor stabilize for a short time.
@param channel LDC1612 has total two channels.
@param result The value to be set.
* */
void ldc1612_set_LC_stabilize_time(uint8_t channel, uint16_t result) {
uint8_t data[2] = {0};
data[0] = (result >> 8) & 0xFF;
data[1] = result & 0xFF;
#ifdef SOFTWARE_IIC
soft_i2c_write_16bits(LDC1612_ADDR, SET_LC_STABILIZE_REG_START + channel, data);
#else
i2c_write_16bits(LDC1612_ADDR, SET_LC_STABILIZE_REG_START + channel, data);
#endif
}
/*!
\brief 读取制造商ID
\param[in] none
\param[out] none
\retval uint16_t 制造商ID
*/
uint16_t ldc1612_get_manufacturer_id(void) {
uint16_t id = 0;
ldc1612_read_register(LDC1612_MANUFACTURER_ID, &id);
return id;
}
/** @brief set input frequency divide and fref divide.
@param channel LDC1612 has total two channels.
@param FIN_DIV FIN input divide
@param FREF_DIV fref,reference frequency of sensor.
* */
void ldc1612_set_freq_divide(uint8_t channel) {
uint16_t value;
uint16_t fin_div, freq_div;
float sensor_freq;
/*!
\brief 读取设备ID
\param[in] none
\param[out] none
\retval uint16_t 设备ID
*/
uint16_t ldc1612_get_device_id(void) {
uint16_t id = 0;
ldc1612_read_register(LDC1612_DEVICE_ID, &id);
return id;
}
sensor_freq = 1 / (2 * 3.14 * sqrt(COIL_L_UH * COIL_C_PF * pow(10, -18))) * pow(10, -6);
/*!
\brief 读取通道原始数据
\param[in] channel: 通道号
\param[out] result: 结果结构体指针
\retval ldc1612_status_t
*/
ldc1612_status_t ldc1612_read_channel(uint8_t channel, ldc1612_result_t *result) {
uint16_t msb, lsb;
uint32_t raw_data;
i2c_status_t status;
if (channel > 1 || result == NULL) {
return LDC1612_STATUS_INVALID_PARAM;
}
/* 读取MSB */
status = ldc1612_read_register(LDC1612_DATA_CH0_MSB + (channel * 2), &msb);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
/* 读取LSB */
status = ldc1612_read_register(LDC1612_DATA_CH0_LSB + (channel * 2), &lsb);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
/* 组合32位数据 */
raw_data = ((uint32_t)msb << 16) | lsb;
/* 解析结果 */
result->raw_data = raw_data;
result->frequency = ldc1612_parse_raw_result(raw_data);
/* 检查错误 */
if (result->frequency >= 0x10000000) {
result->error_flag = true;
result->error_code = (result->frequency >> 24) & 0xFF;
return LDC1612_STATUS_ERROR;
fin_div = (uint16_t) (sensor_freq / 8.75 + 1);
if (fin_div * 4 < 40) {
freq_div = 2;
} else {
result->error_flag = false;
result->error_code = 0;
freq_div = 4;
}
return LDC1612_STATUS_SUCCESS;
value = fin_div << 12;
value |= freq_div;
// printf("\tvalue: 0x%x\r\n", value);
uint8_t data[2] = {0};
data[0] = (value >> 8) & 0xFF;
data[1] = value & 0xFF;
// printf("\tFIN_DIV: %d, FREF_DIV: %d\r\n", fin_div, freq_div);
#ifdef SOFTWARE_IIC
soft_i2c_write_16bits(LDC1612_ADDR, SET_FREQ_REG_START + channel, data);
#else
i2c_write_16bits(LDC1612_ADDR, SET_FREQ_REG_START + channel, data);
#endif
}
/*!
\brief 设置驱动电流
\param[in] channel: 通道号
\param[in] current: 电流值
\param[out] none
\retval ldc1612_status_t
*/
ldc1612_status_t ldc1612_set_drive_current(uint8_t channel, uint16_t current) {
if (channel > 1) {
return LDC1612_STATUS_INVALID_PARAM;
}
i2c_status_t status = ldc1612_write_register(LDC1612_DRIVE_CURRENT_CH0 + channel, current);
return (status == I2C_STATUS_SUCCESS) ? LDC1612_STATUS_SUCCESS : LDC1612_STATUS_ERROR;
}
/*!
\brief 自动检测驱动电流
\param[in] channel: 通道号
\param[out] none
\retval ldc1612_status_t
*/
ldc1612_status_t ldc1612_auto_detect_drive_current(uint8_t channel) {
uint16_t config_value, drive_current_reg;
uint16_t init_value, drive_current;
i2c_status_t status;
if (channel > 1) {
return LDC1612_STATUS_INVALID_PARAM;
}
/* 进入休眠模式 */
status = ldc1612_write_register(LDC1612_CONFIG, LDC1612_SENSOR_CONFIG_SLEEP);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
/* 设置时钟分频 */
uint16_t clock_dividers = ldc1612_calculate_clock_dividers(channel);
status = ldc1612_write_register(LDC1612_CLOCK_DIVIDERS_CH0 + channel, clock_dividers);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
/* 读取当前配置并禁用Rp覆盖 */
status = ldc1612_read_register(LDC1612_CONFIG, &config_value);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
config_value &= ~(1 << 12); // 禁用RP_OVERRIDE_EN
status = ldc1612_write_register(LDC1612_CONFIG, config_value);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
/* 启动测量 */
status = ldc1612_write_register(LDC1612_CONFIG, LDC1612_SENSOR_CONFIG_ACTIVE);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
/* 等待至少一次转换完成 */
delay_ms(10);
/* 读取初始驱动电流值 */
status = ldc1612_read_register(LDC1612_DRIVE_CURRENT_CH0 + channel, &drive_current_reg);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
init_value = (drive_current_reg >> 6) & 0x1F;
drive_current = (init_value << 11) | 0x0000;
/* 写入检测到的驱动电流 */
status = ldc1612_write_register(LDC1612_DRIVE_CURRENT_CH0 + channel, drive_current);
if (status != I2C_STATUS_SUCCESS) return LDC1612_STATUS_ERROR;
return LDC1612_STATUS_SUCCESS;
}
/*!
\brief 获取状态字符串
\param[in] status: 状态码
\param[out] none
\retval const char* 状态字符串
*/
const char* ldc1612_get_status_string(ldc1612_status_t status) {
switch (status) {
case LDC1612_STATUS_SUCCESS:
return "SUCCESS";
case LDC1612_STATUS_ERROR:
return "ERROR";
case LDC1612_STATUS_TIMEOUT:
return "TIMEOUT";
case LDC1612_STATUS_INVALID_PARAM:
return "INVALID_PARAM";
case LDC1612_STATUS_NO_COIL:
return "NO_COIL";
case LDC1612_STATUS_UNDER_RANGE:
return "UNDER_RANGE";
case LDC1612_STATUS_OVER_RANGE:
return "OVER_RANGE";
default:
return "UNKNOWN";
}
}
/* Private Functions Implementation */
/*!
\brief 写入寄存器
\param[in] reg_addr: 寄存器地址
\param[in] value: 写入值
\param[out] none
\retval i2c_status_t
*/
static i2c_status_t ldc1612_write_register(uint8_t reg_addr, uint16_t value) {
uint8_t data[2];
/** @brief Error output config.
@param result The value to be set.
* */
void ldc1612_set_error_config(uint16_t value) {
uint8_t data[2] = {0};
data[0] = (value >> 8) & 0xFF;
data[1] = value & 0xFF;
return i2c_write_16bits(LDC1612_ADDR, reg_addr, data);
#ifdef SOFTWARE_IIC
soft_i2c_write_16bits(LDC1612_ADDR, ERROR_CONFIG_REG, data);
#else
i2c_write_16bits(LDC1612_ADDR, ERROR_CONFIG_REG, data);
#endif
}
/*!
\brief 读取寄存器
\param[in] reg_addr: 寄存器地址
\param[out] value: 读取值指针
\retval i2c_status_t
*/
static i2c_status_t ldc1612_read_register(uint8_t reg_addr, uint16_t *value) {
uint8_t data[2];
i2c_status_t status;
/** @brief mux config.
@param result The value to be set.
* */
void ldc1612_set_mux_config(uint16_t value) {
uint8_t data[2] = {0};
data[0] = (value >> 8) & 0xFF;
data[1] = value & 0xFF;
if (value == NULL) {
return I2C_STATUS_INVALID_PARAM;
}
status = i2c_read_16bits(LDC1612_ADDR, reg_addr, data);
if (status == I2C_STATUS_SUCCESS) {
*value = ((uint16_t)data[0] << 8) | data[1];
}
return status;
#ifdef SOFTWARE_IIC
soft_i2c_write_16bits(LDC1612_ADDR, MUL_CONFIG_REG, data);
#else
i2c_write_16bits(LDC1612_ADDR, MUL_CONFIG_REG, data);
#endif
}
/*!
\brief 计算时钟分频值
\param[in] channel: 通道号
\param[out] none
\retval uint16_t 分频值
*/
static uint16_t ldc1612_calculate_clock_dividers(uint8_t channel) {
uint16_t fin_div, fref_div;
float sensor_freq;
/** @brief reset sensor.
/* 计算传感器频率 (MHz) */
sensor_freq = 1.0f / (2.0f * 3.14159f * sqrtf(LDC1612_COIL_L_UH * LDC1612_COIL_C_PF * 1e-18f)) * 1e-6f;
* */
void ldc1612_reset_sensor(void) {
uint8_t data[2] = {0};
data[0] = 0x80;
data[1] = 0x00;
/* 计算FIN分频 */
fin_div = (uint16_t)(sensor_freq / 8.75f + 1);
/* 计算FREF分频 */
if (fin_div * 4 < 40) {
fref_div = 2;
} else {
fref_div = 4;
}
return (fin_div << 12) | fref_div;
#ifdef SOFTWARE_IIC
soft_i2c_write_16bits(LDC1612_ADDR, SENSOR_RESET_REG, data);
#else
i2c_write_16bits(LDC1612_ADDR, SENSOR_RESET_REG, data);
#endif
}
/*!
\brief 解析原始结果
\param[in] raw_result: 原始数据
\param[out] none
\retval uint32_t 解析后的数据
*/
static uint32_t ldc1612_parse_raw_result(uint32_t raw_result) {
uint32_t calibration_value;
uint8_t error_code;
/** @brief set drive current of sensor.
@param result The value to be set.
* */
void ldc1612_set_drive_current(uint8_t channel, uint16_t value) {
uint8_t data[2] = {0};
data[0] = (value >> 8) & 0xFF;
data[1] = value & 0xFF;
#ifdef SOFTWARE_IIC
soft_i2c_write_16bits(LDC1612_ADDR, SET_DRIVER_CURRENT_REG + channel, data);
#else
i2c_write_16bits(LDC1612_ADDR, SET_DRIVER_CURRENT_REG + channel, data);
#endif
}
/** @brief Main config part of sensor.Contains select channel、start conversion、sleep mode、sensor activation mode、INT pin disable ..
@param result The value to be set.
* */
void ldc1612_set_sensor_config(uint16_t value) {
uint8_t data[2] = {0};
data[0] = (value >> 8) & 0xFF;
data[1] = value & 0xFF;
#ifdef SOFTWARE_IIC
soft_i2c_write_16bits(LDC1612_ADDR, SENSOR_CONFIG_REG, data);
#else
i2c_write_16bits(LDC1612_ADDR, SENSOR_CONFIG_REG, data);
#endif
}
void ldc1612_single_ch0_config(void) {
ldc1612_set_freq_divide(CHANNEL_0); //0x14 --0x1002
ldc1612_set_LC_stabilize_time(CHANNEL_0, LC_STABILIZE_TIME_CH0); //0x10 --0x001E
ldc1612_set_conversion_time(CHANNEL_0, LDC1612_CONVERSION_TIME_CH0); //0x08 --0x0546
ldc1612_set_error_config(LDC1612_ERROR_CONFIG); //0x19 --0x0000)
ldc1612_set_drive_current(CHANNEL_0, LDC1612_DRIVE_CURRENT); //0x1E --0x9000
ldc1612_set_mux_config(LDC1612_MUX_CONFIG); //0x1B --0x020C
ldc1612_set_sensor_config(LDC1612_SENSOR_CONFIG); //0x1A --0x1601
}
void ldc1612_iic_get_sensor_infomation(void) {
uint8_t data[2] = {0};
#ifdef SOFTWARE_IIC
soft_i2c_read_16bits(LDC1612_ADDR, READ_MANUFACTURER_ID, data);
#else
i2c_read_16bits(LDC1612_ADDR, READ_MANUFACTURER_ID, data);
#endif
printf("\tManufacturer: 0x%x", (data[0] << 8) | data[1]);
#ifdef SOFTWARE_IIC
soft_i2c_read_16bits(LDC1612_ADDR, READ_DEVICE_ID, data);
#else
i2c_read_16bits(LDC1612_ADDR, READ_DEVICE_ID, data);
#endif
printf("\tDevice: 0x%x", (data[0] << 8) | data[1]);
}
uint16_t ldc1612_get_manufacturer_id(void) {
uint8_t data[2] = {0};
#ifdef SOFTWARE_IIC
soft_i2c_read_16bits(LDC1612_ADDR, READ_MANUFACTURER_ID, data);
#else
i2c_read_16bits(LDC1612_ADDR, READ_MANUFACTURER_ID, data);
#endif
return (data[0] << 8) | data[1];
}
uint16_t ldc1612_get_deveice_id(void) {
uint8_t data[2] = {0};
#ifdef SOFTWARE_IIC
soft_i2c_read_16bits(LDC1612_ADDR, READ_DEVICE_ID, data);
#else
i2c_read_16bits(LDC1612_ADDR, READ_DEVICE_ID, data);
#endif
return (data[0] << 8) | data[1];
}
/** @brief read the raw channel result from register.
@param channel LDC1612 has total two channels.
@param result raw data
* */
uint32_t ldc1612_get_raw_channel_result(uint8_t channel) {
uint32_t raw_value = 0;
uint8_t value[2] = {0};
#ifdef SOFTWARE_IIC
soft_i2c_read_16bits(LDC1612_ADDR, CONVERTION_RESULT_REG_START + channel, value);
#else
i2c_read_16bits(LDC1612_ADDR, CONVERTION_RESULT_REG_START + channel, value);
#endif
raw_value |= (uint32_t) ((value[0] << 8) | value[1]) << 16;
#ifdef SOFTWARE_IIC
soft_i2c_read_16bits(LDC1612_ADDR, CONVERTION_RESULT_REG_START + channel + 1, value);
#else
i2c_read_16bits(LDC1612_ADDR, CONVERTION_RESULT_REG_START + channel + 1, value);
#endif
raw_value |= (uint32_t) ((value[0] << 8) | value[1]);
return ldc1612_parse_raw_result(raw_value);
}
/** @brief parse the data which read from data register.
@param channel LDC1612 has total two channels.
@param raw_result the raw data which read from data register,it contains error codes and sensor value;
* */
uint32_t ldc1612_parse_raw_result(uint32_t raw_result) {
uint32_t calibration_value = 0;
uint8_t error_code = 0;
calibration_value = raw_result & 0x0FFFFFFF;
/* 检查无线圈错误 */
if (calibration_value == 0x0FFFFFFF) {
return LDC1612_ERROR_NO_COIL;
if (0xFFFFFFF == calibration_value) {
return 0xF0000000;
// ERR_NC-No coil detected!!!
}
error_code = (raw_result >> 24) & 0xFF;
error_code = raw_result >> 24;
/* 检查各种错误 */
if (error_code & 0x80) {
return LDC1612_ERROR_UNDER_RANGE;
return 0x80000000;
// ERR_UR-Under range error!!!
}
if (error_code & 0x40) {
return LDC1612_ERROR_OVER_RANGE;
return 0x40000000;
// ERR_OR-Over range error!!!
}
if (error_code & 0x20) {
return LDC1612_ERROR_WATCHDOG;
return 0x20000000;
// ERR_WD-Watch dog timeout error!!!
}
if (error_code & 0x10) {
return LDC1612_ERROR_AMPLITUDE;
return 0x10000000;
// ERR_AE-error!!!
}
return calibration_value;
return raw_result;
}
void ldc1612_drvie_current_detect(uint8_t channel) {
uint8_t data[2] = {0};
uint16_t init_value = 0 , drive_current = 0;
ldc1612_set_sensor_config(LDC1612_SLEEP_MODE);
ldc1612_set_freq_divide(channel);
soft_i2c_read_16bits(LDC1612_ADDR, SENSOR_CONFIG_REG, data);
ldc1612_set_sensor_config(LDC1612_SLEEP_MODE);
ldc1612_set_sensor_config(LDC1612_SENSOR_CONFIG); //0x1A --0x1601
delay_ms(10);
soft_i2c_read_16bits(LDC1612_ADDR, SET_DRIVER_CURRENT_REG, data);
init_value = (((data[0] << 8) | data[1]) >> 6) & 0x1F;
drive_current = (init_value << 11) | 0x0000;
printf("init value: 0x%x\tdrive current: 0x%x\n", init_value, drive_current);
}

19
Src/main.c
View File

@@ -40,7 +40,7 @@ OF SUCH DAMAGE.
#include <stdio.h>
#include "i2c.h"
#include "board_config.h"
#include "sensor_example.h"
#include "ldc1612.h"
bool g_status_switch = false;
@@ -75,17 +75,24 @@ int main(void)
i2c_config();
i2c_scan();
// i2c_bus_reset();
// uint8_t sensor_data[2] = {0};
// i2c_read_16bits(0x2B, 0x7E, sensor_data);
// printf("Sensor Data: 0x%02X 0x%02X\r\n", sensor_data[0], sensor_data[1]);
// i2c_bus_reset();
ldc1612_iic_get_sensor_infomation();
#ifdef DEBUG_VERBOSE
i2c_scan();
#endif
sensors_init_example();
sensors_read_example();
while(1){
command_process();
delay_ms(100);