天天看点

ros重组传感器数据

测试函数

仅供我自学的

#!/usr/bin/env python

import rospy
from sensor_msgs.msg import LaserScan


if __name__ == "__main__":
 rospy.init_node("subscriber1")
 while(1):
 # ranges=[]
  msg1=rospy.wait_for_message('rexrov/sonar', LaserScan, timeout=3)
  msg2 = rospy.wait_for_message('rexrov/sss_right', LaserScan, timeout=3)
  msg3 = rospy.wait_for_message('rexrov/sss_left', LaserScan, timeout=3)
  ranges=msg2.ranges+msg1.ranges+msg3.ranges
  #print(ranges)
  ranges=list(ranges)
  print(ranges)
  print(msg2.ranges)
 rospy.spin()
           
ros重组传感器数据

sonar数据重组输出1*23

还差一个测深仪数据

问题:采样数据太少,障碍物太小需要重新设置