胶轮低地板智能轨道列车的多轴转向轨迹跟随闭环控制方法
【技术领域】
[0001] 本发明主要设及到城市公共交通设备领域，特指一种适用于胶轮低地板智能轨道 列车的多轴转向轨迹跟随闭环控制方法，W实现列车行进过程中各轴轨迹跟随。
【背景技术】
[0002] 城市轨道交通是指具有连续导向能力的专线公共交通系统，其特点表现为拥有特 定轨道，车辆沿轨道运行。常见的城市轨道交通有地铁、轻轨、有轨电车等。其中，地铁、轻 轨大都建造于地下或者高架桥上，通过使用闭塞模式实现其在轨道专线中自由运行，它们 虽然运输力强大，但前期基础设施及车辆购置成本较大，使得其在中小城市不能广泛应用。 有轨电车则需要专口的电力系统和轨道配合设计，无论是设计建设成本或者维护成本相对 较大、且易受制于运行环境。
[0003] 除了上述轨道交通之外，其它的公共交通系统常见的有传统公交车、较接式汽车 列车。传统公交车成本低、行驶灵活，当前方有障碍物时，能够很方便的躲开障碍物继续行 驶，当车辆发生故障时，可W靠边，不会影响其他车辆行驶。但传统公交车运力少，通常会 通过较接多节车厢来组成汽车列车增加运力。在中小城市中发展汽车列车替代传统的公 交车，在保证汽车列车通过性和转向性能等安全因素条件下，其不仅能够提高运输能力而 且能降低运输成本30%左右。较接式汽车列车客车虽然载客能力大，但是它和单体客车相 比，最大的差别是因车身长度加长带来的道路通过性的变化，具体表现为转弯半径增加，转 弯所占车道面积增大，易与旁边的道路交通其它元素发生干设，从而不能顺利通过，甚至恶 化交通运行环境，无法快速、高效地实现公交运输。
【发明内容】
[0004] 本发明要解决的技术问题就在于：针对现有技术存在的技术问题，本发明提供一 种控制效果好、稳定性高的胶轮低地板智能轨道列车的多轴转向轨迹跟随闭环控制方法。
[0005] 为解决上述技术问题，本发明采用W下技术方案：
[0006] -种胶轮低地板智能轨道列车的多轴转向轨迹跟随闭环控制方法，步骤为：
[0007] S1 :依据驾驶员输入的第一轴的第一轮转角δ1，控制第二轴的转动角度，令第二 轴轨迹与第一轴轨迹重合；
[0008] S2 :通过控制较接点夹角Φ，令第Ξ轴轨迹与第二轴和第一轴在同一圆弧上W保 证轨迹重合，其中较接点为两节车厢之间的较接点。
[0009] 作为本发明的进一步改进：假定胶轮低地板智能轨道列车由两节车厢组成，中间 通过较接点Ε连接，第一节车厢有两轴，车轮分别在Α，Β位置，第二节车厢有一个轴，在C点 位置；上述圆弧的圆屯、为0,半径为R，则0Α，0Β，0C的长度都为R;
[0010] 第一轮转角δ1为驾驶员输入转角，δ2为第二轴转角，为使第二轴轨迹与第一轴 轨迹重合根据卡尔曼原理得到：
[0011] δ2=δ 1 (1)
[0012] 第一节车厢长度为：
[001引 1 = 1札 似
[0014]且：
[0015]
[001引 由上式似和式（3)得到：
[0017] (勺
[0018] 得到转弯半径R为：
[0019] 獄：
[0020] 圆屯、0距离第一节车厢的距离h为：
[0023]L3为第二轴到较接点E的距离；
[0024] 那么，圆屯、0到较接点E的距离R'为：
[00巧]
巧）
[0026] 由余弦定理得到：
[0027]
(.9)
[0028] 作为本发明的进一步改进：所述步骤S2的步骤为：
[0029]L4为较接点E到第Ξ轴的距离，较接点夹角Φ为：
[0030]Φ=JT-ΘΘ2 (10)
[0031] 在车辆行进过程中，不断调整第Ξ轴的转角，使得较接点夹角Φ满足式（10)。
[0032] 作为本发明的进一步改进：所述步骤S2采用闭环PID控制，令第Ξ轴转角δ3为：
[0033] δ3=ΡΙ0(Φ"(1〇 (11)。
[0034]与现有技术相比，本发明的优点在于：本发明的胶轮低地板智能轨道列车的多轴 转向轨迹跟随闭环控制方法，通过闭环控制使得各轮轨迹在一条曲线上，实现了多轴转向 轨迹跟随，整个控制过程原理简单、稳定可靠。同时，因为在列车实际行驶过程中，轮胎存在 侧偏等影响，所W本发明方法所采用的闭环控制方法相比开环控制性能更稳定，效果更好。
【附图说明】
[0035] 图1是本发明控制方法的流程示意图。
[0036] 图2是本发明在具体应用实例中运动轨迹的原理示意图。
[0037] 图3是本发明在具体应用实例中对较接点夹角进行闭环控制的原理示意图。
【具体实施方式】
[003引 W下将结合说明书附图和具体实施例对本发明做进一步详细说明。
[0039] 胶轮低地板智能轨道列车，整个车身长达35米，整车可W分为多节车厢（如Ξ 节）、两个车头，整个车辆可实现双向行驶，每节车厢至少包括一个轴，本发明的控制方法目 标就是为了让整个列车在行进转向过程中所有轴均实现轨迹跟随。
[0040] 如图1所示，本发明胶轮低地板智能轨道列车的多轴转向轨迹跟随闭环控制方 法，其步骤为：
[0041] S1 :依据驾驶员输入的第一轴的第一轮转角δ1，控制第二轴的转动角度，令第二 轴轨迹与第一轴轨迹重合；
[0042] 参见图2,假设在具体应用实例中，胶轮低地板智能轨道列车由两节车厢组成，中 间通过较接点Ε连接，第一节车厢有两轴，车轮分别在Α，Β位置，第二节车厢有一个轴，在C 点位置，为了使胶轮低地板智能轨道列车的Ξ轴都在同一轨迹上，则胶轮低地板智能轨道 列车在行驶过程中Ξ轴必定在同一个圆弧上。
[0043] 假设上述圆弧的圆屯、为0,半径为R，则0Α，0Β，0C的长度都为R。
[0044]第一轮转角δ1为驾驶员输入转角，为使第二轴轨迹与第一轴轨迹重合根据卡尔 曼原理得到：
[0045]δ2=δ1(1)
[0046] 第一节车厢长度为：
[0057] L3为第二轴到较接点Ε的距离。
[0058] 那么，圆屯、0到较接点E的距离r为：
[0059]
[0060] 由余弦定理得到：
[0061]
(9；
[0062] S2:通过控制较接点夹角Φ，令第Ξ轴轨迹与第二轴和第一轴在同一圆弧上W保 证轨迹重合，其中较接点为两节车厢之间的较接点；
[0063] L4为较接点E到第Ξ轴的距离，较接点夹角Φ为：
[0064] Φ=JI-白1一白2 (10)
[0065] 因此，为了保证第Ξ轴与第二轴和第一轴在同一圆弧上必须保证较接点夹角Φ 满足式（10)的关系，所W在车辆行进过程中，不断调整第Ξ轴的转角，使得较接点夹角Φ 满足式（10)。
[0066] 在本实施例中，为了保证较接点满足式（10)的关系，如图3所示，可W采用闭环 PID控制。所W第Ξ轴的转角为：
[0067] δ3=ΡΙ0(Φ"(1〇 (11)
[0068] 通过本发明的上述控制方法，就可W解决列车轨迹跟随的效果，因为车轮侧偏影 响，相比开环控制该方法更稳定，更可靠。同理可知，在其他应用实例中，如果具有多个车厢 或是多根轴，其基本原理也如上，能够实现轨迹跟随控制。
[0069] W上仅是本发明的优选实施方式，本发明的保护范围并不仅局限于上述实施例， 凡属于本发明思路下的技术方案均属于本发明的保护范围。例如说，本发明还能够适用于 其他类型的多轴汽车列车，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发 明原理前提下的若干改进和润饰，应视为本发明的保护范围。
【主权项】
1. 一种胶轮低地板智能轨道列车的多轴转向轨迹跟随闭环控制方法，其特征在于，步 骤为： 51 :依据驾驶员输入的第一轴的第一轮转角Si，控制第二轴的转动角度，令第二轴轨 迹与第一轴轨迹重合； 52 :通过控制铰接点夹角Φ，令第三轴轨迹与第二轴和第一轴在同一圆弧上以保证轨 迹重合，其中铰接点为两节车厢之间的铰接点。2. 根据权利要求1所述的胶轮低地板智能轨道列车的多轴转向轨迹跟随闭环控制方 法，其特征在于，假定胶轮低地板智能轨道列车由两节车厢组成，中间通过铰接点E连接， 第一节车厢有两轴，车轮分别在A，B位置，第二节车厢有一个轴，在C点位置；上述圆弧的圆 心为〇,半径为R，则〇A，OB，0C的长度都为R; 第一轮转角\为驾驶员输入转角，δ2为第二轴转角，为使第二轴轨迹与第一轴轨迹 重合根据卡尔曼原理得到： δ 2= δ1(1) 第一节车厢长度L为： L=L!+L2 (2) L1为第一轴距离转弯圆心垂直车身点的距离，L2为转弯圆心垂直车身的点距离第二 轴的距离，且圆心距离车身的距离h为：由余弦定理得到第二节车厢与圆心到铰接点的夹角θ2为：3. 根据权利要求2所述的胶轮低地板智能轨道列车的多轴转向轨迹跟随闭环控制方 法，其特征在于，所述步骤S2的步骤为： 1^为铰接点E到第三轴的距离，铰接点夹角Φ为： Φ=τι-θΘ2 (10) 在车辆行进过程中，不断调整第三轴的转角，使得铰接点夹角Φ满足式（10)。4. 根据权利要求3所述的胶轮低地板智能轨道列车的多轴转向轨迹跟随闭环控制方 法，其特征在于，所述步骤S2采用闭环PID控制，令第三轴转角δ3为： δ3=ΡΙ?(Φt,ΦΓ) (11) 其中，〇,为理想目标值，Φ 实际值。
【专利摘要】本发明公开了一种胶轮低地板智能轨道列车的多轴转向轨迹跟随闭环控制方法，步骤为：S1：依据驾驶员输入的第一轴的第一轮转角δ1，控制第二轴的转动角度，令第二轴轨迹与第一轴轨迹重合；S2：通过控制铰接点夹角φ，令第三轴轨迹与第二轴和第一轴在同一圆弧上以保证轨迹重合，其中铰接点为两节车厢之间的铰接点。本发明具有控制效果好、稳定性高等优点。
【IPC分类】B62D12/02
【公开号】CN105292256
【申请号】CN201510809301
【发明人】冯江华, 尚敬, 许峻峰, 刘小聪, 肖磊, 彭京, 蒋小晴, 张陈林, 朱田, 魏黎, 任田良
【申请人】南车株洲电力机车研究所有限公司
【公开日】2016年2月3日
【申请日】2015年11月20日