示例#1
0
    def parse_collision(self, data):
        if self.is_connected:
            now = rospy.Time.now()
            collision = SpheroCollision()
            collision.header.stamp = now
            collision.x = data["X"]
            collision.y = data["Y"]
            collision.z = data["Z"]
            collision.axis = int(data["Axis"])
            collision.x_magnitude = data["xMagnitude"]
            collision.y_magnitude = data["yMagnitude"]
            collision.speed = data["Speed"]
            collision.timestamp = data["Timestamp"]

            self.collision = collision
            self.collision_pub.publish(self.collision)
示例#2
0
文件: sphero.py 项目: x75/sphero_ros
 def parse_collision(self, data):
     if self.is_connected:
         now = rospy.Time.now()
         collision = SpheroCollision()
         collision.header.stamp = now
         collision.x = data["X"]
         collision.y = data["Y"]
         collision.z = data["Z"]
         collision.axis = int(data["Axis"])
         collision.x_magnitude = data["xMagnitude"]
         collision.y_magnitude = data["yMagnitude"]
         collision.speed = data["Speed"]
         collision.timestamp = data["Timestamp"]
         
         self.collision = collision
         self.collision_pub.publish(self.collision)