Advertisement
fuccpuff

Untitled

Nov 20th, 2024 (edited)
14
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.16 KB | None | 0 0
  1. import rospy
  2. from sensor_msgs.msg import Imu
  3.  
  4. rospy.init_node('imu_single_display', anonymous=True)
  5.  
  6. # сохраняю данные imu
  7. imu_data = None
  8.  
  9. # получаю данные imu из топика
  10. def imu_callback(data):
  11. global imu_data
  12. imu_data = data # сохраняю данные для дальнейшего использования
  13.  
  14. # подписываюсь на топик imu
  15. rospy.Subscriber('/mavros/imu/data', Imu, imu_callback)
  16.  
  17. # жду, пока данные не станут доступны
  18. rospy.loginfo("жду данные imu...")
  19. rospy.sleep(1) # даю время для получения данных
  20.  
  21. if imu_data:
  22. # вывожу данные акселерометра
  23. accel = imu_data.linear_acceleration
  24. rospy.loginfo("ускорение: x={:.2f}, y={:.2f}, z={:.2f}".format(accel.x, accel.y, accel.z))
  25.  
  26. # вывожу данные гироскопа
  27. gyro = imu_data.angular_velocity
  28. rospy.loginfo("угловая скорость: x={:.2f}, y={:.2f}, z={:.2f}".format(gyro.x, gyro.y, gyro.z))
  29. else:
  30. rospy.logwarn("не удалось получить данные imu")
  31.  
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement