Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- void getData(){
- char c;
- int q = 0;
- while( q < 2){
- if (Serial1.available()) {
- c = Serial1.read();
- if (c == '$'){
- q ++;
- }
- if ( q == 1){
- data += c;
- }
- if( data.startsWith("$") && c == '\n'){
- q++;
- }
- }
- if (data.length() == 66){ //other gps (Blue 6M)
- data = data.substring(0,16) + "0" + data.substring(16,28)+ data.substring(29,42) + data.substring(43, 50) + data.substring(51,52) + "XXXXXX"+ data.substring(52,66);
- }
- }
- if (data.length() == 71){
- data = data.substring(0,50) + "0" + data.substring(50,72);
- }
- if (data.length() == 72){
- data = data.substring(0,45) + "0" + data.substring(45,73);
- }
- if (data.length() == 73){
- data = data.substring(0,45) + "0" + data.substring(45,74);
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement