[go: up one dir, main page]

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 PDF

Info

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
Application number
CN201810459053.8A
Other languages
Chinese (zh)
Inventor
赵又群
葛召浩
张桂玉
闫茜
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN201810459053.8A priority Critical patent/CN108422997A/en
Publication of CN108422997A publication Critical patent/CN108422997A/en
Pending legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/08Active 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

The invention discloses a kind of automobile active safety cooperative control systems and method based on wolf pack algorithm, including sensing system, top level control device, lower layer's controller, chassis execution system.Pilot control signal is monitored by sensing system first, driving states signal, top level control device calculates top level control object (speed according to driver's desired motion and the difference of actual motion by wolf pack algorithm, side slip angle, side acceleration, yaw velocity) optimal solution, and it is output to lower layer's controller, lower layer's controller uses neural network algorithm, with the optimal solution of upper layer control object target in order to control, calculate lower layer's control object (front wheel angle, each wheel brake pressure) optimal solution, it is sent to chassis and executes system, so as to adjust the transport condition of automobile, realize the automobile active safety Collaborative Control under emergency work condition.The present invention optimizes people-vehicle as closed-loop system, can realize the optimum control of the vehicle overall situation.

Description

一种基于狼群算法的汽车主动安全协同控制系统及方法A vehicle active safety cooperative control system and method based on wolf pack algorithm

技术领域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、猎物气味浓度为Yleadd) 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 pb) 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的位置信息Xjc) 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=Yzb) 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、猎物气味浓度为Yleadd) 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的位置信息Xjc) 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=Yzb) 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)

