Compare commits

2 Commits

Author SHA1 Message Date
a02b3581c7 debug vofa 2025-04-02 15:24:40 +08:00
f4364f5315 alpha machine 2.0 dirve current 2025-04-02 14:26:00 +08:00
12 changed files with 44 additions and 150 deletions

View File

@@ -4,11 +4,11 @@ include(cmake/toolchain.cmake)
project(xlsw_3dp_LDC1612) project(xlsw_3dp_LDC1612)
set(VERSION_MAJOR 0) set(VERSION_MAJOR 0)
set(VERSION_MINOR F) set(VERSION_MINOR 2)
set(VERSION_PATCH 1) set(VERSION_PATCH 0)
set(VERSION "V${VERSION_MAJOR}.${VERSION_MINOR}.${VERSION_PATCH}") set(VERSION "V${VERSION_MAJOR}.${VERSION_MINOR}.${VERSION_PATCH}")
string(TIMESTAMP CURRENT_DATE "%Y-%m-%d") string(TIMESTAMP CURRENT_DATE "%Y-%m-%d")
set(IIC_TYPE "AutoDetectDriveCurrent") set(IIC_TYPE "SW-IIC")
#set(IIC_TYPE "HW-IIC") #set(IIC_TYPE "HW-IIC")
enable_language(C) enable_language(C)

View File

