| | |
| | | #define ONTIME3 5 // 500ms |
| | | #define OFFTIME3 5 // 500ms |
| | | |
| | | uint16_t min_dist1,min_dist2; |
| | | int32_t min_dist1,min_dist2; |
| | | extern u16 JDQ_time; |
| | | void Relay1Task(u16 min_dist) |
| | | { |
| | |
| | | beep_state=2; |
| | | distoffset1=0; |
| | | distoffset2=0; |
| | | beep_timer = 0; |
| | | timer_state = 1; |
| | | } |
| | | else if (min_dist <= g_com_map[ALARM_DISTANCE3]+distoffset2) |
| | | { |
| | |
| | | beep_state=0; |
| | | distoffset1=0; |
| | | distoffset2=0; |
| | | beep_timer = 0; |
| | | timer_state = 1; |
| | | } |
| | | |
| | | if(beep_state!=0) |
| | |
| | | beep_state2=2; |
| | | distoffset12=0; |
| | | distoffset22=0; |
| | | timer_state2=1; |
| | | beep_timer2=0; |
| | | } |
| | | else if (min_dist <= g_com_map[RELAY2_DISTANCE3]+distoffset22) |
| | | { |
| | |
| | | beep_state2=0; |
| | | distoffset12=0; |
| | | distoffset22=0; |
| | | timer_state2=1; |
| | | beep_timer2=0; |
| | | } |
| | | |
| | | if(beep_state2!=0) |
| | |
| | | if(beep_judge_cnt++ >= 100) |
| | | { |
| | | beep_judge_cnt = 0; |
| | | min_dist1=0xffff; |
| | | min_dist2=0xffff; |
| | | min_dist1=0x1ffff; |
| | | min_dist2=0x1ffff; |
| | | for(i = 0; i < 255;i++) |
| | | { |
| | | if(g_Tagdist[i] < min_dist1&&g_Tagdist[i]>g_com_map[ALARM_DISTANCE1]) |