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())
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)