Advertisement
Guest User

ROS, working till utm values

a guest
Jan 26th, 2020
79
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Python 1.32 KB | None | 0 0
  1. # -*- coding: utf-8 -*-
  2. """
  3. Spyder Editor
  4.  
  5. This is a temporary script file.
  6. """
  7.  
  8. import rospy
  9. import serial
  10.  
  11. ### Start Rospy and get all the parameters.
  12. rospy.init_node('serial_connection', anonymous = True)
  13. serial_port = rospy.get_param('~port','/dev/ttyUSB0')
  14. serial_baud = rospy.get_param('~baudrate',4800)
  15.  
  16. ### Read the serial ports with above parameters
  17. port = serial.Serial(serial_port, serial_baud, timeout=3)
  18.  
  19.  
  20. lat = []
  21. lon = []
  22. alt = []
  23.  
  24. c = 0
  25.  
  26. while c < 10:
  27.     data = str(port.readline())
  28.  
  29.     if(data.startswith('$GPGGA')): # $GPGGA
  30.         print(data)
  31.        
  32.         ## Seperating with commas
  33.         datalist = data.split(',')
  34.        
  35.         ### Saving Lattitude, longitude and Altitude in each reading in seperate lists.
  36.         lat.append(datalist[2])
  37.         lon.append(datalist[4])
  38.         alt.append(datalist[9])
  39.        
  40.     c = c + 1
  41.        
  42. print(lat)
  43. print(lon)
  44. print(alt)    
  45.  
  46.  
  47. # Convert lat, lon to utm using python utm package
  48. import utm
  49.  
  50. utm_val = []
  51.  
  52. for i in range(0, len(lat)):
  53.    
  54.     utm_values = utm.from_latlon(lat[i], lon[i])          
  55.     utm_val.append(utm_values)
  56.    
  57.    
  58. print(utm_val)
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement