技术摘要：
本发明提供了一种虚拟轨道列车的自主导向控制方法，属于虚拟轨道列车运行控制技术领域。首先将以三节编组的虚拟轨道列车离散为相互独立的M节车辆，建立自导向虚拟轨道列车解耦动力学模型；建立虚拟轨道列车各节车辆的离散侧向动力学模型；计算自导向虚拟轨道列车的首车  全部
背景技术：
本发明的目的是提供一种虚拟轨道列车自主导向控制方法，它能有效地解决虚拟 轨道列车自主导向运行过程中分配各轮毂电机和转向作动器控制量的技术问题。 一种虚拟轨道列车自主导向控制方法，包括以下步骤： 步骤一、建立自导向虚拟轨道列车解耦动力学模型： 虚拟轨道列车通过控制轮毂电机和转向作动器来实现全轮驱动或全轮转向，当以 理想状态进行自导向稳态运行时，两车之间的铰接作用力很小；基于此，将M节车辆编组的 虚拟轨道列车离散为相互独立的M节车辆，车辆之间的耦合作用力对列车而言是一种内部 作用力，而对每节车辆而言可作为一种外部扰动，而这种扰动是有界的，耦合作用力的关系 可表示为： 其中，假设虚拟轨道列车位于水平路面上， 及 表示在平面内2车作 用于1车的纵向力、侧向力及横摆力矩； 及 表示在平面内1车作用于2车的纵 向力、侧向力及横摆力矩； 将虚拟轨道列车的相邻两车辆之间解耦后的二自由度2DOF车辆动力学模型用状 态空间表示为： 6 CN 111547111 A 说　明　书 2/6 页 其中，i为M节车辆编组虚拟轨道列车的车辆编号；vi表示由两节车辆之间耦合作 用引起的外部扰动量；Hi表示扰动增益矩阵；定义 为xi的一阶导数，xi表示第i节车辆的状 态变量列阵，表示为： 分别表示i车辆前、后轴中心在第i节车辆坐标系xioiyi下的侧向位移； 表示第i节车辆的航向角； 表示车辆的侧向速度与横摆角速度；T表示矩阵转置； Φi为状态转移矩阵，表示为： 分别表示第i节车辆质心到前轴中心与后轴中心的距离； 分别表示 2DOF车辆模型中前、后等效轮胎的侧偏刚度；mi、 分别表示第i节车辆的总质量与横摆转 动惯量； 表示第i节车辆质心的纵向速度，通过传感器测量获得，假设在预测时域中为常 量；Γi为控制增益矩阵，表示为： ui为第i节车辆侧向动力学模型的转向控制输入量，表示为： 式中， 分别表示第i节2DOF车辆模型中的前、后等效车轮的偏转角； 步骤二、建立虚拟轨道列车各节车辆的离散侧向动力学模型： 根据式(2)，将离散车辆侧向动力学模型表示为： xi(k 1)＝Ai(k)xi(k) Bi(k)ui(k) Hi(k)vi(k)    (k＝0,1,2…N-1)    (30) 其中，N表示预测时域中离散时刻的数量；k表示预测时域中的第k时刻； 7 CN 111547111 A 说　明　书 3/6 页 定义离散侧向动力学模型的状态转移矩阵为Ai(k)，表示为： 定义I为5×5维的单位矩阵； 为预测时域的长度，单位为秒； 定义离散侧向动力学模型的控制增益矩阵为Bi(k)，表示为： 定义车辆控制模型的输出变量的预测值为yi(k 1)，表示为： yi(k 1)＝Cxi(k 1)    (33) 其中，C为预测第k 1时刻车辆位姿输出的增益矩阵，表示为： 步骤三、计算自导向虚拟轨道列车的首车转向控制量： 以路面的虚拟轨道线条作为跟踪目标，采用专用摄像头进行实时辨识，获得在首 车车辆坐标系中描述的点云坐标序列，通过点云坐标计算首车在预测时域中跟踪虚拟轨道 的目标侧向位移 与航向角位移 此处上标“i”的取值为1，代表首车；“i”大于 1的代表首车后面的车辆，下标“des”代表跟踪目标； 建立首车跟踪虚拟轨道的二次型目标函数，表示为： s.t.xi(k 1)＝Ai(k)xi(k) Bi(k)ui(k) Hi(k)vi(k) ,xi(0)＝xi0 其中，xi0为预测时域中的初始状态变量；由式(12)，求解含有等式约束的二次规划 问题，计算出虚拟轨道列车首车跟踪虚拟轨道的控制输入ui(k)，通过比例增益计算出第i 节车辆前轴与后轴转向作动器的控制输入量，输入到转向作动控制器； 步骤四、计算虚拟轨道列车编组中各节车辆的侧向状态预测值： 结合式(10)，车辆在第k时刻的状态变量xi(k)以及控制输入量ui(k)和扰动估计值 Hi(k)vi(k)，计算出首车在第k 1时刻的状态变量xi(k 1)，通过迭代计算，计算出车辆在预 测时域终端的状态变量预测值，进而计算车辆侧向状态的预测值，表示为： 其中，下标“pre”代表预测；E为车辆侧向状态输出系数矩阵，定义为 步骤五、计算虚拟轨道列车首车后面编号“i”大于1的车辆的转向控制量： 当虚拟轨道列车的首车严格循迹时，首车的后轴中心点在路面上的投影与虚拟轨 道重合；基于此，除首车以外，其他参与编组的各节车辆均跟踪其前车后轴中心点在预测时 8 CN 111547111 A 说　明　书 4/6 页 域中的侧向位移和航向角，最终实现虚拟轨道列车的状态预测和自导向运动跟随； 定义第i节车辆后轴中心在第k 1时刻的侧向距离和航向角分别为 以作为第i 1(i≥M-1)节车辆的跟踪目标，计算式如下： 其中，D为预测第i节车辆后轴中心位姿的增益矩阵； 虚拟轨道列车首车后的各节车辆自导向运动跟随所需的侧向位移 和车辆 航向角 的计算式如下： 结合式(12)与式(15)即计算出首车后每节车辆的转向作动控制量，通过比例增益 转换为转向作动器的控制量，实现虚拟轨道列车首车后面各节车辆的转向作动； 步骤六、计算自导向虚拟轨道列车的各节车辆的纵向参考速度： 自导向虚拟轨道列车运行于不同路段时，需要跟踪不同的目标运行速度，各节车 辆的纵向目标速度按照如下方法计算： 其中， 为牵引工况； 为制动工况，因此牵引与制动统一为式(18)； 步骤七、计算自导向虚拟轨道列车各节车牵引控制量： 假设车体为刚体，由刚体平面运动的基本理论，根据车辆质心的纵向速度、侧向速 度及横摆角速度的预测值，计算出车轮中心处的速度分量，表示为： 其中， 分别第i节辆车的第j个车轮中心在车辆坐标系中的沿x轴的坐标 分量和沿y轴的坐标分量；以车辆运行方向为参考，fl,fr,rl,rr分别表示前左轮、前右轮、 后左轮和后右轮的位置标记； 计算四轮转向轮毂电机驱动车辆的车轮速度偏角： 计算四轮转向轮毂电机驱动车辆的轮胎侧偏角： 9 CN 111547111 A 说　明　书 5/6 页 其中， 为实际车辆的车轮偏转角； 计算虚拟轨道列车各节车辆的车轮转速预测值： 根据轮胎侧偏角及轮心在车辆坐标系中的速度分量，计算轮心在轮胎对称平面中 的速度分量，表示为： 车轮作纯滚动时转速的预测值计算式如下： 其中，rs表示轮胎滚动半径； 综上，由式(2)～(23)首先计算出M节车辆编组的自导向虚拟轨道列车解耦控制模 型的转向控制输入量ui，通过比例增益计算各轴转向作动器的控制输入量，并发送给转向 作动控制器；然后计算出各轮毂电机正向驱动或反向驱动时的转速预测值 并发送给 对应轮毂电机驱动控制器。 附图说明 图1本发明虚拟轨道列车全轮驱动全轮转向示意图 图2本发明虚拟轨道列车车辆之间解耦示意图 图3本发明虚拟轨道列车后车跟随前车示意图 图4本发明虚拟轨道列车车辆左前轮转速预测示意图 图5本发明虚拟轨道列车各车轮的转速曲线 图6本发明虚拟轨道列车各车轮的偏转角曲线 图7本发明虚拟轨道列车每节车辆的质心轨迹曲线 图8本发明虚拟轨道列车牵引转向协同控制算法流程图
技术实现要素：
一种虚拟轨道列车的自主导向控制方法(以三节编组为例)，首先以三节车辆为虚 拟轨道列车的车辆编组，将此虚拟轨道列车离散为相互独立的M节车辆，本例中M＝3，如图 1、2、3、4所示，图中车辆均采用轮毂电机驱动，首车4的转向轴1、两车之间的铰接点2、虚拟 轨道列车车轮3；第二节编组车辆5、第三节编组车辆6。道路以划线形成虚拟轨道7；首车4的 虚拟轨道点云坐标序列8。车后轴中心点在第二车辆坐标系中的点云坐标序列预测值9；首 车后轴中心点10；首车后第一车后轴中心点在第三车辆坐标系中的点云坐标序列预测值 11；首车后第一车后轴中心点12。通过建立自导向虚拟轨道列车解耦动力学模型；建立虚拟 轨道列车各节车辆的离散侧向动力学模型；计算自导向虚拟轨道列车的首车转向控制量； 计算虚拟轨道列车编组中各节车辆的侧向状态预测值；计算虚拟轨道列车首车后面编号 “i”大于1的车辆的转向控制量；计算自导向虚拟轨道列车的各节车辆的纵向参考速度等步 10 CN 111547111 A 说　明　书 6/6 页 骤。即可获得全轮驱动全轮转向的虚拟轨道列车实现自主导向运行所需要的每个轮毂电机 驱动控制器和转向作动控制器所需要的控制输入量。本发明示出的公式可通过运行 (Matlab)软件计算完成。 11 CN 111547111 A 说　明　书　附　图 1/4 页 图1 图2 图3 12 CN 111547111 A 说　明　书　附　图 2/4 页 图4 图5 13 CN 111547111 A 说　明　书　附　图 3/4 页 图6 图7 14 CN 111547111 A 说　明　书　附　图 4/4 页 图8 15