1. a kind of automobile active safety cooperative control system based on wolf pack algorithm, which is characterized in that including sequentially connected biography Sensor system, top level control device, lower layer's controller, chassis execute system;
The sensing system includes for acquiring driver's sensing module of driver actions' signal, current for recording automobile The vehicle sensing module of driving condition;Driver's sensing module and vehicle sensing module are transmitted to upper layer controller respectively to be passed Sensor signal;
The top level control device includes signal identification module, decision-making module, optimization module;The signal identification module receives sensing Device signal is sent to decision-making module after pretreatment;The decision-making module predicts driver's desired movement ginseng according to sensor signal Number, and it is sent to optimization module, the optimization module is minimum with the gap between actual motion parameter with desired movement parameter Control targe optimizes calculating using actual motion parameter as top level control object using wolf pack algorithm, and by top level control pair The optimal solution of elephant is sent to lower layer's controller;
Lower layer's controller is with the optimal solution of upper layer control object target in order to control, with front wheel angle, the brake fluid pressure of wheel Calculating is optimized for lower layer's control object, and exports optimal solution and executes system to chassis;
The chassis executes the control signal that system is used to receive lower layer's controller output, control turn to actuating motor rotation and Adjust wheel braking hydraulic pressure.
2. a kind of automobile active safety cooperative control system based on wolf pack algorithm according to claim 1, feature exist In the kinematic parameter includes speed, side slip angle, side acceleration, yaw velocity.
3. a kind of automobile active safety cooperative control system based on wolf pack algorithm according to claim 1, feature exist In driver's sensing module includes steering wheel angle sensor, brake pedal displacement sensor, for acquiring driver actions Signal;The vehicle sensing module includes wheel detector, sideslip sensor, gyro sensor, current for recording automobile Driving condition.
4. a kind of automobile active safety cooperative control method based on wolf pack algorithm based on control system described in claim 1, It is characterised in that it includes following steps:
Step 1:Sensing system acquires driver actions' signal and automobile current driving situation, and passes it to top level control Device;
Step 2:After top level control device receiving sensor signal, by signal identification module pre-processing sensor signals, and pass to Decision-making module, decision-making module predicts driver's desired movement parameter according to sensor signal, and is sent to optimization module, optimizes mould Block, with the minimum control targe of gap between actual motion parameter, is controlled with desired movement parameter by upper layer of actual motion parameter Object processed optimizes calculating using wolf pack algorithm, and the optimal solution of top level control object is sent to lower layer's controller;
Step 3:Lower layer's controller is with the optimal solution of upper layer control object target in order to control, with front wheel angle, the brake fluid of wheel Pressure is that lower layer's control object optimizes calculating, calculates the optimal solution of lower layer's control object, and output a control signal to chassis Execution system;
Step 4:It includes AFS actuators, DYC actuators that the chassis, which executes system, and the DYC actuators receive lower layer's controller The brake fluid pressure of output controls Signal Regulation wheel braking hydraulic pressure, and AFS actuators receive the front wheel angle of lower layer's controller output It controls signal control and turns to actuating motor.
5. a kind of automobile active safety cooperative control method based on wolf pack algorithm according to claim 4, feature exist In in step 2, the specific steps of the wolf pack algorithm include:
Step 2.1:Numerical value initializes
A) the wolf pack quantity N and location information X of every wolf is initializedi(ν,β,αy, γ), i=(1, N), the location information is Four-dimensional coordinate, ν, β, αy, γ respectively represents speed, side slip angle, side acceleration, yaw velocity;
B) the corresponding prey odorousness Y of every wolf is seti, the as desired vehicle location coordinate of driver and actual vehicle The object function that the difference of position coordinates is constituted:
Wherein, (xt,yt) it is t moment vehicle actual position coordinate, (xe,ye) it is the desired vehicle location coordinate of t moment driver, And
xt=x0+ν*cos(β+γ*t)*t
x0、y0For vehicle initial position co-ordinates;
C) according to control accuracy and solving speed demand, setting maximum iteration kmax, maximum migration number Tmax, visit wolf ratio Factor-alpha, range estimation factor ω, step factor S and update scale factor σ;
D) it is head wolf s to choose the current highest artificial wolf of prey odorousness, and it is X to take its positionlead, prey odorousness be Ylead
Step 2.2:Migration behavior
A) the prey odorousness of N wolf is arranged from big to small, the corresponding people of N* α prey odorousnesses before removing outside a wolf Work wolf is to visit wolf, except head wolf and all artificial wolves in addition to visiting wolf are violent wolf;
B) for visiting wolf j, prey odorousness is Yj 0, Y at this timej 0< Ylead, j=(1, N* α), progress migration behavior, to h Advance a migration step-length step respectively in a directiona, original is retracted after recording the prey odorousness perceived after often taking a step forward Position, the then position that wolf j is visited after advancing to a direction of pth (p=1,2,3..., h) arePrey odorousness is
C) it selectsPrey odorousness Y maximum and more than current locationj 0Direction advance a migration step-length stepa, more The new location information X for visiting wolf jj
D) the migration behavior more than repeating, until certain only visits the prey odorousness Y that wolf perceivesj> Ylead, at this time the spy wolf at For head wolf, Ylead=Yj, or migration number T reaches maximum migration number Tmax, maintain procephalon wolf constant at this time;
Step 2.3:Calling/long-range raid behavior
A) head wolf initiates calling behavior by yelping, and the violent wolves of N* (1- α) -1 of surrounding is convened to be leaned on rapidly to head wolf position Hold together, violent wolf is with long-range raid step-length stepb=2*stepaQuickly approach a wolf position;
B) long-range raid on the way, if the prey odorousness Y that violent wolf z (z=(1, N* (1- α) -1)) is perceivedz> Ylead, then the violent wolf It is converted into a wolf and initiates calling behavior, at this time Ylead=Yz
C) long-range raid on the way, if the prey odorousness Y that violent wolf z is perceivedz< Ylead, then violent wolf z continuation long-range raid is until itself and head wolf The distance between s dzsLess than dnearWhen be added to attack ranks to prey, that is, be transferred to jointly attack behavior;
Step 2.4:Jointly attack behavior
A) position of wolf, that is, head wolf nearest from prey at this time is considered as the shift position of prey, violent wolf joint visits wolf to attack step Long stepcTo prey close approximation to being captured;
If after b) implementing jointly attack behavior, the prey odorousness that certain artificial wolf perceives is more than what its original position state was perceived Prey odorousness then updates the position of this artificial wolf, and if not, artificial wolf position is constant;
If after c) updating artificial wolf position, the prey odorousness that certain artificial wolf perceives is more than the prey that head wolf is perceived Odorousness, then the artificial wolf be converted into a wolf, the position of the artificial wolf is considered as prey position, other artificial wolves are with this Continue jointly attack behavior centered on wolf;
D) behind update head wolf position, judge whether to reach optimization precision or maximum iteration kmax, this wolf is exported if reaching Position, i.e., required optimal solution, otherwise repeatedly step 2.2-2.4.
6. a kind of automobile active safety cooperative control method based on wolf pack algorithm according to claim 4, feature exist In, in step 3, lower layer's controller optimization calculate method be neural network algorithm, the neural network algorithm it is defeated Enter for the brake fluid pressure of front wheel angle, wheel;Output is speed, side slip angle, side acceleration, yaw velocity.
CN201810459053.8A 2018-05-15 2018-05-15 A kind of automobile active safety cooperative control system and method based on wolf pack algorithm Pending CN108422997A (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Patent Citations (4)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
Title
刘永兰: "基于狼群算法的无人机航迹规划", 《系统仿真学报》 *

Cited By (5)

* Cited by examiner, † Cited by third party
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&#39;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