@@ -8,9 +8,10 @@
通信协议:[LDC1612通信协议](CommunicationProtocol.md) 通信协议:[LDC1612通信协议](CommunicationProtocol.md)
以下是代码段的详细寄存器配置解析,包含所有寄存器地址和参数位域定义:
--- ---
## LDC1612寄存器配置
### **1. 软件复位 (RESET_DEV)** ### **1. 软件复位 (RESET_DEV)**
- **寄存器地址**: 0x1C - **寄存器地址**: 0x1C
- **写入值**: 0x8000 - **写入值**: 0x8000
@@ -18,6 +19,8 @@
- **Bit 15 (RESET_DEV)**: 写1触发硬件复位完成后自动清零。 - **Bit 15 (RESET_DEV)**: 写1触发硬件复位完成后自动清零。
- **Bits 14-0**: 保留位必须写0。 - **Bits 14-0**: 保留位必须写0。
---
### **2. 进入休眠模式 (CONFIG)** ### **2. 进入休眠模式 (CONFIG)**
- **寄存器地址**: 0x1A - **寄存器地址**: 0x1A
- **写入值**: 0x2801 - **写入值**: 0x2801
@@ -36,6 +39,8 @@
| 6 | HIGH_CURRENT_DRV | 0 | 禁用高电流驱动模式 | | 6 | HIGH_CURRENT_DRV | 0 | 禁用高电流驱动模式 |
| 5-0 | Reserved | 000001 | 保留位(默认值) | | 5-0 | Reserved | 000001 | 保留位(默认值) |
---
### **3. 配置通道0时钟分频 (CLOCK_DIVIDERS_CH0)** ### **3. 配置通道0时钟分频 (CLOCK_DIVIDERS_CH0)**
- **寄存器地址**: 0x14 - **寄存器地址**: 0x14
- **写入值**: 0x1002 - **写入值**: 0x1002
@@ -47,6 +52,8 @@
| Reserved | Bits 11-10 | 0x0 | 保留位 | | Reserved | Bits 11-10 | 0x0 | 保留位 |
| CH0_FREF_DIVIDER | Bits 9-0 | 0x002 | 参考分频系数=2f_REF=40MHz/2=20MHz | | CH0_FREF_DIVIDER | Bits 9-0 | 0x002 | 参考分频系数=2f_REF=40MHz/2=20MHz |
---
### **4. 设置通道0转换时间 (RCOUNT_CH0)** ### **4. 设置通道0转换时间 (RCOUNT_CH0)**
- **寄存器地址**: 0x08 - **寄存器地址**: 0x08
- **写入值**: 0x04D6 (十进制1238) - **写入值**: 0x04D6 (十进制1238)
@@ -56,6 +63,8 @@
t_{C0} = \frac{(0x04D6 \times 16)}{20\text{MHz}} = 991\mu s t_{C0} = \frac{(0x04D6 \times 16)}{20\text{MHz}} = 991\mu s
\] \]
---
### **5. 设置通道0稳定时间 (SETTLECOUNT_CH0)** ### **5. 设置通道0稳定时间 (SETTLECOUNT_CH0)**
- **寄存器地址**: 0x10 - **寄存器地址**: 0x10
- **写入值**: 0x000A (十进制10) - **写入值**: 0x000A (十进制10)
@@ -65,6 +74,8 @@
t_{S0} = \frac{(0x000A \times 16)}{20\text{MHz}} = 8\mu s t_{S0} = \frac{(0x000A \times 16)}{20\text{MHz}} = 8\mu s
\] \]
---
### **6. 配置通道0驱动电流 (DRIVE_CURRENT_CH0)** ### **6. 配置通道0驱动电流 (DRIVE_CURRENT_CH0)**
- **寄存器地址**: 0x1E - **寄存器地址**: 0x1E
- **写入值**: 0x9000 - **写入值**: 0x9000
@@ -76,6 +87,8 @@
| CH0_INIT_IDRIVE | Bits 10-6 | 0x00 | 初始电流值(未使用) | | CH0_INIT_IDRIVE | Bits 10-6 | 0x00 | 初始电流值(未使用) |
| Reserved | Bits 5-0 | 0x00 | 保留位 | | Reserved | Bits 5-0 | 0x00 | 保留位 |
---
### **7. 多通道扫描配置 (MUX_CONFIG)** ### **7. 多通道扫描配置 (MUX_CONFIG)**
- **寄存器地址**: 0x1B - **寄存器地址**: 0x1B
- **写入值**: 0x820C - **写入值**: 0x820C
@@ -88,6 +101,8 @@
| Reserved | Bits 12-3 | 0x020 | 保留位(默认值) | | Reserved | Bits 12-3 | 0x020 | 保留位(默认值) |
| DEGLITCH | Bits 2-0 | 0x4 | 去抖动滤波器带宽=3.3MHz | | DEGLITCH | Bits 2-0 | 0x4 | 去抖动滤波器带宽=3.3MHz |
---
### **8. 退出休眠并启动转换 (CONFIG)** ### **8. 退出休眠并启动转换 (CONFIG)**
- **寄存器地址**: 0x1A - **寄存器地址**: 0x1A
- **写入值**: 0x1601 - **写入值**: 0x1601
@@ -99,6 +114,8 @@
| 9 | REF_CLK_SRC | 1 | 使用外部时钟CLKIN=40MHz| | 9 | REF_CLK_SRC | 1 | 使用外部时钟CLKIN=40MHz|
| 12 | RP_OVERRIDE_EN | 1 | 启用Rp覆盖固定驱动电流 | | 12 | RP_OVERRIDE_EN | 1 | 启用Rp覆盖固定驱动电流 |
---
### **关键参数总结表** ### **关键参数总结表**
| 寄存器名 | 地址 | 写入值 | 核心功能 | | 寄存器名 | 地址 | 写入值 | 核心功能 |
|----------------------|-------|--------|----------------------------| |----------------------|-------|--------|----------------------------|
@@ -111,43 +128,10 @@
| MUX_CONFIG | 0x1B | 0x820C | 启用双通道扫描Ch0→Ch1 | | MUX_CONFIG | 0x1B | 0x820C | 启用双通道扫描Ch0→Ch1 |
| CONFIG (启动) | 0x1A | 0x1601 | 退出休眠,启用外部时钟 | | CONFIG (启动) | 0x1A | 0x1601 | 退出休眠,启用外部时钟 |
---
通过以上配置,设备将按以下流程运行: 通过以上配置,设备将按以下流程运行:
1. 复位后进入休眠模式,配置寄存器。 1. 复位后进入休眠模式,配置寄存器。
2. 设置通道0的时钟分频、转换时间、稳定时间和驱动电流。 2. 设置通道0的时钟分频、转换时间、稳定时间和驱动电流。
3. 启用双通道自动扫描,设置去抖动滤波器。 3. 启用双通道自动扫描,设置去抖动滤波器。
4. 退出休眠模式,开始连续转换。 4. 退出休眠模式,开始连续转换。
---
## **自动校准配置(可选)**
### **适用场景**
- Rp未知或环境变化大时通过自动校准获取初始电流值。
### **操作流程**
1. **设置目标至最大距离**
2. **进入休眠模式**
```c
write_register(0x1A, 0x2801); // SLEEP_MODE_EN=1
```
3. **启用自动校准**
```c
// CLOCK_DIVIDERS_CH0配置分频
write_register(0x14, 0x1002); // FIN_DIV=1, FREF_DIV=2
// 禁用Rp覆盖
uint16_t config = read_register(0x1A);
config &= ~(1 << 12); // RP_OVERRIDE_EN=0
write_register(0x1A, config);
```
4. **启动测量并读取初始值**
```c
write_register(0x1A, 0x1601); // 退出休眠
delay(10); // 等待至少一次转换完成
uint16_t init_value = (read_register(0x1E) >> 6) & 0x1F; // 读取CH0_INIT_IDRIVE
```
5. **写入驱动电流**
```c
uint16_t drive_current = (init_value << 11) | 0x0000;
write_register(0x1E, drive_current);
```
---

