DFRobot TEL0051 Manual page 28

132
f o r ( i n t i = 0 ; i < G P S _ B U F _ S I Z E ; i + + ) {
133
d e l a y ( 7 ) ;
134
i f ( S e r i a l 1 . a v a i l a b l e ( ) ) {
135
g p s _ b u f [ i ] = S e r i a l 1 . r e a d ( ) ;
136
} e l s e {
137
# i f d e f D E B U G
138
S e r i a l . p r i n t ( " r e a d " ) ;
139
S e r i a l . p r i n t ( i ) ;
140
S e r i a l . p r i n t l n ( " c h a r a c t e r " ) ;
141
# e n d i f
142
r e t u r n 1 ;
143
}
144
}
145
# i f d e f D E B U G
146
S e r i a l . p r i n t l n ( " e r r o r ! d a t a i s s o b i g ! " ) ;
147
# e n d i f
148
r e t u r n 0 ;
149
}
150
151
/ / t e s t h e a d o f g p s _ b u f [ ] i f i s " $ G P G G A " o r n o t
152
s t a t i c i n t i s _ G P G G A ( ) {
153
c h a r g g a _ i d [ 7 ] = " $ G P G G A " ;
154
f o r ( i n t i = 0 ; i < 6 ; i + + )
155
i f ( g g a _ i d [ i ] ! = g p s _ b u f [ i ] )
156
r e t u r n 0 ;
157
r e t u r n 1 ;
158
}
159
160
/ /
161
s t a t i c u i n t 8 _ t g e t _ g g a _ l e n g ( ) {
162
u i n t 8 _ t l ;
163
f o r ( l = 0 ; l < G P S _ B U F _ S I Z E & & g p s _ b u f [ l ] ! = 0 x 0 d ; l + + ) ;
164
r e t u r n l ;
165
}
166
167
/ / b u i l d g g a _ p [ ] b y g p s _ b u f
168
s t a t i c v o i d b u i l d _ g g a _ p ( ) {
169
i n t p , b ;
170
f o r ( p = b = 0 ; p < G G A _ N U M & & b < G P S _ B U F _ S I Z E ; p + + , b + + ) {
171
g g a _ p [ p ] = ( g p s _ b u f + b ) ; / /
172
i f ( g p s _ b u f [ b ] = = ' , ' )
173
c o n t i n u e ;
174
f o r ( b + + ; b < G P S _ B U F _ S I Z E & & g p s _ b u f [ b ] ! = ' , ' ; b + + ) ;
175
}
176
}