CN108153145B - 一种基于pid和滤波算法的列车速度自动控制方法 - Google Patents
一种基于pid和滤波算法的列车速度自动控制方法 Download PDFInfo
- Publication number
- CN108153145B CN108153145B CN201711416436.9A CN201711416436A CN108153145B CN 108153145 B CN108153145 B CN 108153145B CN 201711416436 A CN201711416436 A CN 201711416436A CN 108153145 B CN108153145 B CN 108153145B
- Authority
- CN
- China
- Prior art keywords
- pid
- train
- speed
- pid control
- control
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 48
- 238000001914 filtration Methods 0.000 title abstract description 11
- 230000008569 process Effects 0.000 claims abstract description 17
- 230000010354 integration Effects 0.000 claims abstract description 10
- 238000012937 correction Methods 0.000 claims abstract description 7
- 230000001133 acceleration Effects 0.000 claims description 49
- 230000009191 jumping Effects 0.000 claims description 9
- 230000009467 reduction Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 description 3
- 238000005265 energy consumption Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002068 genetic effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Regulating Braking Force (AREA)
Abstract
本发明提供一种基于PID和滤波算法的列车速度自动控制方法,包括:获取列车当前运行目标速度和实际速度;计算出速度跟踪误差;计算出误差偏差并更新误差偏差微分滤波器的状态量;计算出PID控制量并更新PID控制器在积分过程中的状态量;调整PID控制量;修正经过调整的PID控制量;更新经过修正的PID控制量;将经过更新的PID控制量转换为相应的控制力并对控制力进行修正;将经过修正的控制力输出给列车。本发明结合滤波算法及PID控制算法的优点对速度跟踪误差进行偏差修正,从而减小列车驾驶过程中的速度跟踪误差,使得对列车的控制更加精确,确保列车能够更加平滑稳定运行,提高乘坐舒适度。
Description
技术领域
本发明涉及城市轨道交通控制技术领域,具体是一种基于PID和滤波算法的列车速度自动控制方法。
背景技术
随着城市轨道交通的迅速发展,在高效率运营的同时对列车驾驶控制技术也提出了更高的要求。CBTC(基于通信的列车控制系统)的出现大幅度提高了城市轨道交通信号系统的可靠性和安全性,ATO(列车自动驾驶)系统是CBTC实现列车自动驾驶、降低列车能耗和提高运营效率的基础。ATO系统主要负责保证列车自动驾驶,提供列车自动控制和调整并辅助司机驾驶等功能,是轨道交通CBTC系统的核心系统之一。
目前国内外对ATO系统控制算法的研究取得了显著成果,主要包括遗传算法、模糊控制算法、传统的PID控制算法和神经网络控制算法等。但这些算法均存在一定的局限性,不仅对计算机的计算能力要求较高,而且工况切换时列车的速度变化次数较为频繁,速度跟踪精确度较低,耗能较多,无法保证控制精确性和乘坐舒适度。
发明内容
本发明的目的在于提供一种基于PID和滤波算法的列车速度自动控制方法,在列车自动驾驶过程中减小速度跟踪误差,提高列车速度控制量的计算精确度,保证乘坐舒适性和列车运行效率,实现对列车的精确控制。
本发明的技术方案为:
一种基于PID和滤波算法的列车速度自动控制方法,该方法包括以下步骤:
(1)获取列车当前运行目标速度和实际速度;
(2)根据所述列车当前运行目标速度和实际速度,计算出速度跟踪误差;
(3)根据所述速度跟踪误差,采用误差偏差微分滤波器计算出误差偏差,并更新所述误差偏差微分滤波器的状态量;
(4)根据所述速度跟踪误差和误差偏差,采用PID控制器计算出PID控制量,并更新所述PID控制器在积分过程中的状态量;
(5)获取前馈值并采用所述前馈值对步骤(4)计算出的PID控制量进行调整;
(6)根据最大目标制动加速度和最大目标牵引加速度,对经过步骤(5)调整的PID控制量进行修正;
(7)根据所述速度跟踪误差,对经过步骤(6)修正的PID控制量进行更新;
(8)将经过步骤(7)更新的PID控制量转换为相应的控制力,并对所述控制力进行修正;
(9)将经过步骤(8)修正的控制力输出给列车。
所述的基于PID和滤波算法的列车速度自动控制方法,步骤(1)中,所述列车当前运行目标速度的获取包括以下步骤:
a、根据列车在当前区间内的区间计划运营时间以及线路限定条件信息,计算出列车运行推荐速度曲线;
b、根据列车运行推荐速度曲线,获取列车当前运行目标速度。
所述的基于PID和滤波算法的列车速度自动控制方法,步骤(3)中,所述误差偏差采用以下公式计算得到:
diffErr=(diffFc0*diffFx0)+(diffFc1*diffFx1)+(diffFd0*errorSpeed);
其中,diffErr表示所述误差偏差,diffFc0、diffFc1、diffFd0均表示所述误差偏差微分滤波器的系数,diffFx0、diffFx1均表示所述误差偏差微分滤波器的状态量,errorSpeed表示所述速度跟踪误差;
所述误差偏差微分滤波器的状态量采用以下公式进行更新:
diffFx0=(diffFa0*diffFx0)+(diffFa1*diffFx1)+(diffFb0*errorSpeed);
diffFx1=(diffFa2*diffFx0)+(diffFa3*diffFx1)+(diffFb1*errorSpeed);其中,diffFa0、diffFa1、diffFb0、diffFa2、diffFa3、diffFb1均表示所述误差偏差微分滤波器的系数。
所述的基于PID和滤波算法的列车速度自动控制方法,步骤(4)中,所述PID控制量采用以下公式计算得到:
pidResult=(Kp*errorSpeed)+(Ki*Xi)+(Kd*diffErr);
其中,pidResult表示所述PID控制量,Kp、Ki、Kd均表示所述PID控制器的系数,errorSpeed表示所述速度跟踪误差,diffErr表示所述误差偏差,Xi表示PID控制器在积分过程中的状态量;
所述PID控制器在积分过程中的状态量采用以下公式进行更新:
Xi=Xi+(errorSpeed*cycTime)
其中,cycTime表示ATO系统控制循环周期。
所述的基于PID和滤波算法的列车速度自动控制方法,步骤(5)中,所述获取前馈值并采用所述前馈值对步骤(4)计算出的PID控制量进行调整,具体包括以下步骤:
a、判断列车当前驾驶状态是否处于巡航阶段,若是,则执行步骤b,若否,则直接将所述前馈值设为停车制动加速度,然后跳转至步骤d;
b、判断所述列车当前运行目标速度是否低于预设阈值,若是,则将所述前馈值设为最大目标制动加速度,然后跳转至步骤d,若否,则执行步骤c;
c、根据所述列车当前运行目标速度以及前馈值微分滤波器,采用以下公式计算出所述前馈值,并更新所述前馈值微分滤波器的状态量,然后跳转至步骤d:
forwardVal=(forwardFc0*forwardFx0)+(forwardFc1*forwardFx1)+(forwardFd0*targetSpeed);
forwardFx0=(forwardFa0*forwardFx0)+(forwardFa1*forwardFx1)+(forwardFb0*targetSpeed);
forwardFx1=(forwardFa2*forwardFx0)+(forwardFa3*forwardFx1)+(forwardFb1*targetSpeed);
其中,forwardVal表示所述前馈值,forwardFx0、forwardFx1均表示所述前馈值微分滤波器的状态量,forwardFa0、forwardFa1、forwardFa2、forwardFa3、forwardFb0、forwardFb1、forwardFc0、forwardFc1、forwardFd0均表示所述前馈值微分滤波器的系数,targetSpeed表示所述列车当前运行目标速度;
d、根据获取的所述前馈值,采用以下公式对步骤(4)计算出的PID控制量进行调整:
pidResult=pidResult+forwardVal;
其中,pidResult表示PID控制量,且公式中左边的pidResult表示调整后的PID控制量,右边的pidResult表示调整前的PID控制量。
所述的基于PID和滤波算法的列车速度自动控制方法,步骤(6)中,所述根据最大目标制动加速度和最大目标牵引加速度,对经过步骤(5)调整的PID控制量进行修正,具体包括以下步骤:
a、若所述经过步骤(5)调整的PID控制量处于最大目标制动加速度与最大目标牵引加速度之间,则保持所述经过步骤(5)调整的PID控制量不变;
b、若所述经过步骤(5)调整的PID控制量大于最大目标牵引加速度,则将所述经过步骤(5)调整的PID控制量修正为具体线路场景中的牵引加速度;
c、若所述经过步骤(5)调整的PID控制量小于最大目标制动加速度,则将所述经过步骤(5)调整的PID控制量修正为具体线路场景中的制动加速度。
所述的基于PID和滤波算法的列车速度自动控制方法,步骤(7)中,根据所述速度跟踪误差,对经过步骤(6)修正的PID控制量进行更新,具体包括以下步骤:
判断所述速度跟踪误差是否大于预设阈值,若是,则保持所述经过步骤(6)修正的PID控制量不变,若否,则将所述经过步骤(6)修正的PID控制量更新为0。
所述的基于PID和滤波算法的列车速度自动控制方法,步骤(8)中,对所述控制力进行修正,具体包括以下步骤:
a、判断所述控制力是否小于预设的控制力最小值,若是,则将所述控制力修正为所述预设的控制力最小值,若否,则执行步骤b;
b、判断所述控制力与上周期输出的控制力之差是否大于牵引力每次增加的上限值,若是,则将所述控制力修正为所述上周期输出的控制力与牵引力每次增加的上限值之和,若否,则执行步骤c;
c、判断所述上周期输出的控制力与所述控制力之差是否大于牵引力每次减少的上限值,若是,则将所述控制力修正为所述上周期输出的控制力与牵引力每次减少的上限值之差,若否,则执行步骤d;
d、保持所述控制力不变。
所述的基于PID和滤波算法的列车速度自动控制方法,步骤(5)中,还包括获取坡度加速度,在所述前馈值对步骤(4)计算出的PID控制量进行调整的基础上,采用所述坡度加速度对步骤(4)计算出的PID控制量进行再次调整;或者先采用所述坡度加速度对步骤(4)计算出的PID控制量进行调整,在所述坡度加速度对步骤(4)计算出的PID控制量进行调整的基础上,采用所述前馈值对步骤(4)计算出的PID控制量进行再次调整。
所述的基于PID和滤波算法的列车速度自动控制方法,步骤(9)中,将经过步骤(8)修正的控制力以电流环的形式输出给列车。
由上述技术方案可知,本发明在传统的PID控制算法的基础上增加了滤波算法的控制,结合滤波及PID控制的优点对速度跟踪误差进行偏差修正,从而减小列车驾驶过程中的速度跟踪误差,使得对列车的控制更加精确,确保列车能够更加平滑稳定运行,提高乘坐舒适度。
附图说明
图1是本发明ATO系统的架构示意图;
图2是本发明的方法流程图。
具体实施方式
下面结合附图和具体实施例进一步说明本发明。
如图1所示,本发明ATO系统的架构主要包括目标速度计算模块1、滤波器2、PID控制器3和实际速度采集模块4。
目标速度计算模块1是用于根据线路限定条件计算出列车运行推荐速度曲线。滤波器2是用于根据列车运行推荐速度曲线及实际速度采集模块4采集到的列车运行实际速度信息计算速度跟踪误差,并进行相应的数据处理。PID控制器3是用于在滤波器2处理的基础上对误差偏差进行修正,并向受控列车输出相应调节控制量,受控列车根据控制量大小对速度进行调整。实际速度采集模块4是用于将采集到的列车运行实际速度信息反馈到回路中进行新一轮的修正和调整。
如图2所示,一种基于PID和滤波算法的列车速度自动控制方法,包括以下步骤:
S0、获取列车在当前区间内的区间计划运营时间以及线路限定条件信息,计算出列车运行推荐速度曲线。
S1、根据列车运行推荐速度曲线,获取列车当前运行目标速度targetSpeed,并根据实际速度采集模块4获取列车当前运行实际速度realSpeed。
S2、将获取的列车当前运行目标速度targetSpeed和实际速度realSpeed相减,计算出速度跟踪误差errorSpeed。
S3、根据步骤S2中计算出的速度跟踪误差errorSpeed及低通滤波方法的原理,利用微分滤波算法计算出误差偏差diffErr,并更新误差偏差微分滤波器(即用于计算误差偏差的微分滤波器)的状态量,具体包括以下步骤:
S301、设定如下误差偏差微分滤波器的系数:diffFa0、diffFa1、diffFa2、diffFa3、diffFb0、diffFb1、diffFc0、diffFc1、diffFd0,其数值由具体场景多次运行过程中调整所得;及误差偏差微分滤波器的状态量:diffFx0、diffFx1,其初始值设定为0。
S302、根据速度跟踪误差errorSpeed以及误差偏差微分滤波器计算出误差偏差diffErr,从而滤除干扰信号,通过以下公式实现:
diffErr=(diffFc0*diffFx0)+(diffFc1*diffFx1)+(diffFd0*errorSpeed)
S303、根据速度跟踪误差errorSpeed以及误差偏差微分滤波器的系数,更新误差偏差微分滤波器的状态量diffFx0和diffFx1,通过以下公式实现:
diffFx0=(diffFa0*diffFx0)+(diffFa1*diffFx1)+(diffFb0*errorSpeed)
diffFx1=(diffFa2*diffFx0)+(diffFa3*diffFx1)+(diffFb1*errorSpeed)
S4、根据速度跟踪误差errorSpeed和误差偏差diffErr,利用PID控制算法计算出PID控制结果即控制量pidResult,并更新PID控制器在积分过程中的状态量,具体包括以下步骤:
S401、设定如下PID控制器的系数:Kp、Ki、Kd,其数值由具体场景多次运行过程中调整所得;及PID控制器在积分过程中的状态量:Xi,其初始值设定为0。
S402、根据速度跟踪误差errorSpeed和误差偏差diffErr计算出PID控制量pidResult,通过以下公式实现:
pidResult=(Kp*errorSpeed)+(Ki*Xi)+(Kd*diffErr)
S403、采用以下公式更新PID控制器在积分过程中的状态量Xi,其中cycTime为ATO系统控制循环周期:
Xi=Xi+(errorSpeed*cycTime)
S5、获取前馈值forwardVal,并将获取的前馈值forwardVal加入到PID控制量pidResult中,具体包括以下步骤:
S501、判断ATO系统驾驶状态是否处于巡航阶段,若是,则执行步骤S502,否则说明驾驶状态处于停车阶段,直接将前馈值forwardVal设为停车制动加速度,该停车制动加速度由具体线路场景设定,然后跳转至步骤S506。
S502、判断列车当前运行目标速度targetSpeed是否低于预设阈值,该预设阈值由具体线路场景设定;若是,则将前馈值forwardVal设为最大目标制动加速度,该最大目标制动加速度由具体线路场景设定,然后跳转至步骤S506,否则执行步骤S503。
S503、设定如下前馈值微分滤波器(即用于计算前馈值的微分滤波器)的系数:forwardFa0、forwardFa1、forwardFa2、forwardFa3、forwardFb0、forwardFb1、forwardFc0、forwardFc1、forwardFd0,其数值由具体场景多次运行过程中调整所得;及前馈值微分滤波器的状态量:forwardFx0、forwardFx1,其初始值设定为0。
S504、根据列车当前运行目标速度targetSpeed以及前馈值微分滤波器,采用以下公式计算出前馈值forwardVal,然后跳转至步骤S506:
forwardVal=(forwardFc0*forwardFx0)+(forwardFc1*forwardFx1)+(forwardFd0*targetSpeed)
S505、根据列车当前运行目标速度targetSpeed以及前馈值微分滤波器更新前馈值微分滤波器的状态量forwardFx0、forwardFx1,通过以下公式实现:
forwardFx0=(forwardFa0*forwardFx0)+(forwardFa1*forwardFx1)+(forwardFb0*targetSpeed)
forwardFx1=(forwardFa2*forwardFx0)+(forwardFa3*forwardFx1)+(forwardFb1*targetSpeed)
S506、将得到的前馈值forwardVal加入到PID控制量pidResult中:
pidResult=pidResult+forwardVal
注:上式中“=”左边的pidResult表示调整后的PID控制量,“=”右边的pidResult表示调整前的PID控制量,下同。
S6、在步骤S5的基础上,考虑到线路坡度对PID控制量pidResult的影响,将坡度加速度graAcc加入到上述PID控制量pidResult中,该坡度加速度graAcc由具体线路场景设定:
pidResult=pidResult+graAcc
注:步骤S6也可以放在步骤S5之前。
S7、根据ATO系统的最大目标制动加速度和最大目标牵引加速度,对步骤S6得到的PID控制量pidResult进行修正,具体包括以下步骤:
S701、判断步骤6计算出的PID控制量pidResult是否处于最大目标制动加速度与最大目标牵引加速度之间,最大目标制动加速度和最大目标牵引加速度由具体线路场景设定,若是,则执行步骤S702,否则判断该PID控制量pidResult是否大于最大目标牵引加速度,若是,则执行步骤S703,否则执行步骤S704;
S702、PID控制量pidResult处于最大目标制动加速度与最大目标牵引加速度之间,保持该PID控制量pidResult不变,即不需要修正,
S703、PID控制量pidResult大于最大目标牵引加速度,将PID控制量pidResult修正为具体线路场景中的牵引加速度;
S704、PID控制量pidResult小于最大目标制动加速度,将PID控制量pidResult修正为具体线路场景中的制动加速度。
S8、根据步骤S2得到的速度跟踪误差errorSpeed判断节能巡航状态,并更新PID控制量pidResult,仅当速度跟踪误差errorSpeed大于某一阈值时才允许在制动阶段施加牵引力,该阈值由具体线路场景设定,否则说明列车处于节能巡航状态,将PID控制量pidResult置0。
S9、将经过上述步骤得到的最终的PID控制量pidResult转换为控制力ctrlPower,为了防止输出时冲量过大,需要对控制力ctrlPower进行修正,然后ATO系统将修正后确定下来的最终的控制力ctrlPower以电流环的形式输出给列车,实现对列车的控制。
控制力ctrlPower的修正包括以下步骤:
S901、首先判断控制力ctrlPower是否小于预设的控制力范围的最小值,该控制力范围的最小值由具体线路场景设定,若是,则将控制力ctrlPower修正为该控制力范围的最小值,若否,则执行步骤S902;
S902、判断控制力ctrlPower与上周期输出的控制力ctrlLastPower之差是否大于牵引力每次增加的上限值trackMax,若是,则将控制力ctrlPower修正为上周期输出的控制力ctrlLastPower与牵引力每次增加的上限值trackMax之和,若否,则执行步骤S903;
S903、判断上周期输出的控制力ctrlLastPower与控制力ctrlPower之差是否大于牵引力每次减少的上限值trackMin,若是,则将控制力ctrlPower修正为上周期输出的控制力ctrlLastPower与牵引力每次减少的上限值trackMin之差,若否,则执行步骤S904;
S904、不需要对控制力ctrlPower进行修正。
本发明所描述的控制方法在传统PID控制算法的基础上加入了滤波算法对数据的处理,结合了滤波算法和PID控制算法的优点,能够更好地提高计算精确性,增强控车效果,使得列车更加平滑稳定运行,同时提高乘坐舒适性。
以上所述实施方式仅仅是对本发明的优选实施方式进行描述,并非对本发明的范围进行限定,在不脱离本发明设计精神的前提下,本领域普通技术人员对本发明的技术方案作出的各种变形和改进,均应落入本发明的权利要求书确定的保护范围内。
Claims (9)
1.一种基于PID和滤波算法的列车速度自动控制方法,其特征在于,该方法包括以下步骤:
(1)获取列车当前运行目标速度和实际速度;
(2)根据所述列车当前运行目标速度和实际速度,计算出速度跟踪误差;
(3)根据所述速度跟踪误差,采用误差偏差微分滤波器计算出误差偏差,并更新所述误差偏差微分滤波器的状态量;
(4)根据所述速度跟踪误差和误差偏差,采用PID控制器计算出PID控制量,并更新所述PID控制器在积分过程中的状态量;
(5)获取前馈值并采用所述前馈值对步骤(4)计算出的PID控制量进行调整;
(6)根据最大目标制动加速度和最大目标牵引加速度,对经过步骤(5)调整的PID控制量进行修正;
(7)根据所述速度跟踪误差,对经过步骤(6)修正的PID控制量进行更新;
(8)将经过步骤(7)更新的PID控制量转换为相应的控制力,并对所述控制力进行修正;
(9)将经过步骤(8)修正的控制力输出给列车;
步骤(3)中,所述误差偏差采用以下公式计算得到:
diffErr=(diffFc0*diffFx0)+(diffFc1*diffFx1)+(diffFd0*errorSpeed);
其中,diffErr表示所述误差偏差,diffFc0、diffFc1、diffFd0均表示所述误差偏差微分滤波器的系数,diffFx0、diffFx1均表示所述误差偏差微分滤波器的状态量,errorSpeed表示所述速度跟踪误差;
所述误差偏差微分滤波器的状态量采用以下公式进行更新:
diffFx0=(diffFa0*diffFx0)+(diffFa1*diffFx1)+(diffFb0*errorSpeed);
diffFx1=(diffFa2*diffFx0)+(diffFa3*diffFx1)+(diffFb1*errorSpeed);
其中,diffFa0、diffFa1、diffFb0、diffFa2、diffFa3、diffFb1均表示所述误差偏差微分滤波器的系数。
2.根据权利要求1所述的基于PID和滤波算法的列车速度自动控制方法,其特征在于,步骤(1)中,所述列车当前运行目标速度的获取包括以下步骤:
a、根据列车在当前区间内的区间计划运营时间以及线路限定条件信息,计算出列车运行推荐速度曲线;
b、根据列车运行推荐速度曲线,获取列车当前运行目标速度。
3.根据权利要求1所述的基于PID和滤波算法的列车速度自动控制方法,其特征在于,步骤(4)中,所述PID控制量采用以下公式计算得到:
pidResult=(Kp*errorSpeed)+(Ki*Xi)+(Kd*diffErr);
其中,pidResult表示所述PID控制量,Kp、Ki、Kd均表示所述PID控制器的系数,errorSpeed表示所述速度跟踪误差,diffErr表示所述误差偏差,Xi表示PID控制器在积分过程中的状态量;
所述PID控制器在积分过程中的状态量采用以下公式进行更新:
Xi=Xi+(errorSpeed*cycTime)
其中,cycTime表示ATO系统控制循环周期。
4.根据权利要求1所述的基于PID和滤波算法的列车速度自动控制方法,其特征在于,步骤(5)中,所述获取前馈值并采用所述前馈值对步骤(4)计算出的PID控制量进行调整,具体包括以下步骤:
a、判断列车当前驾驶状态是否处于巡航阶段,若是,则执行步骤b,若否,则直接将所述前馈值设为停车制动加速度,然后跳转至步骤d;
b、判断所述列车当前运行目标速度是否低于预设阈值,若是,则将所述前馈值设为最大目标制动加速度,然后跳转至步骤d,若否,则执行步骤c;
c、根据所述列车当前运行目标速度以及前馈值微分滤波器,采用以下公式计算出所述前馈值,并更新所述前馈值微分滤波器的状态量,然后跳转至步骤d:
forwardVal=(forwardFc0*forwardFx0)+(forwardFc1*forwardFx1)+(forwardFd0*targetSpeed);
forwardFx0=(forwardFa0*forwardFx0)+(forwardFa1*forwardFx1)+(forwardFb0*targetSpeed);
forwardFx1=(forwardFa2*forwardFx0)+(forwardFa3*forwardFx1)+(forwardFb1*targetSpeed);
其中,forwardVal表示所述前馈值,forwardFx0、forwardFx1均表示所述前馈值微分滤波器的状态量,forwardFa0、forwardFa1、forwardFa2、forwardFa3、forwardFb0、forwardFb1、forwardFc0、forwardFc1、forwardFd0均表示所述前馈值微分滤波器的系数,targetSpeed表示所述列车当前运行目标速度;
d、根据获取的所述前馈值,采用以下公式对步骤(4)计算出的PID控制量进行调整:
pidResult=pidResult+forwardVal;
其中,pidResult表示PID控制量,且公式中左边的pidResult表示调整后的PID控制量,右边的pidResult表示调整前的PID控制量。
5.根据权利要求1所述的基于PID和滤波算法的列车速度自动控制方法,其特征在于,步骤(6)中,所述根据最大目标制动加速度和最大目标牵引加速度,对经过步骤(5)调整的PID控制量进行修正,具体包括以下步骤:
a、若所述经过步骤(5)调整的PID控制量处于最大目标制动加速度与最大目标牵引加速度之间,则保持所述经过步骤(5)调整的PID控制量不变;
b、若所述经过步骤(5)调整的PID控制量大于最大目标牵引加速度,则将所述经过步骤(5)调整的PID控制量修正为具体线路场景中的牵引加速度;
c、若所述经过步骤(5)调整的PID控制量小于最大目标制动加速度,则将所述经过步骤(5)调整的PID控制量修正为具体线路场景中的制动加速度。
6.根据权利要求1所述的基于PID和滤波算法的列车速度自动控制方法,其特征在于,步骤(7)中,根据所述速度跟踪误差,对经过步骤(6)修正的PID控制量进行更新,具体包括以下步骤:
判断所述速度跟踪误差是否大于预设阈值,若是,则保持所述经过步骤(6)修正的PID控制量不变,若否,则将所述经过步骤(6)修正的PID控制量更新为0。
7.根据权利要求1所述的基于PID和滤波算法的列车速度自动控制方法,其特征在于,步骤(8)中,对所述控制力进行修正,具体包括以下步骤:
a、判断所述控制力是否小于预设的控制力最小值,若是,则将所述控制力修正为所述预设的控制力最小值,若否,则执行步骤b;
b、判断所述控制力与上周期输出的控制力之差是否大于牵引力每次增加的上限值,若是,则将所述控制力修正为所述上周期输出的控制力与牵引力每次增加的上限值之和,若否,则执行步骤c;
c、判断所述上周期输出的控制力与所述控制力之差是否大于牵引力每次减少的上限值,若是,则将所述控制力修正为所述上周期输出的控制力与牵引力每次减少的上限值之差,若否,则执行步骤d;
d、保持所述控制力不变。
8.根据权利要求1所述的基于PID和滤波算法的列车速度自动控制方法,其特征在于,步骤(5)中,还包括获取坡度加速度,在所述前馈值对步骤(4)计算出的PID控制量进行调整的基础上,采用所述坡度加速度对步骤(4)计算出的PID控制量进行再次调整;或者先采用所述坡度加速度对步骤(4)计算出的PID控制量进行调整,在所述坡度加速度对步骤(4)计算出的PID控制量进行调整的基础上,采用所述前馈值对步骤(4)计算出的PID控制量进行再次调整。
9.根据权利要求1所述的基于PID和滤波算法的列车速度自动控制方法,其特征在于,步骤(9)中,将经过步骤(8)修正的控制力以电流环的形式输出给列车。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711416436.9A CN108153145B (zh) | 2017-12-22 | 2017-12-22 | 一种基于pid和滤波算法的列车速度自动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711416436.9A CN108153145B (zh) | 2017-12-22 | 2017-12-22 | 一种基于pid和滤波算法的列车速度自动控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108153145A CN108153145A (zh) | 2018-06-12 |
CN108153145B true CN108153145B (zh) | 2020-10-16 |
Family
ID=62464436
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711416436.9A Active CN108153145B (zh) | 2017-12-22 | 2017-12-22 | 一种基于pid和滤波算法的列车速度自动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108153145B (zh) |
Families Citing this family (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109278806B (zh) * | 2018-08-13 | 2021-01-26 | 浙江众合科技股份有限公司 | 基于站停结果的ato自学习自适应精确站停系统及方法 |
CN109407666A (zh) * | 2018-10-11 | 2019-03-01 | 智久(厦门)机器人科技有限公司上海分公司 | 一种无人车辆的控制方法、装置、设备及存储介质 |
CN109606397A (zh) * | 2018-12-12 | 2019-04-12 | 怀化学院 | 列车运行控制方法、装置、计算机设备和存储介质 |
CN109693688B (zh) * | 2018-12-24 | 2020-08-25 | 北京交通大学 | 预设性能的列车自动驾驶控制系统及控制方法 |
CN109739228B (zh) * | 2018-12-28 | 2021-12-10 | 创泽智能机器人集团股份有限公司 | 一种安防机器人的速度调节参数自训练方法 |
CN109634099A (zh) * | 2018-12-29 | 2019-04-16 | 百度在线网络技术(北京)有限公司 | 用于控制车辆的方法和装置 |
CN109606365A (zh) * | 2018-12-29 | 2019-04-12 | 百度在线网络技术(北京)有限公司 | 用于控制车辆的方法和装置 |
CN111824168B (zh) * | 2019-04-15 | 2022-01-07 | 比亚迪股份有限公司 | 车辆控制方法、装置及车辆 |
CN112083648A (zh) * | 2019-06-14 | 2020-12-15 | 株洲中车时代电气股份有限公司 | 一种基于pid的列车恒速控制方法、装置、介质及设备 |
CN110284426B (zh) * | 2019-06-25 | 2021-07-09 | 衡橡科技股份有限公司 | 一种桥梁检查车变频控制系统及其控制方法 |
CN110632846A (zh) * | 2019-09-17 | 2019-12-31 | 北京交通大学 | 基于二阶adrc算法的地铁列车速度自动控制方法 |
CN110824919A (zh) * | 2019-10-31 | 2020-02-21 | 北京交通大学 | 一种直流电脑鼠自动控制方法和系统 |
CN113625542B (zh) * | 2020-05-06 | 2024-08-20 | 北京新能源汽车股份有限公司 | 一种比例积分微分控制方法、控制装置及测功机模型 |
CN111791890B (zh) * | 2020-05-22 | 2021-11-16 | 武汉光庭科技有限公司 | 一种基于pid的跟车方法 |
CN113928371B (zh) * | 2020-06-29 | 2023-06-13 | 比亚迪股份有限公司 | 列车自动驾驶方法和系统 |
CN112197803B (zh) * | 2020-09-29 | 2022-04-15 | 北京环境特性研究所 | 船载光电传感器控制方法和装置 |
CN112286045A (zh) * | 2020-10-15 | 2021-01-29 | 天津津航计算技术研究所 | 一种用于真空金属管道高速列车的启停控制系统 |
CN112641384B (zh) * | 2020-12-17 | 2021-11-19 | 珠海一微半导体股份有限公司 | 机器人减速刹车状态下的pid调节方法 |
CN112947047B (zh) * | 2021-01-26 | 2022-08-09 | 重庆长安汽车股份有限公司 | 一种基于自适应pid算法的自动驾驶加速度控制方法 |
CN113026021A (zh) * | 2021-02-02 | 2021-06-25 | 宁波职业技术学院 | 一种基于pid的蚀刻液再生装置控制系统及方法 |
CN113428195B (zh) * | 2021-06-29 | 2023-03-31 | 通号城市轨道交通技术有限公司 | 列车自动控制方法及装置 |
CN113759701B (zh) * | 2021-09-09 | 2024-06-28 | 五邑大学 | 一种高速列车速度控制方法及系统 |
CN115469691A (zh) * | 2022-09-23 | 2022-12-13 | 湖南大学 | 电机驱动方法、装置、设备和系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004021309A (ja) * | 2002-06-12 | 2004-01-22 | Denso Corp | Pid制御装置、プログラム及び記録媒体 |
CN101893849A (zh) * | 2010-07-12 | 2010-11-24 | 绍兴县精功机电研究所有限公司 | 一种pid控制器的控制方法 |
CN102033548A (zh) * | 2009-09-29 | 2011-04-27 | 北京航空航天大学 | 基于rbf神经网络的伺服控制系统及方法 |
CN103620191A (zh) * | 2011-07-01 | 2014-03-05 | 丰田自动车株式会社 | 车辆的驱动力控制装置 |
CN104199362A (zh) * | 2014-09-09 | 2014-12-10 | 上虞安卡拖车配件有限公司 | 一种城市轨道列车的实时速度跟踪控制方法及系统 |
-
2017
- 2017-12-22 CN CN201711416436.9A patent/CN108153145B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004021309A (ja) * | 2002-06-12 | 2004-01-22 | Denso Corp | Pid制御装置、プログラム及び記録媒体 |
CN102033548A (zh) * | 2009-09-29 | 2011-04-27 | 北京航空航天大学 | 基于rbf神经网络的伺服控制系统及方法 |
CN101893849A (zh) * | 2010-07-12 | 2010-11-24 | 绍兴县精功机电研究所有限公司 | 一种pid控制器的控制方法 |
CN103620191A (zh) * | 2011-07-01 | 2014-03-05 | 丰田自动车株式会社 | 车辆的驱动力控制装置 |
CN104199362A (zh) * | 2014-09-09 | 2014-12-10 | 上虞安卡拖车配件有限公司 | 一种城市轨道列车的实时速度跟踪控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN108153145A (zh) | 2018-06-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108153145B (zh) | 一种基于pid和滤波算法的列车速度自动控制方法 | |
CN107487228B (zh) | 电力机车恒速运行工况下的平稳性控制方法 | |
CN102275601B (zh) | 一种智能控车方法及装置 | |
CN105934363B (zh) | 行驶控制装置、车辆、交通系统、控制方法、以及程序 | |
CN108001447A (zh) | 一种智能车辆路径跟踪前轮转角补偿控制方法 | |
CN110568758A (zh) | 一种自动驾驶汽车的参数自适应横向运动lqr控制方法 | |
CN106600952A (zh) | 一种车辆编队形成的方法 | |
CN110116730B (zh) | 一种车辆制动控制方法、系统、设备和介质 | |
CN111679668B (zh) | 一种基于新的时距策略的网络化自主车队的跟随控制方法 | |
CN110632846A (zh) | 基于二阶adrc算法的地铁列车速度自动控制方法 | |
CN108549214A (zh) | 一种高性能pid控制方法 | |
CN110893850A (zh) | 一种车辆纵向速度规划方法和纵向速度规划装置 | |
CN104049536A (zh) | 底盘非线性系统模糊神经网络广义逆控制器的构造方法 | |
WO2015101102A1 (zh) | 车辆定速控制方法及装置 | |
CN113311783A (zh) | 一种s型运动曲线规划方法及系统 | |
CN113085963B (zh) | 列车控制级位的动态调控方法及其动态调控装置 | |
CN112271909A (zh) | 母线平衡桥均压控制方法及装置 | |
CN112744270B (zh) | 一种基于状态辨识的列车快速精确停车方法 | |
Huang et al. | Prescribed performance tracking control for adjacent virtual coupling high‐speed trains with input saturation | |
CN109572697B (zh) | 基于模糊控制的特殊路段行进车辆的油门自动控制方法 | |
CN113428195B (zh) | 列车自动控制方法及装置 | |
CN203562983U (zh) | 多电机同步控制系统 | |
CN116909145A (zh) | 一种用于长大下坡循环制动的重载列车速度跟踪控制方法 | |
CN113872477B (zh) | 一种永磁同步电机滑模控制方法及其应用 | |
CN114274787A (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 |