From 612814daf9bb44c4104ab3708d8a5fcba6f2a6d5 Mon Sep 17 00:00:00 2001 From: zhyinch <zhyinch@gmail.com> Date: 星期五, 23 七月 2021 14:25:42 +0800 Subject: [PATCH] 增加继电器控制时间,还有速度显示 --- 源码/核心板/Src/main.c | 27 +++++++++++++++++++-------- 1 files changed, 19 insertions(+), 8 deletions(-) diff --git "a/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/main.c" "b/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/main.c" index e80c138..b8e263f 100644 --- "a/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/main.c" +++ "b/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/main.c" @@ -72,11 +72,24 @@ checksum = Checksum_u16(&hbsend[2],12); memcpy(&hbsend[14],&checksum,2); } + uint16_t vel_factor,pos_factor; -u16 tyncpoll_time,dist_threshold; +u16 tyncpoll_time,dist_threshold,group_id; u16 slottime,max_slotpos; extern u8 module_power; extern u16 total_slotnum; +void ComMapCheck(void) +{ + + if(g_com_map[WAR_JDQ_TIME]>1000||g_com_map[WAR_JDQ_TIME]<0) + { + g_com_map[WAR_JDQ_TIME] = 1; + } + if(dist_threshold<300) + {dist_threshold = 300;} + if(dist_threshold>15000) + {dist_threshold = 15000;} +} void Program_Init(void) { float temp; u16 temp2; @@ -101,14 +114,12 @@ g_com_map[COM_INTERVAL]=100; } - g_com_map[VERSION] = 0x012d; -dist_threshold = (g_com_map[SPEEDFILTER_THRES]*10)/(1000/g_com_map[COM_INTERVAL]); - if(dist_threshold<300) - {dist_threshold = 300;} - if(dist_threshold>15000) - {dist_threshold = 15000;} + g_com_map[VERSION] = 0x0133; + dist_threshold = (g_com_map[SPEEDFILTER_THRES]*10)/(1000/g_com_map[COM_INTERVAL]); + ComMapCheck(); g_com_map[SW_TYPE] = SW_FANGZHUANG; dev_id = g_com_map[DEV_ID]; + group_id=g_com_map[GROUP_ID]; slottime=ceil((double)g_com_map[MAX_REPORT_ANC_NUM]*SLOT_SCALE)+3; max_slotpos=g_com_map[COM_INTERVAL]/slottime; tyncpoll_time=(g_com_map[DEV_ID]%max_slotpos)*slottime; @@ -185,7 +196,7 @@ if(heartbeat_timer>1000) { heartbeat_timer=0; - if(g_com_map[HEARTBEAT]&&g_com_map[DEV_ROLE]==0) + if(g_com_map[HEARTBEAT]) HeatBeat(); } if(flag_newsecond) -- Gitblit v1.9.3