V1.6 给客户测试

yincheng.zhong

2024-09-03 9b59e87d8280de129c18421b5d12cf96d0ea904e

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
#include "board.h"
#define GPS_OPEN_TIME_OUT  240
#define GPS_RESTART_TIME1  1200
#define GPS_RESTART_TIME2  120
 
extern uint16_t gps_wait_count;
uint8_t gps_power_state,gps_uwb_flag,gps_4g_flag,gps_timeout_flag,gps_need_data_flag = 1;
void GPS_Poll(void)
{
    if(gps_4g_flag||gps_uwb_flag) 
        {
        
        if(!gps_timeout_flag)
            {
            if(gps_need_data_flag)
                {
                gps_power_state = 1;  //´ò¿ªGPSµçÔ´
                gps_wait_count++;
                if(gps_wait_count>=GPS_OPEN_TIME_OUT) 
                    { //³¬Ê±Çл»¹¤×÷״̬
                    gps_timeout_flag=1;//´®¿ÚÌí¼Ó¸Ä±ätimeoutÂß¼­
                    gps_wait_count=0;
                    gps_need_data_flag=0;//Çл»Îª¹Ø±Õģʽ
                }
            } else {
                gps_wait_count++;
                gps_power_state=0;//¹Ø±ÕGPS
                if(gps_wait_count>GPS_RESTART_TIME2)
                    {
                    gps_power_state=1;//¿ªÆôGPS
                    gps_need_data_flag=1;
                    gps_wait_count=0;
                }
            }
        } else { //³¬Ê±¹¤×÷״̬
            if(gps_need_data_flag)
                {
                gps_power_state = 1;  //´ò¿ªGPSµçÔ´
                gps_wait_count++;
                if(gps_wait_count>=GPS_OPEN_TIME_OUT) 
                    { //³¬Ê±Çл»¹¤×÷״̬
                    gps_timeout_flag=1;
                    gps_need_data_flag=0;
                    gps_wait_count=0;
                }
            } else {
                gps_wait_count++;
                gps_power_state=0;//¹Ø±ÕGPS
                if(gps_wait_count>GPS_RESTART_TIME1) {
                    gps_power_state=1;//¿ªÆôGPS
                    gps_need_data_flag=1;
                    gps_wait_count=0;
                }
            }
 
        }
    } else {
        gps_power_state=0;//¹Ø±Õgps
        gps_wait_count=0;
        gps_timeout_flag=0;
        gps_need_data_flag=1;
    }
}
void GpsConrol(uint8_t flag_4g_uwb,uint8_t open_close)
{
    if(gps_4g_flag==0&&gps_uwb_flag==0)
        if(open_close)
        {
            gps_wait_count = 0;
            gps_need_data_flag = 1;
            gps_timeout_flag = 0;
        }
    if(flag_4g_uwb)
    {
        gps_4g_flag = open_close;
    } else {
        gps_uwb_flag = open_close;
    }
 
}