uarm_core.py 文件源码

def readCurrentCoords():
    cc = uarm.get_position()
    print 'Current location is x: %2.2fcm, y: %2.2fcm, z: %2.2fcm.' %(float(cc[0]), float(cc[1]), float(cc[2]))

    rospy.set_param('current_x', cc[0])
    rospy.set_param('current_y', float(cc[1]))
    rospy.set_param('current_z', float(cc[2]))

# Read current Angles function