| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495 |
- /*
- * 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"
- #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 /*光控*/
- #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;
- /*串口初始化*/
- 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);
- 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;
- }
- LOG_I("光控计数:%d-%d",checklightnum,checknightnum);
- rt_thread_mdelay(5000);
- }
- }
- static void Power_ReadCheck(void *parameter)
- {
- int rain_cnt = 0;
- int RV;
- while(1)
- {
- #if ROBOT_EN == 0
- sprintf(device_status.power,"%.2f",Read_Real_Current()/100.0*2.5);
- #endif
- if (Read_Real_Voltage()/100<12) {
- //关闭外设
- ctr_photo(OFF); //关闭相机供电
- ctr_led(OFF); //关闭补光灯
- ctr_Heat(OFF); //关闭加热
- ctr_Cold(OFF); //关闭制冷
- #if Color_EN == 0
- ctr_cangmen_down(OFF); //关闭下仓门输出(转盘)
- ctr_cangmen_up(OFF); //关闭上仓门输出(散热)
- #endif
- }
- if(Read_Real_Voltage()/100<21)
- {
- #if ROBOT_EN == 1
- ctr_led(OFF);
- HMI_WRITE("sleep=%d",1);
- #endif
- device_status.bat_status = 1; //欠压
- }
- else {
- device_status.bat_status = 0; //解除欠压
- //ctr_router(ON); //打开路由器供电
- ctr_photo(ON); //打开相机供电
- #if ROBOT_EN == 1
- ctr_led(ON); //打开补光灯
- ctr_lamp(ON, 1); //打开镇流器输出,用于24V转12V给相机供电
- ctr_router(ON);
- HMI_WRITE("sleep=%d",0);
- #endif
- }
- //
- if(device_status.dtype==7)
- {
- //箱体温度
- RV = 10000 * (4096 - Read_Rain_Voltage()) / Read_Rain_Voltage();
- if(TempCalculate(RV, 3950, 10000)-TempCalculate(RV, 3950, 10000)>10)
- {
- LOG_E("temp value err!!!!");
- }
- else
- {
- device_status.box_temp = TempCalculate(RV, 3950, 10000);
- if(device_status.box_temp>160)
- {
- device_status.box_temp = 25;
- }
- }
- //培养仓温度
- RV = 10000 * (4096 - Read_Light_Voltage()) / Read_Light_Voltage();
- if(TempCalculate(RV, 3950, 10000)-TempCalculate(RV, 3950, 10000)>10)
- {
- LOG_E("temp value err!!!!");
- }
- else
- {
- device_status.pre_temp = TempCalculate(RV, 3950, 10000);
- if(device_status.pre_temp>160)
- {
- device_status.pre_temp = 25;
- }
- }
- }
- else {
- 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;
- }
- }
- //雨控
- if(Read_Rain_Voltage()>100)
- {
- device_status.rain_status = 1;
- ctr_lamp(OFF,1);
- ctr_lamp(OFF,2);
- ctr_lamp(OFF,3);
- rain_cnt = 0;
- }
- else {
- rain_cnt++;
- //雨控消抖,1分钟
- LOG_D("rain_cnt:%d-value:%d",rain_cnt,Read_Rain_Voltage());
- if(rain_cnt==60&&Read_Rain_Voltage()<100)
- {
- rain_cnt = 0;
- device_status.rain_status = 0;
- }
- }
- }
- #if ROBOT_EN == 0
- rt_sprintf(device_status.voltage,"%d.%02d",filter_voltage()/100,filter_voltage()%100);
- //LOG_D("voltage is:%sV",device_status.voltage);
- sprintf(device_status.fuse_voltage, "%d.%02d",Read_Fuse_Voltage()/100,Read_Fuse_Voltage()%100);
- #endif
- rt_thread_mdelay(10);
- }
- }
- /*读取电流值*/
- 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 (int)((ADC_VOL_BASE * (adc1_value*1.0)/(in_adc_17*1.0))*100000);
- }
- /*读取电压值*/
- 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);
- /* 关闭通道 */
- 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);
- //rt_kprintf("read rain value:%d\n",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, 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);
|