Advertisement
Guest User

Untitled

a guest
Jul 16th, 2018
65
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.79 KB | None | 0 0
  1. void getData(){
  2.  
  3. char c;
  4.  
  5. int q = 0;
  6. while( q < 2){
  7. if (Serial1.available()) {
  8.  
  9. c = Serial1.read();
  10. if (c == '$'){
  11. q ++;
  12. }
  13. if ( q == 1){
  14. data += c;
  15. }
  16. if( data.startsWith("$") && c == '\n'){
  17.  
  18. q++;
  19.  
  20. }
  21.  
  22. }
  23. if (data.length() == 66){ //other gps (Blue 6M)
  24.  
  25. 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);
  26. }
  27. }
  28. if (data.length() == 71){
  29. data = data.substring(0,50) + "0" + data.substring(50,72);
  30. }
  31.  
  32. if (data.length() == 72){
  33. data = data.substring(0,45) + "0" + data.substring(45,73);
  34. }
  35.  
  36. if (data.length() == 73){
  37. data = data.substring(0,45) + "0" + data.substring(45,74);
  38. }
  39.  
  40.  
  41.  
  42. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement