| | |
| | | |
| | | #define ONTIME3 1 // 500ms |
| | | #define OFFTIME3 5 // 500ms |
| | | int16_t min_dist; |
| | | void main_logic(void) //主é»è¾å¨è¿éæ§è¡ |
| | | { |
| | | static uint8_t beep_state,timer_state,beep_timer,beep_ontime,beep_offtime; |
| | | uint16_t i, min_dist; |
| | | int16_t i; |
| | | //é¤UWBä¹å¤çå
¶ä»ä»£ç ... |
| | | static uint16_t beep_judge_cnt = 0; |
| | | if(beep_judge_cnt++ >= 100) |
| | | { |
| | | beep_judge_cnt = 0; |
| | | min_dist=0xffff; |
| | | min_dist=0x7fff; |
| | | for(i = 0; i < 255;i++) |
| | | { |
| | | if(g_Tagdist[i] < min_dist) |
| | |
| | | beep_ontime = ONTIME1; |
| | | beep_offtime = OFFTIME1; |
| | | beep_state=1; |
| | | }else if (min_dist <= g_com_map[ALARM_DISTANCE2]) |
| | | RELAY1_ON; |
| | | RELAY2_ON; |
| | | |
| | | } |
| | | else if (min_dist <= g_com_map[ALARM_DISTANCE2]) |
| | | { |
| | | beep_ontime = ONTIME2; |
| | | beep_offtime = OFFTIME2; |
| | | beep_state=1; |
| | | }else if (min_dist <= g_com_map[ALARM_DISTANCE3]) |
| | | { |
| | | beep_ontime = ONTIME3; |
| | | beep_offtime = OFFTIME3; |
| | | beep_state=1; |
| | | }else{ |
| | | RELAY2_ON; |
| | | } |
| | | //else if (min_dist <= g_com_map[ALARM_DISTANCE3]) |
| | | // { |
| | | // beep_ontime = ONTIME3; |
| | | // beep_offtime = OFFTIME3; |
| | | // beep_state=1; |
| | | // } |
| | | else{ |
| | | beep_state=0; |
| | | } |
| | | if (min_dist >= g_com_map[ALARM_DISTANCE1]+10) |
| | | { |
| | | RELAY1_OFF; |
| | | } |
| | | |
| | | if (min_dist >= g_com_map[ALARM_DISTANCE2]+10) |
| | | { |
| | | RELAY2_OFF; |
| | | } |
| | | |
| | | |
| | | if(beep_state==1) |
| | | { |