Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- # -*- coding: utf-8 -*-
- """
- Spyder Editor
- This is a temporary script file.
- """
- import rospy
- import serial
- ### Start Rospy and get all the parameters.
- rospy.init_node('serial_connection', anonymous = True)
- serial_port = rospy.get_param('~port','/dev/ttyUSB0')
- serial_baud = rospy.get_param('~baudrate',4800)
- ### Read the serial ports with above parameters
- port = serial.Serial(serial_port, serial_baud, timeout=3)
- lat = []
- lon = []
- alt = []
- c = 0
- while c < 10:
- data = str(port.readline())
- if(data.startswith('$GPGGA')): # $GPGGA
- print(data)
- ## Seperating with commas
- datalist = data.split(',')
- ### Saving Lattitude, longitude and Altitude in each reading in seperate lists.
- lat.append(datalist[2])
- lon.append(datalist[4])
- alt.append(datalist[9])
- c = c + 1
- print(lat)
- print(lon)
- print(alt)
- # Convert lat, lon to utm using python utm package
- import utm
- utm_val = []
- for i in range(0, len(lat)):
- utm_values = utm.from_latlon(lat[i], lon[i])
- utm_val.append(utm_values)
- print(utm_val)
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement