| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655 |
- #include <control.h>
- /*
- * Copyright (c) 2006-2020, RT-Thread Development Team
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date Author Notes
- * 2020-05-30 Administrator the first version
- */
- #include "beep.h"
- #include "hmi.h"
- #include "easyflash.h"
- #include "stdio.h"
- #include "sound.h"
- #define DBG_TAG "control.c"
- #define DBG_LVL LOG_LVL_INFO
- #include <ulog.h>
- #include "dtu_uart2.h"
- #include "sht30_collect.h"
- //工作检测
- #define WORK_CHECK_THREAD_PRIORITY 23 //线程优先级
- #define WORK_CHECK_THREAD_STACK_SIZE 1024 //栈大小
- #define WORK_CHECK_THREAD_TIMESLICE 5 //时间片
- //工作流程
- #define WORK_LOOP_THREAD_PRIORITY 12 //线程优先级
- #define WORK_LOOP_THREAD_STACK_SIZE 1024 //栈大小
- #define WORK_LOOP_THREAD_TIMESLICE 5 //时间片
- //设备状态表结构体
- Device_Status_typedef device_status;
- rt_thread_t tid_workloop = RT_NULL;
- rt_thread_t tid_wkstc = RT_NULL;
- /*光控*/
- uint8_t In_Light_status(void)
- {
- rt_pin_mode(LIGHT_PIN,PIN_MODE_INPUT);
- return rt_pin_read(LIGHT_PIN);
- }
- /*雨控*/
- uint8_t In_Rain_status(void)
- {
- rt_pin_mode(RAIN_PIN,PIN_MODE_INPUT);
- return rt_pin_read(RAIN_PIN);
- }
- /*加热*/
- uint8_t ctr_Heat(uint8_t status_heat)
- {
- device_status.heat_status = status_heat;
- rt_pin_mode(Heat_Pin, PIN_MODE_OUTPUT);
- rt_pin_write(Heat_Pin,status_heat);
- return status_heat;
- }
- /*制冷*/
- uint8_t ctr_Cold(uint8_t status_cold)
- {
- device_status.cold_status = status_cold;
- rt_pin_mode(Cold_Pin, PIN_MODE_OUTPUT);
- rt_pin_write(Cold_Pin,status_cold);
- return status_cold;
- }
- /*相机供电*/
- uint8_t ctr_photo(uint8_t status_photo)
- {
- rt_pin_mode(PHOTO,PIN_MODE_OUTPUT);
- rt_pin_write(PHOTO,status_photo);
- return status_photo;
- }
- /*采集风机/上仓门*/
- uint8_t ctr_cangmen_up(uint8_t status_up)
- {
- rt_pin_mode(TURN_ZP_R, PIN_MODE_OUTPUT);
- rt_pin_mode(TURN_ZP_L, PIN_MODE_OUTPUT);
- if(status_up==OFF)
- {
- }
- if(status_up==OPEN)
- {
- }
- return 0;
- }
- /*************************************************
- Function: ctr_Cool_Fan
- Description: 散热风机的开关
- Calls:
- Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
- Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
- Input: ON-开,OFF-关
- Output: NULL
- Return: ON-开,OFF-关
- Others: NULL
- *************************************************/
- uint8_t ctr_Cool_Fan(uint8_t status_cool)
- {
- device_status.cool_fan_status = status_cool;
- rt_pin_mode(Cool_Fan_L, PIN_MODE_OUTPUT);
- rt_pin_mode(Cool_Fan_R, PIN_MODE_OUTPUT);
- if(status_cool==OFF)
- {
- rt_pin_write(Cool_Fan_L,OFF);
- rt_pin_write(Cool_Fan_R,OFF);
- }
- if(status_cool==ON)
- {
- rt_pin_write(Cool_Fan_L,ON);
- rt_pin_write(Cool_Fan_R,OFF);
- }
- return device_status.cool_fan_status;
- }
- /*************************************************
- Function: ctr_Collect_Fan
- Description: 采集风机的开关
- Calls:
- Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
- Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
- Input: ON-开,OFF-关
- Output: NULL
- Return: ON-开,OFF-关
- Others: NULL
- *************************************************/
- uint8_t ctr_Collect_Fan(uint8_t status_collect)
- {
- device_status.collect_fan_status = status_collect;
- rt_pin_mode(Collect_Fan, PIN_MODE_OUTPUT);
- if(status_collect==OFF)
- {
- rt_pin_write(Collect_Fan,OFF);
- }
- if(status_collect==ON)
- {
- rt_pin_write(Collect_Fan,ON);
- }
- return device_status.collect_fan_status;
- }
- /*************************************************
- Function: ctr_DiYe
- Description: 电磁阀控制
- Calls:
- Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
- Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
- Input: shake_sec
- Output: NULL
- Return: shake_sec
- Others: NULL
- *************************************************/
- uint8_t ctr_DiYe(uint8_t shake_sec)
- {
- if(shake_sec>0) DTU_Write("drop.mp3");
- rt_pin_mode(SHAKE_SW, PIN_MODE_OUTPUT);
- if(shake_sec==0)
- {
- rt_pin_write(SHAKE_SW,OFF);
- return 0;
- }
- rt_pin_write(SHAKE_SW,ON);
- rt_thread_delay(shake_sec*1000);
- rt_pin_write(SHAKE_SW,OFF);
- HMI_WRITE("sysTest.switchDrop.val=%d",OFF);
- return shake_sec;
- }
- /*************************************************
- Function: ctr_Motor_Driver
- Description: 步进电机驱动
- Calls:
- Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
- Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
- Input: 50000000
- Output: NULL
- Return: shake_sec
- Others: NULL
- *************************************************/
- void ctr_Motor_Driver(uint8_t EN,uint8_t DIR,rt_uint32_t pwm,rt_uint32_t time_out)
- {
- ctr_Heat(ON);
- rt_thread_delay(1000*5);
- beep_init();
- rt_pin_mode(Motor_Power, PIN_MODE_OUTPUT);
- rt_pin_mode(LIMIT_UP, PIN_MODE_INPUT);
- rt_pin_mode(LIMIT_DOWN, PIN_MODE_INPUT);
- rt_pin_mode(Motor_EN, PIN_MODE_OUTPUT);
- rt_pin_mode(Motor_DIR, PIN_MODE_OUTPUT);
- if(EN==2)
- {
- rt_pin_write(Motor_EN, 0);
- rt_pin_write(HK_TAKE, 0); //使能步进电机2
- }
- else if(EN==0)
- {
- rt_pin_write(Motor_Power,0);
- }
- else{
- rt_pin_write(Motor_EN, EN);
- rt_pin_write(Motor_Power,1);
- }
- rt_pin_write(Motor_DIR, DIR);
- beep_set(pwm, pwm/2); //200kzh - 50%
- while(DIR==1&&rt_pin_read(LIMIT_DOWN)==1)
- {
- // if(time_out==0)
- // {
- // break;
- // }
- rt_thread_delay(50);
- time_out --;
- }
- while(DIR==0&&rt_pin_read(LIMIT_UP)==1)
- {
- // if(time_out==0)
- // {
- // break;
- // }
- rt_thread_delay(50);
- time_out --;
- }
- rt_pin_write(Motor_EN, OFF);
- rt_pin_write(HK_TAKE,OFF); //双电机此处ON
- //rt_pin_write(HK_TAKE,ON); //双电机此处ON
- beep_set(0, 0); //200kzh - 50%
- }
- /*************************************************
- Function: ctr_Petroleum_jelly
- Description: 涂凡士林
- Calls:
- Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
- Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
- Input: NULL
- Output: NULL
- Return: NULL
- Others: NULL
- *************************************************/
- void ctr_Petroleum_jelly(rt_uint32_t delay)
- {
- beep_init();
- pwm_on(2,50000);
- rt_thread_delay(delay*1000);
- pwm_off(2,0);
- rt_thread_delay(1000);
- pwm_on(3, 50000);
- rt_thread_delay(delay*1000);
- pwm_off(3,0);
- device_status.fsl_sw = 0;
- }
- uint8_t ctr_led(uint8_t status_led)
- {
- rt_pin_mode(LED_SW, PIN_MODE_OUTPUT);
- if(status_led==ON)
- {
- rt_pin_write(LED_SW,ON);
- HMI_WRITE("sysTest.switchFill.val=%d",ON);
- }
- else {
- rt_pin_write(LED_SW,OFF);
- HMI_WRITE("sysTest.switchPhoto.val=%d",OFF);
- HMI_WRITE("sysTest.switchFill.val=%d",OFF);
- }
- return status_led;
- }
- /*************************************************
- Function: ctr_turn
- Description: 转盘驱动
- Calls:
- Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
- Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
- Input: v=0(复位) v=90转90度
- Output: NULL
- Return: NULL
- Others: NULL
- *************************************************/
- void ctr_turn(uint8_t v)
- {
- DTU_Write("turn.mp3");
- LOG_I("================v===============:%d\n",v);
- rt_uint16_t turn_cnt = 0;
- rt_pin_mode(TURN_ZP_R, PIN_MODE_OUTPUT);
- rt_pin_mode(TURN_ZP_L, PIN_MODE_OUTPUT);
- rt_pin_mode(LIMIT_0, PIN_MODE_INPUT);
- rt_pin_mode(LIMIT_90, PIN_MODE_INPUT);
- if(v==0&&rt_pin_read(LIMIT_0)==0) return; //如果在初始位置,则不再往下执行
- while(rt_pin_read(LIMIT_0)==0||rt_pin_read(LIMIT_90)==0)
- {
- rt_pin_write(TURN_ZP_R, ON);
- rt_pin_write(TURN_ZP_L, OFF);
- turn_cnt ++;
- rt_thread_delay(100);
- if(turn_cnt==1000)
- {
- turn_cnt = 0;
- rt_pin_write(TURN_ZP_R, OFF);
- rt_pin_write(TURN_ZP_L, OFF);
- char *turn_warn ="limit timeout!!!";
- DTU_Write(makeJson_Warn(turn_warn, "ERR"));
- rt_free(turn_warn);
- break;
- }
- }
- turn_cnt = 0;
- while(v==0&&rt_pin_read(LIMIT_0)==1)
- {
- rt_pin_write(TURN_ZP_R, ON);
- rt_pin_write(TURN_ZP_L, OFF);
- rt_thread_delay(10);
- turn_cnt ++;
- if(turn_cnt==5000)
- {
- turn_cnt = 0;
- rt_pin_write(TURN_ZP_R, OFF);
- rt_pin_write(TURN_ZP_L, OFF);
- char *turn_warn ="turn timrout!!!";
- DTU_Write(makeJson_Warn(turn_warn, "ERR"));
- rt_free(turn_warn);
- break;
- }
- }
- turn_cnt = 0;
- while(v==90&&rt_pin_read(LIMIT_90)==1)
- {
- rt_pin_write(TURN_ZP_R, ON);
- rt_pin_write(TURN_ZP_L, OFF);
- rt_thread_delay(10);
- turn_cnt ++;
- if(turn_cnt==5000)
- {
- turn_cnt = 0;
- rt_pin_write(TURN_ZP_R, OFF);
- rt_pin_write(TURN_ZP_L, OFF);
- char *turn_warn ="turn timrout!!!";
- DTU_Write(makeJson_Warn(turn_warn, "ERR"));
- rt_free(turn_warn);
- break;
- }
- }
- turn_cnt = 0;
- rt_pin_write(TURN_ZP_R, OFF);
- rt_pin_write(TURN_ZP_L, OFF);
- HMI_WRITE("cangWei.rotateFlag.val=0");
- }
- //路由器供电
- void ctr_router(uint8_t status_router)
- {
- rt_pin_mode(ROUTER, PIN_MODE_OUTPUT);
- if(status_router==ON)
- {
- rt_pin_write(ROUTER,ON);
- }
- else {
- rt_pin_write(ROUTER,OFF);
- }
- }
- //DTU,RTU供电
- void ctr_RTU_DTU(uint8_t status_rtu)
- {
- rt_pin_mode(RTU_DTU, PIN_MODE_OUTPUT);
- if(status_rtu==ON)
- {
- rt_pin_write(RTU_DTU,ON);
- }
- else
- {
- rt_pin_write(RTU_DTU,OFF);
- }
- }
- //海康拍照
- void Hk_Take_io(void)
- {
- rt_pin_mode(HK_TAKE, PIN_MODE_OUTPUT);
- rt_pin_write(HK_TAKE, ON);
- rt_thread_delay(1000);
- //Beep_Tip(500);
- rt_pin_write(HK_TAKE, 0);
- }
- /*************************************************
- Function: ctr_develop
- Description: 培养载玻片孢子
- Calls:
- Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
- Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
- Input: v=0(复位) v=90转90度
- Output: NULL
- Return: NULL
- Others: NULL
- *************************************************/
- void ctr_develop(void)
- {
- rt_kprintf("===============开始培养=================:%d\n",device_status.culture_time);
- //已经培养的时间-分钟
- device_status.staytime = 0;
- rt_uint32_t ii = 0;
- while(device_status.develop_flag==1)
- {
- ii++;
- LOG_I("developing...................................%d\n",ii);
- LOG_I("============================设定的培养温度:%d\n",device_status.set_tempture);
- LOG_I("============================培养仓实时温度:%d\n",device_status.culture_tempture);
- if(device_status.culture_tempture<(device_status.set_tempture-10))
- {
- //未制冷
- if(device_status.cold_status==0)
- {
- ctr_Heat(ON);
- }
- }
- else
- {
- ctr_Heat(OFF);
- }
- LOG_I("============================制冷开关:%d\n",device_status.cold_sw);
- if(device_status.cold_sw==1)
- {
- if(device_status.culture_tempture>(device_status.set_tempture-10))
- {
- if(device_status.heat_status==0)
- {
- ctr_Cold(ON);
- }
- }
- else
- {
- ctr_Cold(OFF);
- }
- }
- if(ii%60==0)
- {
- device_status.staytime++;
- if(device_status.staytime/60==device_status.culture_time) device_status.develop_flag = 0;
- LOG_I("developed...................................%d分钟\n",device_status.staytime);
- float stayedtime = 0.1;
- char stayed[5];
- stayedtime = device_status.staytime / 60;
- rt_sprintf(stayed,"%s",stayedtime);
- HMI_WRITE("workSta.staytime.txt=\"%s\"",stayed);
- }
- rt_thread_delay(1000);
- }
- ctr_Cold(OFF);
- ctr_Heat(OFF);
- LOG_I("=========!!!培养完成!!!==========");
- }
- //拍照
- void HK_TakePhoto(void)
- {
- //触发海康相机拍照
- Hk_Take_io();
- HMI_WRITE("sysTest.switchPic.val=%d",OFF);
- HMI_WRITE("sysTest.switchLed.val=%d",OFF);
- }
- /*上电初始化*/
- void ResetInit(void)
- {
- device_status.work_done = 1;
- ctr_Motor_Driver(0, 0, 0, 0);
- //1.打开路由器供电
- ctr_router(ON);
- ctr_RTU_DTU(ON);
- //2.打开相机供电
- ctr_photo(ON);
- //4.关闭电磁阀
- ctr_DiYe(OFF);
- //5.关闭加热
- ctr_Heat(OFF);
- //关闭制冷
- ctr_Cold(OFF);
- //6.关闭补光灯
- ctr_led(OFF);
- //
- ctr_turn(0);
- }
- /*入口函数-工作流程*/
- static void Work_Loop_thread_entry(void *parameter)
- {
- Beep_Tip(200);
- ResetInit();
- while(1)
- {
- if(device_status.ds==1)
- {
- //时间段判断
- //先判断第一个时间段
- time_t now;
- time(&now);
- static struct tm now_stamp; //现在
- static struct tm cul_sh1_stamp; //开始1
- static struct tm cul_eh1_stamp; //结束1
- static struct tm cul_sh2_stamp; //开始2
- static struct tm cul_eh2_stamp; //结束2
- static struct tm cul_sh3_stamp; //开始3
- static struct tm cul_eh3_stamp; //结束3
- now_stamp = *localtime(&now);
- //获取定时开始的时间戳
- cul_sh1_stamp = *localtime(&now);
- cul_sh1_stamp.tm_hour = device_status.culture_sh1;
- cul_sh1_stamp.tm_min = 0;
- cul_sh1_stamp.tm_sec = 0;
- cul_sh2_stamp = *localtime(&now);
- cul_sh2_stamp.tm_hour = device_status.culture_sh2;
- cul_sh2_stamp.tm_min = 0;
- cul_sh2_stamp.tm_sec = 0;
- cul_sh3_stamp = *localtime(&now);
- cul_sh3_stamp.tm_hour = device_status.culture_sh3;
- cul_sh3_stamp.tm_min = 0;
- cul_sh3_stamp.tm_sec = 0;
- //获取定时结束的时间戳
- cul_eh1_stamp = *localtime(&now);
- cul_eh1_stamp.tm_hour = device_status.culture_eh1;
- cul_eh1_stamp.tm_min = 0;
- cul_eh1_stamp.tm_sec = 0;
- cul_eh2_stamp = *localtime(&now);
- cul_eh2_stamp.tm_hour = device_status.culture_eh2;
- cul_eh2_stamp.tm_min = 0;
- cul_eh2_stamp.tm_sec = 0;
- cul_eh3_stamp = *localtime(&now);
- cul_eh3_stamp.tm_hour = device_status.culture_eh3;
- cul_eh3_stamp.tm_min = 0;
- cul_eh3_stamp.tm_sec = 0;
- LOG_I("采集时间1-%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_sh1_stamp.tm_year+1900,cul_sh1_stamp.tm_mon+1,cul_sh1_stamp.tm_mday,cul_sh1_stamp.tm_hour,cul_sh1_stamp.tm_min,cul_sh1_stamp.tm_sec);
- LOG_I("采集时间2-%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_sh2_stamp.tm_year+1900,cul_sh2_stamp.tm_mon+1,cul_sh2_stamp.tm_mday,cul_sh2_stamp.tm_hour,cul_sh2_stamp.tm_min,cul_sh2_stamp.tm_sec);
- LOG_I("采集时间3-%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_sh3_stamp.tm_year+1900,cul_sh3_stamp.tm_mon+1,cul_sh3_stamp.tm_mday,cul_sh3_stamp.tm_hour,cul_sh3_stamp.tm_min,cul_sh3_stamp.tm_sec);
- LOG_I("结束时间1-%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_eh1_stamp.tm_year+1900,cul_eh1_stamp.tm_mon+1,cul_eh1_stamp.tm_mday,cul_eh1_stamp.tm_hour,cul_eh1_stamp.tm_min,cul_eh1_stamp.tm_sec);
- LOG_I("结束时间2-%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_eh2_stamp.tm_year+1900,cul_eh2_stamp.tm_mon+1,cul_eh2_stamp.tm_mday,cul_eh2_stamp.tm_hour,cul_eh2_stamp.tm_min,cul_eh2_stamp.tm_sec);
- LOG_I("结束时间3-%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_eh3_stamp.tm_year+1900,cul_eh3_stamp.tm_mon+1,cul_eh3_stamp.tm_mday,cul_eh3_stamp.tm_hour,cul_eh3_stamp.tm_min,cul_eh3_stamp.tm_sec);
- //此处判断,一个一个时间段判断,判断当前时间是否大于开始时间:
- while(difftime(mktime(&now_stamp), mktime(&cul_sh1_stamp)) < 0)
- {
- time_t now;
- time(&now);
- cul_sh1_stamp = *localtime(&now);
- cul_sh1_stamp.tm_hour = device_status.culture_sh1;
- cul_sh1_stamp.tm_min = 0;
- cul_sh1_stamp.tm_sec = 0;
- now_stamp = *localtime(&now);
- LOG_I("==============收集时间1:%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_sh1_stamp.tm_year+1900,cul_sh1_stamp.tm_mon+1,cul_sh1_stamp.tm_mday,cul_sh1_stamp.tm_hour,cul_sh1_stamp.tm_min,cul_sh1_stamp.tm_sec);
- LOG_I("==============未到收集时间1:%04d年%02d月%02d日%02d时%02d分%02d秒.\n",now_stamp.tm_year+1900,now_stamp.tm_mon+1,now_stamp.tm_mday,now_stamp.tm_hour,now_stamp.tm_min,now_stamp.tm_sec);
- rt_thread_delay(1000);
- }
- while(difftime(mktime(&now_stamp), mktime(&cul_sh2_stamp)) < 0&&difftime(mktime(&now_stamp), mktime(&cul_eh1_stamp)) > 0)
- {
- time_t now;
- time(&now);
- cul_sh2_stamp = *localtime(&now);
- cul_sh2_stamp.tm_hour = device_status.culture_sh2;
- cul_sh2_stamp.tm_min = 0;
- cul_sh2_stamp.tm_sec = 0;
- now_stamp = *localtime(&now);
- LOG_I("==============收集时间2:%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_sh2_stamp.tm_year+1900,cul_sh2_stamp.tm_mon+1,cul_sh2_stamp.tm_mday,cul_sh2_stamp.tm_hour,cul_sh2_stamp.tm_min,cul_sh2_stamp.tm_sec);
- LOG_I("==============未到收集时间2:%04d年%02d月%02d日%02d时%02d分%02d秒.\n",now_stamp.tm_year+1900,now_stamp.tm_mon+1,now_stamp.tm_mday,now_stamp.tm_hour,now_stamp.tm_min,now_stamp.tm_sec);
- rt_thread_delay(1000);
- }
- if((difftime(mktime(&now_stamp), mktime(&cul_sh1_stamp)) >= 0&&difftime(mktime(&now_stamp), mktime(&cul_eh1_stamp)) < 0)||(difftime(mktime(&now_stamp), mktime(&cul_sh2_stamp)) >= 0&&difftime(mktime(&now_stamp), mktime(&cul_eh2_stamp)) < 0))
- {
- LOG_I("start to collect!!!");
- DTU_Write("collect.mp3");
- //判断是否在初始位置
- ctr_turn(90);
- rt_thread_delay(2000);
- //涂凡士林
- ctr_Petroleum_jelly(10);
- rt_thread_delay(5000);
- ctr_turn(90);
- //只有开始和结束时刻不同的时间段,才有效
- if((difftime(mktime(&cul_eh1_stamp), mktime(&now_stamp)) > 0)||(difftime(mktime(&cul_eh2_stamp), mktime(&now_stamp)) > 0))
- {
- device_status.work_status = 1;
- rt_uint32_t collect_cnt = 0;
- ctr_Collect_Fan(ON);
- if((difftime(mktime(&cul_eh1_stamp), mktime(&now_stamp)) > 0))
- {
- collect_cnt = difftime(mktime(&cul_eh1_stamp), mktime(&now_stamp));
- while(collect_cnt--)
- {
- rt_kprintf("===========采集风机启动,正在收集.....%d\n",collect_cnt);
- rt_thread_delay(1000);
- }
- collect_cnt = 2;
- }
- if(difftime(mktime(&cul_eh2_stamp), mktime(&now_stamp)) > 0)
- {
- collect_cnt = difftime(mktime(&cul_eh2_stamp), mktime(&now_stamp));
- while(collect_cnt--)
- {
- rt_kprintf("===========采集风机启动,正在收集.....%d\n",collect_cnt);
- rt_thread_delay(1000);
- }
- }
- ctr_Collect_Fan(OFF);
- }
- else
- {
- LOG_I("this collect time is 0s,The wait time cannot be negative!");
- }
- }
- else
- {
- LOG_I("next collect time is not arrivd!!! >>> .. start now time:%d",mktime(&now_stamp));
- }
- if(device_status.work_status==1)
- {
- LOG_I("===============collect ok,turn to drop!!!");
- device_status.develop_flag=1;
- device_status.work_status=2; //现在是培养
- DTU_Write("develop.mp3");
- ctr_turn(90);
- rt_thread_delay(1000);
- ctr_DiYe(device_status.drop_sec);
- rt_thread_delay(1000);
- ctr_develop();
- ctr_turn(90);
- rt_thread_delay(1000);
- DTU_Write("takephoto.mp3");
- device_status.work_status=3; //现在是拍照
- device_status.autotakepic=1; //对焦拍照
- while(device_status.autotakepic==0)
- {
- rt_thread_delay(500);
- LOG_I("正在对焦拍照............\n");
- }
- device_status.work_status = 0; //待机
- DTU_Write("wait.mp3");
- LOG_I("=====================work finished==================");
- }
- }
- else
- {
- LOG_W("==================!!!设备已关机!!!===================");
- }
- rt_thread_delay(1000);
- }
- }
- /*工作流程线程*/
- int Work_Loop_Task(void)
- {
- /* 创建线程*/
- tid_workloop = rt_thread_create("work_loop_thread",
- Work_Loop_thread_entry, RT_NULL,
- WORK_LOOP_THREAD_STACK_SIZE, //2048
- WORK_LOOP_THREAD_PRIORITY, //12
- WORK_LOOP_THREAD_TIMESLICE); //5
- if(tid_workloop!=RT_NULL)
- {
- rt_thread_startup(tid_workloop);
- }
- return 0;
- }
|