#include /* * 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" #include "dtu_uart2.h" #include "sht30_collect.h" #define DBG_ENABLE #define DBG_COLOR #define DBG_TAG "control" #define DBG_LEVEL DBG_LOG #include //must after of DBG_LVL, DBG_TAG or other options //工作检测 #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 2048 //栈大小 #define WORK_LOOP_THREAD_TIMESLICE 5 //时间片 #define PWM_EN 1 //0关闭,1-打开 //设备状态表结构体 Device_Status_typedef device_status; Device_slide_typedef slide_para; static rt_thread_t tid_workloop = RT_NULL; static rt_thread_t tid_wkstc = RT_NULL; static rt_thread_t rt_slide = RT_NULL; /***************************************************************************/ int thread_delete_workloop(void) { LOG_W("thread_delete_workloop."); rt_err_t result; if(tid_workloop!=RT_NULL) { result = rt_thread_delete(tid_workloop); } if(tid_wkstc!=RT_NULL) { result = rt_thread_delete(tid_wkstc); } if(rt_slide!=RT_NULL) { result = rt_thread_delete(rt_slide); } return 0; } int thread_restart_workloop(void) { rt_err_t result; result = Work_Loop_Task(); return result; } void slidelock(); //滑台垂直方向开关 uint8_t ctr_swz(uint8_t status_swz) { rt_pin_mode(SHAKE_SW, PIN_MODE_OUTPUT); if(status_swz == ON){ rt_pin_write(SHAKE_SW,ON); } else if(status_swz == OFF){ rt_pin_write(SHAKE_SW,OFF); } return status_swz; } //限位开关判断函数 void turnlimit(void) { if(device_status.temp_status==1) return; //Motor_shake(ON,0); Motor_Qingsao_R_PWM(ON); static uint16_t turn_timeout = 0; rt_pin_mode(LIMIT_DOWN,PIN_MODE_INPUT); while(rt_pin_read(LIMIT_DOWN)==0) { rt_thread_delay(20); while(rt_pin_read(LIMIT_DOWN)==0) { //ctr_cangmen_down(CLOSE); rt_thread_delay(50); turn_timeout++; if(turn_timeout==200){ char *translate = makeJson_Warn("translate","limit timeout"); DTU_Write("%s",translate); rt_free(translate); break; } } break; } while(rt_pin_read(LIMIT_DOWN)==1) { rt_thread_delay(10); while(rt_pin_read(LIMIT_DOWN)==1) { turn_timeout++; rt_thread_delay(5); if(turn_timeout==2000){ char *translate = makeJson_Warn("translate","limit timeout"); DTU_Write("%s",translate); rt_free(translate); break; } } break; } while(rt_pin_read(LIMIT_DOWN)==0) { rt_thread_delay(20); if(rt_pin_read(LIMIT_DOWN)==0) { //Motor_shake(OFF,0); Motor_Qingsao_R_PWM(OFF); break; } else { break; } } //Motor_shake(OFF,0); Motor_Qingsao_R_PWM(OFF); turn_timeout = 0; char *translate = makeJson_Warn("translate","done"); DTU_Write("%s",translate); rt_free(translate); // rt_thread_delay(1000); } uint32_t mapSpeed(int a1) { const int a1Min = 0; const int a1Max = 100; const int a2Min = 50000; //20khz const int a2Max = 200000; //5khz // 确保 a1 在有效范围内 if (a1 < a1Min) { a1 = a1Min; } else if (a1 > a1Max) { a1 = a1Max; } // 执行线性映射 uint32_t a2 = a2Max - ((a2Max - a2Min) * a1) / (a1Max - a1Min); return a2; } void stop_move(void) { slide_para.stop_flag = 1; slidelock(); rt_pin_mode(HK_IO, PIN_MODE_OUTPUT); //PB14 EN pwm_stop(); rt_pin_write(HK_IO, ON); } //DIR_ 轴选择(0-X,1-Y,2-Z) dir 轴方向 uint32_t ctr_move(uint8_t DIR_,uint8_t dir_,uint32_t dis_,uint32_t pulse) { uint32_t j; switch(DIR_){ case X_: ctr_lamp(ON,1); //X轴开关:关 ctr_swz(OFF); //Z轴开关:关 ctr_Collect_Fan(OFF); //Y轴开关:关 break; case Y_: ctr_swz(OFF); //Z轴开关:关 ctr_lamp(OFF,1); //X轴开关:关 ctr_Collect_Fan(ON); //Y轴开关:开 break; case Z_: ctr_swz(ON); //Y轴开关:关 ctr_lamp(OFF,1); //X轴开关:关 ctr_Collect_Fan(OFF); //Y轴开关:关 break; } //限位检测初始化 rt_pin_mode(Limit_Motor_X, PIN_MODE_INPUT); rt_pin_mode(Limit_Motor_Y, PIN_MODE_INPUT); rt_pin_mode(Limit_Motor_Z, PIN_MODE_INPUT); //驱动器初始化 rt_pin_mode(HK_IO, PIN_MODE_OUTPUT); //PB14 EN rt_pin_mode(CTR_RO_LIMIT, PIN_MODE_OUTPUT); //PB15 DIR //rt_pin_mode(CTR_RC_LIMIT, PIN_MODE_OUTPUT); //PC6 PWM // if(dis_ >=1000){ // beep_set(500000, 250000); //PWM使能 // }else{ // beep_set(2000000, 1000000); //PWM使能 // } //驱动使能 rt_pin_write(HK_IO, ON); //方向选择 if(dir_ == 1){ rt_pin_write(CTR_RO_LIMIT, ON); }else{ rt_pin_write(CTR_RO_LIMIT, OFF); } switch(DIR_){ case X_: ctr_lamp(1, ON); //X轴电源开关:开 rt_thread_delay(1000); //判断限位 if(dir_== 0 && rt_pin_read(Limit_Motor_X)==1){ for(int z =0;z < 3; z++){ Beep_Tip(200); LOG_W("X:已在初始位置!"); } return 0; } rt_pin_write(HK_IO, ON); rt_thread_delay(100); beep_set(pulse, pulse/3); //PWM使能 for(j=0;j=8000){rt_thread_delay(10);}else{rt_thread_delay(1);} if(dir_==0&&rt_pin_read(Limit_Motor_Y)==1){ if(dis_>=8000){rt_thread_delay(10);}else{rt_thread_delay(1);} if(rt_pin_read(Limit_Motor_Y)==1){ j = dis_; } } }else{ //急停 for(int z =0;z < 3; z++){ Beep_Tip(200); } break; } } break; case Z_: ctr_swz(ON); //Z轴电源开关:开 rt_thread_delay(1000); // //判断限位 if(dir_== 1 && rt_pin_read(Limit_Motor_Z)==1){ for(int z =0;z < 3; z++){ Beep_Tip(200); LOG_W("Z:已在初始位置!"); } return 0; } //驱动使能 rt_pin_write(HK_IO, ON); beep_set(pulse, pulse/3); //PWM使能 for(j=0;j= start_sec && curr_sec < end_sec) ? 1 : 0; } else { // 跨天模式 workflag = (curr_sec >= start_sec || curr_sec < end_sec) ? 1 : 0; } LOG_I("时控模式:状态[%s] 当前时间:%02d:%02d:%02d 设置:%02d:%02d-%02d:%02d", workflag ? "工作" : "待机", now_tm.tm_hour, now_tm.tm_min, now_tm.tm_sec, starthour,startmin, endhour,endmin); rt_thread_delay(10000); return workflag; } void WorkTask_BZYV2(void) { if(device_status.ds==1&&device_status.temp_status==0){ ctr_lamp(OFF,1); //镇流器关=X轴开关:开 ctr_swz(OFF); ctr_Collect_Fan(OFF); while(device_status.work_status ==0){ rt_thread_delay(10000); LOG_W("等待设备进入工作"); } while(device_status.work_status ==1){ if(device_status.autotakepic==0){ ctr_router(ON); }else{ ctr_router(OFF); } if(device_status.temp_status==1){ device_status.work_status = 0; ctr_router(OFF); break; } rt_thread_delay(10000); } ctr_router(OFF); if(device_status.work_done==1){ turnlimit(); //卷带电机转一圈 rt_thread_delay(2000); uint8_t retry_send = 0; while(1){ char *take_start = makeJson_Warn("start", "autofocus"); DTU_Write(take_start); rt_free(take_start); rt_thread_delay(5000); retry_send++; if(retry_send==30||device_status.autotakepic>=0){ break; } } device_status.work_done = 0; } }else{ LOG_W("==================!!!设备已待机!!!==================="); } } /* 入口函数-工作状态检测 */ static void Work_status_thread_entry(void *parameter) { static uint32_t takephoto_cnt = 0; while(1) { if(device_status.ds==0|| device_status.temp_status==1){ device_status.work_status = 0; rt_thread_delay(5000); continue; } while(alarmCheck(device_status.collecting_sh1,device_status.collecting_eh1,device_status.collt_min_sh1,device_status.collt_min_eh1) == ON) { device_status.work_status = 1; LOG_I("the alarm1 workflag was ON"); device_status.work_done=1; rt_thread_delay(1000); } //如果当前时间大于collecting_eh1,开始拍照 while(alarmCheck(device_status.collecting_sh2,device_status.collecting_eh2,device_status.collt_min_sh2,device_status.collt_min_eh2) == ON) { device_status.work_status = 1; device_status.work_done=1; LOG_I("the alarm2 workflag was ON"); rt_thread_delay(1000); } //如果当前时间大于collecting_eh2,开始拍照 while(alarmCheck(device_status.collecting_sh3,device_status.collecting_eh3,device_status.collt_min_sh3,device_status.collt_min_eh3) == ON) { device_status.work_status = 1; device_status.work_done=1; LOG_I("the alarm3 workflag was ON"); rt_thread_delay(1000); } device_status.work_status = 0; if(device_status.autotakepic==2){ takephoto_cnt++; }else{ takephoto_cnt=0; } if(takephoto_cnt==3600){ device_status.autotakepic = 0; takephoto_cnt = 0; } //如果当前时间大于 if(device_status.work_done!=0) { rt_thread_delay(1000*30); device_status.work_done = 0; } rt_thread_delay(1000); } } /*入口函数-工作流程*/ static void Work_Loop_thread_entry(void *parameter) { rt_thread_delay(1000); ResetInit(); while(1) { WorkTask_BZYV2(); rt_thread_delay(1000); } } void slide_thread_entry(void *parameter) { slide_para.pulse_period = 1; //默认滑台的脉宽为1ms while(1) { rt_thread_delay(10); switch(slide_para.en_slide){ case 1:{ ctr_move(X_,slide_para.xdir,slide_para.xdis,slide_para.pulse_period); LOG_I("The slide's x movement was done ok"); if(slide_para.xdis==55||slide_para.xdis==80) { DTU_Write("{\"cmd\": \"takephoto\" }"); device_status.autotakepic = 4; }else { char *photo = makeJson_Warn("movx","done"); LOG_I("%s",photo); DTU_Write("%s",photo); rt_free(photo); } slide_para.stop_flag = 0; slide_para.en_slide = OFF; break; } case 2:{ ctr_move(Z_,slide_para.zdir,slide_para.zdis,slide_para.pulse_period); rt_kprintf("The slide's z movement was done ok\n"); if(slide_para.zdis==55||slide_para.zdis==80) { DTU_Write("{\"cmd\": \"takephoto\" }"); device_status.autotakepic = 4; }else { char *photo = makeJson_Warn("movz","done"); LOG_I("%s",photo); DTU_Write("%s",photo); rt_free(photo); } slide_para.zdir = 1; slide_para.zdis = 0; slide_para.stop_flag = 0; slide_para.en_slide = OFF; break; } case 3:{ //复位X LOG_W("X轴复位!"); slide_para.xdir = 0; slide_para.xdis = 8000; ctr_move(X_,slide_para.xdir,slide_para.xdis,slide_para.pulse_period); LOG_I("The slide's X movement was done ok"); slide_para.xdir = 0; slide_para.xdis = 0; slide_para.stop_flag = 0; slide_para.en_slide = OFF; break; } case 4:{ //复位Z LOG_W("Z轴复位!"); slide_para.zdir = 1; //250717 slide_para.zdis = 5000; ctr_move(Z_,slide_para.zdir,slide_para.zdis,slide_para.pulse_period); LOG_I("The slide's Z movement was done ok"); slide_para.zdis = 0; slide_para.stop_flag = 0; slide_para.en_slide = OFF; break; } case 6:{ //Y轴 ctr_move(Y_,slide_para.ydir,slide_para.ydis,slide_para.pulse_period); rt_kprintf("The slide's y movement was done ok\n"); rt_thread_delay(1000); if(1){ char utos[5]; rt_sprintf(utos,"%d",slide_para.ystep); char *photo = makeJson_Warn("movy",utos); LOG_I("%s",photo); DTU_Write("%s",photo); rt_free(photo); } slide_para.ydis = 0; slide_para.stop_flag = 0; slide_para.en_slide = OFF; break; } case 7:{ //Y轴复位 LOG_W("Y轴复位!"); slide_para.ydir = 0; slide_para.ydis = 8000; ctr_move(Y_,slide_para.ydir,slide_para.ydis,slide_para.pulse_period); LOG_I("The slide's Y movement was done ok"); slide_para.stop_flag = 0; slide_para.en_slide = OFF; break; } default: { slide_para.en_slide = OFF; slide_para.stop_flag = 0; break; } } } } /* 创建线程 -工作状态检测*/ int Workstatus_check(void) { /* 创建线程*/ tid_wkstc = rt_thread_create("w_s_c_t", Work_status_thread_entry, RT_NULL, WORK_CHECK_THREAD_STACK_SIZE, //1024 WORK_CHECK_THREAD_PRIORITY, //23 WORK_CHECK_THREAD_TIMESLICE); //5 if(tid_wkstc!=RT_NULL) { rt_thread_startup(tid_wkstc); } return 0; } /*工作流程线程*/ int Work_Loop_Task(void) { rt_err_t result_loop; /* 创建线程*/ 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 Color_EN == 0 if(tid_workloop!=RT_NULL) { result_loop = rt_thread_startup(tid_workloop); } #endif return result_loop; } int slide_Fresh(void) { rt_err_t ret = RT_EOK; rt_slide = rt_thread_create("rt_slide", slide_thread_entry, RT_NULL, 1024, 5, 20); if (rt_slide != RT_NULL) { rt_thread_startup(rt_slide); rt_kprintf("the thread of rt_slide start ok\n"); } else { ret = RT_ERROR; } return ret; } void reboot(void) { LOG_W("手动触发重启!"); rt_hw_cpu_reset(); } MSH_CMD_EXPORT(ctr_lamp,ctr_lamp); MSH_CMD_EXPORT(ctr_led,sample:ctr_led ); MSH_CMD_EXPORT(reboot,reboot); //INIT_APP_EXPORT(Control_heat);