【发布时间】:2026-02-07 09:35:01
【问题描述】:
我是 ROS 新手,我的任务是开发一种算法,允许 只要前面没有障碍物,机器人就会向前移动 他,但它一直卡在我在凉亭模拟中放在他面前的障碍中。 当我深入检查时,我发现我的机器人似乎扫描到侧面而不是前面。当我检查扫描仪激光的规格时 它说扫描的角度应该最大在-90度到90度之间,最好比那个小得多。因此,由于“硬件”问题,我似乎无法完成任务,但这对我来说似乎很奇怪。 有人可以帮忙吗?
这是我的代码:
#!/usr/bin/python
#
# stopper.py
#
# Created on:
# Author:
#
import rospy
import math
from geometry_msgs.msg import Twist
from sensor_msgs.msg import LaserScan
class Stopper(object):
def __init__(self, forward_speed):
self.forward_speed = forward_speed
self.min_scan_angle = -10/180*math.pi
self.max_scan_angle = 10 / 180 * math.pi
self.min_dist_from_obstacle = 0.5
self.keep_moving = True
self.command_pub = rospy.Publisher("/cmd_vel_mux/input/teleop", Twist, queue_size=10)
self.laser_subscriber = rospy.Subscriber("scan",LaserScan, self.scan_callback, queue_size=1)
def start_moving(self):
rate = rospy.Rate(10)
rospy.loginfo("Starting to move")
while not rospy.is_shutdown() and self.keep_moving:
self.move_forward()
rate.sleep()
def move_forward(self):
move_msg = Twist()
move_msg.linear.x = self.forward_speed
self.command_pub.publish(move_msg)
def scan_callback(self, scan_msg):
for dist in scan_msg.ranges:
if dist < self.min_dist_from_obstacle:
self.keep_moving = False
break
【问题讨论】: