Beispiel #1
0
 def gazebo_truth_callback(self, msg):
     self.truth_pos.append(jmu.list_of_xyz(msg.pose.pose.position))
     self.truth_ori.append(jmu.list_of_xyzw(msg.pose.pose.orientation))
     self.truth_lvel.append(jmu.list_of_xyz(msg.twist.twist.linear))
     self.truth_rvel.append(jmu.list_of_xyz(msg.twist.twist.angular))
     self.truth_stamp.append(msg.header.stamp.to_sec())
Beispiel #2
0
 def smocap_cbk(self, msg):
     self.mocap_pos.append(jmu.list_of_xyz(msg.pose.pose.position))
     self.mocap_ori.append(jmu.list_of_xyzw(msg.pose.pose.orientation))
     self.mocap_stamp.append(msg.header.stamp)