View File

@@ -5,13 +5,11 @@
#ifndef BOARD_CONFIG_H #ifndef BOARD_CONFIG_H
#define BOARD_CONFIG_H #define BOARD_CONFIG_H
// #define SOFTWARE_IIC #define SOFTWARE_IIC
// #define DEBUG_VERBOES // #define DEBUG_VERBOES
// #define RS485_MAX13487 #define DEBUG_VOFA_TOOL
// #define DEBUG_VOFA_TOOL
/******************************************************************************/ /******************************************************************************/

View File

@@ -19,7 +19,7 @@
/******************************************************************************/ /******************************************************************************/
#define I2C_SPEED 100*(1000) #define I2C_SPEED 20000
#define I2C_TIME_OUT (uint16_t)(5000) #define I2C_TIME_OUT (uint16_t)(5000)
#define I2C_OK 1 #define I2C_OK 1

View File

@@ -48,21 +48,19 @@
/******************************************************************************/ /******************************************************************************/
#define LDC1612_CONVERSION_TIME_CH0 0x0546 //0536 #define LDC1612_CONVERSION_TIME_CH0 0x0546 //0536
#define LDC1612_DRIVE_CURRENT 0x9000 //A000 #define LDC1612_DRIVE_CURRENT 0x8800 //A000
#define LDC1612_MUX_CONFIG 0x020C // no auto scan and filter bandwidth 3.3MHz #define LDC1612_MUX_CONFIG 0x020C // no auto scan and filter bandwidth 3.3MHz
#define LDC1612_SENSOR_CONFIG 0x1601 #define LDC1612_SENSOR_CONFIG 0x1601
#define LDC1612_SLEEP_MODE 0x2801
#define LDC1612_ERROR_CONFIG 0x0000 #define LDC1612_ERROR_CONFIG 0x0000
#define LC_STABILIZE_TIME_CH0 0x001E //30 #define LC_STABILIZE_TIME_CH0 0x001E //30
#define LDC1612_RESET_DEV 0x8000 //[15:0] 0b1000 0000 0000 0000 #define LDC1612_RESET_DEV 0x8000 //[15:0] 0b1000 0000 0000 0000
/******************************************************************************/ /******************************************************************************/
#define COIL_RP_KOM 7.2 #define COIL_RP_KOM 15.727
#define COIL_L_UH 33 #define COIL_L_UH 33
#define COIL_C_PF 150 #define COIL_C_PF 150
#define COIL_Q_FACTOR 35.97 #define COIL_Q_FACTOR 35.97
#define COIL_FREQ_HZ 2262000
/******************************************************************************/ /******************************************************************************/
@@ -96,6 +94,4 @@ uint32_t ldc1612_get_raw_channel_result(uint8_t channel);
uint32_t ldc1612_parse_raw_result(uint32_t raw_result); uint32_t ldc1612_parse_raw_result(uint32_t raw_result);
void ldc1612_drvie_current_detect(uint8_t channel);
#endif //LDC1612_H #endif //LDC1612_H

View File

@@ -36,7 +36,6 @@ OF SUCH DAMAGE.
#define MAIN_H #define MAIN_H
#include <stdio.h> #include <stdio.h>
#include <stdbool.h>
#include "gd32e23x.h" #include "gd32e23x.h"
#include "systick.h" #include "systick.h"
#include "gd32e23x_libopt.h" #include "gd32e23x_libopt.h"

View File

@@ -9,8 +9,6 @@
#include "gd32e23x.h" #include "gd32e23x.h"
#include "systick.h" #include "systick.h"
#include <stdio.h> #include <stdio.h>
#include <string.h>
#include <stdbool.h>
#include "ldc1612.h" #include "ldc1612.h"
#include "tmp112.h" #include "tmp112.h"
#include "fwdgt.h" #include "fwdgt.h"
@@ -37,12 +35,6 @@ typedef enum
/******************************************************************************/ /******************************************************************************/
uint8_t Command_Write(uint8_t *data, uint8_t length);
uint8_t Command_GetCommand(uint8_t *command);
/******************************************************************************/
void rs485_config(void); void rs485_config(void);
void process_command(uint8_t* cmd, size_t length); void process_command(uint8_t* cmd, size_t length);

