CN111547111B - 一种虚拟轨道列车自主导向控制方法 - Google Patents
一种虚拟轨道列车自主导向控制方法 Download PDFInfo
- Publication number
- CN111547111B CN111547111B CN202010439538.8A CN202010439538A CN111547111B CN 111547111 B CN111547111 B CN 111547111B CN 202010439538 A CN202010439538 A CN 202010439538A CN 111547111 B CN111547111 B CN 111547111B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- train
- virtual rail
- rail train
- calculating
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B61—RAILWAYS
- B61L—GUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
- B61L27/00—Central railway traffic control systems; Trackside control; Communication systems specially adapted therefor
- B61L27/60—Testing or simulation
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Mechanical Engineering (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Geometry (AREA)
- General Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明提供了一种虚拟轨道列车的自主导向控制方法,属于虚拟轨道列车运行控制技术领域。首先将以三节编组的虚拟轨道列车离散为相互独立的M节车辆,建立自导向虚拟轨道列车解耦动力学模型;建立虚拟轨道列车各节车辆的离散侧向动力学模型;计算自导向虚拟轨道列车的首车转向控制量;计算虚拟轨道列车编组中各节车辆的侧向状态预测值;计算虚拟轨道列车首车后面编号“i”大于1的车辆的转向控制量;计算自导向虚拟轨道列车的各节车辆的纵向参考速度等步骤。即可获得全轮驱动全轮转向的虚拟轨道列车实现自主导向运行所需要的每个轮毂电机驱动控制器和转向作动控制器所需要的控制输入量。本发明可通过应用Matlab软件计算完成。
Description
技术领域
本发明属于虚拟轨道列车控制技术领域。
技术背景
自导向虚拟轨道列车是一种在公共路权下运行,沿着涂抹于道路上表面的虚拟轨道进行自主导向行驶,具备中等运能的新型城市轨道交通列车。其采用了胶轮承载、全轮轮毂电机独立驱动、双向自主运行、多轴转向及灵活编组技术,具有冗余牵引、转向及制动的技术特征。因此,大幅度提高了自导向虚拟轨道列车在复杂城市环境下的运载能力、曲线通过能力及主动安全能力。牵引、转向及制动控制与分配技术是自导向虚拟轨道列车实现基本功能和保障运行安全的关键技术。现有的控制方法主要是采用扩展阿克曼转向几何、刚性轮胎假设及统一瞬心来实现的,具有简单可靠、成本低廉、实时性能好等优点,如专利(CN110244731A)。而自导向虚拟轨道列车在牵引、转向及制动过程,轮胎纵向与侧向粘着力、每节车辆内部以及车辆之间均存在强非线性的耦合作用,若是没有良好的协调机制,将引起虚拟轨道列车侧向失稳、制动过程中车厢折叠、铰接作用力过大以及降低自导向控制精度等问题。由于上述耦合作用涉及车辆动力学响应及控制,但传统的协同控制方法并未考虑车辆动力学特性。
发明内容
本发明的目的是提供一种虚拟轨道列车自主导向控制方法,它能有效地解决虚拟轨道列车自主导向运行过程中分配各轮毂电机和转向作动器控制量的技术问题。
一种虚拟轨道列车自主导向控制方法,包括以下步骤:
步骤一、建立自导向虚拟轨道列车解耦动力学模型:
虚拟轨道列车通过控制轮毂电机和转向作动器来实现全轮驱动或全轮转向,当以理想状态进行自导向稳态运行时,两车之间的铰接作用力很小;基于此,将M节车辆编组的虚拟轨道列车离散为相互独立的M节车辆,车辆之间的耦合作用力对列车而言是一种内部作用力,而对每节车辆而言可作为一种外部扰动,而这种扰动是有界的,耦合作用力的关系可表示为:
将虚拟轨道列车的相邻两车辆之间解耦后的二自由度2DOF车辆动力学模型用状态空间表示为:
其中,i为M节车辆编组虚拟轨道列车的车辆编号,i=1,2,3…M;vi表示由两节车辆之间耦合作用引起的外部扰动量;Hi表示扰动增益矩阵;定义为xi的一阶导数,xi表示第i节车辆的状态变量列阵,表示为:
Φi为状态转移矩阵,表示为:
分别表示第i节车辆质心到前轴中心与后轴中心的距离;分别表示2DOF车辆模型中前、后等效轮胎的侧偏刚度;mi、分别表示第i节车辆的总质量与横摆转动惯量;表示第i节车辆质心的纵向速度,通过传感器测量获得,假设在预测时域中为常量;Γi为控制增益矩阵,表示为:
ui为第i节车辆侧向动力学模型的转向控制输入量,表示为:
步骤二、建立虚拟轨道列车各节车辆的离散侧向动力学模型:
根据式(2),将离散车辆侧向动力学模型表示为:
xi(k+1)=Ai(k)xi(k)+Bi(k)ui(k)+Hi(k)vi(k) (7)
其中,N表示预测时域中离散时刻的数量;k表示预测时域中的第k时刻,k=0,1,2…N-1;
定义离散侧向动力学模型的状态转移矩阵为Ai(k),表示为:
定义离散侧向动力学模型的控制增益矩阵为Bi(k),表示为:
定义车辆控制模型的输出变量的预测值为yi(k+1),表示为:
yi(k+1)=Cxi(k+1) (10)
其中,C为预测第k+1时刻车辆位姿输出的增益矩阵,表示为:
步骤三、计算自导向虚拟轨道列车的首车转向控制量:
以路面的虚拟轨道线条作为跟踪目标,采用专用摄像头进行实时辨识,获得在首车车辆坐标系中描述的点云坐标序列,通过点云坐标计算首车在预测时域中跟踪虚拟轨道的目标侧向位移与航向角位移此处上标“i”的取值为1,代表首车;“i”大于1的代表首车后面的车辆,下标“des”代表跟踪目标;
建立首车跟踪虚拟轨道的二次型目标函数,表示为:
其中,xi 0为预测时域中的初始状态变量;Q表示跟踪误差权重矩阵;R表示控制输入量权重矩阵;由式(12),求解含有等式约束的二次规划问题,计算出虚拟轨道列车首车跟踪虚拟轨道的控制输入ui(k),通过比例增益计算出第i节车辆前轴与后轴转向作动器的控制输入量,输入到转向作动控制器;
步骤四、计算虚拟轨道列车编组中各节车辆的侧向状态预测值:
结合式(10),车辆在第k时刻的状态变量xi(k)以及控制输入量ui(k)和扰动估计值Hi(k)vi(k),计算出首车在第k+1时刻的状态变量xi(k+1),通过迭代计算,计算出车辆在预测时域终端的状态变量预测值,进而计算车辆侧向状态的预测值,表示为:
其中,下标“pre”代表预测;E为车辆侧向状态输出系数矩阵,定义为
步骤五、计算虚拟轨道列车首车后面编号“i”大于1的车辆的转向控制量:
当虚拟轨道列车的首车严格循迹时,首车的后轴中心点在路面上的投影与虚拟轨道重合;基于此,除首车以外,其他参与编组的各节车辆均跟踪其前车后轴中心点在预测时域中的侧向位移和航向角,最终实现虚拟轨道列车的状态预测和自导向运动跟随;
其中,D为预测第i节车辆后轴中心位姿的增益矩阵;
结合式(12)与式(15)即计算出首车后每节车辆的转向作动控制量,通过比例增益转换为转向作动器的控制量,实现虚拟轨道列车首车后面各节车辆的转向作动;
步骤六、计算自导向虚拟轨道列车的各节车辆的纵向参考速度:
自导向虚拟轨道列车运行于不同路段时,需要跟踪不同的目标运行速度,各节车辆的纵向目标速度按照如下方法计算:
步骤七、计算自导向虚拟轨道列车各节车牵引控制量:
假设车体为刚体,由刚体平面运动的基本理论,根据车辆质心的纵向速度、侧向速度及横摆角速度的预测值,计算出车轮中心处的速度分量,表示为:
计算四轮转向轮毂电机驱动车辆的车轮速度偏角:
计算四轮转向轮毂电机驱动车辆的轮胎侧偏角:
计算虚拟轨道列车各节车辆的车轮转速预测值:
根据轮胎侧偏角及轮心在车辆坐标系中的速度分量,计算轮心在轮胎对称平面中的速度分量,表示为:
车轮作纯滚动时转速的预测值计算式如下:
其中,rs表示轮胎滚动半径;
附图说明
图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的车辆的转向控制量;计算虚拟轨道列车的各节车辆的纵向参考速度等步骤。即可获得全轮驱动全轮转向的虚拟轨道列车实现自主导向运行所需要的每个轮毂电机驱动控制器和转向作动控制器所需要的控制输入量。本发明示出的公式可通过运行(Matlab)软件计算完成。
Claims (1)
1.一种虚拟轨道列车自主导向控制方法,包括以下步骤:
步骤一、建立自导向虚拟轨道列车解耦动力学模型:
虚拟轨道列车通过控制轮毂电机和转向作动器来实现全轮驱动或全轮转向,当以理想状态进行自导向稳态运行时,两车之间的铰接作用力很小;基于此,将M节车辆编组的虚拟轨道列车离散为相互独立的M节车辆,车辆之间的耦合作用力对列车而言是一种内部作用力,而对每节车辆而言可作为一种外部扰动,而这种扰动是有界的,耦合作用力的关系可表示为:
将虚拟轨道列车的相邻两车辆之间解耦后的二自由度2DOF车辆动力学模型用状态空间表示为:
其中,i为M节车辆编组虚拟轨道列车的车辆编号,i=1,2,3…M;vi表示由两节车辆之间耦合作用引起的外部扰动量;Hi表示扰动增益矩阵;定义为xi的一阶导数,xi表示第i节车辆的状态变量列阵,表示为:
Φi为状态转移矩阵,表示为:
分别表示第i节车辆质心到前轴中心与后轴中心的距离;分别表示2DOF车辆模型中前、后等效轮胎的侧偏刚度;mi、分别表示第i节车辆的总质量与横摆转动惯量;表示第i节车辆质心的纵向速度,通过传感器测量获得,假设在预测时域中为常量;Γi为控制增益矩阵,表示为:
ui为第i节车辆侧向动力学模型的转向控制输入量,表示为:
步骤二、建立虚拟轨道列车各节车辆的离散侧向动力学模型:
根据式(2),将离散车辆侧向动力学模型表示为:
xi(k+1)=Ai(k)xi(k)+Bi(k)ui(k)+Hi(k)vi(k) (7)
其中,N表示预测时域中离散时刻的数量;k表示预测时域中的第k时刻,k=0,1,2…N-1;
定义离散侧向动力学模型的状态转移矩阵为Ai(k),表示为:
定义离散侧向动力学模型的控制增益矩阵为Bi(k),表示为:
定义车辆控制模型的输出变量的预测值为yi(k+1),表示为:
yi(k+1)=Cxi(k+1) (10)
其中,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)=xi 0
其中,xi 0为预测时域中的初始状态变量;Q表示跟踪误差权重矩阵;R表示控制输入量权重矩阵;由式(12),求解含有等式约束的二次规划问题,计算出虚拟轨道列车首车跟踪虚拟轨道的控制输入ui(k),通过比例增益计算出第i节车辆前轴与后轴转向作动器的控制输入量,输入到转向作动控制器;
步骤四、计算虚拟轨道列车编组中各节车辆的侧向状态预测值:
结合式(10),车辆在第k时刻的状态变量xi(k)以及控制输入量ui(k)和扰动估计值Hi(k)vi(k),计算出首车在第k+1时刻的状态变量xi(k+1),通过迭代计算,计算出车辆在预测时域终端的状态变量预测值,进而计算车辆侧向状态的预测值,表示为:
其中,下标“pre”代表预测;E为车辆侧向状态输出系数矩阵,定义为
步骤五、计算虚拟轨道列车首车后面编号“i”大于1的车辆的转向控制量:
当虚拟轨道列车的首车严格循迹时,首车的后轴中心点在路面上的投影与虚拟轨道重合;基于此,除首车以外,其他参与编组的各节车辆均跟踪其前车后轴中心点在预测时域中的侧向位移和航向角,最终实现虚拟轨道列车的状态预测和自导向运动跟随;
其中,D为预测第i节车辆后轴中心位姿的增益矩阵;
结合式(12)与式(15)即计算出首车后每节车辆的转向作动控制量,通过比例增益转换为转向作动器的控制量,实现虚拟轨道列车首车后面各节车辆的转向作动;
步骤六、计算自导向虚拟轨道列车的各节车辆的纵向参考速度:
自导向虚拟轨道列车运行于不同路段时,需要跟踪不同的目标运行速度,各节车辆的纵向目标速度按照如下方法计算:
步骤七、计算自导向虚拟轨道列车各节车牵引控制量:
假设车体为刚体,由刚体平面运动的基本理论,根据车辆质心的纵向速度、侧向速度及横摆角速度的预测值,计算出车轮中心处的速度分量,表示为:
计算四轮转向轮毂电机驱动车辆的车轮速度偏角:
计算四轮转向轮毂电机驱动车辆的轮胎侧偏角:
计算虚拟轨道列车各节车辆的车轮转速预测值:
根据轮胎侧偏角及轮心在车辆坐标系中的速度分量,计算轮心在轮胎对称平面中的速度分量,表示为:
车轮作纯滚动时转速的预测值计算式如下:
其中,rs表示轮胎滚动半径;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010439538.8A CN111547111B (zh) | 2020-05-22 | 2020-05-22 | 一种虚拟轨道列车自主导向控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010439538.8A CN111547111B (zh) | 2020-05-22 | 2020-05-22 | 一种虚拟轨道列车自主导向控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111547111A CN111547111A (zh) | 2020-08-18 |
CN111547111B true CN111547111B (zh) | 2021-04-13 |
Family
ID=72002094
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010439538.8A Expired - Fee Related CN111547111B (zh) | 2020-05-22 | 2020-05-22 | 一种虚拟轨道列车自主导向控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111547111B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111976751B (zh) * | 2020-08-26 | 2021-08-03 | 中南大学 | 一种基于智轨列车横向加速度的转向辅助***及控制方法 |
CN112836296B (zh) * | 2021-01-28 | 2022-09-13 | 西南交通大学 | 一种虚拟轨道列车空间动力学模型的建模方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108454449A (zh) * | 2018-05-04 | 2018-08-28 | 西南交通大学 | 一种虚拟轨道交通列车分布式电源***及匹配控制方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH04201675A (ja) * | 1990-11-30 | 1992-07-22 | Mitsubishi Electric Corp | 列車運行管理方法 |
CN109166328B (zh) * | 2018-08-28 | 2021-01-01 | 中铁第四勘察设计院集团有限公司 | 一种基于胶轮虚拟轨道列车的运行控制***及方法 |
CN109795502B (zh) * | 2018-09-27 | 2021-05-04 | 吉林大学 | 智能电动汽车路径跟踪模型预测控制方法 |
CN109655294B (zh) * | 2018-12-19 | 2020-07-24 | 西南民族大学 | 基于混合动力的虚拟轨道列车半实物仿真*** |
CN110244731B (zh) * | 2019-06-19 | 2021-06-08 | 西南交通大学 | 三节编组虚拟轨道列车主动循迹控制方法 |
CN110309483B (zh) * | 2019-06-24 | 2023-07-21 | 中车株洲电力机车研究所有限公司 | 一种虚拟轨道列车纵-横向耦合动力学模型的建模方法 |
-
2020
- 2020-05-22 CN CN202010439538.8A patent/CN111547111B/zh not_active Expired - Fee Related
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108454449A (zh) * | 2018-05-04 | 2018-08-28 | 西南交通大学 | 一种虚拟轨道交通列车分布式电源***及匹配控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111547111A (zh) | 2020-08-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107380161B (zh) | 一种辅助驾驶员实现理想行驶轨迹的主动转向控制装置 | |
CN109263716B (zh) | 一种四轮毂电机驱动车辆转向的控制方法 | |
CN107685767B (zh) | 多轴轮毂电机驱动车辆后轮线控转向驱动装置及转向方法 | |
CN103786602B (zh) | 基于分布式驱动电动汽车的操纵性改善控制方法 | |
Wu et al. | Differential speed steering control for four-wheel independent driving electric vehicle | |
CN103303367B (zh) | 一种四轮驱动电动车车身稳定控制方法 | |
CN110466604B (zh) | 轮毂电机驱动电动汽车差动驱动转向及稳定性的控制方法 | |
CN102975714B (zh) | 一种电动车辆底盘*** | |
CN106080753A (zh) | 一种融合主动转向、助力转向和直接横摆力矩控制功能的电动轮转向控制***及其控制方法 | |
CN105857304A (zh) | 基于四轮驱动汽车力矩分配控制*** | |
CN105253141A (zh) | 一种基于车轮纵向力调节的车辆操纵稳定性控制方法 | |
CN103935265A (zh) | 一种电动汽车的车身稳定控制*** | |
CN111547111B (zh) | 一种虚拟轨道列车自主导向控制方法 | |
CN104925054A (zh) | 一种基于微分平坦的车辆稳定转向集成控制方法 | |
KR20120046638A (ko) | 독립 다축 구동형 차량 | |
CN105774902A (zh) | 一种带有容错功能的汽车动力转向控制装置及控制方法 | |
CN110901630A (zh) | 一种半挂汽车列车横向稳定性控制方法及*** | |
CN111546907B (zh) | 一种四轮转向轮毂电机驱动车辆的轮速分配方法 | |
Wu et al. | Speed following control for differential steering of 4WID electric vehicle | |
CN115848162A (zh) | 一种用于六轮独立电驱动无人车辆差动转向的控制方法 | |
CN112572605A (zh) | 一种分布式驱动车辆及其转向控制方法与装置 | |
Oke et al. | H∞ dynamic output feedback control for independently driven four-wheel electric vehicles with differential speed steering | |
US20230415746A1 (en) | Methods for reducing high-speed off-tracking in multi-trailer heavy duty vehicles | |
CN114524021A (zh) | 基于分布式电机驱动的车辆行驶轨迹调节方法和装置 | |
Sun et al. | Lap time optimization and path following control for 4WS & 4WID autonomous vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210413 |