Ejemplo n.º 1
0
def timer_callback(msg):
    pubmsg = servo()
    pubmsg.id = 1
    if high == True:
        pubmsg.angle = -rospy.get_param('~angle') - 0.4
    else:
        pubmsg.angle = -rospy.get_param('~angle')
    s.publish(pubmsg)
Ejemplo n.º 2
0
def timer_callback(msg):
    pubmsg = servo()
    pubmsg.id = 1
    if high == True:
        pubmsg.angle = -rospy.get_param('~angle')-0.4
    else:
        pubmsg.angle = -rospy.get_param('~angle')
    s.publish( pubmsg )
Ejemplo n.º 3
0
def callback(msg):
    pubmsg = servo()
    pubmsg.stamp = rospy.get_rostime()
    pubmsg.id = msg.id
    try:
        pubmsg.angle = (k.setAngle(msg.id, 7500 + msg.angle/(0.000589049) )-7500) * (0.000589049)
        pub.publish( pubmsg )

    except:
        rospy.logerr("Communication error")
Ejemplo n.º 4
0
def callback(msg):
    pubmsg = servo()
    pubmsg.stamp = rospy.get_rostime()
    pubmsg.id = msg.id
    try:
        pubmsg.angle = (k.setAngle(msg.id, 7500 + msg.angle /
                                   (0.000589049)) - 7500) * (0.000589049)
        pub.publish(pubmsg)

    except:
        rospy.logerr("Communication error")
Ejemplo n.º 5
0
def targetCallback(msg):
    pubmsg = servo()
    pubmsg.id = 1
    pubmsg.angle = -msg.data
    s.publish(pubmsg)
Ejemplo n.º 6
0
def targetCallback(msg):
    pubmsg = servo()
    pubmsg.id = 1
    pubmsg.angle = -msg.data
    s.publish( pubmsg )