Commit e7a70c3c authored by michaero's avatar michaero
Browse files

added bag.write for data

parent b0ee60af
......@@ -158,17 +158,21 @@ class PPSRadioClient:
distances = Float32MultiArray()
distances.data = [data["ranging.distance1"],data["ranging.distance2"],data["ranging.distance3"],data["ranging.distance4"],data["ranging.distance5"],data["ranging.distance6"]]
bag.write('anchorDistances',distances)
distances_pub.publish(distances)
def _xyzrpy_received_callback(self, timestamp, data, xyzrpy):
#arrXYZ = Float32MultiArray()
#arrXYZ.data = [data["xxx.x"], fdata["xxx.y"],data["xxx.z"]]
#bag.write('XYZ',arrXYZ)
#xyz_pub.publish(arrXYZ)
arrRPY = Float32MultiArray()
arrRPY.data = [data["stabilizer.roll"],data["stabilizer.pitch"],data["stabilizer.yaw"]]
bag.write('rollPitchYaw',arrRPY)
rpy_pub.publish(arrRPY)
#print arrRPY
......
Supports Markdown
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment