From 737a981dc473a1e6018bd7e0db35fee69e5b3b01 Mon Sep 17 00:00:00 2001 From: yincheng.zhong <634916154@qq.com> Date: 星期五, 05 五月 2023 15:37:53 +0800 Subject: [PATCH] 初步测试完成 --- 源码/核心板/Src/application/beep_logic_app.c | 28 ++++++++++++++++------------ 1 files changed, 16 insertions(+), 12 deletions(-) diff --git "a/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/application/beep_logic_app.c" "b/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/application/beep_logic_app.c" index dafd917..f6ce661 100644 --- "a/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/application/beep_logic_app.c" +++ "b/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/application/beep_logic_app.c" @@ -157,6 +157,7 @@ } } #define RELAY2IDHEAD 9 +extern int16_t tag_angle[TAG_NUM_IN_SYS],alarm_angle; extern u16 tagid_list[TAG_NUM_IN_SYS]; void main_logic(void) //主逻辑在这里执行 { @@ -170,20 +171,23 @@ beep_judge_cnt = 0; min_dist1=0x1ffff; min_dist2=0x1ffff; - for(i = 0; i < 255;i++) + for(i = 0; i < TAG_NUM_IN_SYS;i++) { - if((tagid_list[i]>>12)!=RELAY2IDHEAD) - { - if(g_Tagdist[i] < min_dist1&&g_Tagdist[i]>g_com_map[ALARM_DISTANCE1]) + if((tagid_list[i]>>12)!=RELAY2IDHEAD) { - min_dist1=g_Tagdist[i]; - } - }else{ - if(g_Tagdist[i] < min_dist2&&g_Tagdist[i]>g_com_map[RELAY2_DISTANCE1]) - { - min_dist2=g_Tagdist[i]; - } - } + if(g_Tagdist[i] < min_dist1&&g_Tagdist[i]>g_com_map[ALARM_DISTANCE1]) + { + if(tag_angle[i]>alarm_angle) + min_dist1=g_Tagdist[i]; + } + + }else{ + if(g_Tagdist[i] < min_dist2&&g_Tagdist[i]>g_com_map[RELAY2_DISTANCE1]) + { + if(tag_angle[i]>alarm_angle) + min_dist2=g_Tagdist[i]; + } + } } Relay1Task(); // Relay2Task(min_dist2); -- Gitblit v1.9.3