| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679 |
- /*
- * Copyright (c) 2006-2020, RT-Thread Development Team
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date Author Notes
- * 2020-05-23 Administrator the first version
- */
- #include <rtthread.h>
- #include <board.h>
- #include <sht3x.h>
- #include "sht30_collect.h"
- #include <string.h>
- #include <stdio.h>
- #include "control.h"
- #include "hmi.h"
- #include "math.h"
- #include "test.h"
- #define DBG_ENABLE
- #define DBG_COLOR
- #define DBG_TAG "control"
- #define DBG_LEVEL DBG_LOG
- #include <rtdbg.h> //must after of DBG_LVL, DBG_TAG or other options
- // 温湿度
- #define THREAD_PRIORITY 21 // 线程优先级
- #define THREAD_STACK_SIZE 1024 // 栈大小
- #define THREAD_TIMESLICE 5 // 时间片
- // 电压,电流
- #define P_THREAD_PRIORITY 13 // 线程优先级
- #define P_THREAD_STACK_SIZE 1024 // 栈大小
- #define P_THREAD_TIMESCLICE 5 // 时间片
- // ADC
- #define ADC_DEV_NAME "adc1" /*ADC设备名称*/
- #define ADC_DEV_CHANNLE_0 0 /*ADC通道*/ // 电压
- #define ADC_DEV_CHANNLE_1 1 /*ADC通道*/ // 电流
- #define ADC_DEV_CHANNLE_2 10 /*光控*/
- #define ADC_DEV_CHANNLE_3 11 /*雨控*/ // 现在只有一个adc 给雨控用吧 小虫体可以用光照度传感器
- #define ADC_DEV_CHANNLE_4 12 /*加热仓温度*/
- #define ADC_DEV_CHANNLE_5 13 /*保险丝之后的电压*/
- #define ADC_DEV_CHANNLE_6 16 /*内部温度传感器*/
- #define REFER_VOLTAGE 330 /* 参考电压 3.3V,数据精度乘以100保留2位小数*/
- #define CONVERT_BITS (1 << 12) /* 转换位数为12位 */
- Device_Status_typedef device_status;
- rt_device_t serial_485; /*串口设备句柄*/
- struct serial_configure uart_config_485 = RT_SERIAL_CONFIG_DEFAULT; /*初始化配置参数*/
- rt_uint32_t adc0_value, adc1_value, in_adc_17, adc13_value, adc16_value;
- rt_uint32_t adc10_rain, adc11_light, adc12_ntc;
- int8_t hum_value, tem_value;
- static rt_thread_t tid1 = RT_NULL;
- static rt_thread_t tid2 = RT_NULL;
- ADC_HandleTypeDef hadc1;
- int32_t Read_Filtered_Current(void);
- /*串口初始化*/
- int UART_485_INIT(void)
- {
- serial_485 = rt_device_find(UART_485);
- /*修改串口配置参数*/
- uart_config_485.baud_rate = BAUD_RATE_9600; // 修改波特率9600
- uart_config_485.data_bits = DATA_BITS_8; // 数据位8
- uart_config_485.stop_bits = STOP_BITS_1; // 停止位1
- uart_config_485.bufsz = 512; // 缓冲区1k
- uart_config_485.parity = PARITY_NONE; // 奇校验
- /* step3:控制串口设备。通过控制接口传入命令控制字,与控制参数 */
- rt_device_control(serial_485, RT_DEVICE_CTRL_CONFIG, &uart_config_485);
- /* step4:打开串口设备。以DMA接收及轮询发送模式打开串口设备 */
- rt_device_open(serial_485, RT_DEVICE_FLAG_INT_RX);
- return 0;
- }
- /* 入口函数 */
- static void sht30_collect_thread_entry(void *parameter)
- {
- sht3x_device_t sht3x_device;
- static int checklightnum = 0;
- static int checknightnum = 0;
- sht3x_device = sht3x_init("i2c1", 0x44);
- // 此处需要短暂的延时,否则会出现连续读取失败的问题
- rt_thread_mdelay(150);
- uint16_t log_en_inr = 30; // 打印log的速度 数值越小 打印越频繁
- static int16_t log_en_cnt = -1;
- while (1)
- {
- if (sht3x_device)
- {
- if (RT_EOK == sht3x_read_singleshot(sht3x_device))
- {
- hum_value = sht3x_device->humidity;
- tem_value = sht3x_device->temperature;
- if (hum_value != 0)
- {
- rt_sprintf(device_status.humidity, "%d.%d", (int)sht3x_device->humidity, (uint)(sht3x_device->humidity * 10) % 10);
- rt_sprintf(device_status.tempture, "%d.%d", (int)sht3x_device->temperature, (uint)(sht3x_device->temperature * 10) % 10);
- }
- else
- {
- rt_kprintf("sht3x_read_singleshot eRR:%d", hum_value);
- }
- }
- else
- {
- sht3x_softreset(sht3x_device);
- }
- //// rt_kprintf("sht30 humidity : %d.%d ", (int)sht3x_device->humidity, (int)(sht3x_device->humidity * 10) % 10);
- //// rt_kprintf("temperature: %d.%d\n", (int)sht3x_device->temperature, (int)(sht3x_device->temperature * 10) % 10);
- }
- else
- {
- rt_kprintf("read sht3x fail.\r\n");
- // 重新初始化
- sht3x_deinit(sht3x_device);
- sht3x_device = sht3x_init("i2c1", 0x44);
- rt_thread_mdelay(150);
- }
- if (Read_Light_Voltage() > 500)
- {
- checklightnum++;
- if (checklightnum == 20)
- {
- device_status.sun_status = 1;
- checklightnum = 0;
- }
- }
- else
- {
- checknightnum++;
- if (checknightnum == 20)
- {
- device_status.sun_status = 0;
- checknightnum = 0;
- }
- }
- // 温控
- // if (atoi(device_status.tempture) >= device_status.tph || atoi(device_status.tempture) <= device_status.tpl)
- // {
- // device_status.temp_status = 1;
- // }
- // else if (atoi(device_status.tempture) >= (device_status.tpl + 5) && atoi(device_status.tempture) <= (device_status.tph - 10))
- // {
- // device_status.temp_status = 0;
- // }
- if (chk_log_time)
- {
- LOG_I("光控计数:%d-%d", checklightnum, checknightnum);
- }
- rt_thread_mdelay(5000);
- }
- }
- /**
- * @brief 250411 适配新的电流采集芯片
- *
- */
- // 定义滑动平均滤波器结构体
- typedef struct
- {
- rt_uint16_t *buffer;
- int bufferSize;
- int currentIndex;
- rt_uint16_t sum;
- } MovingAverageFilter;
- // 初始化滑动平均滤波器
- MovingAverageFilter *moving_average_filter_init(int size)
- {
- MovingAverageFilter *filter = (MovingAverageFilter *)malloc(sizeof(MovingAverageFilter));
- if (filter == NULL)
- {
- return NULL;
- }
- filter->buffer = (rt_uint16_t *)calloc(size, sizeof(rt_uint16_t));
- if (filter->buffer == NULL)
- {
- free(filter);
- return NULL;
- }
- filter->bufferSize = size;
- filter->currentIndex = 0;
- filter->sum = 0.0;
- return filter;
- }
- // 更新滑动平均滤波器
- rt_uint16_t moving_average_filter_update(MovingAverageFilter *filter, rt_uint16_t newValue)
- {
- filter->sum -= filter->buffer[filter->currentIndex];
- filter->buffer[filter->currentIndex] = newValue;
- filter->sum += newValue;
- filter->currentIndex = (filter->currentIndex + 1) % filter->bufferSize;
- return filter->sum / filter->bufferSize;
- }
- // 释放滑动平均滤波器资源
- void moving_average_filter_free(MovingAverageFilter *filter)
- {
- if (filter != NULL)
- {
- free(filter->buffer);
- free(filter);
- }
- }
- /**
- * @brief 电流读取
- *
- * @param parameter
- */
- static void Power_ReadCheck(void *parameter)
- {
- int rain_cnt = 0;
- //int bat_cnt = 0;
- int RV;
- //MovingAverageFilter *filter = moving_average_filter_init(10);
- // MovingAverageFilter* filter_hi = moving_average_filter_init(10);
- MovingAverageFilter *filter_v = moving_average_filter_init(10);
- rt_thread_mdelay(1000);
- while (1)
- {
- //rt_kprintf("Read_Filtered_Current() > %d \n", Read_Filtered_Current());
- // #if PCB_V1 == 0
- // rt_uint16_t _24v_current_int = moving_average_filter_update(filter, Read_Real_Current());
- // if (_24v_current_int - 2430 > 0)
- // {
- // sprintf(device_status.power, "%.2f", (float)(_24v_current_int - 2430) / 0.4);
- // }
- // else
- // {
- // sprintf(device_status.power, "0.0");
- // }
- // #else
- // rt_uint16_t _24v_current_int = moving_average_filter_update(filter,Read_Real_Current());
- // sprintf(device_status.power,"%.2f",(float)_24v_current_int/10);
- sprintf(device_status.power, "%d", Read_Filtered_Current());
- // #endif
- //LOG_I("负载电流:%s", device_status.power);
- if ((Read_Real_Voltage() / 10) < 105) // 设备状态低于10.5 欠压保护 此处需要在屏幕明显位置进行提示
- {
- // 关闭外设
- // ctr_photo(OFF); // 关闭相机供电
- rt_kprintf("detact low volage %d.%d\n", Read_Real_Voltage() / 100, Read_Real_Voltage() % 100);
- // ctr_led(OFF); // 关闭补光灯
- device_status.bat_status = 0;
- }
- else
- {
- //rt_kprintf("Read_Real_Voltage() / 10 < 105 >>> %d \n" , Read_Real_Voltage() / 10);
- device_status.bat_status = 1;
- }
- RV = 10000 * (4096 - Read_Ntc_Voltage()) / Read_Ntc_Voltage();
- if (TempCalculate(RV, 3950, 10000) - TempCalculate(RV, 3950, 10000) > 10)
- {
- LOG_E("temp value err!!!!");
- }
- else
- {
- device_status.heattem = TempCalculate(RV, 3950, 10000);
- if (device_status.heattem > 160)
- {
- device_status.heattem = 25;
- }
- }
- // rt_kprintf("Read_Rain_Voltage > %d\n" , Read_Rain_Voltage());
- // 雨控
- if (Read_Rain_Voltage() > 250)
- {
- device_status.C01 |= (1 << 5);
- device_status.rain_update = 1;
- ctr_lamp(OFF, 1);
- ctr_lamp(OFF, 2);
- ctr_lamp(OFF, 3);
- rain_cnt = 0;
- LOG_W("雨控状态触发\n");
- }
- // else if (device_status.rain_status)
- // {
- // rain_cnt++;
- // if(Read_Rain_Voltage() < 250)
- // {
- // rain_cnt++;
- // if(rain_cnt >= 10 * 4)
- // {
- // device_status.rain_status = 0;
- // LOG_I("雨控状态恢复\n");
- // rain_cnt = 0;
- // }
- // }
- // else
- // {
- // rain_cnt = 0;
- // }
- // }
- // rt_sprintf(device_status.voltage,"%d.%02d",filter_voltage()/100,filter_voltage()%100);
- rt_uint16_t in_voltage_int = moving_average_filter_update(filter_v, Read_Real_Voltage());
- sprintf(device_status.voltage, "%d.%02d", in_voltage_int / 100, in_voltage_int % 100);
- // LOG_D("voltage is:%sV",device_status.voltage);
- sprintf(device_status.fuse_voltage, "%d.%02d", Read_Fuse_Voltage() / 100, Read_Fuse_Voltage() % 100);
- rt_thread_mdelay(10);
- }
- }
- /**
- * @brief 250411 适配新的电流采集芯片
- *
- */
- /**
- *
- * @return 250411 修改电流采集函数 过去的太为杂乱
- *
- *
- */
- // ADC参数
- #define ADC_MAX 4095u // 12位ADC最大值
- #define VREF_ADC_MV 3300 // ADC参考电压(单位:mV)
- #define DIVIDER_RATIO_NUM 2 // 分压比分子
- #define DIVIDER_RATIO_DEN 3 // 分压比分母
- // 传感器参数
- #define V_SUPPLY_MV 5100 // 传感器供电电压(单位:mV)// 先不要动这个
- #define V_OFFSET_MV (V_SUPPLY_MV / 2) // 零点电压(2755mV)
- #define SENSITIVITY_MA 100 // 灵敏度(0.1V/A → 100mV/A)
- //#define SENSITIVITY_MA 400 // 灵敏度(0.4V/A → 400mV/A,对应±5A) 若修改为5A芯片 用这个
- // 低通滤波参数(α=0.2,整数运算实现)
- #define FILTER_ALPHA 1 // α分子(α = 1/5 = 0.2)
- #define FILTER_BETA 4 // β分母(β = 1 - α = 4/5)
- // 250603 新
- // 硬件参数定义
- #define VCC 5000 // 电源电压5V (使用mV单位)
- #define ADC_REF 3300 // STM32 ADC参考电压3.3V (mV)
- #define ADC_RES 4095 // 12位ADC分辨率
- // 分压电阻参数 (放大1000倍避免浮点)
- #define R1 10000 // 10K上拉电阻
- #define R2 20000 // 20K下拉电阻
- #define RATIO_NUM (R1 + R2) // 分子
- #define RATIO_DEN R2 // 分母
- // 芯片选择(取消注释切换量程)
- #define CC6900_5A
- // #define CC6900_10A
- #ifdef CC6900_5A
- #define SENSITIVITY 400 // 5A芯片灵敏度(mV/A)
- #define CURRENT_RANGE 5000 // 5A量程(mA)
- #else
- #define SENSITIVITY 200 // 10A芯片灵敏度(mV/A)
- #define CURRENT_RANGE 10000 // 10A量程(mA)
- #endif
- // 精度放大因子 (Q10格式,放大1024倍)
- #define SCALE_FACTOR 1024
- /**
- * @brief 将ADC值转换为电流值(mA) - 定点数版本
- * @param adcValue ADC读取的原始值(0-4095)
- * @return 电流值(mA),正值表示正向电流,负值表示反向电流
- */
- int32_t ADC_to_Current_FixedPoint(uint16_t adcValue)
- {
- // rt_kprintf("adc >>> %d \n" , adcValue);
- // 1. 计算ADC电压 (mV) = adcValue * ADC_REF / ADC_RES
- uint32_t adcVoltage = ((uint32_t)adcValue * ADC_REF) / ADC_RES;
- // 2. 计算VOUT实际电压 (mV) = adcVoltage * (R1+R2)/R2
- uint32_t vout = (adcVoltage * RATIO_NUM) / RATIO_DEN;
- // 3. 计算相对于VCC/2的电压差 (mV)
- int32_t voltageDiff = (int32_t)vout - (VCC / 2);
- // 4. 计算电流 (mA) = (voltageDiff * 1000) / SENSITIVITY
- // 使用SCALE_FACTOR保持精度,最后再除回去
- int32_t current = (voltageDiff * 1000 * SCALE_FACTOR) / SENSITIVITY;
- // 5. 移除缩放因子并返回
- return current / SCALE_FACTOR;
- }
- // 250603 新
- /**
- * @brief 读取并滤波后的电流值(单位:mA,整数)
- * @return int32_t 滤波后的电流值
- */
- int32_t Read_Filtered_Current(void)
- {
- static int32_t filtered_current = 0; // 静态变量保存滤波结果
- // 1. 读取原始电流值
- int32_t raw_current = ADC_to_Current_FixedPoint(Read_Real_Current());
- // rt_kprintf("raw_current >>> %d \n" , raw_current);
- // 2. 一阶低通滤波(整数运算)
- // 公式:filtered = (α * raw + β * filtered_prev) / (α + β)
- filtered_current = (FILTER_ALPHA * raw_current + FILTER_BETA * filtered_current) /
- (FILTER_ALPHA + FILTER_BETA);
- filtered_current = abs(filtered_current);
- return filtered_current;
- }
- /*读取电流值*/
- int Read_Real_Current(void)
- {
- rt_adc_device_t adc_dev; /*ADC设备句柄*/
- adc_dev = (rt_adc_device_t)rt_device_find(ADC_DEV_NAME);
- if (adc_dev == RT_NULL)
- {
- LOG_E("adc sample run failed! can't find %s device!", ADC_DEV_NAME);
- return RT_ERROR; // adc 采样值不可能为负值,返回负值表示出错
- }
- HAL_ADCEx_Calibration_Start(adc_dev->parent.user_data);
- rt_adc_enable(adc_dev, ADC_DEV_CHANNLE_1);
- // rt_adc_enable(adc_dev, 17);
- adc1_value = filter_Mid(rt_adc_read(adc_dev, ADC_DEV_CHANNLE_1));
- in_adc_17 = filter_Mid(rt_adc_read(adc_dev, 17));
- /* 关闭通道 */
- rt_adc_disable(adc_dev, ADC_DEV_CHANNLE_1);
- // rt_adc_disable(adc_dev, 17);
- // rt_kprintf("read in adc:ADC17:%d-ADC1:%d\n",in_adc_17,adc1_value);
- return adc1_value;
- }
- /**
- *
- * @return 250411 修改电流采集函数 过去的太为杂乱
- *
- *
- */
- /*
- * https://blog.csdn.net/loop222/article/details/120497425
- 采样电阻0.01 Ω
- 运放为INA240A2,放大倍数50
- 背面需分别短接A0/A2至输出
- C1_OUT=INA_VCC/2 + 0.01 * I * 50
- 如果INA_VCC=3.3V,C1_OUT=1.65 + 0.01 * I * 50,电流范围(-3.3A,3.3A)
- 如果INA_VCC=5.0V,C1_OUT=2.50 + 0.01 * I * 50,电流范围(-5A,5A)
- B相采样输入在PCB上为走线方便做了反向输入,所以放大倍数需乘以 -1(移植后的代码已经做了处理)
- */
- /*读取电压值*/
- int Read_Real_Voltage(void)
- {
- rt_adc_device_t adc_dev; /*ADC设备句柄*/
- adc_dev = (rt_adc_device_t)rt_device_find(ADC_DEV_NAME);
- if (adc_dev == RT_NULL)
- {
- rt_kprintf("adc sample run failed! can't find %s device!\n", ADC_DEV_NAME);
- return RT_ERROR; // adc 采样值不可能为负值,返回负值表示出错
- }
- HAL_ADCEx_Calibration_Start(adc_dev->parent.user_data);
- rt_adc_enable(adc_dev, ADC_DEV_CHANNLE_0);
- // adc0_value = rt_adc_read(adc_dev, ADC_DEV_CHANNLE_0);
- adc0_value = filter_Mid(rt_adc_read(adc_dev, ADC_DEV_CHANNLE_0));
- /* 关闭通道 */
- rt_adc_disable(adc_dev, ADC_DEV_CHANNLE_0);
- return (adc0_value * REFER_VOLTAGE / CONVERT_BITS * 12 + 20);
- }
- /*读取保险丝的电压值*/
- int Read_Fuse_Voltage(void)
- {
- rt_adc_device_t adc_dev; /*ADC设备句柄*/
- adc_dev = (rt_adc_device_t)rt_device_find(ADC_DEV_NAME);
- if (adc_dev == RT_NULL)
- {
- rt_kprintf("adc sample run failed! can't find %s device!\n", ADC_DEV_NAME);
- return RT_ERROR; // adc 采样值不可能为负值,返回负值表示出错
- }
- HAL_ADCEx_Calibration_Start(adc_dev->parent.user_data);
- rt_adc_enable(adc_dev, ADC_DEV_CHANNLE_5);
- adc13_value = rt_adc_read(adc_dev, ADC_DEV_CHANNLE_5);
- /* 关闭通道 */
- rt_adc_disable(adc_dev, ADC_DEV_CHANNLE_5);
- return (adc13_value * REFER_VOLTAGE / CONVERT_BITS * 12 + 8);
- }
- /*读取雨控*/
- int Read_Rain_Voltage(void)
- {
- rt_adc_device_t adc_dev; /*ADC设备句柄*/
- adc_dev = (rt_adc_device_t)rt_device_find(ADC_DEV_NAME);
- if (adc_dev == RT_NULL)
- {
- rt_kprintf("adc sample run failed! can't find %s device!\n", ADC_DEV_NAME);
- return RT_ERROR; // adc 采样值不可能为负值,返回负值表示出错
- }
- rt_adc_enable(adc_dev, ADC_DEV_CHANNLE_3);
- adc11_light = rt_adc_read(adc_dev, ADC_DEV_CHANNLE_3);
- rt_adc_disable(adc_dev, ADC_DEV_CHANNLE_3);
- HAL_ADCEx_Calibration_Start(adc_dev->parent.user_data);
- // LOG_D("read rain value:%d",adc11_light);
- return adc11_light;
- // rt_pin_mode(RAIN_PIN,PIN_MODE_INPUT);
- // return rt_pin_read(RAIN_PIN);
- }
- /*读取光控*/
- int Read_Light_Voltage(void)
- {
- rt_adc_device_t adc_dev; /*ADC设备句柄*/
- adc_dev = (rt_adc_device_t)rt_device_find(ADC_DEV_NAME);
- if (adc_dev == RT_NULL)
- {
- rt_kprintf("adc sample run failed! can't find %s device!\n", ADC_DEV_NAME);
- return RT_ERROR; // adc 采样值不可能为负值,返回负值表示出错
- }
- rt_adc_enable(adc_dev, ADC_DEV_CHANNLE_2);
- adc10_rain = rt_adc_read(adc_dev, ADC_DEV_CHANNLE_2);
- rt_adc_disable(adc_dev, ADC_DEV_CHANNLE_2);
- HAL_ADCEx_Calibration_Start(adc_dev->parent.user_data);
- // rt_kprintf("read light value:%d\n",adc10_rain);
- return adc10_rain;
- }
- // 获取内部温度传感器值
- short Get_Temprate(void)
- {
- short result;
- double temperate;
- rt_adc_device_t adc_dev; /*ADC设备句柄*/
- adc_dev = (rt_adc_device_t)rt_device_find(ADC_DEV_NAME);
- if (adc_dev == RT_NULL)
- {
- rt_kprintf("adc sample run failed! can't find %s device!\n", ADC_DEV_NAME);
- return RT_ERROR; // adc 采样值不可能为负值,返回负值表示出错
- }
- HAL_ADCEx_Calibration_Start(adc_dev->parent.user_data);
- rt_adc_enable(adc_dev, ADC_DEV_CHANNLE_6);
- adc16_value = rt_adc_read(adc_dev, ADC_DEV_CHANNLE_6);
- /* 关闭通道 */
- rt_adc_disable(adc_dev, ADC_DEV_CHANNLE_6);
- temperate = (float)adc16_value * (3.3 / 4096); // 电压值
- temperate = (1.43 - temperate) / 0.0043 + 25; // 转换为温度值
- result = temperate *= 100; // 扩大100倍.
- return result;
- }
- /**
- * Rv: 热敏电阻当前阻值
- * B: 热敏电阻参数B值
- * Revise: 校正温度
- * BasicRx: 热敏电阻25度时电阻(标称电阻数值)
- * 返回: 摄氏度
- */
- int TempCalculate(float Rv, int B, int BasicRx)
- {
- float Rx;
- Rx = Rv * 1.0 / BasicRx;
- Rx = log(Rx);
- Rx = Rx / B;
- Rx = 1 / (Rx + 0.003354);
- // Rx = Rx + 0.003356;
- // Rx = 1 / Rx;
- Rx = Rx - 273.13;
- return (int)(Rx + 0.5);
- }
- /*
- * 中位值平均滤波法
- * */
- unsigned int filter_Mid(int adc_return)
- {
- unsigned char count, i, j;
- unsigned int value_buf[N], temp = 0;
- int sum = 0;
- for (count = 0; count < N; count++)
- {
- value_buf[count] = adc_return;
- // rt_kprintf("value_buf:%d-%d\n",value_buf[count],count);
- rt_thread_delay(10);
- }
- for (j = 0; j < N - 1; j++)
- {
- for (i = 0; i < N - j - 1; i++)
- {
- if (value_buf[i] > value_buf[i + 1])
- {
- temp = value_buf[i];
- value_buf[i] = value_buf[i + 1];
- value_buf[i + 1] = temp;
- }
- }
- }
- for (count = 1; count < N - 1; count++)
- {
- sum += value_buf[count];
- }
- return (int)(sum / (N - 2));
- }
- /*
- 限幅消抖滤波法
- A、方法:
- 相当于“限幅滤波法”+“消抖滤波法”
- 先限幅,后消抖
- B、优点:
- 继承了“限幅”和“消抖”的优点
- 改进了“消抖滤波法”中的某些缺陷,避免将干扰值导入系统
- C、缺点:
- 对于快速变化的参数不宜
- */
- unsigned int filter_voltage(void)
- {
- uint8_t data_cnt = 0;
- int value = 0, new_value = 0;
- new_value = Read_Real_Voltage();
- while (value != new_value)
- {
- data_cnt++;
- if (data_cnt >= N)
- return new_value;
- rt_thread_delay(10);
- new_value = Read_Real_Voltage();
- }
- return value;
- }
- /*读取加热仓温度*/
- int Read_Ntc_Voltage(void)
- {
- rt_adc_device_t adc_dev; /*ADC设备句柄*/
- adc_dev = (rt_adc_device_t)rt_device_find(ADC_DEV_NAME);
- if (adc_dev == RT_NULL)
- {
- rt_kprintf("adc sample run failed! can't find %s device!\n", ADC_DEV_NAME);
- return RT_ERROR; // adc 采样值不可能为负值,返回负值表示出错
- }
- rt_adc_enable(adc_dev, ADC_DEV_CHANNLE_4);
- adc12_ntc = filter_Mid(rt_adc_read(adc_dev, ADC_DEV_CHANNLE_4));
- // LOG_D("Read_Ntc_Voltage:%d",adc12_ntc);
- rt_adc_disable(adc_dev, ADC_DEV_CHANNLE_4);
- HAL_ADCEx_Calibration_Start(adc_dev->parent.user_data);
- return adc12_ntc;
- }
- /* 创建线程 */
- int sht30_collect(void)
- {
- /* 创建线程*/
- //tid1 = rt_thread_create("sht30_collect_thread", sht30_collect_thread_entry, RT_NULL, THREAD_STACK_SIZE, THREAD_PRIORITY, THREAD_TIMESLICE);
- tid2 = rt_thread_create("Power Check thread", Power_ReadCheck, RT_NULL, P_THREAD_STACK_SIZE + 512, P_THREAD_PRIORITY, P_THREAD_TIMESCLICE);
- /* 如果获得线程控制块,启动这个线程 */
- // if (tid1 != RT_NULL)
- // rt_thread_startup(tid1);
- if (tid2 != RT_NULL)
- rt_thread_startup(tid2);
- return 0;
- }
- // 控制台打印传感器信息
- void Msh_DisplaySensor(void)
- {
- rt_kprintf("温度:%d\n", tem_value);
- rt_kprintf("湿度:%d\n", hum_value);
- rt_kprintf("电压:%s\n", device_status.voltage);
- rt_kprintf("电流:%s\n", device_status.power);
- }
- MSH_CMD_EXPORT(Msh_DisplaySensor, Msh_DisplaySensor);
- MSH_CMD_EXPORT(Read_Rain_Voltage, Read_Rain_Voltage);
- MSH_CMD_EXPORT(Read_Light_Voltage, Read_Light_Voltage);
|