diff --git a/src/dataset/ManageDataset/project_vel_to_cam.py b/src/dataset/ManageNCLTDataset/project_vel_to_cam.py similarity index 98% rename from src/dataset/ManageDataset/project_vel_to_cam.py rename to src/dataset/ManageNCLTDataset/project_vel_to_cam.py index 0356d4e..415e06f 100644 --- a/src/dataset/ManageDataset/project_vel_to_cam.py +++ b/src/dataset/ManageNCLTDataset/project_vel_to_cam.py @@ -120,7 +120,7 @@ def project_vel_to_cam(hits, cam_num): def main(args): if len(args)<4: - print """Incorrect usage. + print("""Incorrect usage. To use: @@ -129,7 +129,7 @@ To use: vel: The velodyne binary file (timestamp.bin) img: The undistorted image (timestamp.tiff) cam_num: The index (0 through 5) of the camera -""" + """) return 1 diff --git a/src/dataset/ManageDataset/read_gps.py b/src/dataset/ManageNCLTDataset/read_gps.py similarity index 100% rename from src/dataset/ManageDataset/read_gps.py rename to src/dataset/ManageNCLTDataset/read_gps.py diff --git a/src/dataset/ManageDataset/read_ground_truth.py b/src/dataset/ManageNCLTDataset/read_ground_truth.py similarity index 100% rename from src/dataset/ManageDataset/read_ground_truth.py rename to src/dataset/ManageNCLTDataset/read_ground_truth.py diff --git a/src/dataset/ManageDataset/read_hokuyo_30m.py b/src/dataset/ManageNCLTDataset/read_hokuyo_30m.py similarity index 100% rename from src/dataset/ManageDataset/read_hokuyo_30m.py rename to src/dataset/ManageNCLTDataset/read_hokuyo_30m.py diff --git a/src/dataset/ManageDataset/read_hokuyo_4m.py b/src/dataset/ManageNCLTDataset/read_hokuyo_4m.py similarity index 100% rename from src/dataset/ManageDataset/read_hokuyo_4m.py rename to src/dataset/ManageNCLTDataset/read_hokuyo_4m.py diff --git a/src/dataset/ManageDataset/read_ms25.py b/src/dataset/ManageNCLTDataset/read_ms25.py similarity index 100% rename from src/dataset/ManageDataset/read_ms25.py rename to src/dataset/ManageNCLTDataset/read_ms25.py diff --git a/src/dataset/ManageDataset/read_ms25_euler.py b/src/dataset/ManageNCLTDataset/read_ms25_euler.py similarity index 100% rename from src/dataset/ManageDataset/read_ms25_euler.py rename to src/dataset/ManageNCLTDataset/read_ms25_euler.py diff --git a/src/dataset/ManageDataset/read_odom.py b/src/dataset/ManageNCLTDataset/read_odom.py similarity index 100% rename from src/dataset/ManageDataset/read_odom.py rename to src/dataset/ManageNCLTDataset/read_odom.py diff --git a/src/dataset/ManageDataset/undistort.py b/src/dataset/ManageNCLTDataset/undistort.py similarity index 100% rename from src/dataset/ManageDataset/undistort.py rename to src/dataset/ManageNCLTDataset/undistort.py diff --git a/src/dataset/dataManipulation/GPSmanip.py b/src/dataset/dataManipulation/GPSmanip.py new file mode 100644 index 0000000..7ee0f2f --- /dev/null +++ b/src/dataset/dataManipulation/GPSmanip.py @@ -0,0 +1,24 @@ +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)