diff --git a/CMakeLists.txt b/CMakeLists.txt index 1d0e927..96d9a6c 100644 --- a/CMakeLists.txt +++ b/CMakeLists.txt @@ -4,11 +4,11 @@ include(cmake/toolchain.cmake) project(xlsw_3dp_LDC1612) set(VERSION_MAJOR 0) -set(VERSION_MINOR 2) -set(VERSION_PATCH 0) +set(VERSION_MINOR F) +set(VERSION_PATCH 1) set(VERSION "V${VERSION_MAJOR}.${VERSION_MINOR}.${VERSION_PATCH}") string(TIMESTAMP CURRENT_DATE "%Y-%m-%d") -set(IIC_TYPE "SW-IIC") +set(IIC_TYPE "AutoDetectDriveCurrent") #set(IIC_TYPE "HW-IIC") enable_language(C) diff --git a/inc/board_config.h b/inc/board_config.h index b265b3f..091364b 100644 --- a/inc/board_config.h +++ b/inc/board_config.h @@ -11,6 +11,8 @@ #define RS485_MAX13487 +#define DEBUG_VOFA_TOOL + /******************************************************************************/ #define RCU_GPIO_I2C RCU_GPIOF diff --git a/inc/ldc1612.h b/inc/ldc1612.h index f11cae6..ec0228e 100644 --- a/inc/ldc1612.h +++ b/inc/ldc1612.h @@ -51,6 +51,7 @@ #define LDC1612_DRIVE_CURRENT 0x9000 //A000 #define LDC1612_MUX_CONFIG 0x020C // no auto scan and filter bandwidth 3.3MHz #define LDC1612_SENSOR_CONFIG 0x1601 +#define LDC1612_SLEEP_MODE 0x2801 #define LDC1612_ERROR_CONFIG 0x0000 #define LC_STABILIZE_TIME_CH0 0x001E //30 #define LDC1612_RESET_DEV 0x8000 //[15:0] 0b1000 0000 0000 0000 @@ -94,4 +95,6 @@ uint32_t ldc1612_get_raw_channel_result(uint8_t channel); uint32_t ldc1612_parse_raw_result(uint32_t raw_result); +void ldc1612_drvie_current_detect(uint8_t channel); + #endif //LDC1612_H diff --git a/src/ldc1612.c b/src/ldc1612.c index 8580255..3c9cb06 100644 --- a/src/ldc1612.c +++ b/src/ldc1612.c @@ -276,3 +276,20 @@ uint32_t ldc1612_parse_raw_result(uint32_t 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); +} \ No newline at end of file diff --git a/src/main.c b/src/main.c index 85babea..2529da2 100644 --- a/src/main.c +++ b/src/main.c @@ -36,11 +36,14 @@ int main(void) { ldc1612_single_ch0_config(); /* Initialize watchdog */ - watchdog_init(); + // watchdog_init(); while (1) { - delay_ms(99); - fwdgt_counter_reload(); + + // delay_ms(10); + ldc1612_drvie_current_detect(CHANNEL_0); + delay_ms(999); + // fwdgt_counter_reload(); } } diff --git a/src/rs485.c b/src/rs485.c index 97f0ee7..025fce1 100644 --- a/src/rs485.c +++ b/src/rs485.c @@ -146,6 +146,15 @@ void eddy_current_value_report(void) { package_data[2] = (eddy_current_value_uint32 >> 8) & 0xFF; package_data[3] = eddy_current_value_uint32 & 0xFF; + +#ifdef DEBUG_VOFA_TOOL + printf("%d\n", eddy_current_value_uint32); +#else + package_data[0] = (eddy_current_value_uint32 >> 24) & 0xFF; + package_data[1] = (eddy_current_value_uint32 >> 16) & 0xFF; + package_data[2] = (eddy_current_value_uint32 >> 8) & 0xFF; + package_data[3] = eddy_current_value_uint32 & 0xFF; + uint8_t combined_data[7]; memcpy(combined_data, package_header, 3); memcpy(combined_data + 3, package_data, 4); @@ -153,6 +162,7 @@ void eddy_current_value_report(void) { printf("%c%c%c", package_header[0], package_header[1], package_header[2]); printf("%c%c%c%c", package_data[0], package_data[1], package_data[2], package_data[3]); printf("%c", calculate_crc(combined_data, 8)); +#endif } void tempture_value_report(void) {