CN110244731B - 三节编组虚拟轨道列车主动循迹控制方法 - Google Patents
三节编组虚拟轨道列车主动循迹控制方法 Download PDFInfo
- Publication number
- CN110244731B CN110244731B CN201910530460.8A CN201910530460A CN110244731B CN 110244731 B CN110244731 B CN 110244731B CN 201910530460 A CN201910530460 A CN 201910530460A CN 110244731 B CN110244731 B CN 110244731B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- carriage
- car
- train
- central axis
- 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
- 238000000034 method Methods 0.000 title claims abstract description 15
- 238000004364 calculation method Methods 0.000 claims description 8
- 230000000694 effects Effects 0.000 description 2
- 238000010276 construction Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000004134 energy conservation Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000008520 organization Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明提供了一种三节编组虚拟轨道列车主动循迹控制方法,属于智能车辆控制技术领域。具体为:(1)虚拟轨道列车主控制器通过头车和尾车摄像头读取虚拟轨道信息,并判断车辆是否脱离轨迹;(2)根据车辆相对于轨道的偏移量,计算为使车辆循迹运行所需的头车和尾车各轴车轮转向角;(3)由车辆尺寸参数和头车及尾车的各轴转向角,确定头车和尾车的转弯半径和速度瞬心,并计算得到中间车的速度瞬心;(4)由车辆尺寸参数和头车和尾车的转弯半径以及中间车的速度瞬心,计算得到中间车各轴车轮转向角;(5)虚拟轨道列车循迹控制器根据各轴车轮目标转向角控制各转向电机,实现车辆循迹运行。
Description
技术领域
本发明属于智能车辆控制技术领域,具体涉及控制虚拟轨道列车循迹运行的控制方法。
背景技术
虚拟轨道列车***作为一种全新的公共路权运行环境下非轮轨接触导向运输***,具有建设周期短、投资成本低、运营组织灵活、节能环保等优势,能够满足人们日益增长的多样化出行需求,具有广阔的市场前景。
现有的虚拟轨道列车虽然初步实现了车辆循迹运行这一主要目标,但是其循迹运行仍然存在问题,如控制精度不高,需要司机进行运行关键节点控制等,此外,现有的车辆主动循迹控制技术仅涉及单节车辆循迹控制,尚无多节编组车辆主动循迹运行的实例。如申请号CN201710174916.2所述专利,虽然给出了一种车辆主动循迹控制方法,但是该方法只适用于普通的智能汽车,不适用于长大车体多节铰接连接的虚拟轨道列车。
发明内容
本发明的目的是提供一种三节编组虚拟轨道列车主动循迹控制方法,它能有效地解决长大车体多节编组车辆循迹运行的技术问题。
本发明的目是通过以下技术方案来实现的:一种三节编组虚拟轨道列车主动循迹控制方法,具体包括以下步骤:
步骤一、通过虚拟轨道列车首车端部的摄像头获取当前车辆相对于虚拟轨道的位置信息;
步骤二、根据当前列车相对于虚拟轨道的位置信息,以路径最短原则初步计算得到列车回归轨迹所需的首车及尾车的各轴转角;其中车辆循迹控制点设置在车辆中轴线的中点,且首车及尾车前轴和后轴车轮转向角等大、反向;由首车及尾车各轴车轮转向角及阿克曼转向几何原理,得到首车的速度瞬心M1和尾车的速度瞬心M3;
步骤三、设虚拟轨道列车整列车的各节车厢之间铰接力最小,相邻两节车厢在铰接点处G1的速度方向相同,基于这一原则得到虚拟轨道列车中间车车厢的速度瞬心M2,所述速度瞬心在通过中间车车厢前铰接点G1和速度瞬心M1的直线G1M1与通过中间车车厢后铰接点G2和速度瞬心M3的直线G2M3交点上;那么,首车中轴线与G1M1的夹角α1为:
式中:R1表示首车前轴的转弯半径,l表示车厢前轴到后轴的距离,lR表示车厢后轴到车厢后端的距离,下标R表示车厢后方;由首车中轴线与G1M1的夹角α1推导得到直线G1M1与中间车车厢中轴线的夹角为β1=α1-ψ1,其中ψ1为首车车厢中轴线与中间车车厢中轴线的夹角,该夹角由传感器测得;相同方式得到尾车车厢中轴线与直线G2M2的夹角α2:
式中:R6表示尾车后轴的转弯半径;由直线G2M2与尾车车厢中轴线的夹角α2通过计算得到直线G2M2与中间车车厢中轴线的夹角为β2=α2+ψ2,其中ψ2为尾车车厢中轴线与中间车车厢中轴线的夹角;由上述两角β1,β2计算得到直线G1M1和G2M2的夹角ξ=β1-β2;由该夹角推导得到线段RM2G1和RM2G2的长度,其表达式为:
其中,lF表示车厢前轴到车厢前端的距离,下标F表示车厢前方;采用转向角正负判定系数S2判断中间车厢各车轮转角的正负,其表达式为:
其中,RM2G1表示线段M2G1的长度,下标M2G1表示线段M2G1;根据该正负判定系数得到中间车车厢前轴中心转弯半径R3:
以同样方式推导得到中间车车厢后轴的转弯半径R4:
步骤四、根据设置在首车内的虚拟轨道列车循迹控制器将上述推导计算得到的车厢各轴转向角传递给各轴转向电机控制器,通过转向电机控制器控制各轴车轮转向使虚拟轨道列车回归轨道,完成循迹控制目标。
附图说明
图1是本发明的方法流程图;
图2是本发明的虚拟轨道列车各节车转向几何关系示意图;
图3是本发明的Matlab下的循迹效果图;
具体实施方式
下面结合附图对本发明实施方式进行详细的说明。
一种虚拟轨道列车主动循迹控制方法,其具体步骤如图1所示。
步骤(1)获得虚拟轨道列车当前运行前方道路情况。首先以车辆中轴线为基准,通过车辆前车和后车所搭载的传感器如摄像头等识别道路上的虚拟轨道,并获取车辆中轴线相对于虚拟轨道的偏移。如果偏移量小于一定值,则认为车辆当前循迹运行,无需进行下面的步骤。如果偏移量大于一定值,则认为车辆偏移轨道,需要进行循迹控制,偏移量将作为车辆的控制输入量引入下面的步骤。
步骤(2)获取车辆相对于虚拟轨道的偏移,并计算车辆回到轨道所需的首车及尾车各轴车轮转向角。当车辆偏移轨道时,车辆主控制器将车辆中轴线相对于虚拟轨道的偏移量传输给车辆循迹控制器,并由循迹控制器计算为使车辆回归目标虚拟轨道所需的头车及尾车各轴车轮转向角。为使车辆回归轨道的时间最短,头车及尾车各车轴车轮均参与转向,且每节车辆前轴车轮和后轴车轮的转向角等大反向,如图2所示。
步骤(3)首先计算为使车辆回归轨道所需的首车和尾车的转向角。根据车辆主控制器计算得到的位移偏差ed和角度偏差eθ,计算得到首车和尾车前轴的转向角γ:
γ=kded+kθeθ (1)
其中,kd和kθ为对应的转向系数。首车前轴的转弯半径R1和尾车后轴的转弯半径R6分别为:
其中,γ1为首车前轴的转向角,γ6为尾车后轴的转向角。由首尾车前轴和后轴转向角等大反向,可知首车后轴的转向角为-γ1,尾车前轴的转向角为-γ6。假设车辆各轴车轮的转向角相同,令车辆各车轴与车厢中轴线的交点为Ai,i=1-6分别表示从前车前轴到后车后轴的各车轴,则可以用通过各交点Ai的车轮代表车轴上的各车轮。根据计算得到的首尾车前轴转向角,推导得到首车的速度瞬心M1和尾车的速度瞬心M3。设各节车铰接点速度方向相同,则可以进一步得到中间车的速度瞬心M2。该点在通过铰接点G1和速度瞬心M1的直线G1M1与通过铰接点G2和速度瞬心M3的直线G2M3交点上。由阿克曼转向几何关系可知,首车后轴转向半径R2和尾车前轴转向半径R5分别与首车前轴的转弯半径R1和尾车后轴的转弯半径R6相等。
步骤(4)进一步计算中间车各车轴的转向角。首先计算首车中轴线与直线G1M1的夹角α1。假设虚拟轨道列车各节车辆尺寸参数相同,根据三角形几何公式,计算得到首车中轴线与直线G1M1的夹角α1为:
其中,R1为首车前轴的转向半径,l为车厢前轴到后轴的距离,lR为车厢后轴到车厢后端的距离,下标R表示车厢后方。根据首车中轴线与直线G1M1的夹角α1进一步推导得到直线G1M1与中间车中轴线的夹角β1=α1-ψ1,其中ψ1为首车车厢中轴线与中间车车厢中轴线的夹角,该夹角由传感器测得。以同样方式推导得到尾车中轴线与直线G2M2的夹角α2:
式中,R6为尾车后轴的转向半径。根据尾车中轴线与直线G2M2的夹角α2推导得到直线G2M2与中间车中轴线的夹角为β2=α2+ψ2,其中ψ2为尾车车厢中轴线与中间车车厢中轴线的夹角。根据上述两角β1,β2,得到直线G1M1和G2M2的夹角ξ=β1-β2。
根据直线G1M1和G2M2的夹角ξ,推导得到线段RM2G1和RM2G2的长度,其表达式为:
式中,lF表示车厢前轴到车厢前端的距离,下标F表示车厢前方。
由于车辆各轴的转向角存在正负之分,因此需要通过计算判断转向角的正负,计算过程如下。首先计算中间车前轴转角正负判定系数S2:
式中,RM2G1表示线段M2G1的长度,下标M2G1表示线段M2G1。根据转角正负判定系数S2基于三角形几何定理推导得到中间车前轴中心转弯半径的长度R3:
同样方式可以得到中间车后轴的转向角。中间车后轴的转弯半径R4为:
步骤(5)由上述计算得到的各轴转向角通过循迹控制器处理为控制信号,并分别传输给各个车轴的转向电机控制器,令转向电机驱动车轮转动,从而完成全部控制过程。控制效果如图3所示。该控制方法可以使虚拟轨道列车实现快速而准确的循迹运行目标,并能在车辆受到干扰而偏离轨道时使车辆快速回归轨道,具有较高的工程应用价值。
Claims (1)
1.一种三节编组虚拟轨道列车主动循迹控制方法,包括如下步骤:
步骤一、通过虚拟轨道列车首车端部的摄像头获取当前车辆相对于虚拟轨道的位置信息;
步骤二、根据当前列车相对于虚拟轨道的位置信息,以路径最短原则初步计算得到列车回归轨迹所需的首车及尾车的各轴转角;其中,车辆循迹控制点设置在车辆中轴线的中点,且首车及尾车前轴和后轴车轮转向角等大、反向;由首车及尾车各轴车轮转向角及阿克曼转向几何原理,得到首车的速度瞬心M1和尾车的速度瞬心M3;
步骤三、设虚拟轨道列车整列车的各节车厢之间的铰接力最小,相邻两节车厢在铰接点处G1的速度方向相同,基于这一原则得到虚拟轨道列车中间车车厢的速度瞬心M2,所述速度瞬心M2在通过中间车车厢前铰接点G1和速度瞬心M1的直线G1M1与通过中间车车厢后铰接点G2和速度瞬心M3的直线G2M3交点上;那么,首车中轴线与G1M1的夹角α1为:
式中:R1表示首车前轴的转弯半径,l表示车厢前轴到后轴的距离,lR表示车厢后轴到车厢后端的距离,下标R表示车厢后方;由首车中轴线与G1M1的夹角α1推导得到直线G1M1与中间车车厢中轴线的夹角为β1=α1-ψ1,其中ψ1为首车车厢中轴线与中间车车厢中轴线的夹角,该夹角由传感器测得;以相同方式得到尾车车厢中轴线与直线G2M2的夹角α2:
式中:R6表示尾车后轴的转弯半径;由直线G2M2与尾车车厢中轴线的夹角α2通过计算得到直线G2M2与中间车车厢中轴线的夹角为β2=α2+ψ2,其中ψ2为尾车车厢中轴线与中间车车厢中轴线的夹角;由上述两角β1,β2计算得到直线G1M1和G2M2的夹角ξ=β1-β2;由该夹角推导得到RM2G1和RM2G2的长度,其表达式为:
其中,lF表示车厢前轴到车厢前端的距离,下标F表示车厢前方;采用转向角正负判定系数S2判断中间车车厢各车轮转角的正负,其表达式为:
其中,RM2G1表示线段M2G1的长度,下标 M2G1 表示线段M2G1;根据该正负判定系数得到中间车车厢前轴中心转弯半径R3:
以同样方式推导得到中间车车厢后轴的转弯半径R4:
步骤四、根据设置在首车内的虚拟轨道列车循迹控制器将上述推导计算得到的车厢各轴转向角传递给各轴转向电机控制器,通过转向电机控制器控制各轴车轮转向使虚拟轨道列车回归轨道,完成循迹控制目标。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910530460.8A CN110244731B (zh) | 2019-06-19 | 2019-06-19 | 三节编组虚拟轨道列车主动循迹控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910530460.8A CN110244731B (zh) | 2019-06-19 | 2019-06-19 | 三节编组虚拟轨道列车主动循迹控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110244731A CN110244731A (zh) | 2019-09-17 |
CN110244731B true CN110244731B (zh) | 2021-06-08 |
Family
ID=67887958
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910530460.8A Expired - Fee Related CN110244731B (zh) | 2019-06-19 | 2019-06-19 | 三节编组虚拟轨道列车主动循迹控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110244731B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112849222A (zh) * | 2019-11-28 | 2021-05-28 | 中车株洲电力机车研究所有限公司 | 一种跟随轴的转向控制方法及其装置 |
CN111547111B (zh) * | 2020-05-22 | 2021-04-13 | 西南交通大学 | 一种虚拟轨道列车自主导向控制方法 |
CN111976751B (zh) * | 2020-08-26 | 2021-08-03 | 中南大学 | 一种基于智轨列车横向加速度的转向辅助***及控制方法 |
CN111976726B (zh) * | 2020-08-26 | 2022-01-18 | 中南大学 | 一种智轨车辆的转向辅助***及其控制方法 |
CN114590333B (zh) * | 2020-12-03 | 2023-07-14 | 宇通客车股份有限公司 | 一种自动驾驶多节拖车及其位姿确定方法 |
CN113734245B (zh) * | 2021-09-24 | 2024-03-12 | 中车南京浦镇车辆有限公司 | 一种转轴式胶轮低地板虚拟轨道列车循迹控制方法和装置 |
CN113895516B (zh) * | 2021-10-14 | 2022-11-01 | 浙江吉利控股集团有限公司 | 铰接车的转向控制方法、铰接车及计算机存储介质 |
CN115817199B (zh) * | 2022-11-30 | 2023-09-26 | 同济大学 | 一种用于虚拟轨道列车的牵引导向协同控制方法和*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0580995A1 (de) * | 1992-07-24 | 1994-02-02 | Linke-Hofmann-Busch GmbH | Aus mindestens zwei Fahrzeugen bestehender spurgeführter Fahrzeugverband mit gesteuerten Einzelradsatzfahrwerken |
CN102343912A (zh) * | 2011-06-20 | 2012-02-08 | 中南大学 | 一种汽车行驶过程中的状态估计方法 |
CN106347457A (zh) * | 2016-10-19 | 2017-01-25 | 中车株洲电力机车研究所有限公司 | 一种列车轨迹跟随控制方法、***及列车 |
WO2017194353A1 (de) * | 2016-05-11 | 2017-11-16 | MüLLER CHRISTOPH | Verfahren und system zur führung von mechanisch gekoppelten oder frei folgenden zug- und fahrzeugverbänden ohne mechanische schiene |
CN109533021A (zh) * | 2019-01-08 | 2019-03-29 | 吉林大学 | 一种适用于商用车的多轴转向控制*** |
-
2019
- 2019-06-19 CN CN201910530460.8A patent/CN110244731B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0580995A1 (de) * | 1992-07-24 | 1994-02-02 | Linke-Hofmann-Busch GmbH | Aus mindestens zwei Fahrzeugen bestehender spurgeführter Fahrzeugverband mit gesteuerten Einzelradsatzfahrwerken |
CN102343912A (zh) * | 2011-06-20 | 2012-02-08 | 中南大学 | 一种汽车行驶过程中的状态估计方法 |
WO2017194353A1 (de) * | 2016-05-11 | 2017-11-16 | MüLLER CHRISTOPH | Verfahren und system zur führung von mechanisch gekoppelten oder frei folgenden zug- und fahrzeugverbänden ohne mechanische schiene |
CN106347457A (zh) * | 2016-10-19 | 2017-01-25 | 中车株洲电力机车研究所有限公司 | 一种列车轨迹跟随控制方法、***及列车 |
CN107963125A (zh) * | 2016-10-19 | 2018-04-27 | 中车株洲电力机车研究所有限公司 | 一种列车轨迹跟随控制方法、***及列车 |
CN109533021A (zh) * | 2019-01-08 | 2019-03-29 | 吉林大学 | 一种适用于商用车的多轴转向控制*** |
Also Published As
Publication number | Publication date |
---|---|
CN110244731A (zh) | 2019-09-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110244731B (zh) | 三节编组虚拟轨道列车主动循迹控制方法 | |
US10647348B2 (en) | Vehicle, single-wheelset/double-wheelset trackless train, and tracking and steering control method therefor | |
CN106681327B (zh) | 一种大惯性电动客车的智能驾驶横纵向解耦控制方法及*** | |
EP2517943B1 (en) | Active steering control device and method for railroad vehicle | |
WO2018072649A1 (zh) | 一种列车轨迹跟随控制方法、***及列车 | |
CN107963126B (zh) | 一种多轴转向车辆大曲率自动驾驶转向控制方法 | |
CN105197010A (zh) | 辅助泊车***以及辅助泊车控制方法 | |
CN110077418B (zh) | 考虑驾驶员特性的差动辅助转向与共享控制***建模方法 | |
US6345218B1 (en) | Vehicle steering control system based on vehicle body side slip angle | |
CN106218708A (zh) | 车辆转向控制装置 | |
CN111532283B (zh) | 一种基于模型预测控制的半挂汽车列车的路径跟踪方法 | |
CN112793677A (zh) | 一种门式虚拟轨道列车及其转向循迹控制方法 | |
US6289273B1 (en) | Measuring and control system for the tranverse regulation of successive vehicles and method for this purpose | |
CN109292018B (zh) | 基于同轴式轮腿结构的四轮转向轨迹跟踪控制方法 | |
CN104417603B (zh) | 转向控制设备和方法 | |
CN105291733B (zh) | 用于确定由车辆部段组成的车辆组合的纵向轴线之间的夹角的方法及控制设备 | |
KR100885892B1 (ko) | 굴절 차량용 전 차륜 조향 제어 방법 | |
JP4264399B2 (ja) | 無人搬送車 | |
CN112026749B (zh) | 一种线控转向***稳定性控制方法 | |
CN113665567A (zh) | 用于带拖车车辆的自动倒车的控制方法和控制*** | |
JP3740786B2 (ja) | 操舵補助装置 | |
US6571178B1 (en) | Method for curve recognition and axle alignment in rail vehicles | |
CN111547111A (zh) | 一种虚拟轨道列车自主导向控制方法 | |
Yuan et al. | Development and validation of an automatic steering control system for rubber-tire transit revenue service | |
CN111661048B (zh) | 多铰接式车辆及其轨迹跟随控制方法与*** |
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 |
Granted publication date: 20210608 |
|
CF01 | Termination of patent right due to non-payment of annual fee |