|
|
@ -128,7 +128,7 @@ def imu_callback(imu, vehicle_state): |
|
|
|
vehicle_state.bearing_deg = math.degrees(imu.compass) |
|
|
|
vehicle_state.bearing_deg = math.degrees(imu.compass) |
|
|
|
dat = messaging.new_message('accelerometer') |
|
|
|
dat = messaging.new_message('accelerometer') |
|
|
|
dat.accelerometer.sensor = 4 |
|
|
|
dat.accelerometer.sensor = 4 |
|
|
|
dat.accelerometer.type = 0x1 |
|
|
|
dat.accelerometer.type = 0x10 |
|
|
|
dat.accelerometer.timestamp = dat.logMonoTime # TODO: use the IMU timestamp |
|
|
|
dat.accelerometer.timestamp = dat.logMonoTime # TODO: use the IMU timestamp |
|
|
|
dat.accelerometer.init('acceleration') |
|
|
|
dat.accelerometer.init('acceleration') |
|
|
|
dat.accelerometer.acceleration.v = [imu.accelerometer.x, imu.accelerometer.y, imu.accelerometer.z] |
|
|
|
dat.accelerometer.acceleration.v = [imu.accelerometer.x, imu.accelerometer.y, imu.accelerometer.z] |
|
|
|