control.h 15 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352
  1. /*
  2. * Copyright (c) 2006-2020, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2020-05-30 Administrator the first version
  9. */
  10. #ifndef APPLICATIONS_INC_CONTROL_H_
  11. #define APPLICATIONS_INC_CBD_CONTROL_H_
  12. #include <rtthread.h>
  13. #include <board.h>
  14. #include "stdio.h"
  15. #include <rtdevice.h>
  16. //定制相关//////////////////////////////////////////////////////
  17. #define SENSOR_EN 0 //温湿度:0关闭,1打开
  18. #define FOCUS_STEP_EN 1 //自动对焦0关闭,1打开
  19. #define BZYV13_EN 1 //孢子仪1.3 0关闭 1打开
  20. /* 录制式对焦策略: 0=旧行为(盲走到 y_init_dis 就开录, 靠长行程覆盖漂移);
  21. * 1=新策略(每个点位录制前先做轻量"预对焦", 找到清晰度上升沿之前的位置
  22. * 作为录制起点, 因此只需约 3 秒行程即可覆盖整个焦区)。
  23. * 详见 control.c 顶部"预对焦(Pre-Focus)"注释块。 */
  24. #define PF_EN 0
  25. #if (PF_EN == 1) && (FOCUS_STEP_EN == 1)
  26. #warning "PF_EN 与 FOCUS_STEP_EN 同时开启: 两套对焦逻辑会争抢 Y 轴, 实际只能二选一"
  27. #endif
  28. /* 初始化时相对 y_init_dis 少走的量(目的: 给预对焦留出检测上升沿所需的平坦区)。
  29. * 单位 = y_init_dis 的口径(dis_>=8000 档, 每格 10ms @8kHz ≈ 80 个脉冲), 8 格 ≈ 640 脉冲。
  30. * 调大 -> 上升沿检测更从容但更慢; 调小 -> 可能起点就已贴着上升沿, 采不到干净的底噪。 */
  31. #define PF_APPROACH_BACKOFF 8
  32. /***** 预对焦(Pre-Focus)对外接口, 实现见 control.c *****/
  33. extern volatile uint8_t g_pf_busy; /* 预对焦进行中: 期间回传的 focus 帧需挡在旧的爬山/校准状态机之外 */
  34. int slide_pre_focus(void); /* 返回1=找到上升沿且 Y 已停在录制起点; 0=失败, 需按兜底行程录制 */
  35. void slide_set_record_travel(uint8_t pf_ok); /* 依据预对焦结果设定本次录制的行程 */
  36. ////////////////////////////////////////////////////////////////
  37. ///
  38. ///
  39. ///
  40. #define VERSION_BZY "3.7.45" //孢子仪
  41. /* 对焦串口通信异常标志: 串口收到合法 JSON 且含 "focus" 字段时置1(定义于dtu_uart2.c) */
  42. extern volatile uint8_t focus_valid_flag;
  43. typedef struct _packed
  44. {
  45. uint8_t iSave; //存储标志位
  46. uint8_t dtype; //设备类型?7-孢子仪,3-测报灯
  47. /*孢子仪*/
  48. uint8_t run_sta; //转盘的位置:0原始;1收集;2培养;3拍照;4凡士林,其他-测试
  49. uint8_t cul_time; //培养时间
  50. uint8_t stay_time; //已培养时间
  51. uint8_t pre_temp; //培养仓温度
  52. uint8_t box_temp; //箱体温度
  53. volatile uint8_t auto_test_sw; //一键测试 0-关 1-开
  54. volatile uint8_t replace_filter_sw; //滤网替换开关 0-关 1-开
  55. uint8_t collect_fan_status; //采集状态 0-关 1-开
  56. volatile uint8_t autotakepic; //对焦拍照 0-关 1-开
  57. volatile uint8_t calibrate_slide; //校准开关 0-关 1 X 2 Y 3 Z
  58. uint8_t develop_flag; //是否进入培养模式
  59. uint8_t cool_fan_status; //散热风机状态 0-停止 1-打开
  60. uint8_t fsl_sw; //凡士林开关:0-关,1-开
  61. uint8_t collecting_sh1; //采集开启1
  62. uint8_t collt_min_sh1;
  63. uint8_t collecting_eh1; //采集关闭1
  64. uint8_t collt_min_eh1;
  65. uint8_t collecting_sh2; //采集开启2
  66. uint8_t collt_min_sh2;
  67. uint8_t collecting_eh2; //采集关闭2
  68. uint8_t collt_min_eh2;
  69. uint8_t collecting_sh3; //采集开启3
  70. uint8_t collt_min_sh3;
  71. uint8_t collecting_eh3; //采集关闭3
  72. uint8_t collt_min_eh3;
  73. /*测报灯*/
  74. uint8_t heat_sw; //加热开关
  75. uint8_t photo_ws; //拍照
  76. uint8_t power_status; //电源
  77. uint8_t sun_test; //光控测测试标志位
  78. uint8_t heat_status; //加热状态 0-关 1-开
  79. uint8_t lamp_status; //灯管1状态 0-关 1-开
  80. uint8_t lamp1_status; //灯管2状态 0-关 1-开
  81. uint8_t lamp2_status; //灯管3状态 0-关 1-开
  82. uint8_t up_status; //上仓门状态 0-停止 1-打开 2-关闭
  83. uint8_t down_status; //下仓门状态 0-停止 1-打开 2-关闭
  84. uint8_t clear_status; //清扫状态 0-停止 1-开始
  85. uint8_t cold_status;
  86. uint8_t shake_ws; //震动 0-关 1-开
  87. uint8_t heatvalue; //加热设定温度
  88. uint8_t ctr_up_motor; //上仓门, 1打开,0关闭
  89. uint8_t ctr_down_motor; //下仓门, 1打开,0关闭
  90. uint8_t rain_status; //雨控 0-正常 1-欠压
  91. uint8_t temp_status; //温控 0-正常 1-温控
  92. uint8_t sun_status; //光控 0-正常 1-光控
  93. uint8_t ds; //设备状态 0-关机 1-开机
  94. volatile uint8_t work_status; //工作状态 0-待机 1-工作
  95. volatile uint8_t work_done; //工作结束 1-正常 0-工作已结束
  96. uint8_t bat_status; //电压状态 1-正常 0-欠压
  97. uint8_t heattime; //加热时间
  98. uint8_t heat_time_min; //实时加热时间
  99. uint8_t clt_time; //收集时间
  100. uint8_t vol; //音量
  101. uint8_t refresh_num; //DTU数据刷新时间
  102. uint8_t refresh_timeout; //刷新超时时间
  103. uint8_t sunBar; //光控定时时间
  104. uint8_t startBar; //时控开始时间
  105. uint8_t stopBar; //时控结束时间
  106. uint8_t tph; //高温保护
  107. int8_t tpl; //低温保护
  108. uint8_t timeSwitch; //模式0光控,1时控
  109. uint8_t link_sta; //有线接入状态:0-未接入,1已接入
  110. int8_t heattem; //加热仓温度(实时)
  111. uint8_t hmi_fresh; //是否启动屏幕
  112. uint8_t update_flag; //是否启动升级
  113. uint8_t photo_type; //相机类型,0-USB,1-海康,2-大华
  114. uint8_t version_type; //版本类型,1-转盘,4-海康,41-水稻,11-高空,48-4800
  115. uint8_t stop_in_bootloader; //进入bootloader模式 1
  116. uint8_t account_status; //卡状态
  117. uint8_t test_flag; //测试标志
  118. uint8_t sensor_485_sta; //485传感器
  119. uint8_t Power_Type; //供电类型
  120. uint8_t handle_bugger; //排虫模式,0推杆收回来是排虫,1推出去是收虫
  121. uint8_t collt_box_sta; //收虫仓状态
  122. uint8_t camsta; //拍照报警,0正常,1异常
  123. uint8_t heat_sta; //加热报警0-正常,1-异常
  124. uint8_t led_sta; //补光灯报警0-正常,1-异常
  125. volatile uint8_t selfcheck_ws; //自检开关1-北大荒,2-标配
  126. uint8_t step_focus;
  127. uint16_t dattim; //数据上传间隔
  128. uint16_t shake_sec; //震动时间
  129. uint16_t thsp; //息屏时间
  130. uint16_t C01; //故障码
  131. rt_uint32_t num_updata; //
  132. rt_uint32_t rebootcnt; //启动次数
  133. rt_uint32_t light_over_tim; //光控定时差秒数,镇流器的结束时间
  134. rt_uint32_t x_init_dis; //
  135. rt_uint32_t y_init_dis; //
  136. rt_uint32_t lux;
  137. double focus_value;
  138. int passWord; //初始密码
  139. double process;
  140. long photo_stamp; //采集时间戳
  141. const char *coll_time[10];
  142. char mqttcfg1[64]; //
  143. char mqttcfg2[64]; //
  144. char tempture[8]; //温度
  145. char humidity[8]; //湿度
  146. char csq[8]; //信号强度
  147. char net[8]; //网络
  148. char sim[8]; //SIM卡
  149. char gps[8]; //定位类型
  150. char gps_state[8]; //定位类型
  151. char driver[64]; //版本
  152. char driver_4g[64]; //4g版本
  153. char driver_bl[64]; //BL版本
  154. char driver_compile[64]; //BL编译时间
  155. char project[32]; //project,用于判断升级
  156. char lng[32]; //经度
  157. char lat[32]; //纬度
  158. char stamp[32]; //系统时间
  159. char fuse_voltage[32]; //保险丝电压
  160. char iccid[32]; //SIM卡ICCID
  161. char imei[32]; //IMEI,唯一ID
  162. /* 2026-09-28 扩容: "%.2f" 在大电流下会生成 8 个字符(如 "24850.00")+ 结尾 '\0' = 9 字节,
  163. * 原 8 字节缓冲会溢出 1 字节, 恰好踩坏紧随其后的 voltage[0], 导致 atof(voltage)==0 -> 欠压误判。
  164. * 现统一放宽到 12 字节, 并配合 rt_snprintf 做限长(双保险)。 */
  165. char power[12]; //功率
  166. char heat_power[12]; //加热功率
  167. char voltage[6]; //电池电压
  168. }Device_Status_typedef;
  169. /**************滑台数据********************/
  170. typedef struct
  171. {
  172. uint32_t xdis; //x轴坐标移动距离
  173. uint32_t ydis;
  174. uint32_t zdis; //z轴坐标移动距离
  175. uint32_t ystep; //y步进距离
  176. uint32_t pulse_period; //滑台的运动速度 1为最高
  177. uint16_t dxdis; //x轴坐标蛇形移动间距距离
  178. uint16_t dzdis; //z轴坐标蛇形移动间距距离
  179. uint8_t xdir; //x轴坐标移动方向
  180. uint8_t ydir; //y轴坐标移动方向
  181. uint8_t zdir; //z轴坐标移动方向
  182. volatile uint8_t en_slide; //
  183. uint8_t zccwl_on; //z轴限位开关信号 高电平为触发限位
  184. uint8_t xccwl_on; //x轴限位开关信号 高电平为触发限位
  185. volatile uint8_t stop_flag; //滑台停止标志位
  186. }Device_slide_typedef;
  187. /************************************************/
  188. #define ON 1
  189. #define OFF 0
  190. #define LED0_PIN GET_PIN(B, 3)
  191. #define Beep GET_PIN(B, 4)
  192. #define OPEN 0x02
  193. #define CLOSE 0x03
  194. /************************************************/
  195. //光控
  196. #define LIGHT_PIN GET_PIN(C,0)
  197. //雨控
  198. #define RAIN_PIN GET_PIN(C,1)
  199. //加热
  200. #define Heat_Pin GET_PIN(B,12)
  201. //采集/上仓门
  202. #define Collect_fan_R GET_PIN(C, 5)
  203. #define Collect_fan_L GET_PIN(B, 6)
  204. //下仓门
  205. #define C_DOWN_R GET_PIN(B,0)
  206. #define C_DOWN_L GET_PIN(B,1)
  207. //镇流器
  208. #define LAMP_SW GET_PIN(C,9)
  209. //震动电机
  210. #define SHAKE_SW GET_PIN(B,2)
  211. //补光
  212. #define LED_SW GET_PIN(A,15)
  213. //清扫
  214. #define CLEAR_R GET_PIN(C,7)
  215. #define CLEAR_L GET_PIN(C,8)
  216. //相机供电
  217. #define PHOTO GET_PIN(A,12)
  218. //路由器供电
  219. #define ROUTER GET_PIN(A,8)
  220. //RTU/DTU供电
  221. #define RTU_DTU GET_PIN(B,13)
  222. //海康相机拍照
  223. #define HK_TAKE GET_PIN(A,11)
  224. #define HK_IO GET_PIN(B,14) //备用触发拍照
  225. //清扫限位
  226. #define CLEAR_R_LIMIT GET_PIN(C,13)
  227. /*****************************4.0定制多光源*********************************/
  228. #define LAMP_1_SW GET_PIN(B,10)
  229. #define LAMP_2_SW GET_PIN(B,11)
  230. /***************************高空测报灯*************************/
  231. //上仓门电机限位
  232. #define CTR_UPO_LIMIT GET_PIN(C,13)
  233. //下仓门电机限位
  234. #define CTR_DWO_LIMIT GET_PIN(B,5)
  235. #define CTR_DWC_LIMIT GET_PIN(B,8)
  236. //雨控电机限位,控制排水和落虫
  237. #define CTR_RO_LIMIT GET_PIN(B,15)
  238. #define CTR_RC_LIMIT GET_PIN(C,6)
  239. #define PC7_TIM3_CH 2 //pwm8
  240. #define PC8_TIM3_CH 3 //pwm8
  241. #define PB1_TIM3_CH 4 //pwm3
  242. #define MOTOR1_CTR_PIN GET_PIN(C,9) //吸虫电机IO
  243. #define MOTOR2_CTR_PIN GET_PIN(B,2) //吸附电机IO
  244. #define MOTOR_CR_PIN GET_PIN(C,7)
  245. #define MOTOR_CL_PIN GET_PIN(C,8)
  246. #define MOTOR_C_LIMIT GET_PIN(C,13) //卷带限位
  247. void ctr_JD_Clear(uint8_t shake_sw);
  248. uint8_t ctr_Motor_xichong(uint8_t status_ws);
  249. uint8_t ctr_Motor_xifu(uint8_t status_ws);
  250. uint8_t ctr_Camera_Power(uint8_t status_ws);
  251. /*****************************5.0测报灯******************************/
  252. void ctr_turnv5(void);
  253. /*****************************孢子仪**********************************/
  254. //制冷
  255. #define Cold_Pin GET_PIN(B,11)
  256. //采集
  257. #define Collect_Fan GET_PIN(B,10)
  258. //转盘
  259. #define TURN_ZP_R GET_PIN(B,0)
  260. #define TURN_ZP_L GET_PIN(B,1)
  261. //转盘限位
  262. #define LIMIT_0 GET_PIN(C,13)
  263. //散热
  264. #define Cool_Fan_R GET_PIN(C, 5)
  265. #define Cool_Fan_L GET_PIN(C, 4)
  266. //步进电机限位
  267. #define LIMIT_UP GET_PIN(B,8)
  268. #define LIMIT_DOWN GET_PIN(B,5)
  269. //步进电机驱动
  270. #define Motor_EN GET_PIN(B,14)
  271. #define Motor_DIR GET_PIN(B,15)
  272. void ctr_turn(uint8_t v,uint8_t sta);
  273. uint8_t ctr_Cold(uint8_t status_cold);
  274. uint8_t ctr_Cool_Fan(uint8_t status_cool); //散热风机
  275. uint8_t ctr_Collect_Fan(uint8_t status_collect); //采集风机
  276. void ctr_Motor_Driver(uint8_t EN,uint8_t DIR,rt_uint32_t pwm,rt_uint32_t time_out); //步进电机
  277. void ctr_Petroleum_jelly(rt_uint32_t delay); //凡士林
  278. /*****************************定制4.0-2000W***************************************/
  279. #define FAN_P GET_PIN(B,10)
  280. #define FAN_I GET_PIN(B,11)
  281. uint8_t ctr_Fan_IN(uint8_t status_ws);
  282. uint8_t ctr_Fan_PUT(uint8_t status_ws);
  283. /***************************************************************/
  284. /***************************************************************/
  285. uint8_t ctr_Heat(uint8_t status_heat); //加热
  286. uint8_t ctr_cangmen_up(uint8_t status_up); //上仓门
  287. uint8_t ctr_cangmen_down(uint8_t status_down); //下仓门
  288. uint8_t ctr_lamp(uint8_t status_lamp,uint8_t lamp_num); //镇流器
  289. uint8_t ctr_clear(uint16_t status_clear); //清扫
  290. void ctr_TG_Clear(uint16_t clear_timeout); //清扫2
  291. uint8_t ctr_led(uint8_t status_led); //补光灯
  292. void calorstat(uint16_t heat_time); //恒温
  293. void ctr_router(uint8_t status_router); //路由器
  294. void turnzp(void); //转仓
  295. void Hk_Take_io(void); //触发拍照
  296. void HK_TakePhoto(void); //拍照
  297. void ctr_photo(uint8_t status_photo);
  298. void ctr_RTU_DTU(uint8_t status_rtu);
  299. void ResetInit(void); //上电复位
  300. void SunTest(void); //光控测试
  301. /*****************************************************/
  302. void WorkTask_XCT(void);
  303. /****************************************************/
  304. void WorkCheck(void); //工作检测
  305. void WorkTask(void); //工作任务
  306. //
  307. /***********************孢子仪2.0****************************/
  308. #define X_ 0
  309. #define Y_ 1
  310. #define Z_ 2
  311. #define Limit_Motor_X GET_PIN(C,13) //IO输入,X轴限位
  312. #define Limit_Motor_Z GET_PIN(B,9) //IO输入,Y轴限位
  313. #define Limit_Motor_Y GET_PIN(B,8) //IO输入,Z轴限位
  314. uint8_t ctr_swz(uint8_t status_swz); //z轴的电机开关控制
  315. uint32_t mapSpeed(int a1);
  316. uint32_t ctr_move(uint8_t DIR_,uint8_t dir_,uint32_t dis_,uint32_t pulse);
  317. void stop_move(void);
  318. void slidelock(); //电机移动完毕后上锁
  319. void turnlimit(void); //位移兼限位开关功能
  320. void motor_turnlimit_req(void); //非阻塞请求卷带电机旋转一次(由电机任务线程异步执行, 不阻塞串口解析)
  321. uint8_t Replace_Filter(void);
  322. /***************************************************/
  323. //线程
  324. int Workstatus_check(void);
  325. int Work_Loop_Task(void);
  326. int slide_Fresh(void);
  327. int Motor_Task_Init(void);
  328. int thread_delete_workloop(void);
  329. int thread_restart_workloop(void);
  330. #endif /* APPLICATIONS_INC_CONTROL_H_ */