uarm_core.py 文件源码

def readStopperStatus():
    val = uarm.get_tip_sensor()
    if val == True:
        print 'Stopper is actived'
        rospy.set_param('stopper_status','HIGH')
    else:
        print 'Stopper is not actived'
        rospy.set_param('stopper_status','LOW')


# Write single angle