sravan/UMICH-NCLT-SLAP
1
0
Fork 0
mirror of https://github.com/Mobile-Robotics-W20-Team-9/UMICH-NCLT-SLAP.git synced 2025-09-09 04:13:14 +00:00
Code Issues Packages Projects Releases Wiki Activity

cleaning up files from other project

Browse Source
This commit is contained in:
snbenge
2020-04-21 22:54:35 -04:00
parent 62b9542960
commit 01fdc3d643
1 changed files with 0 additions and 24 deletions
Download Patch File Download Diff File Expand all files Collapse all files

24
src/dataset/dataManipulation/GPSmanip.py
View File

@@ -1,24 +0,0 @@
import sys
import numpy as np
def gpstoLocalFrame(lat, lng, alt):
lat0 = 0.7381566413
lng0 = -1.4610097151
alt0 = 265.8
print(np.deg2rad(lng))
dLat = np.deg2rad(lat) - lat0
print(dLat)
dLng = np.deg2rad(lng) - lng0
dAlt = alt - alt0
r = 6400000 # approx. radius of earth (m)
y = r * np.cos(lat0) * np.sin(dLng)
x = r * np.sin(dLat)
z = dAlt
return [x,y,z]
#Example
# x = gpstoLocalFrame(42.29360387311647,-83.71222615242006,272)
# print(x)