Exemplo n.º 1
0
from fake_sensor import FakeSensor  # <1>

import rospy
import tf

from geometry_msgs.msg import Quaternion  # <2>


def make_quaternion(angle):  # <3>
    q = tf.transformations.quaternion_from_euler(0, 0, angle)
    return Quaternion(*q)


if __name__ == '__main__':
    sensor = FakeSensor()  # <4>

    rospy.init_node('fake_sensor')

    pub = rospy.Publisher('angle', Quaternion, queue_size=10)

    rate = rospy.Rate(10.0)  # <5>
    while not rospy.is_shutdown():  # <6>
        angle = sensor.value() * 2 * pi / 100.0

        q = make_quaternion(angle)

        pub.publish(q)

        rate.sleep()
Exemplo n.º 2
0
from fake_sensor import FakeSensor  # <1>

import rospy
import tf

from geometry_msgs.msg import Quaternion  # <2>


def make_quaternion(angle):  # <3>
    q = tf.transformations.quaternion_from_euler(0, 0, angle)
    return Quaternion(*q)


if __name__ == "__main__":
    sensor = FakeSensor()  # <4>

    rospy.init_node("fake_sensor")

    pub = rospy.Publisher("angle", Quaternion, queue_size=10)

    rate = rospy.Rate(10.0)  # <5>
    while not rospy.is_shutdown():  # <6>
        angle = sensor.value() * 2 * pi / 100.0

        q = make_quaternion(angle)

        pub.publish(q)

        rate.sleep()
Exemplo n.º 3
0
from math import pi

from fake_sensor import FakeSensor  # <1>

import rospy
import tf

from geometry_msgs.msg import Quaternion  # <2>


def make_quaternion(angle):
    q = tf.transformations.quaternion_from_euler(0, 0, angle)
    return Quaternion(*q)

def publish_value(value):
    angle = value * 2 * pi / 100.0
    q = make_quaternion(angle)
    pub.publish(q)

if __name__ == '__main__':
    sensor = FakeSensor()
    rospy.init_node('fake_sensor')

    pub = rospy.Publisher('angle', Quaternion, queue_size=10) 

    rate = rospy.Rate(10.0)

    while not rospy.is_shutdown():
        v = sensor.value()
        sensor.register_callback(publish_value(v))