View File

@@ -39,8 +39,6 @@ OF SUCH DAMAGE.
#include "rs485.h" #include "rs485.h"
#include "led.h" #include "led.h"
extern uint8_t readBuffer[16];
/*! /*!
\brief this function handles NMI exception \brief this function handles NMI exception
\param[in] none \param[in] none
@@ -121,21 +119,22 @@ void TIMER16_IRQHandler(void) {
void USART0_IRQHandler(void) { void USART0_IRQHandler(void) {
static uint8_t rx_index = 0; static uint8_t rx_index = 0;
static uint8_t rx_buffer[RX_BUFFER_SIZE];
if (RESET != usart_interrupt_flag_get(USART0, USART_INT_FLAG_RBNE)) { if (RESET != usart_interrupt_flag_get(USART0, USART_INT_FLAG_RBNE)) {
// usart_interrupt_flag_clear(USART0, USART_INT_FLAG_RBNE); usart_interrupt_flag_clear(USART0, USART_INT_FLAG_RBNE);
// uint8_t received_data = (uint8_t) usart_data_receive(USART0); uint8_t received_data = (uint8_t) usart_data_receive(USART0);
// 将接收到的数据存储到缓冲区 // 将接收到的数据存储到缓冲区
if (rx_index < sizeof(readBuffer) - 1) { if (rx_index < RX_BUFFER_SIZE - 1) {
readBuffer[rx_index++] = usart_data_receive(USART0); rx_buffer[rx_index++] = received_data;
} }
} }
if (RESET != usart_interrupt_flag_get(USART0, USART_INT_FLAG_IDLE)) { if (RESET != usart_interrupt_flag_get(USART0, USART_INT_FLAG_IDLE)) {
usart_interrupt_flag_clear(USART0, USART_INT_FLAG_IDLE); usart_interrupt_flag_clear(USART0, USART_INT_FLAG_IDLE);
Command_Write(readBuffer, rx_index);// 处理指令 process_command(rx_buffer, rx_index); // 处理指令
rx_index = 0; // 重置缓冲区索引 rx_index = 0; // 重置缓冲区索引
return; return;

View File

@@ -276,20 +276,3 @@ uint32_t ldc1612_parse_raw_result(uint32_t raw_result) {
return raw_result; 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);
}

View File

@@ -28,5 +28,5 @@ void led_config(void) {
timer_enable(LED_BLINK_TIMER); timer_enable(LED_BLINK_TIMER);
nvic_irq_enable(LED_BLINK_IRQ, 3U); nvic_irq_enable(LED_BLINK_IRQ, 2);
} }

View File

@@ -6,10 +6,6 @@
*/ */
#include "main.h" #include "main.h"
bool g_statusSwitch = false;
uint8_t readBuffer[16];
/*! /*!
\brief main function \brief main function
\param[in] none \param[in] none
@@ -42,23 +38,9 @@ int main(void) {
/* Initialize watchdog */ /* Initialize watchdog */
watchdog_init(); watchdog_init();
uint8_t command[10];
uint8_t command_length = 0;
while (1) { while (1) {
delay_ms(99);
// delay_ms(10);
fwdgt_counter_reload(); fwdgt_counter_reload();
command_length = Command_GetCommand(command);
if (command_length != 0)
{
for (int i = 0; i < command_length; i++)
{
printf("%c", command[i]);
}
}
// if (g_statusSwitch)
// {eddy_current_value_report();}
} }
} }

View File

