• 已解决 73482 个问题
  • 已帮助 5993 位优秀工程师

PID车辆横向控制如何判断转角的正负

loulou 2019-10-15 浏览量:2052
最近在simulink上设计一个车辆横向控制的PID控制器,其中pid的输入量是cross track error(车辆离参考路径的横向距离),pid的输出量是车前轮的转角,那么问题来了,我的输出量也就是车前轮的转角是需要区分正负的,因为执行的时候需要让车子知道我是该往左转还是往右转,那么我如何知道我我的前轮转角应该是正的还是负的,换句话说我如何判断我的车是在参考路径的左边还是右边?已知车辆当前的pose(xyheading) 和参考路径waypoint的pose(xyheading),还有速度。
非常感谢大家的回答!
0 0 收起

我来回答

上传资料:
选择文件 文件大小不超过15M(格式支持:doc、ppt、xls、pdf、zip、rar、txt)
所有亮答 数量:1
  • 这个问题,会坐标系变换的话很简单。

    把参考路径上的参考点,沿路径切向是轴1,沿垂直水平面的竖直方向为轴2,用右手定则确定轴3。把车辆坐标往轴1、轴2、轴3组成的坐标系转换,轴3上的分量就是正/负的横向距离。

相关问题

问题达人换一批

PID车辆横向控制如何判断转角的正负