User Tools

Site Tools


neurali:husky_python1

husky codice python

#!/usr/bin/env python
PKG = 'numpy_tutorial'
import roslib
#roslib.load_manifest(PKG)
 
import rospy
# from rospy_tutorials.msg import Floats
# import sys, rospy, cv, cv2
# from std_msgs.msg import String
from geometry_msgs.msg import Twist, Point, Point32, Polygon
from sensor_msgs.msg import Image, LaserScan, Joy
import numpy as np
from rospy.numpy_msg import numpy_msg
 
from sensor_msgs.msg import Imu
 
def callback(data):
    # print rospy.get_name(), "I heard %s"%str(data)
    # print type(data) <class 'rospy.numpy_msg.Numpy_sensor_msgs__Imu
	print "ruota?",data.angular_velocity.z
	print "avanti?",data.linear_acceleration.x
 
def listener():
    rospy.init_node('listener')
    rospy.Subscriber("imu/data", numpy_msg(Imu), callback) # topic name imu/data???
    rospy.spin()
 
if __name__ == '__main__':
    listener()
neurali/husky_python1.txt · Last modified: 2020/06/08 22:20 by 127.0.0.1