@@ -7,46 +7,7 @@
uint8_t package_header[3] = {0xB5, 0xF0, 0x04}; uint8_t package_header[3] = {0xB5, 0xF0, 0x04};
uint8_t package_data[4] = {0}; uint8_t package_data[4] = {0};
extern bool g_statusSwitch;
void rs485_config(void) { void rs485_config(void) {
#ifndef RS485_MAX13487
rcu_periph_clock_enable(RS485_GPIO_RCU);
rcu_periph_clock_enable(RS485_RCU);
gpio_af_set(RS485_GPIO_PORT, GPIO_AF_1, RS485_TX_PIN | RS485_RX_PIN | RS485_EN_PIN);
/* configure USART Tx&Rx as alternate function push-pull */
gpio_mode_set(RS485_GPIO_PORT, GPIO_MODE_AF, GPIO_PUPD_PULLUP, RS485_TX_PIN | RS485_RX_PIN);
gpio_output_options_set(RS485_GPIO_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_10MHZ, RS485_TX_PIN | RS485_RX_PIN);
/* configure RS485 EN Pin */
gpio_mode_set(RS485_GPIO_PORT, GPIO_MODE_AF, GPIO_PUPD_NONE, RS485_EN_PIN);
gpio_output_options_set(RS485_GPIO_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, RS485_EN_PIN);
// gpio_bit_write(RS485_GPIO_PORT, RS485_EN_PIN, SET);
/* USART configure */
usart_deinit(RS485_PHY);
usart_baudrate_set(RS485_PHY, RS485_BAUDRATE);
// usart_parity_config(RS485_PHY, USART_PM_NONE);
// usart_word_length_set(RS485_PHY, USART_WL_8BIT);
// usart_stop_bit_set(RS485_PHY, USART_STB_1BIT);
usart_receive_config(RS485_PHY, USART_RECEIVE_ENABLE);
usart_transmit_config(RS485_PHY, USART_TRANSMIT_ENABLE);
usart_driver_assertime_config(RS485_PHY, 0x01);
usart_driver_deassertime_config(RS485_PHY, 0x01);
// usart_depolarity_config(USART0, USART_DEP_HIGH);
// usart_depolarity_config(USART0, USART_DEP_LOW);
usart_rs485_driver_enable(RS485_PHY);
usart_enable(RS485_PHY);
nvic_irq_enable(USART0_IRQn, 0);
usart_interrupt_enable(RS485_PHY, USART_INT_RBNE);
usart_interrupt_enable(RS485_PHY, USART_INT_IDLE);
#else
rcu_periph_clock_enable(RS485_GPIO_RCU); rcu_periph_clock_enable(RS485_GPIO_RCU);
rcu_periph_clock_enable(RS485_RCU); rcu_periph_clock_enable(RS485_RCU);
@@ -72,7 +33,6 @@ void rs485_config(void) {
nvic_irq_enable(USART0_IRQn, 0); nvic_irq_enable(USART0_IRQn, 0);
usart_interrupt_enable(RS485_PHY, USART_INT_RBNE); usart_interrupt_enable(RS485_PHY, USART_INT_RBNE);
usart_interrupt_enable(RS485_PHY, USART_INT_IDLE); usart_interrupt_enable(RS485_PHY, USART_INT_IDLE);
#endif
} }
void process_command(uint8_t *cmd, size_t length) { void process_command(uint8_t *cmd, size_t length) {
@@ -89,11 +49,13 @@ void process_command(uint8_t *cmd, size_t length) {
// printf("%d", length); // printf("%d", length);
sprintf(combined_str, "%c%c", cmd[3], cmd[4]); sprintf(combined_str, "%c%c", cmd[3], cmd[4]);
if (strcmp(combined_str, "M1") == 0) { if (strcmp(combined_str, "M1") == 0) {
g_statusSwitch = true; eddy_current_value_report();
} else if (strcmp(combined_str, "M2") == 0) { } else if (strcmp(combined_str, "M2") == 0)
g_statusSwitch = false; {
} else if (strcmp(combined_str, "M3") == 0) { tempture_value_report();
printf("%c%c%c%c%c%c", 0xB5, 0xF0, 0x02, 0x6F, 0x6B, 0xCC); } else if (strcmp(combined_str, "M3") == 0)
{
printf("%c%c%c%c%c%c", 0xB5, 0xF1, 0x02, 0x6F, 0x6B, 0xCC);
fwdgt_reset_mcu(); fwdgt_reset_mcu();
} else { } else {
printf("%c%c%c%c%c%c%c", 0xB5, 0xF0, 0x03, 0x65, 0x72, 0x72, 0x3C); printf("%c%c%c%c%c%c%c", 0xB5, 0xF0, 0x03, 0x65, 0x72, 0x72, 0x3C);
@@ -169,7 +131,6 @@ void eddy_current_value_report(void) {
package_data[2] = (eddy_current_value_uint32 >> 8) & 0xFF; package_data[2] = (eddy_current_value_uint32 >> 8) & 0xFF;
package_data[3] = eddy_current_value_uint32 & 0xFF; package_data[3] = eddy_current_value_uint32 & 0xFF;
#ifdef DEBUG_VOFA_TOOL #ifdef DEBUG_VOFA_TOOL
printf("%d\n", eddy_current_value_uint32); printf("%d\n", eddy_current_value_uint32);
#else #else