| | |
| | | } |
| | | } |
| | | #define RELAY2IDHEAD 9 |
| | | extern int16_t tag_angle[TAG_NUM_IN_SYS],alarm_angle; |
| | | extern int16_t tag_angle[TAG_NUM_IN_SYS],tag_dist[TAG_NUM_IN_SYS],alarm_angle; |
| | | extern u16 tagid_list[TAG_NUM_IN_SYS]; |
| | | void main_logic(void) //主é»è¾å¨è¿éæ§è¡ |
| | | { |
| | |
| | | min_dist2=0x1ffff; |
| | | 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(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]; |
| | | } |
| | | } |
| | | min_dist1=g_Tagdist[i]; |
| | | } |
| | | if(tag_dist[i] < min_dist2&&tag_dist[i]>g_com_map[RELAY2_DISTANCE1]) |
| | | { |
| | | if(tag_angle[i]>alarm_angle) |
| | | min_dist2=tag_dist[i]; |
| | | } |
| | | |
| | | } |
| | | Relay1Task(); |
| | | // Relay2Task(min_dist2); |
| | | Relay2Task(min_dist2); |
| | | |
| | | } |
| | | }else{ |