CN108422997A - A kind of automobile active safety cooperative control system and method based on wolf pack algorithm - Google Patents
A kind of automobile active safety cooperative control system and method based on wolf pack algorithm Download PDFInfo
- Publication number
- CN108422997A CN108422997A CN201810459053.8A CN201810459053A CN108422997A CN 108422997 A CN108422997 A CN 108422997A CN 201810459053 A CN201810459053 A CN 201810459053A CN 108422997 A CN108422997 A CN 108422997A
- Authority
- CN
- China
- Prior art keywords
- wolf
- prey
- control
- lower layer
- controller
- 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.)
- Pending
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Regulating Braking Force (AREA)
Abstract
Description
技术领域technical field
本发明涉及汽车主动安全技术领域,特别是涉及一种基于狼群算法的汽车主动安全协同控制系统及方法。The invention relates to the technical field of automobile active safety, in particular to an automobile active safety cooperative control system and method based on wolf pack algorithm.
背景技术Background technique
随着时代进步,人们对汽车安全性能的期待越来越高,主动安全控制系统逐渐成为各类车型的标配。主动安全系统由多个子系统组成,各系统需要密切配合以实现控制意图,因此对主动安全系统的协同控制已成为领域研究热点。然而,目前大多数的研究只考虑了汽车本身的失稳问题,而忽略了驾驶员的操纵对汽车行驶状态的影响,这就造成控制精度的降低;同时,因为目前广泛使用的优化算法收敛性较差,多数的优化方案仅考虑了一个控制目标,优化结果只实现了局部优化,未能实现整车全局的最优控制。With the progress of the times, people have higher and higher expectations for the safety performance of automobiles, and active safety control systems have gradually become the standard configuration of various models. The active safety system is composed of multiple subsystems, and each system needs to cooperate closely to realize the control intention. Therefore, the cooperative control of the active safety system has become a research hotspot in the field. However, most of the current research only considers the instability of the car itself, while ignoring the influence of the driver's manipulation on the driving state of the car, which reduces the control accuracy; at the same time, because the widely used optimization algorithm convergence Poor, most of the optimization schemes only consider one control objective, the optimization results only achieve local optimization, and fail to achieve the overall optimal control of the whole vehicle.
发明内容Contents of the invention
针对上述现有技术的不足,本发明提供一种基于狼群算法的汽车主动安全协同控制系统及方法,能够实现整车全局的最优控制。In view of the deficiencies of the above-mentioned prior art, the present invention provides a vehicle active safety cooperative control system and method based on wolf pack algorithm, which can realize the overall optimal control of the whole vehicle.
为实现上述目的,本发明采用如下技术方案:To achieve the above object, the present invention adopts the following technical solutions:
一种基于狼群算法的汽车主动安全协同控制系统,包括依次连接的传感器系统、上层控制器、下层控制器、底盘执行系统;A vehicle active safety cooperative control system based on the wolf pack algorithm, including a sequentially connected sensor system, an upper controller, a lower controller, and a chassis execution system;
所述传感器系统包括用于采集驾驶员动作信号的驾驶员感知模块、用于记录汽车当前行驶状况的车辆感知模块;所述驾驶员感知模块和车辆感知模块分别向上层控制器传递传感器信号;The sensor system includes a driver sensing module for collecting driver action signals, and a vehicle sensing module for recording the current driving condition of the car; the driver sensing module and the vehicle sensing module transmit sensor signals to the upper controller respectively;
所述上层控制器包括信号识别模块、决策模块、优化模块;所述信号识别模块接收传感器信号,预处理后发送给决策模块;所述决策模块根据传感器信号预测驾驶员预期运动参数,并发送给优化模块,所述优化模块以预期运动参数跟实际运动参数之间的差距最小为控制目标,以实际运动参数为上层控制对象,利用狼群算法进行优化计算,并将上层控制对象的最优解发送给下层控制器;The upper controller includes a signal recognition module, a decision module, and an optimization module; the signal recognition module receives sensor signals, and sends them to the decision module after preprocessing; the decision module predicts the driver's expected motion parameters according to the sensor signals, and sends them to An optimization module, the optimization module takes the minimum difference between the expected motion parameters and the actual motion parameters as the control target, takes the actual motion parameters as the upper-level control object, uses the wolf pack algorithm to perform optimization calculations, and uses the optimal solution of the upper-level control object sent to the lower controller;
所述下层控制器以上层控制对象的最优解为控制目标,以前轮转角、车轮的制动液压为下层控制对象进行优化计算,计算出下层控制对象的最优解,并输出控制信号到底盘执行系统;The lower-level controller takes the optimal solution of the upper-level control object as the control target, performs optimization calculations on the front wheel rotation angle and the brake hydraulic pressure of the wheels as the lower-level control objects, calculates the optimal solution of the lower-level control object, and outputs control signals to the chassis execution system;
所述底盘执行系统用于接收下层控制器输出的控制信号,控制转向执行电机转动以及调节车轮制动液压。The chassis execution system is used to receive the control signal output by the lower controller, control the rotation of the steering execution motor and adjust the wheel brake hydraulic pressure.
进一步的,所述运动参数包括车速、质心侧偏角、侧向加速度、横摆角速度。Further, the motion parameters include vehicle speed, side slip angle of center of mass, lateral acceleration, and yaw rate.
进一步的,所述驾驶员感知模块包括转向盘角传感器、制动踏板位移传感器,用于采集驾驶员动作信号;所述车辆感知模块包括车轮传感器、侧滑传感器、陀螺仪传感器,用于记录汽车当前行驶状况。Further, the driver sensing module includes a steering wheel angle sensor and a brake pedal displacement sensor for collecting driver action signals; the vehicle sensing module includes a wheel sensor, a sideslip sensor, and a gyroscope sensor for recording Current driving conditions.
一种基于狼群算法的汽车主动安全协同控制方法,包括如下步骤:A vehicle active safety cooperative control method based on wolf pack algorithm, comprising the following steps:
步骤1:传感器系统采集驾驶员动作信号和汽车当前行驶状况,并将其传递到上层控制器;Step 1: The sensor system collects the driver's action signal and the current driving status of the car, and transmits it to the upper controller;
步骤2:上层控制器接收传感器信号后,由信号识别模块预处理传感器信号,并传递给决策模块,决策模块根据传感器信号预测驾驶员预期运动参数,并发送给优化模块,优化模块以预期运动参数跟实际运动参数之间的差距最小为控制目标,以实际运动参数为上层控制对象,利用狼群算法进行优化计算,并将上层控制对象的最优解发送给下层控制器;Step 2: After the upper controller receives the sensor signal, the sensor signal is preprocessed by the signal recognition module and passed to the decision-making module. The decision-making module predicts the driver's expected motion parameters according to the sensor signal and sends it to the optimization module. The optimization module uses the expected motion parameters The minimum gap between the actual motion parameters is the control target, the actual motion parameters are used as the upper control object, the wolf pack algorithm is used for optimization calculation, and the optimal solution of the upper control object is sent to the lower controller;
步骤3:下层控制器以上层控制对象的最优解为控制目标,以前轮转角、车轮的制动液压为下层控制对象进行优化计算,并输出控制信号到底盘执行系统;Step 3: The lower-level controller takes the optimal solution of the upper-level control object as the control target, performs optimization calculations on the front wheel rotation angle and the brake hydraulic pressure of the wheels as the lower-level control objects, and outputs control signals to the chassis execution system;
步骤4:所述底盘执行系统包括AFS执行器、DYC执行器,所述DYC执行器接收下层控制器输出的制动液压控制信号调节车轮制动液压,AFS执行器接收下层控制器输出的前轮转角控制信号控制转向执行电机。Step 4: The chassis execution system includes an AFS actuator and a DYC actuator. The DYC actuator receives the brake hydraulic control signal output by the lower controller to adjust the wheel brake hydraulic pressure. The AFS actuator receives the front wheel brake output output from the lower controller. The steering angle control signal controls the steering actuator motor.
优选的,步骤2中,所述狼群算法的具体步骤包括:Preferably, in step 2, the specific steps of the wolf pack algorithm include:
步骤2.1:数值初始化Step 2.1: Value initialization
a)初始化狼群数量N以及每只狼的位置信息Xi(ν,β,αy,γ),i=(1,N),所述位置信息为四维坐标,ν,β,αy,γ分别代表车速、质心侧偏角、侧向加速度、横摆角速度;a) Initialize the number of wolves N and the position information Xi (ν, β, α y , γ) of each wolf, i=(1, N), the position information is four-dimensional coordinates, ν, β, α y , γ respectively represent vehicle speed, side slip angle of center of mass, lateral acceleration and yaw rate;
b)设置每只狼对应的猎物气味浓度Yi,即为驾驶员期望的车辆位置坐标与实际的车辆位置坐标的差值构成的目标函数:b) Set the prey odor concentration Y i corresponding to each wolf, which is the objective function formed by the difference between the driver's expected vehicle position coordinates and the actual vehicle position coordinates:
其中,(xt,yt)为t时刻车辆实际位置坐标,(xe,ye)为t时刻驾驶员期望的车辆位置坐标,且Among them, (x t , y t ) is the actual vehicle position coordinates at time t, (x e , y e ) is the vehicle position coordinates expected by the driver at time t, and
xt=x0+ν*cos(β+γ*t)*tx t =x 0 +ν*cos(β+γ*t)*t
x0、y0为车辆初始位置坐标;x 0 and y 0 are the initial position coordinates of the vehicle;
c)根据控制精度及求解速度需求,设置最大迭代次数kmax、最大游走次数Tmax、探狼比例因子α、距离判定因子ω、步长因子S以及更新比例因子σ;c) According to the control accuracy and solution speed requirements, set the maximum number of iterations k max , the maximum number of walks T max , the wolf detection scale factor α, the distance determination factor ω, the step size factor S and the update scale factor σ;
d)选取当前猎物气味浓度最高的人工狼为头狼s,取其位置为Xlead、猎物气味浓度为Ylead;d) Select the artificial wolf with the highest prey odor concentration as the head wolf s, take its position as X lead , and the prey odor concentration as Y lead ;
步骤2.2:游走行为Step 2.2: Walking Behavior
a)将N只狼的猎物气味浓度从大到小排列,取除头狼外前N*α个猎物气味浓度对应的人工狼为探狼,除头狼与探狼外的所有人工狼为猛狼;a) Arrange the prey odor concentrations of N wolves from large to small, and take the artificial wolves corresponding to the first N*α prey odor concentrations except the head wolf as the detection wolf, and all the artificial wolves except the head wolf and the detection wolf as the ferocious wolf Wolf;
b)对于探狼j,其猎物气味浓度为Yj 0,此时Yj 0<Ylead,j=(1,N*α),其进行游走行为,向h个方向分别前进一个游走步长stepa,记录每前进一步后所感知的猎物气味浓度后退回原位置,则向第p(p=1,2,3...,h)个方向前进后探狼j的位置为Xj p、猎物气味浓度为Yj p;b) For wolf j, whose prey odor concentration is Y j 0 , at this time Y j 0 <Y lead , j=(1,N*α), it performs a wandering behavior, and advances one walk in h directions respectively The step size is step a , record the perceived prey odor concentration after each step forward and then return to the original position, then the position of the wolf j after moving to the pth (p=1,2,3...,h) direction is X j p , the prey odor concentration is Y j p ;
c)选择Yj p最大且大于当前位置的猎物气味浓度Yj 0的方向前进一个游走步长stepa,更新探狼j的位置信息Xj;c) Choose the direction where Y j p is the largest and greater than the prey odor concentration Y j 0 at the current position, advance a walking step step a , and update the position information X j of wolf j;
d)重复以上的游走行为,直到某只探狼感知到的猎物气味浓度Yj>Ylead,此时该探狼成为头狼,Ylead=Yj,或游走次数T达到最大游走次数Tmax,此时维持原头狼不变;d) Repeat the above walking behavior until the concentration of prey odor perceived by a certain wolf is Y j > Y lead , at this time the wolf becomes the leader wolf, Y lead = Y j , or the number of wanderings T reaches the maximum wandering The number of times T max , at this time, the original wolf remains unchanged;
步骤2.3:召唤/奔袭行为Step 2.3: Summon/Rush Behavior
a)头狼通过嚎叫发起召唤行为,召集周围的N*(1-α)-1只猛狼向头狼所在位置迅速靠拢,猛狼以奔袭步长stepb=2*stepa快速逼近头狼所在位置;a) The head wolf initiates the summoning behavior by howling, and calls the surrounding N*(1-α)-1 wolves to quickly approach the head wolf's position, and the wolf quickly approaches the head wolf with a running step of step b = 2*step a where the wolf is located;
b)奔袭途中,若猛狼z(z=(1,N*(1-α)-1))感知到的猎物气味浓度Yz>Ylead,则该猛狼转化为头狼并发起召唤行为,此时Ylead=Yz;b) During the attack, if the wolf z (z=(1,N*(1-α)-1)) perceives the prey odor concentration Y z >Y lead , then the wolf will transform into a wolf leader and initiate a calling behavior , at this time Y lead = Y z ;
c)奔袭途中,若猛狼z感知到的猎物气味浓度Yz<Ylead,则猛狼z继续奔袭直到其与头狼s之间的距离dzs小于dnear时加入到对猎物的攻击行列,即转入围攻行为;c) During the attack, if the prey odor concentration Yz perceived by the wolf z <Y lead , then the wolf z will continue to attack until the distance d zs between it and the wolf s is less than d near and join the ranks of attacking the prey , that is, turning into siege behavior;
步骤2.4:围攻行为Step 2.4: Siege Behavior
a)将此时离猎物最近的狼即头狼的位置视为猎物的移动位置,猛狼联合探狼以攻击步长stepc向猎物紧密逼近以期将其捕获;a) Consider the position of the wolf closest to the prey, that is, the head wolf, as the moving position of the prey, and the ferocious wolf and the wolf detection will approach the prey closely with the attack step step c in order to capture it;
b)若实施围攻行为后,某只人工狼感知到的猎物气味浓度大于其原位置状态所感知的猎物气味浓度,则更新此人工狼的位置,若不然,人工狼位置不变;b) If after the siege is carried out, the prey odor concentration perceived by an artificial wolf is greater than the prey odor concentration perceived by its original position, then update the position of the artificial wolf, otherwise, the position of the artificial wolf remains unchanged;
c)若更新人工狼位置后,某只人工狼感知到的猎物气味浓度大于头狼所感知到的猎物气味浓度,则该人工狼转化为头狼,将该人工狼的位置视为猎物所在位置,其他人工狼以该狼为中心继续围攻行为;c) If after updating the position of the artificial wolf, the concentration of prey odor perceived by an artificial wolf is greater than that of the head wolf, the artificial wolf will be transformed into a head wolf, and the position of the artificial wolf will be regarded as the location of the prey , other artificial wolves continue to besiege around this wolf;
d)更新头狼位置后,判断是否达到优化精度或最大迭代次数kmax,若达到则输出此头狼的位置,即所求的最优解,否则重复步骤2.2-2.4。d) After updating the head wolf's position, judge whether the optimization accuracy or the maximum number of iterations k max is reached, and if so, output the head wolf's position, which is the optimal solution sought, otherwise repeat steps 2.2-2.4.
优选的,步骤3中,所述下层控制器的优化计算的方法为神经网络算法,所述神经网络算法的输入为前轮转角、车轮的制动液压;输出为车速、质心侧偏角、侧向加速度、横摆角速度。Preferably, in step 3, the optimization calculation method of the lower controller is a neural network algorithm, the input of the neural network algorithm is the front wheel angle, the brake hydraulic pressure of the wheel; the output is the vehicle speed, the side slip angle of the center of mass, the side Acceleration, yaw rate.
有益效果:1、将人—车作为闭环系统进行优化,考虑了驾驶员操纵对控制目标的影响;Beneficial effects: 1. The human-vehicle is optimized as a closed-loop system, and the influence of the driver's manipulation on the control target is considered;
2、狼群算法对于不同特征的复杂函数具有较好的鲁棒性及全局收敛性能,进一步提高了控制系统的精度和效率;2. The wolf pack algorithm has good robustness and global convergence performance for complex functions with different characteristics, which further improves the accuracy and efficiency of the control system;
3、神经网络算法由于其特有的大规模并行结构、信息的分布式存储和并行处理特点,提高了控制系统的自适应性和容错性。3. The neural network algorithm improves the adaptability and fault tolerance of the control system due to its unique large-scale parallel structure, distributed storage of information and parallel processing characteristics.
附图说明Description of drawings
图1为本发明的控制方法流程图;Fig. 1 is a flow chart of the control method of the present invention;
图2为本发明中狼群算法流程图;Fig. 2 is wolf pack algorithm flowchart in the present invention;
图3为本发明中神经网络算法流程图。Fig. 3 is a flow chart of the neural network algorithm in the present invention.
具体实施方式Detailed ways
下面结合附图对本发明做更进一步的解释。The present invention will be further explained below in conjunction with the accompanying drawings.
本发明为一种基于狼群算法的汽车主动安全协同控制系统及方法。首先由传感器系统监测驾驶员操纵信号、行车状态信号,上层控制器据此信号由内置算法对上层控制对象进行优化计算,下层控制器对下层控制对象进行优化计算并转换为控制指令发送至执行器,以实现行车状态的调整。The invention relates to a vehicle active safety cooperative control system and method based on wolf pack algorithm. First, the sensor system monitors the driver's manipulation signal and the driving status signal. Based on the signal, the upper-level controller performs optimal calculation on the upper-level control object by the built-in algorithm, and the lower-level controller performs optimal calculation on the lower-level control object and converts it into a control command and sends it to the actuator. , in order to realize the adjustment of the driving state.
下面结合附图对本发明进一步说明。The present invention will be further described below in conjunction with the accompanying drawings.
如图1所示,本发明的工作方法为:As shown in Figure 1, working method of the present invention is:
1)传感器系统监测驾驶员操纵信号、行车状态信号,并将其传递到上层控制器。1) The sensor system monitors the driver's manipulation signals and driving status signals, and transmits them to the upper controller.
2)上层控制器接收传感信号后,由信号识别模块预处理(包括滤波、放大、调制等,目的是抽取出信号中我们需要的内容)传感器信号,将驾驶员操纵信号及车辆当前运动状态信号传递给决策模块,决策模块根据以上信号估计驾驶员预期运动参数(此为现有技术,本文不再赘述),并输入给优化模块,优化模块以预期运动参数跟实际运动参数之间的差距最小为控制目标,以实际的车速、质心侧偏角、侧向加速度、横摆角速度为上层控制对象,采用狼群算法进行优化计算,并输出最优解到下层控制器。2) After the upper controller receives the sensor signal, the sensor signal is preprocessed by the signal recognition module (including filtering, amplification, modulation, etc., the purpose is to extract the content we need in the signal), and the driver's control signal and the current motion state of the vehicle The signal is delivered to the decision-making module, and the decision-making module estimates the driver's expected motion parameters according to the above signals (this is the prior art, so this paper will not repeat them), and input to the optimization module, the optimization module uses the difference between the expected motion parameters and the actual motion parameters The minimum is the control target, and the actual vehicle speed, center of mass side slip angle, lateral acceleration, and yaw rate are the upper-level control objects, and the wolf pack algorithm is used for optimization calculation, and the optimal solution is output to the lower-level controller.
3)下层控制器中以上层控制对象(车速、质心侧偏角、侧向加速度、横摆角速度)的最优解为控制目标,以前轮转角、车轮的制动液压为下层控制对象,采用神经网络算法对其进行优化计算,并输出控制信号到底盘执行系统。3) In the lower-layer controller, the optimal solution of the upper-layer control objects (vehicle speed, side slip angle, lateral acceleration, and yaw rate) is the control target, and the front wheel rotation angle and the brake hydraulic pressure of the wheels are the lower-layer control objects. The network algorithm performs optimization calculations and outputs control signals to the chassis execution system.
4)底盘执行系统根据相应的控制信号执行动作,协同作用以实现行车状态的调整。4) The chassis execution system executes actions according to the corresponding control signals, and cooperates to realize the adjustment of the driving state.
5)此时,行车状态信号以及后续的驾驶员操纵信号都将发生变化,传感器系统持续监测以上信号并传递到上层控制器,循环往复。5) At this time, the driving status signal and the subsequent driver's manipulation signal will change, and the sensor system will continuously monitor the above signals and transmit them to the upper controller, and the cycle will repeat.
如图2所示,狼群算法的优化过程为:As shown in Figure 2, the optimization process of the wolf pack algorithm is:
步骤2.1:数值初始化Step 2.1: Value initialization
a)初始化狼群数量N以及每只狼的位置信息Xi(ν,β,αy,γ),i=(1,N),所述位置信息为四维坐标,ν,β,αy,γ分别代表车速、质心侧偏角、侧向加速度、横摆角速度;a) Initialize the number of wolves N and the position information Xi (ν, β, α y , γ) of each wolf, i=(1, N), the position information is four-dimensional coordinates, ν, β, α y , γ respectively represent vehicle speed, side slip angle of center of mass, lateral acceleration and yaw rate;
b)设置每只狼对应的猎物气味浓度Yi,即为驾驶员期望运动与实际运动的差值构成的目标函数b) Set the prey odor concentration Y i corresponding to each wolf, which is the objective function formed by the difference between the driver's expected motion and the actual motion
其中,(xt,yt)为t时刻车辆实际位置坐标,(xe,ye)为t时刻驾驶员期望车辆位置坐标,且Among them, (x t , y t ) is the actual vehicle position coordinates at time t, (x e , y e ) is the driver’s expected vehicle position coordinates at time t, and
xt=x0+ν*cos(β+γ*t)*tx t =x 0 +ν*cos(β+γ*t)*t
x0、y0为车辆初始位置坐标;x 0 and y 0 are the initial position coordinates of the vehicle;
c)根据控制精度及求解速度需求,设置最大迭代次数kmax、最大游走次数Tmax、探狼比例因子α、距离判定因子ω、步长因子S以及更新比例因子σ;c) According to the control accuracy and solution speed requirements, set the maximum number of iterations k max , the maximum number of walks T max , the wolf detection scale factor α, the distance determination factor ω, the step size factor S and the update scale factor σ;
d)选取当前猎物气味浓度最高的人工狼为头狼s,取其位置为Xlead、猎物气味浓度为Ylead;d) Select the artificial wolf with the highest prey odor concentration as the head wolf s, take its position as X lead , and the prey odor concentration as Y lead ;
步骤2.2:游走行为Step 2.2: Walking Behavior
a)取初始解空间中除头狼外的N*α只猎物气味浓度较佳的人工狼为探狼,除头狼与探狼外的所有人工狼为猛狼;a) Take the N*α artificial wolves with better prey odor concentration in the initial solution space as the wolves, and all the artificial wolves except the head wolf and the wolves are ferocious wolves;
b)对于探狼j,当前位置的猎物气味浓度Yj 0,此时Yj 0<Ylead,j=(1,N*α),其进行游走行为,向h个方向分别前进一个游走步长stepa,记录每前进一步后所感知的猎物气味浓度后退回原位置,则向第p(p=1,2,3...,h)个方向前进后探狼j的位置为猎物气味浓度为 b) For the wolf detective j, the prey odor concentration Y j 0 at the current position, at this time Y j 0 <Y lead , j=(1,N*α), it performs a wandering behavior, and advances one swim in h directions respectively. Walk step length step a , record the perceived prey odor concentration after each step forward and then return to the original position, then the position of wolf j after moving to the pth (p=1,2,3...,h) direction is The prey odor concentration is
c)选择Yj p最大且大于当前位置的猎物气味浓度Yj 0的方向前进一个游走步长stepa,更新探狼j的位置信息Xj;c) Choose the direction where Y j p is the largest and greater than the prey odor concentration Y j 0 at the current position, advance a walking step step a , and update the position information X j of wolf j;
d)重复以上的游走行为,直到某只探狼感知到的猎物气味浓度Yj>Ylead,此时该探狼成为头狼,Ylead=Yj,或游走次数T达到最大游走次数Tmax,此时维持原头狼不变;d) Repeat the above walking behavior until the concentration of prey odor perceived by a certain wolf is Y j > Y lead , at this time the wolf becomes the leader wolf, Y lead = Y j , or the number of wanderings T reaches the maximum wandering The number of times T max , at this time, the original wolf remains unchanged;
步骤2.3:召唤/奔袭行为Step 2.3: Summon/Rush Behavior
a)头狼通过嚎叫发起召唤行为,召集周围的N*(1-α)-1只猛狼向头狼所在位置迅速靠拢,猛狼以奔袭步长stepb=2*stepa快速逼近头狼所在位置;a) The head wolf initiates the summoning behavior by howling, and calls the surrounding N*(1-α)-1 wolves to quickly approach the head wolf's position, and the wolf quickly approaches the head wolf with a running step of step b = 2*step a where the wolf is located;
b)奔袭途中,若猛狼z(z=(1,N*(1-α)-1))感知到的猎物气味浓度Yz>Ylead,则该猛狼转化为头狼并发起召唤行为,此时Ylead=Yz;b) During the attack, if the wolf z (z=(1,N*(1-α)-1)) perceives the prey odor concentration Y z >Y lead , then the wolf will transform into a wolf leader and initiate a calling behavior , at this time Y lead = Y z ;
c)奔袭途中,若猛狼z感知到的猎物气味浓度Yz<Ylead,则猛狼z继续奔袭直到其与头狼s之间的距离dzs小于dnear(由距离判定因子ω和优化对象的取值范围决定)时加入到对猎物的攻击行列,即转入围攻行为;c) During the attack, if the prey odor concentration Yz perceived by the wolf z <Y lead , then the wolf z will continue to attack until the distance d zs between it and the wolf s is less than d near (by the distance determination factor ω and the optimization When the value range of the object is determined), join the ranks of attacking the prey, that is, turn into the siege behavior;
步骤2.4:围攻行为Step 2.4: Siege Behavior
a)将此时离猎物最近的狼即头狼的位置视为猎物的移动位置,猛狼要联合探狼以攻击步长stepc向猎物紧密逼近以期将其捕获;a) Consider the position of the wolf closest to the prey, that is, the head wolf, as the moving position of the prey, and the ferocious wolf should cooperate with the wolf detection to approach the prey closely with the attack step c in order to capture it;
b)若实施围攻行为后,某只人工狼感知到的猎物气味浓度大于其原位置状态所感知的猎物气味浓度,则更新此人工狼的位置,若不然,人工狼位置不变;b) If after the siege is carried out, the prey odor concentration perceived by an artificial wolf is greater than the prey odor concentration perceived by its original position, then update the position of the artificial wolf, otherwise, the position of the artificial wolf remains unchanged;
c)若更新人工狼位置后,某只人工狼感知到的猎物气味浓度大于头狼所感知到的猎物气味浓度,则该人工狼转化为头狼,将该人工狼的位置视为猎物所在位置,其他人工狼以该狼为中心继续围攻行为;c) If after updating the position of the artificial wolf, the concentration of prey odor perceived by an artificial wolf is greater than that of the head wolf, the artificial wolf will be transformed into a head wolf, and the position of the artificial wolf will be regarded as the location of the prey , other artificial wolves continue to besiege around this wolf;
d)更新头狼位置后,判断是否达到优化精度或最大迭代次数kmax,若达到则输出此头狼的位置,即所求的最优解,否则转步骤2.2。d) After updating the position of the wolf, judge whether the optimization accuracy or the maximum number of iterations k max is reached, and if so, output the position of the wolf, which is the optimal solution sought, otherwise go to step 2.2.
狼群算法适用两个机制:The wolf pack algorithm applies two mechanisms:
1、“强者生存”的狼群更新机制1. The wolves update mechanism of "survival of the strong"
a)猎物按照“由强到弱”的原则进行分配,导致弱小的狼会被饿死,即需要在狼群中去除猎物气味浓度最低的N*σ只人工狼;a) The prey is distributed according to the principle of "from strong to weak", resulting in weak wolves starving to death, that is, it is necessary to remove N*σ artificial wolves with the lowest prey odor concentration in the wolf pack;
b)同时,为维护狼群的个体多样性,需随机生成N*σ只新的人工狼,即开辟新的解空间;b) At the same time, in order to maintain the individual diversity of wolves, it is necessary to randomly generate N*σ new artificial wolves, that is, to open up a new solution space;
2、“胜者为王”的头狼产生机制2. The "winner takes the king" alpha wolf production mechanism
a)为保证最终解为最优,需持续对头狼进行优胜劣汰,当存在某只人工狼对应的猎物气味浓度大于Ylead时,即更新该狼为头狼;a) In order to ensure that the final solution is optimal, it is necessary to continuously carry out the survival of the fittest for the leader wolf. When there is an artificial wolf whose prey odor concentration is greater than Y lead , the wolf is updated as the leader wolf;
b)更新头狼位置后,判断是否达到优化精度或最大迭代次数kmax,若达到则输出此头狼的位置,即所求的最优解,否则转步骤2)。b) After updating the position of the wolf, judge whether the optimization accuracy or the maximum number of iterations k max is reached, and if so, output the position of the wolf, which is the optimal solution sought, otherwise go to step 2).
如图3所示,神经网络算法的训练过程为:As shown in Figure 3, the training process of the neural network algorithm is:
选取神经网络系统输入为Xi(前轮转角、前左轮制动液压、前右轮制动液压、后左轮制动液压、后右轮制动液压)、系统输出为Yi(车速、质心侧偏角、侧向加速度、横摆角速度),即输入层节点数n=5,输出层节点数m=4,隐含层节点数l=3。取大量实车测试数据,即测量实车行驶时的输入、输出信号,作为神经网络训练的样本数据对神经网络进行训练,迭代结果后取部分数据对神经网络进行测试,当其输出结果满足精度要求时,即可用于控制系统的参数优化。此时,给定一组输出(车速、质心侧偏角、侧向加速度、横摆角速度),可由神经网络反求出对应的一组输入(前轮转角、前左轮制动压力、前右轮制动压力、后左轮制动压力、后右轮制动压力),即完成了给定控制目标下对于控制对象的最优求解。然后,下层控制器将该控制对象的最优解发送到底盘执行系统。The input of the neural network system is selected as X i (front wheel angle, front left wheel brake hydraulic pressure, front right wheel brake hydraulic pressure, rear left wheel brake hydraulic pressure, rear right wheel brake hydraulic pressure), and the system output is Y i (vehicle speed, center of mass side deflection angle, lateral acceleration, and yaw rate), that is, the number of nodes in the input layer is n=5, the number of nodes in the output layer is m=4, and the number of nodes in the hidden layer is l=3. Take a large amount of real vehicle test data, that is, measure the input and output signals of the real vehicle when driving, and use it as the sample data for neural network training to train the neural network. After iterating the results, take some data to test the neural network. When the output results meet the accuracy When required, it can be used for parameter optimization of the control system. At this point, given a set of outputs (vehicle speed, side slip angle, lateral acceleration, yaw rate), the corresponding set of inputs (front wheel rotation angle, front left wheel brake pressure, front right wheel brake pressure, rear left wheel brake pressure, rear right wheel brake pressure), that is, the optimal solution for the control object under the given control objective has been completed. Then, the lower layer controller sends the optimal solution of the control object to the chassis execution system.
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。The above is only a preferred embodiment of the present invention, it should be pointed out that, for those of ordinary skill in the art, without departing from the principle of the present invention, some improvements and modifications can also be made, and these improvements and modifications can also be made. It should be regarded as the protection scope of the present invention.
Claims (6)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810459053.8A CN108422997A (en) | 2018-05-15 | 2018-05-15 | A kind of automobile active safety cooperative control system and method based on wolf pack algorithm |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810459053.8A CN108422997A (en) | 2018-05-15 | 2018-05-15 | A kind of automobile active safety cooperative control system and method based on wolf pack algorithm |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108422997A true CN108422997A (en) | 2018-08-21 |
Family
ID=63163065
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810459053.8A Pending CN108422997A (en) | 2018-05-15 | 2018-05-15 | A kind of automobile active safety cooperative control system and method based on wolf pack algorithm |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108422997A (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110473175A (en) * | 2019-07-26 | 2019-11-19 | 长春工程学院 | A kind of train axle space linearity measurement method |
CN113085578A (en) * | 2021-04-26 | 2021-07-09 | 浙江吉利控股集团有限公司 | Four-wheel-drive automobile yaw control method and device based on fuzzy PID |
CN110626340B (en) * | 2019-09-30 | 2023-07-11 | 南京航空航天大学 | Intelligent vehicle path tracking control system and method based on gray wolf algorithm |
CN119928894A (en) * | 2025-04-10 | 2025-05-06 | 沈阳安普合科技有限公司 | A vehicle control system |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1608011A (en) * | 2001-12-27 | 2005-04-20 | 丰田自动车株式会社 | Integrated vehicle motion control system |
CN106092138A (en) * | 2016-06-06 | 2016-11-09 | 东南大学 | A kind of silicon micro-gyroscope temperature compensation based on microprocessor |
CN107085942A (en) * | 2017-06-26 | 2017-08-22 | 广东工业大学 | A traffic flow prediction method, device and system based on wolf pack algorithm |
CN107696915A (en) * | 2017-09-20 | 2018-02-16 | 江苏大学 | A kind of wheeled driving control system of electric automobile based on hierarchical control and its control method |
-
2018
- 2018-05-15 CN CN201810459053.8A patent/CN108422997A/en active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1608011A (en) * | 2001-12-27 | 2005-04-20 | 丰田自动车株式会社 | Integrated vehicle motion control system |
CN106092138A (en) * | 2016-06-06 | 2016-11-09 | 东南大学 | A kind of silicon micro-gyroscope temperature compensation based on microprocessor |
CN107085942A (en) * | 2017-06-26 | 2017-08-22 | 广东工业大学 | A traffic flow prediction method, device and system based on wolf pack algorithm |
CN107696915A (en) * | 2017-09-20 | 2018-02-16 | 江苏大学 | A kind of wheeled driving control system of electric automobile based on hierarchical control and its control method |
Non-Patent Citations (1)
Title |
---|
刘永兰: "基于狼群算法的无人机航迹规划", 《系统仿真学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110473175A (en) * | 2019-07-26 | 2019-11-19 | 长春工程学院 | A kind of train axle space linearity measurement method |
CN110626340B (en) * | 2019-09-30 | 2023-07-11 | 南京航空航天大学 | Intelligent vehicle path tracking control system and method based on gray wolf algorithm |
CN113085578A (en) * | 2021-04-26 | 2021-07-09 | 浙江吉利控股集团有限公司 | Four-wheel-drive automobile yaw control method and device based on fuzzy PID |
CN119928894A (en) * | 2025-04-10 | 2025-05-06 | 沈阳安普合科技有限公司 | A vehicle control system |
CN119928894B (en) * | 2025-04-10 | 2025-07-25 | 沈阳安普合科技有限公司 | A vehicle control system |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108422997A (en) | A kind of automobile active safety cooperative control system and method based on wolf pack algorithm | |
JP6445497B2 (en) | Route determination method for automatic mobile | |
US11308391B2 (en) | Offline combination of convolutional/deconvolutional and batch-norm layers of convolutional neural network models for autonomous driving vehicles | |
US12296849B2 (en) | Method and system for feasibility-based operation of an autonomous agent | |
CN111332362B (en) | An intelligent steering-by-wire control method integrating driver's personality | |
US12084073B2 (en) | Method and device for optimum parameterization of a driving dynamics control system for vehicles | |
JP2021515178A (en) | LIDAR positioning for time smoothing using RNN and LSTM in self-driving vehicles | |
CN110626340B (en) | Intelligent vehicle path tracking control system and method based on gray wolf algorithm | |
Yu et al. | Baidu driving dataset and end-to-end reactive control model | |
CN110077393B (en) | Automatic parking speed control method based on image vision | |
US11858523B2 (en) | Vehicle travel control device | |
KR20180037468A (en) | Method for deciding a road surface using vehicle data | |
JP7701000B2 (en) | Modifying constraints on vehicle dynamics for trajectories | |
CN112977411A (en) | Intelligent chassis control method and device | |
US20210403039A1 (en) | Arithmetic operation system for vehicle | |
US12103614B2 (en) | Systems and methods for intelligently implementing an autonomous electric-powered trailer during a towing operation | |
JP2015036840A (en) | Autonomous travel vehicle, control system for said vehicle, control method for said vehicle | |
Arat et al. | An intelligent tyre based adaptive vehicle stability controller | |
US11919526B1 (en) | Model-based vehicle drive system monitors | |
CN119329548A (en) | Vehicle control method, device, apparatus, readable storage medium and program product | |
CN118525294A (en) | Estimating a state of motion of a vehicle from camera data by means of machine learning | |
US20220009486A1 (en) | Calculation device for vehicle travel control and travel control system using same | |
US11879978B1 (en) | Out of sequence preception system | |
Lining et al. | Mobile robot real-time path planning based on virtual targets method | |
US20230075425A1 (en) | Systems and methods for training and using machine learning models and algorithms |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20180821 |
|
RJ01 | Rejection of invention patent application after publication |