(3-8-02)速度控制算法:基于Carla的十字路口车的辆控制程序

(7)函数pure_pursuit_control_wrapper(self)的功能是通过纯追踪模型实现一步车辆控制,存储关键信息,包括当前速度、位置和参考速度,应用油门-转向-刹车控制,同时检查安全距离和交通信号灯状态,最终返回是否到达终点。

def pure_pursuit_control_wrapper(self):
    '''
    对车辆应用一步控制,存储后续使用的关键信息

    Returns
    -------
    end_trajectory : bool
        车辆是否到达终点

    '''
   
    # 获取当前速度和车辆位置(包括(x,y)坐标和偏航角)
    curr_speed = self.env.get_forward_speed(self.model_uniquename)
    vehicle_pos_2d = self.env.get_transform_2d(self.model_uniquename)
    
    # 存储当前速度和位置信息
    self.speed.append(curr_speed)
    self.curr_speeds.append(curr_speed)
    
    # 在调试模式下绘制真实轨迹
    if self.debug_vehicle:
        sel
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

码农三叔

感谢鼓励

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值