技术特征：
1.一种轮式移动平台运动轨迹预瞄跟踪控制系统，其特征在于：包括设置于轮式移动平台上的车载预瞄控制设备和执行机构单元；车载预瞄控制设备包括车载定位装置、运动参考曲线生成器、预瞄准量调节器、处理器、数据存储器、程序存储器，车载定位装置用于测量出轮式移动平台当前的位姿，运动参考曲线生成器用于生成一条轮式移动平台可执行的路径，预瞄准量调节器用于根据轮式移动平台的线速度动态调整瞄准距离，程序存储器存储有预瞄准点位姿误差解算和控制程序，数据存储器作为预瞄准点位姿误差解算和控制程序运行过程中产生的中间数据载体，程序存储器和数据存储器均与处理器通信连接，以计算出轮式移动平台当前的预瞄准点位姿误差、控制线速度和控制角速度；处理器与执行机构单元连接，执行机构单元根据处理器输出的控制线速度和控制角速度驱动轮式移动平台移动。2.根据权利要求1所述的轮式移动平台运动轨迹预瞄跟踪控制系统，其特征在于：处理器包括预瞄准点位姿误差计算单元、运动控制单元、速度规划单元和速度反馈单元，其中，预瞄准点位姿误差计算单元用于根据车载定位装置提供的轮式移动平台定位位姿、运动参考曲线生成器提供的路径曲线方程、以及预瞄准量调节器提供的调整量数据计算轮式移动平台预瞄点位姿误差；速度反馈单元用于将轮式移动平台当前速度数据反馈给速度规划单元；速度规划单元根据轮式移动平台与目标点的剩余路程在速度反馈单元反馈的当前速度数据基础上规划当前点的线速度和角速度；运动控制单元，根据预瞄准点位姿误差和规划的线速度与角速度计算出对轮式移动平台的轨迹控制数据，将轨迹控制数据输送给执行机构单元。3.根据权利要求1所述的轮式移动平台运动轨迹预瞄跟踪控制系统，其特征在于：所述车载定位装置输出轮式移动平台中心点p的当前位姿。4.根据权利要求3所述的轮式移动平台运动轨迹预瞄跟踪控制系统，其特征在于：运动参考曲线生成器输出绝对坐标系中轮式移动平台可行路径的曲线方程f(t)。5.根据权利要求4所述的轮式移动平台运动轨迹预瞄跟踪控制系统，其特征在于：预瞄准量调节器输出轮式移动平台预瞄准调整量δl，其中δl是点q到点r的弧长，点q是轮式移动平台中心点p距离曲线方程上的最近点，点r是曲线方程上的预瞄准的点；预瞄准点位姿误差的求解方法如下：假设1，点q在曲线方程f(t)上对应的方程参数为t
q
；假设2，点r在曲线方程f(t)上对应的方程参数为t
r
；假设3，对于曲线方程f(t)，任意两点之间的弧长表示为l(t1，t2)，l(t1，t2)应用高斯
‑
勒让德积分法计算；通过不断地迭代参数t
q
和t
r
，使得且l(t
q
，t
r
)≈δl，是指点p与点q连线的矢量，f(t
q
)
′
是指点q处的切线矢量：f(t
q
)
′
＝[x
′
(t
q
)，y
′
(t
q
)]；那么，可以得到参数t
q
和t
r
的最佳值，表示为和由此，预瞄准点位姿误差计算式为：其中：e
pr
是预瞄准点位姿误差表示，e
pr
＝(x
e
，y
e
，θ
e
)，x
e
是绝对坐标系中当前轮式移动平台中心点p到运动参考曲线上的预瞄准点r的横坐标偏差量，y
e
是绝对坐标系中当前轮式移动平台中心点p到运动参考曲线上的预瞄准点r的纵坐标偏差量，θ
e
是绝对坐标系中当前轮式移
动平台的角位姿与运动参考曲线上的预瞄准点r切矢量方向角之间的角度偏差量；是运动参考曲线上的预瞄准点r的位姿表示，x
r
是绝对坐标系中预瞄准点r的横坐标，y
r
是绝对坐标系中预瞄准点r的纵坐标，θ
r
是绝对坐标系中预瞄准点r的切线矢量方向角；p是轮式移动平台中心点p的当前位姿表示，p＝(a，b，θ)，其中，a是轮式移动平台中心点p在绝对坐标系xoy中的横坐标，b是轮式移动平台中心点p在绝对坐标系xoy中的纵坐标，θ是轮式移动平台前行方向与绝对坐标系的x轴的夹角。6.根据权利要求5所述的轮式移动平台运动轨迹预瞄跟踪控制系统，其特征在于：根据预瞄准点位姿误差对轮式移动平台进行位姿调控，得到的轮式移动平台的控制律为：式中，v
r
是机器人线速度规划值，由点q到终点t的距离以及速度约束得到，ω
r
是机器人角速度规划值，ω
r
由v
r
和q点曲率相乘得到，[v，ω]
t
是线速度和角速度控制量，控制参数k1＞0，k2＞0，k3＞0。7.一种运动轨迹预瞄跟踪控制方法，其特征在于，包括以下步骤：s100：加载车载定位装置的定位位姿、运动参考曲线生成器的路径方程、预瞄准量调节器的调整量数据，并将数据输入处理器；s200：利用定位位姿、路径方程、调整量数据计算轮式移动平台预瞄点位姿误差；s300：利用轮式移动平台与目标点的剩余路程规划当前点的线速度和角速度；s400：根据预瞄点位姿误差、规划的线速度与角速度计算轮式移动平台运动的控制线速度和控制角速度；s500：将控制线速度和控制角速度作为轮式移动平台的当前控制值，输入给执行机构单元，调整轮式移动平台的位姿，达到目标姿态。
技术总结
本发明公开了一种轮式移动平台运动轨迹预瞄跟踪控制系统、方法。该系统包括车载定位装置、运动参考曲线生成器、预瞄准量调节器和处理器，首先加载车载定位装置的定位位姿、运动参考曲线生成器的路径方程、预瞄准量调节器的调整量数据，并将数据输入处理器；利用定位位姿、路径方程、调整量数据计算轮式移动平台预瞄点位姿误差；利用轮式移动平台与目标点的剩余路程规划当前点的线速度和角速度；根据预瞄点位姿误差、规划的线速度与角速度计算轮式移动平台运动的控制线速度和控制角速度；再将控制线速度和控制角速度作为轮式移动平台的当前控制值，输入给执行机构单元，调整轮式移动平台的位姿，达到目标姿态，提高轮式移动平台行走的控制精度。台行走的控制精度。台行走的控制精度。
技术研发人员：束健伟 周宏运 詹雅婷 张帅帅 刘铭 董晋峰 刘华 张伟玉 杜鹏
受保护的技术使用者：天津瑞斯达智能农机装备有限公司
技术研发日：2021.07.21
技术公布日：2021/11/4