Skip to content
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
22 changes: 13 additions & 9 deletions python/examples/extract_imu_data.py
Original file line number Diff line number Diff line change
Expand Up @@ -65,10 +65,12 @@
gps_time = reader.convert_to_gps_time(imu_data.p1_time)
with open(path, 'w') as f:
f.write('P1 Time (sec), GPS Time (sec), Accel X (m/s^2), Y, Z, Gyro X (rad/s), Y, Z\n')
np.savetxt(f, np.concatenate([imu_data.p1_time[:, None],
gps_time[:, None],
imu_data.accel_mps2.T,
imu_data.gyro_rps.T], axis=1), fmt='%.6f')
np.savetxt(f,
np.concatenate([imu_data.p1_time[:, None],
gps_time[:, None],
imu_data.accel_mps2.T,
imu_data.gyro_rps.T], axis=1),
fmt='%.6f', delimiter=',')
else:
logger.info("No corrected IMU data.")

Expand All @@ -79,11 +81,13 @@
gps_time = reader.convert_to_gps_time(raw_imu_data.p1_time)
with open(path, 'w') as f:
f.write('P1 Time (sec), GPS Time (sec), Accel X (m/s^2), Y, Z, Gyro X (rad/s), Y, Z, Temp(C)\n')
np.savetxt(f, np.concatenate([raw_imu_data.p1_time[:, None],
gps_time[:, None],
raw_imu_data.accel_mps2.T,
raw_imu_data.gyro_rps.T,
raw_imu_data.temperature_degc[:, None]], axis=1), fmt='%.6f')
np.savetxt(f,
np.concatenate([raw_imu_data.p1_time[:, None],
gps_time[:, None],
raw_imu_data.accel_mps2.T,
raw_imu_data.gyro_rps.T,
raw_imu_data.temperature_degc[:, None]], axis=1),
fmt='%.6f', delimiter=',')
else:
logger.info("No raw IMU data.")

Expand Down
52 changes: 30 additions & 22 deletions python/examples/extract_vehicle_speed_data.py
Original file line number Diff line number Diff line change
Expand Up @@ -71,13 +71,15 @@
gps_time = reader.convert_to_gps_time(wheel_speed_data.p1_time)
with open(path, 'w') as f:
f.write('P1 Time (sec), GPS Time (sec), Front Left Speed (m/s), Front Right Speed (m/s), Back Left Speed (m/s), Back Right Speed (m/s), Gear\n')
np.savetxt(f, np.stack([wheel_speed_data.p1_time,
gps_time,
wheel_speed_data.front_left_speed_mps,
wheel_speed_data.front_right_speed_mps,
wheel_speed_data.rear_left_speed_mps,
wheel_speed_data.rear_right_speed_mps,
wheel_speed_data.gear], axis=1), fmt=['%.6f'] * 6 + ['%d'])
np.savetxt(f,
np.stack([wheel_speed_data.p1_time,
gps_time,
wheel_speed_data.front_left_speed_mps,
wheel_speed_data.front_right_speed_mps,
wheel_speed_data.rear_left_speed_mps,
wheel_speed_data.rear_right_speed_mps,
wheel_speed_data.gear], axis=1),
fmt=['%.6f'] * 6 + ['%d'], delimiter=',')
else:
logger.info("No corrected wheel speed data.")

Expand All @@ -89,13 +91,15 @@
gps_time = reader.convert_to_gps_time(raw_wheel_speed_data.p1_time)
with open(path, 'w') as f:
f.write('P1 Time (sec), GPS Time (sec), Front Left Speed (m/s), Front Right Speed (m/s), Back Left Speed (m/s), Back Right Speed (m/s), Gear\n')
np.savetxt(f, np.stack([raw_wheel_speed_data.p1_time,
gps_time,
raw_wheel_speed_data.front_left_speed_mps,
raw_wheel_speed_data.front_right_speed_mps,
raw_wheel_speed_data.rear_left_speed_mps,
raw_wheel_speed_data.rear_right_speed_mps,
raw_wheel_speed_data.gear], axis=1), fmt=['%.6f'] * 6 + ['%d'])
np.savetxt(f,
np.stack([raw_wheel_speed_data.p1_time,
gps_time,
raw_wheel_speed_data.front_left_speed_mps,
raw_wheel_speed_data.front_right_speed_mps,
raw_wheel_speed_data.rear_left_speed_mps,
raw_wheel_speed_data.rear_right_speed_mps,
raw_wheel_speed_data.gear], axis=1),
fmt=['%.6f'] * 6 + ['%d'], delimiter=',')
else:
logger.info("No raw wheel speed data.")

Expand All @@ -107,10 +111,12 @@
gps_time = reader.convert_to_gps_time(vehicle_speed_data.p1_time)
with open(path, 'w') as f:
f.write('P1 Time (sec), GPS Time (sec), Vehicle Speed (m/s), Gear\n')
np.savetxt(path, np.stack([vehicle_speed_data.p1_time,
gps_time,
vehicle_speed_data.vehicle_speed_mps,
vehicle_speed_data.gear], axis=1), fmt=['%.6f'] * 3 + ['%d'])
np.savetxt(path,
np.stack([vehicle_speed_data.p1_time,
gps_time,
vehicle_speed_data.vehicle_speed_mps,
vehicle_speed_data.gear], axis=1),
fmt=['%.6f'] * 3 + ['%d'], delimiter=',')
else:
logger.info("No corrected vehicle speed data.")

Expand All @@ -122,10 +128,12 @@
gps_time = reader.convert_to_gps_time(raw_vehicle_speed_data.p1_time)
with open(path, 'w') as f:
f.write('P1 Time (sec), GPS Time (sec), Vehicle Speed (m/s), Gear\n')
np.savetxt(path, np.stack([raw_vehicle_speed_data.p1_time,
gps_time,
raw_vehicle_speed_data.vehicle_speed_mps,
raw_vehicle_speed_data.gear], axis=1), fmt=['%.6f'] * 3 + ['%d'])
np.savetxt(path,
np.stack([raw_vehicle_speed_data.p1_time,
gps_time,
raw_vehicle_speed_data.vehicle_speed_mps,
raw_vehicle_speed_data.gear], axis=1),
fmt=['%.6f'] * 3 + ['%d'], delimiter=',')
else:
logger.info("No raw vehicle speed data.")

Expand Down
Loading