CN111857340B - Multi-factor fusion man-machine co-driving right allocation method - Google Patents
Multi-factor fusion man-machine co-driving right allocation method Download PDFInfo
- Publication number
- CN111857340B CN111857340B CN202010690235.3A CN202010690235A CN111857340B CN 111857340 B CN111857340 B CN 111857340B CN 202010690235 A CN202010690235 A CN 202010690235A CN 111857340 B CN111857340 B CN 111857340B
- Authority
- CN
- China
- Prior art keywords
- driving
- driver
- vehicle
- muscle
- road
- 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
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F3/00—Input arrangements for transferring data to be processed into a form capable of being handled by the computer; Output arrangements for transferring data from processing unit to output unit, e.g. interface arrangements
- G06F3/01—Input arrangements or combined input and output arrangements for interaction between user and computer
- G06F3/011—Arrangements for interaction with the human body, e.g. for user immersion in virtual reality
- G06F3/015—Input arrangements based on nervous system activity detection, e.g. brain waves [EEG] detection, electromyograms [EMG] detection, electrodermal response detection
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/0055—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots with safety arrangements
- G05D1/0061—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots with safety arrangements for transition from automatic pilot to manual pilot and vice versa
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- General Physics & Mathematics (AREA)
- General Engineering & Computer Science (AREA)
- Mathematical Physics (AREA)
- Data Mining & Analysis (AREA)
- Neurosurgery (AREA)
- Algebra (AREA)
- Health & Medical Sciences (AREA)
- Neurology (AREA)
- General Health & Medical Sciences (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Computational Mathematics (AREA)
- Dermatology (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Biomedical Technology (AREA)
- Pure & Applied Mathematics (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种多因素融合的人机共驾驾驶权分配方法,包括以下步骤:采集驾驶员相关信息、车辆状态信息以及环境信息;计算驾驶员的认知负荷,并输出当前认知负荷所对应的应分配的驾驶权值;计算驾驶员肌肉驾驶能力的恢复程度,并输出当前时刻的肌肉驾驶能力所对应的应分配的驾驶权值;建立行车安全场模型,输出当前汽车所处位置的安全场场力值所对应的应分配的驾驶权值;进行加权得到当前时刻的驾驶权分配值。本发明考虑驾驶员接管时的认知负荷、肌肉驾驶能力的恢复程度以及车辆周围环境对驾驶权接管的影响,通过计算三者所对应的当前时刻应该分配的驾驶权值,最终将得到的对应各因素的驾驶权分配值进行加权融合,得到最终的驾驶权分配值。
The present invention discloses a multi-factor fusion human-machine co-driving driving rights allocation method, comprising the following steps: collecting driver-related information, vehicle status information and environmental information; calculating the driver's cognitive load, and outputting the driving weight value to be allocated corresponding to the current cognitive load; calculating the degree of recovery of the driver's muscle driving ability, and outputting the driving weight value to be allocated corresponding to the muscle driving ability at the current moment; establishing a driving safety field model, outputting the driving weight value to be allocated corresponding to the safety field force value of the current position of the car; and weighting to obtain the driving right allocation value at the current moment. The present invention takes into account the cognitive load of the driver when taking over, the degree of recovery of the muscle driving ability and the influence of the vehicle's surrounding environment on the takeover of driving rights, and calculates the driving weight value to be allocated at the current moment corresponding to the three, and finally weights and fuses the driving right allocation values corresponding to each factor to obtain the final driving right allocation value.
Description
技术领域Technical Field
本发明属于人机共驾技术领域,具体涉及一种多因素融合的人机共驾驾驶权分配方法。The present invention belongs to the technical field of human-machine co-driving, and specifically relates to a method for allocating driving rights for human-machine co-driving integrating multiple factors.
背景技术Background technique
近年来,汽车自动驾驶技术得到迅速发展,各大企业都在争相研究自动驾驶技术。然而,自动驾驶技术在行驶安全性和驾驶员对系统接受度方面还存在着许多问题,且很多调查都显示,大多数的驾驶人对自动驾驶的安全性表示怀疑。由此可见,自动驾驶想要大规模的应用还是需要一个很长时间的过度阶段,即手动驾驶与自动驾驶协作的人机共驾阶段。In recent years, the technology of autonomous driving has developed rapidly, and major companies are competing to research autonomous driving technology. However, there are still many problems with autonomous driving technology in terms of driving safety and driver acceptance of the system, and many surveys show that most drivers are skeptical about the safety of autonomous driving. It can be seen that large-scale application of autonomous driving still requires a long transition period, that is, the stage of human-machine co-driving in which manual driving and autonomous driving collaborate.
人机共驾是指非完全自动驾驶的条件下,驾驶人和智能汽车控制系统都可以对自动驾驶汽车进行控制的阶段,这意味着机器和驾驶人共同享有对汽车的决策和控制权。人机共驾环境下,动态驾驶任务由传统的连续过程转变为自动驾驶、手动驾驶交替变换的离散过程。其中,在由机驾到人驾的控制权切换过程中,驾驶人能否有效的对当前驾驶状态进行认知和评估,进而接管车辆操作,并最终规避风险,是保证人机共驾行驶安全,降低自动驾驶事故率的关键。Human-machine co-driving refers to the stage in which both the driver and the intelligent vehicle control system can control the autonomous vehicle under non-fully autonomous driving conditions, which means that the machine and the driver share the decision-making and control rights over the vehicle. In the human-machine co-driving environment, the dynamic driving task is transformed from a traditional continuous process to a discrete process of alternating between autonomous driving and manual driving. Among them, in the process of switching control from machine driving to human driving, whether the driver can effectively recognize and evaluate the current driving state, and then take over the vehicle operation and ultimately avoid risks is the key to ensuring the safety of human-machine co-driving and reducing the accident rate of autonomous driving.
目前对接管过程中的驾驶权分配已经有了一定的研究,例如中国发明专利申请号为201810253686.3,专利名称为“交替式人机共驾中驾驶权转移方法”中提出的驾驶权转移方法能够在减轻驾驶员负担的同时,提高驾驶的安全性,减少事故发生,全面提高智能交通系统的性能;中国发明专利申请号为201810846175.2,专利名称为“一种考虑驾驶员驾驶技能的人机共驾横向驾驶权分配方法”中考虑驾驶员的驾驶技能对驾驶权进行分配,能够提高驾乘的舒适性又能保证车辆的安全行驶,还能减小人机冲突,同时考虑驾驶员期望转角与车道偏离控制器的期望转角的差值作为权重分配的因素之一,能让驾驶员感受到车辆是按照自己的驾驶意图行驶;中国发明专利申请号为201910126135.5,专利名称为“一种人机共驾中的车辆驾驶控制权分配系统”中提供了一种全局性的人机驾驶控制权分配方案,通过综合考虑外部环境状况、车辆运动状态和驾驶员综合状态来实现人类驾驶员和自动驾驶系统之间的驾驶控制权分配。At present, there have been some studies on the allocation of driving rights during the takeover process. For example, the Chinese invention patent application number is 201810253686.3, and the patent name is "A method for transferring driving rights in alternating human-machine co-driving". The driving rights transfer method proposed in the patent can reduce the burden on the driver while improving driving safety, reducing accidents, and comprehensively improving the performance of the intelligent transportation system; the Chinese invention patent application number is 201810846175.2, and the patent name is "A method for allocating lateral driving rights in human-machine co-driving considering the driver's driving skills". The driving rights are allocated by considering the driver's driving skills, which can improve the driving safety. Comfort can ensure the safe driving of the vehicle and reduce human-machine conflicts. At the same time, the difference between the driver's expected turning angle and the lane departure controller's expected turning angle is considered as one of the factors for weight distribution, which can make the driver feel that the vehicle is driving according to his own driving intention; the Chinese invention patent application number is 201910126135.5, and the patent name is "A vehicle driving control rights allocation system in human-machine co-driving", which provides a global human-machine driving control rights allocation scheme, which realizes the driving control rights allocation between the human driver and the automatic driving system by comprehensively considering the external environment conditions, the vehicle's motion state and the driver's comprehensive state.
综上来看,虽然现在对驾驶权分配已经有了一定的研究,但是在现有的驾驶权分配方法中,设计驾驶权分配方法时考虑并不全面,然而任何一个影响因素被忽略都会造成驾驶权切换过程中出现危险。另一方面,在现有的驾驶权分配系统中,虽然涉及了驾驶权分配问题且考虑了较多方面,但是缺少具体的驾驶权分配方法。In summary, although there has been some research on driving rights allocation, the existing driving rights allocation methods do not take comprehensive considerations into account when designing driving rights allocation methods. However, any factor that is ignored will cause danger during the driving rights switching process. On the other hand, in the existing driving rights allocation system, although the driving rights allocation problem is involved and many aspects are considered, there is a lack of specific driving rights allocation methods.
发明内容Summary of the invention
针对于上述现有技术的不足,本发明的目的在于提供一种多因素融合的人机共驾驾驶权分配方法,以解决现有的人机共驾驾驶权分配方法中存在的驾驶权分配时所考虑因素不够全面,以及各种驾驶权分配方法过于模糊难以实现且分配方法较少等问题。本发明所提出的方法在接管过程中考虑驾驶员接管时的认知负荷、肌肉驾驶能力的恢复程度以及车辆周围环境对驾驶权接管的影响,通过计算三者所对应的当前时刻应该分配的驾驶权值,最终将得到的对应各因素的驾驶权分配值进行加权融合,得到最终的驾驶权分配值,通过多因素融合后得到的分配方法进行驾驶权分配,进一步的保证驾驶员在进行接管时车辆的行车安全性。In view of the deficiencies of the above-mentioned prior art, the purpose of the present invention is to provide a multi-factor fusion method for allocating driving rights for human-machine co-driving, so as to solve the problems that the factors considered in the existing human-machine co-driving driving rights allocation methods are not comprehensive enough, and the various driving rights allocation methods are too vague to be implemented and there are few allocation methods. The method proposed by the present invention considers the cognitive load of the driver when taking over, the degree of recovery of muscle driving ability, and the influence of the vehicle's surrounding environment on the takeover of driving rights during the takeover process. By calculating the driving weight value that should be allocated at the current moment corresponding to the three, the driving rights allocation values corresponding to each factor are finally weighted and fused to obtain the final driving rights allocation value. The driving rights are allocated by the allocation method obtained after multi-factor fusion, which further ensures the driving safety of the vehicle when the driver takes over.
为达到上述目的,本发明采用的技术方案如下:To achieve the above object, the technical solution adopted by the present invention is as follows:
本发明的一种多因素融合的人机共驾驾驶权分配方法,包括以下步骤:A multi-factor integrated human-machine co-driving driving rights allocation method of the present invention comprises the following steps:
(1)采集驾驶员相关信息、车辆状态信息以及环境信息;(1) Collect driver-related information, vehicle status information, and environmental information;
(2)根据所述步骤(1)中所采集的信息,计算驾驶员的认知负荷,并输出当前认知负荷所对应的应分配的驾驶权值;(2) calculating the driver's cognitive load based on the information collected in step (1), and outputting the driving weight value to be allocated corresponding to the current cognitive load;
(3)根据所述步骤(1)中所采集的信息,计算驾驶员肌肉驾驶能力的恢复程度,并输出当前时刻的肌肉驾驶能力所对应的应分配的驾驶权值;(3) calculating the degree of recovery of the driver's muscle driving ability based on the information collected in step (1), and outputting the driving weight value to be allocated corresponding to the muscle driving ability at the current moment;
(4)根据所述步骤(1)中所采集的信息,建立行车安全场模型,输出当前汽车所处位置的安全场场力值所对应的应分配的驾驶权值;(4) establishing a driving safety field model based on the information collected in step (1), and outputting the driving weight value to be allocated corresponding to the safety field force value at the current position of the vehicle;
(5)根据步骤(1)、(2)、(3)中所计算得出的驾驶权值,进行加权得到当前时刻的驾驶权分配值。(5) According to the driving rights calculated in steps (1), (2), and (3), weighted addition is performed to obtain the driving rights allocation value at the current moment.
进一步地,所述步骤(1)中的驾驶员相关信息为驾驶员注意力集中程度和驾驶员驾驶过程左、右手臂的上下臂的夹角;车辆状态信息为驾驶员实际输出转矩、方向盘转角、方向盘角速度和车速;环境信息为周围车辆位置信息、周围车辆车速信息和自车位置信息。Furthermore, the driver-related information in step (1) includes the driver's concentration level and the angle between the upper and lower arms of the driver's left and right arms during driving; the vehicle status information includes the driver's actual output torque, steering wheel angle, steering wheel angular velocity and vehicle speed; and the environmental information includes surrounding vehicle position information, surrounding vehicle speed information and the vehicle's own position information.
进一步地,所述步骤(2)的具体步骤如下:Furthermore, the specific steps of step (2) are as follows:
(21)计算驾驶员的认知负荷:(21) Calculate the driver’s cognitive load:
式中,k为认知负荷;e为自然常数;λ1和λ2和λ3为调整参数;τ为加权因子;AS为驾驶员注意力集中程度;为归一化转矩参数;Treal为当前驾驶员实际输入的转向力矩,Tneed为正常驾驶时驾驶员在车辆当前运动状态下需要输入的转向力矩;Where, k is cognitive load; e is a natural constant; λ 1 , λ 2 and λ 3 are adjustment parameters; τ is a weighting factor; AS is the driver's concentration level; is the normalized torque parameter; T real is the steering torque actually input by the current driver; T need is the steering torque that the driver needs to input under the current motion state of the vehicle during normal driving;
(22)根据当前的驾驶员认知负荷,计算对应的所应该分配的驾驶权值:(22) According to the current cognitive load of the driver, the corresponding driving weight to be allocated is calculated:
Qk=Qmax-ξ1(k-ξ2)2 (2)Q k =Q max -ξ 1 (k-ξ 2 ) 2 (2)
式中,Qk为由驾驶员认知负荷决定的驾驶员驾驶权值(即驾驶员控制权限);Qmax为驾驶权控制权限最大值;ξ1和ξ2表示调整因子;k为认知负荷值。Where Qk is the driver's driving right value (i.e., driver control authority) determined by the driver's cognitive load; Qmax is the maximum value of driving right control authority; ξ1 and ξ2 represent adjustment factors; and k is the cognitive load value.
进一步地,所述步骤(3)的具体步骤如下:Furthermore, the specific steps of step (3) are as follows:
(31)选取用于逻辑递归的输入变量;(31) Selecting input variables for logical recursion;
(32)驾驶员驾驶过程左、右手臂的上下臂的夹角估计:(32) Estimation of the angle between the upper and lower arms of the driver’s left and right arms during driving:
驾驶员进行转向时的左、右手臂的上下臂的夹角(顺时针为正):The angle between the upper and lower arms of the driver's left and right arms when steering (clockwise is positive):
式中,ls为上臂长;lx为下臂长;lsx为上臂上端点距下臂下端点距离;d为半肩宽;b为转向盘半径;e为转向盘与驾驶员距离;θcl为左臂上下臂夹角;θcr为右臂上下臂夹角;θw为方向盘转角;Where, l s is the length of the upper arm; l x is the length of the lower arm; l sx is the distance between the upper end of the upper arm and the lower end of the lower arm; d is the half shoulder width; b is the radius of the steering wheel; e is the distance between the steering wheel and the driver; θ cl is the angle between the upper and lower arms of the left arm; θ cr is the angle between the upper and lower arms of the right arm; θ w is the steering wheel angle;
(33)采用逻辑递归方法,估计肌肉活化度:(33) Using a logical recursive method, muscle activation was estimated:
式中,为输入变量;β为回归系数;T为转置符号;α为肌肉活化度;In the formula, is the input variable; β is the regression coefficient; T is the transposition sign; α is the muscle activation degree;
(34)计算驾驶员肌肉驾驶能力的恢复程度:(34) Calculate the degree of recovery of the driver's muscle driving ability:
式中,md为驾驶员肌肉驾驶能力的恢复程度;αreal为肌肉的实际活化度;αneed为正常操作时所需的肌肉活化度;Where md is the degree of recovery of the driver's muscle driving ability; αreal is the actual muscle activation; αneed is the muscle activation required for normal operation;
(35)根据当前的驾驶员肌肉驾驶能力的恢复程度,计算所对应的应该分配的驾驶权值:(35) According to the current recovery degree of the driver's muscle driving ability, the corresponding driving weight to be allocated is calculated:
式中,为由驾驶员肌肉恢复程度决定的驾驶员驾驶权值;a和b分别为调整参数。In the formula, is the driver's driving weight determined by the driver's muscle recovery degree; a and b are adjustment parameters.
进一步地,所述步骤(4)的具体步骤如下:Furthermore, the specific steps of step (4) are as follows:
(41)道路静止物体势能场建模;(41) Modeling of potential energy field of stationary objects on the road;
(411)静止物体分类:(411) Classification of stationary objects:
将静止物体分为两类:第一类是与车辆发生碰撞而造成重大损失的不动物体;第二类是不动的物体,不能发生实际碰撞,但对驾驶员的行为有约束;The stationary objects are divided into two categories: the first category is the immovable objects that can cause significant damage by colliding with the vehicle; the second category is the immovable objects that cannot actually collide with the vehicle but have constraints on the driver's behavior;
(412)第一类静止物体势能场建模:(412) Modeling of the potential energy field of the first type of stationary object:
式中,ER_aj_o为在(xa,ya)处的物体在(xj,yj)处形成的势能场矢量,方向与raj相同;G和k1为大于零的待定常数;Ma为目标a的虚拟质量;Ra为在(xa,ya)处道路的影响因子;raj=(xj-xa,yj-ya)为距离矢量;Where, E R_aj_o is the potential energy field vector formed by the object at ( xa , ya ) at ( xj , yj ), and its direction is the same as that of raj ; G and k1 are unknown constants greater than zero; Ma is the virtual mass of target a; Ra is the influence factor of the road at ( xa , ya ); raj = ( xj - xa , yj - ya ) is the distance vector;
上述虚拟质量表达式为:The above virtual mass expression is:
式中,Ta为类型,具体为该类型碰撞损失与标准类型碰撞损失之比;ma为目标a的实际质量;αk、βk为待定常数;va为目标a的速度;Wherein, Ta is the type, specifically the ratio of the collision loss of this type to the collision loss of the standard type; ma is the actual mass of target a; αk and βk are constants to be determined; va is the velocity of target a;
上述道路影响因子表达式为:The above road impact factor expression is:
式中,δa为(xa,ya)处的能见度;μa为(xa,ya)处的道路附着系数;ρa为(xa,ya)处的道路曲率;τa为(xa,ya)处的道路坡度;γ1、γ2、γ3、γ4为待定系数,γ1,γ2<0;γ3,γ4>0;δ*、μ*、ρ*、τ*为该参数的标准值;Wherein, δa is the visibility at ( xa , ya ); μa is the road adhesion coefficient at ( xa , ya ); ρa is the road curvature at ( xa , ya ); τa is the road slope at ( xa , ya ); γ1 , γ2 , γ3 , γ4 are unknown coefficients, γ1 , γ2 <0; γ3 , γ4 >0; δ * , μ * , ρ * , τ * are the standard values of the parameters;
(413)第二类静止物体势能场建模:(413) Modeling of the potential energy field of the second type of stationary object:
式中,ER_aj_L为(xa,ya)处道路标线a的场强矢量,方向与raj相同;LTa为道路标线类型;D为道路宽度;k2为大于零的待定常数;raj=(xj-xa,yj-ya)为距离矢量 Where, ERajL is the field intensity vector of road marking a at ( xa , ya ), with the same direction as raj ; LTa is the road marking type; D is the road width; k2 is a constant greater than zero to be determined; raj = ( xj - xa , yj - ya ) is the distance vector
(42)动能场建模:(42) Kinetic energy field modeling:
式中,EV_bj为在(xb,yb)处的移动物体在(xj,yj)处形成的动能场矢量,方向与rbj相同;k1、k3和G为大于零的待定常数;Rb为在(xb,yb)处道路的影响因子;Mb为目标b的虚拟质量;rbj=(xj-xb,yj-yb)为距离矢量;vb为目标b的速度;θb为vb和rbj的夹角(顺时针为正);Wherein, EV_bj is the kinetic energy field vector formed by the moving object at ( xb , yb ) at ( xj , yj ), and its direction is the same as that of rbj ; k1 , k3 and G are unknown constants greater than zero; Rb is the influence factor of the road at ( xb , yb ); Mb is the virtual mass of target b; rbj = ( xj - xb , yj - yb ) is the distance vector; vb is the speed of target b; θb is the angle between vb and rbj (clockwise is positive);
(43)行为场建模:(43) Behavioral Field Modeling:
ED_cj=EV_cj.DRc (15) ED_cj = EV_cj .DR c (15)
式中,ED_cj为在(xc,yc)处的c车驾驶员在(xj,yj)处形成的行为场矢量,方向与EV_cj相同;EV_cj为在(xc,yc)处的移动物体在(xj,yj)处形成的动能场矢量;DRc为跟c车驾驶员相关的驾驶员风险因素;Wherein, ED_cj is the behavior field vector formed by the driver of car c at (x c ,y c ) at (x j ,y j ), and its direction is the same as EV_cj ; EV_cj is the kinetic energy field vector formed by the moving object at (x c ,y c ) at (x j ,y j ); DR c is the driver risk factor related to the driver of car c;
(44)行车安全场建模:(44) Driving safety field modeling:
ES_j=ER_j+EV_j+ED_j (16)E S_j = E R_j + E V_j + E D_j (16)
式中,ES_j为(xj,yj)处的行车安全场;ER_j为(xj,yj)处的势能场;EV_j为(xj,yj)处的动能场矢量;ED_j为(xj,yj)处的行为场矢量;Wherein, ES_j is the driving safety field at (x j ,y j ); ER_j is the potential energy field at (x j ,y j ); EV_j is the kinetic energy field vector at (x j ,y j ); ED_j is the behavior field vector at (x j ,y j );
则根据上述可导出在(xj,yj)处的安全场场力为:According to the above, the safety field force at (x j ,y j ) can be derived as:
式中,Fj为在(xj,yj)处的安全场场力矢量,方向与Ej相同;Ej为(xj,yj)的安全场矢量;Mj为(xj,yj)处j车的虚拟质量;Rj为在(xj,yj)处的道路的影响因子;k3为大于零的待定系数;vj为(xj,yj)处j车的速度;θj为vj和Ej的夹角(顺时针为正);DRj为j车驾驶员的驾驶员风险因素;Wherein, Fj is the safety field force vector at ( xj , yj ), with the same direction as Ej ; Ej is the safety field vector at ( xj , yj ); Mj is the virtual mass of vehicle j at ( xj , yj ); Rj is the influence factor of the road at ( xj , yj ); k3 is an undetermined coefficient greater than zero; vj is the speed of vehicle j at ( xj , yj ); θj is the angle between vj and Ej (clockwise is positive); DRj is the driver risk factor of the driver of vehicle j;
(45)根据当前的车辆的行驶安全场场力值,计算所对应的应该分配的驾驶权值:采用查表法按照一定的分配原则来对驾驶权进行分配,并根据实际情况的不同对表格参数进行调整。(45) According to the current driving safety field force value of the vehicle, the corresponding driving right value to be allocated is calculated: the driving right is allocated according to a certain allocation principle using a table lookup method, and the table parameters are adjusted according to different actual conditions.
进一步地,所述步骤(5)中最终驾驶权计算方法如下:Furthermore, the final driving right calculation method in step (5) is as follows:
根据上述步骤计算得出的当前时刻应分配的驾驶权值Qk、和QF计算得出最终输出的驾驶权值Q:The driving weight Q k that should be allocated at the current moment calculated according to the above steps, And Q F calculate the final output driving weight Q:
式中,Q为最终的驾驶权值分配结果;w1、w2和w3为加权因子。Where Q is the final driving weight allocation result; w 1 , w 2 and w 3 are weighting factors.
本发明的有益效果:Beneficial effects of the present invention:
本发明的分配方法,解决了人机共驾中驾驶员接管过程中的驾驶权分配方法不健全及概念模糊的问题;The allocation method of the present invention solves the problem of imperfect allocation method and vague concept of driving rights during the driver taking over process in human-machine co-driving;
本发明的分配方法能够实现驾驶权的安全平滑交接,提高了接管过程的安全性和舒适性;The allocation method of the present invention can realize safe and smooth handover of driving rights, and improve the safety and comfort of the takeover process;
本发明的方法具有较强的实用性,有利于推进人机共驾技术的发展。The method of the present invention has strong practicability and is conducive to promoting the development of human-machine co-driving technology.
附图说明BRIEF DESCRIPTION OF THE DRAWINGS
图1为本发明的驾驶权分配方法原理框图;FIG1 is a block diagram of the driving rights allocation method of the present invention;
图2为驾驶员认知负荷曲线图;Figure 2 is a graph showing driver cognitive load;
图3为驾驶员认知负荷与驾驶权关系图;Figure 3 is a diagram showing the relationship between driver cognitive load and driving rights;
图4为驾驶员肌肉驾驶能力恢复程度与驾驶权关系图;FIG4 is a graph showing the relationship between the degree of recovery of the driver's muscle driving ability and driving rights;
图5为行车安全场示意图。Figure 5 is a schematic diagram of a driving safety field.
具体实施方式Detailed ways
为了便于本领域技术人员的理解,下面结合实施例与附图对本发明作进一步的说明,实施方式提及的内容并非对本发明的限定。In order to facilitate the understanding of those skilled in the art, the present invention is further described below in conjunction with embodiments and drawings. The contents mentioned in the implementation modes are not intended to limit the present invention.
参照图1所示,本发明的一种多因素融合的人机共驾驾驶权分配方法,包括以下步骤:1 , a multi-factor integrated human-machine co-driving driving rights allocation method of the present invention includes the following steps:
(1)采集驾驶员相关信息、车辆状态信息以及环境信息;(1) Collect driver-related information, vehicle status information, and environmental information;
其中,驾驶员相关信息为驾驶员注意力集中程度和驾驶员驾驶过程左、右手臂的上下臂的夹角;车辆状态信息为驾驶员实际输出转矩、方向盘转角、方向盘角速度和车速;环境信息为周围车辆位置信息、周围车辆车速信息和自车位置信息。Among them, the driver-related information includes the driver's concentration level and the angle between the upper and lower arms of the left and right arms during the driving process; the vehicle status information includes the driver's actual output torque, steering wheel angle, steering wheel angular velocity and vehicle speed; the environmental information includes the surrounding vehicle position information, surrounding vehicle speed information and the vehicle's own position information.
(2)根据所述步骤(1)中所采集的信息,计算驾驶员的认知负荷,并输出当前认知负荷所对应的应分配的驾驶权值;参照图2所示,具体表现为:(2) Calculating the driver's cognitive load based on the information collected in step (1) and outputting the driving weight value to be allocated corresponding to the current cognitive load; as shown in FIG. 2 , this is specifically performed as follows:
(21)计算驾驶员的认知负荷:(21) Calculate the driver’s cognitive load:
式中,k为认知负荷;e为自然常数;λ1和λ2和λ3为调整参数;τ为加权因子;AS为驾驶员注意力集中程度;为归一化转矩参数;Treal为当前驾驶员实际输入的转向力矩,Tneed为正常驾驶时驾驶员在车辆当前运动状态下需要输入的转向力矩;Where, k is cognitive load; e is a natural constant; λ 1 , λ 2 and λ 3 are adjustment parameters; τ is a weighting factor; AS is the driver's concentration level; is the normalized torque parameter; T real is the steering torque actually input by the current driver; T need is the steering torque that the driver needs to input under the current motion state of the vehicle during normal driving;
(22)根据当前的驾驶员认知负荷,参照图3所示,计算对应的所应该分配的驾驶权值:(22) According to the current driver's cognitive load, as shown in FIG3 , the corresponding driving weight to be allocated is calculated:
Qk=Qmax-ξ1(k-ξ2)2 (2)Q k =Q max -ξ 1 (k-ξ 2 ) 2 (2)
式中,Qk为由驾驶员认知负荷决定的驾驶员驾驶权值;Qmax为驾驶权控制权限最大值;ξ1和ξ2表示调整因子;k为认知负荷值。Where Qk is the driver's driving right value determined by the driver's cognitive load; Qmax is the maximum value of driving right control authority; ξ1 and ξ2 represent adjustment factors; and k is the cognitive load value.
(3)根据所述步骤(1)中所采集的信息,计算驾驶员肌肉驾驶能力的恢复程度,并输出当前时刻的肌肉驾驶能力所对应的应分配的驾驶权值;具体表现为:(3) Calculating the degree of recovery of the driver's muscle driving ability based on the information collected in step (1), and outputting the driving weight value to be allocated corresponding to the muscle driving ability at the current moment; specifically, as follows:
(31)选取用于逻辑递归的输入变量;(31) Selecting input variables for logical recursion;
(32)驾驶员驾驶过程左、右手臂的上下臂的夹角估计:(32) Estimation of the angle between the upper and lower arms of the driver’s left and right arms during driving:
驾驶员进行转向时的左、右手臂的上下臂的夹角(顺时针为正):The angle between the upper and lower arms of the driver's left and right arms when steering (clockwise is positive):
式中,ls为上臂长;lx为下臂长;lsx为上臂上端点距下臂下端点距离;d为半肩宽;b为转向盘半径;e为转向盘与驾驶员距离;θcl为左臂上下臂夹角;θcr为右臂上下臂夹角;θw为方向盘转角;Where, l s is the length of the upper arm; l x is the length of the lower arm; l sx is the distance between the upper end of the upper arm and the lower end of the lower arm; d is the half shoulder width; b is the radius of the steering wheel; e is the distance between the steering wheel and the driver; θ cl is the angle between the upper and lower arms of the left arm; θ cr is the angle between the upper and lower arms of the right arm; θ w is the steering wheel angle;
(33)采用逻辑递归方法,估计肌肉活化度:(33) Using a logical recursive method, muscle activation was estimated:
式中,为输入变量;β为回归系数;T为转置符号;α为肌肉活化度;In the formula, is the input variable; β is the regression coefficient; T is the transposition sign; α is the muscle activation degree;
(34)计算驾驶员肌肉驾驶能力的恢复程度:(34) Calculate the degree of recovery of the driver's muscle driving ability:
式中,md为驾驶员肌肉驾驶能力的恢复程度;αreal为肌肉的实际活化度;αneed为正常操作时所需的肌肉活化度;Where md is the degree of recovery of the driver's muscle driving ability; αreal is the actual muscle activation; αneed is the muscle activation required for normal operation;
(35)根据当前的驾驶员肌肉驾驶能力的恢复程度,参照图4所示,计算所对应的应该分配的驾驶权值:(35) According to the current recovery degree of the driver's muscle driving ability, as shown in FIG4 , the corresponding driving weight to be allocated is calculated:
式中,为由驾驶员肌肉恢复程度决定的驾驶员驾驶权值;a和b分别为调整参数。In the formula, is the driver's driving weight determined by the driver's muscle recovery degree; a and b are adjustment parameters.
(4)根据所述步骤(1)中所采集的信息,建立行车安全场模型,输出当前汽车所处位置的安全场场力值所对应的应分配的驾驶权值;(4) establishing a driving safety field model based on the information collected in step (1), and outputting the driving weight value to be allocated corresponding to the safety field force value at the current position of the vehicle;
(41)道路静止物体势能场建模;(41) Modeling of potential energy field of stationary objects on the road;
(411)静止物体分类:(411) Classification of stationary objects:
将静止物体分为两类:第一类是与车辆发生碰撞而造成重大损失的不动物体;第二类是不动的物体,不能发生实际碰撞,但对驾驶员的行为有约束;The stationary objects are divided into two categories: the first category is the immovable objects that can cause significant damage by colliding with the vehicle; the second category is the immovable objects that cannot actually collide with the vehicle but have constraints on the driver's behavior;
(412)第一类静止物体势能场建模:(412) Modeling of the potential energy field of the first type of stationary object:
式中,ER_aj_o为在(xa,ya)处的物体在(xj,yj)处形成的势能场矢量,方向与raj相同;G和k1为大于零的待定常数;Ma为目标a的虚拟质量;Ra为在(xa,ya)处道路的影响因子;raj=(xj-xa,yj-ya)为距离矢量;Wherein, E R_aj_o is the potential energy field vector formed by the object at ( xa , ya ) at ( xj , yj ), and its direction is the same as that of raj ; G and k1 are unknown constants greater than zero; Ma is the virtual mass of target a; Ra is the influence factor of the road at ( xa , ya ); raj = ( xj - xa , yj - ya ) is the distance vector;
上述虚拟质量表达式为:The above virtual mass expression is:
式中,Ta为类型,具体为该类型碰撞损失与标准类型碰撞损失之比;ma为目标a的实际质量;αk、βk为待定常数;va为目标a的速度;Wherein, Ta is the type, specifically the ratio of the collision loss of this type to the collision loss of the standard type; ma is the actual mass of target a; αk and βk are constants to be determined; va is the velocity of target a;
上述道路影响因子表达式为:The above road impact factor expression is:
式中,δa为(xa,ya)处的能见度;μa为(xa,ya)处的道路附着系数;ρa为(xa,ya)处的道路曲率;τa为(xa,ya)处的道路坡度;γ1、γ2、γ3、γ4为待定系数,γ1,γ2<0;γ3,γ4>0;δ*、μ*、ρ*、τ*为该参数的标准值;Wherein, δa is the visibility at ( xa , ya ); μa is the road adhesion coefficient at ( xa , ya ); ρa is the road curvature at ( xa , ya ); τa is the road slope at ( xa , ya ); γ1 , γ2 , γ3 , γ4 are unknown coefficients, γ1 , γ2 <0; γ3 , γ4 >0; δ * , μ * , ρ * , τ * are the standard values of the parameters;
(413)第二类静止物体势能场建模:(413) Modeling of the potential energy field of the second type of stationary object:
式中,ER_aj_L为(xa,ya)处道路标线a的场强矢量,方向与raj相同;LTa为道路标线类型;D为道路宽度;k2为大于零的待定常数;raj=(xj-xa,yj-ya)为距离矢量 Where, ERajL is the field intensity vector of road marking a at ( xa , ya ), with the same direction as raj ; LTa is the road marking type; D is the road width; k2 is a constant greater than zero to be determined; raj = ( xj - xa , yj - ya ) is the distance vector
(42)动能场建模:(42) Kinetic energy field modeling:
式中,EV_bj为在(xb,yb)处的移动物体在(xj,yj)处形成的动能场矢量,方向与rbj相同;k1、k3和G为大于零的待定常数;Rb为在(xb,yb)处道路的影响因子;Mb为目标b的虚拟质量;rbj=(xj-xb,yj-yb)为距离矢量;vb为目标b的速度;θb为vb和rbj的夹角(顺时针为正);Wherein, EV_bj is the kinetic energy field vector formed by the moving object at ( xb , yb ) at ( xj , yj ), and its direction is the same as that of rbj ; k1 , k3 and G are unknown constants greater than zero; Rb is the influence factor of the road at ( xb , yb ); Mb is the virtual mass of target b; rbj = ( xj - xb , yj - yb ) is the distance vector; vb is the speed of target b; θb is the angle between vb and rbj (clockwise is positive);
(43)行为场建模:(43) Behavioral Field Modeling:
ED_cj=EV_cj.DRc (15) ED_cj = EV_cj .DR c (15)
式中,ED_cj为在(xc,yc)处的c车驾驶员在(xj,yj)处形成的行为场矢量,方向与EV_cj相同;EV_cj为在(xc,yc)处的移动物体在(xj,yj)处形成的动能场矢量;DRc为跟c车驾驶员相关的驾驶员风险因素;Wherein, ED_cj is the behavior field vector formed by the driver of car c at (x c ,y c ) at (x j ,y j ), and its direction is the same as EV_cj ; EV_cj is the kinetic energy field vector formed by the moving object at (x c ,y c ) at (x j ,y j ); DR c is the driver risk factor related to the driver of car c;
(44)行车安全场建模:(44) Driving safety field modeling:
参照图5所示,行车安全场可以表示为:As shown in FIG5 , the driving safety field can be expressed as:
ES_j=ER_j+EV_j+ED_j (16)E S_j = E R_j + E V_j + E D_j (16)
式中,ES_j为(xj,yj)处的行车安全场;ER_j为(xj,yj)处的势能场;EV_j为(xj,yj)处的动能场矢量;ED_j为(xj,yj)处的行为场矢量;Wherein, ES_j is the driving safety field at (x j ,y j ); ER_j is the potential energy field at (x j ,y j ); EV_j is the kinetic energy field vector at (x j ,y j ); ED_j is the behavior field vector at (x j ,y j );
则根据上述可导出在(xj,yj)处的安全场场力为:According to the above, the safety field force at (x j ,y j ) can be derived as:
式中,Fj为在(xj,yj)处的安全场场力矢量,方向与Ej相同;Ej为(xj,yj)的安全场矢量;Mj为(xj,yj)处j车的虚拟质量;Rj为在(xj,yj)处的道路的影响因子;k3为大于零的待定系数;vj为(xj,yj)处j车的速度;θj为vj和Ej的夹角(顺时针为正);DRj为j车驾驶员的驾驶员风险因素;Wherein, Fj is the safety field force vector at ( xj , yj ), with the same direction as Ej ; Ej is the safety field vector at ( xj , yj ); Mj is the virtual mass of vehicle j at ( xj , yj ); Rj is the influence factor of the road at ( xj , yj ); k3 is an undetermined coefficient greater than zero; vj is the speed of vehicle j at ( xj , yj ); θj is the angle between vj and Ej (clockwise is positive); DRj is the driver risk factor of the driver of vehicle j;
(45)根据当前的车辆的行驶安全场场力值,计算所对应的应该分配的驾驶权值:采用查表法按照一定的分配原则来对驾驶权进行分配,并根据实际情况的不同对表格参数进行调整。(45) According to the current driving safety field force value of the vehicle, the corresponding driving right value to be allocated is calculated: the driving right is allocated according to a certain allocation principle using a table lookup method, and the table parameters are adjusted according to different actual conditions.
所述步骤(45)中的分配原则如下:The allocation principle in step (45) is as follows:
正常接管时的分配原则,如下表1所示:The allocation principle during normal takeover is shown in Table 1 below:
表1Table 1
危险情况时的分配原则,如下表2所示:The allocation principles in dangerous situations are shown in Table 2 below:
表2Table 2
所述步骤(5)中最终驾驶权计算方法如下:The final driving right calculation method in step (5) is as follows:
根据上述步骤计算得出的当前时刻应分配的驾驶权值Qk、和QF计算得出最终输出的驾驶权值Q:The driving weight Q k that should be allocated at the current moment calculated according to the above steps, And Q F calculate the final output driving weight Q:
式中,Q为最终的驾驶权值分配结果;w1、w2和w3为加权因子,具体可以根据实时的各因素驾驶权分配值进行调整。Wherein, Q is the final driving weight allocation result; w1 , w2 and w3 are weighting factors, which can be adjusted according to the real-time driving weight allocation values of various factors.
本发明具体应用途径很多,以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以作出若干改进,这些改进也应视为本发明的保护范围。The present invention has many specific application paths. The above is only a preferred embodiment of the present invention. It should be pointed out that for ordinary technicians in this technical field, several improvements can be made without departing from the principle of the present invention. These improvements should also be regarded as the protection scope of the present invention.
Claims (3)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010690235.3A CN111857340B (en) | 2020-07-17 | 2020-07-17 | Multi-factor fusion man-machine co-driving right allocation method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010690235.3A CN111857340B (en) | 2020-07-17 | 2020-07-17 | Multi-factor fusion man-machine co-driving right allocation method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111857340A CN111857340A (en) | 2020-10-30 |
CN111857340B true CN111857340B (en) | 2024-04-16 |
Family
ID=72983690
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010690235.3A Active CN111857340B (en) | 2020-07-17 | 2020-07-17 | Multi-factor fusion man-machine co-driving right allocation method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111857340B (en) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112644486B (en) * | 2021-01-05 | 2022-04-08 | 南京航空航天大学 | Intelligent vehicle obstacle avoidance trajectory planning method based on driving safety field |
CN112644498B (en) * | 2021-01-05 | 2022-04-08 | 南京航空航天大学 | An intelligent vehicle safety decision-making method based on driving safety field |
CN113101079A (en) * | 2021-05-20 | 2021-07-13 | 南京邮电大学 | Intelligent wheelchair and dynamic sharing control method and system based on multiple constraints |
CN113359688B (en) * | 2021-05-28 | 2022-06-24 | 重庆交通大学 | Man-machine driving-sharing robust control method based on NMS (network management System) characteristics of driver |
CN113341730B (en) * | 2021-06-28 | 2022-08-30 | 上海交通大学 | Vehicle steering control method under remote man-machine cooperation |
CN115123301A (en) * | 2022-06-30 | 2022-09-30 | 东风商用车有限公司 | Driving right distribution method, device, equipment and readable storage medium |
CN118529082B (en) * | 2024-06-05 | 2025-01-21 | 南京航空航天大学 | A method for allocating driving rights for human-machine co-driving based on incomplete information game |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104239741A (en) * | 2014-09-28 | 2014-12-24 | 清华大学 | Travelling risk field-based automobile driving safety assistance method |
CN108469806A (en) * | 2018-03-26 | 2018-08-31 | 重庆邮电大学 | Alternative expression is man-machine to drive middle driving power transfer method altogether |
CN110949407A (en) * | 2019-12-25 | 2020-04-03 | 清华大学 | A dynamic human-machine co-driving driving right allocation method based on the driver's real-time risk response |
-
2020
- 2020-07-17 CN CN202010690235.3A patent/CN111857340B/en active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104239741A (en) * | 2014-09-28 | 2014-12-24 | 清华大学 | Travelling risk field-based automobile driving safety assistance method |
CN108469806A (en) * | 2018-03-26 | 2018-08-31 | 重庆邮电大学 | Alternative expression is man-machine to drive middle driving power transfer method altogether |
CN110949407A (en) * | 2019-12-25 | 2020-04-03 | 清华大学 | A dynamic human-machine co-driving driving right allocation method based on the driver's real-time risk response |
Also Published As
Publication number | Publication date |
---|---|
CN111857340A (en) | 2020-10-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111857340B (en) | Multi-factor fusion man-machine co-driving right allocation method | |
CN108437991B (en) | Intelligent electric automobile self-adaptive cruise control system and method thereof | |
CN111746539B (en) | A method for strict and safe lane change and queuing control for intelligent networked vehicles | |
Liu et al. | Heuristic dynamic programming based online energy management strategy for plug-in hybrid electric vehicles | |
CN112644486B (en) | Intelligent vehicle obstacle avoidance trajectory planning method based on driving safety field | |
CN115056798A (en) | A Bayesian Game-Based Vehicle-Road Collaborative Decision Algorithm for Lane-changing Behavior of Autonomous Vehicles | |
CN110716562A (en) | Decision-making method for multi-lane driving of driverless cars based on reinforcement learning | |
CN111439264B (en) | Implementation method of lane change control model based on man-machine hybrid driving | |
CN107577234B (en) | Automobile fuel economy control method for driver in-loop | |
CN110304074A (en) | A Hybrid Driving Method Based on Hierarchical State Machine | |
CN110626339A (en) | Calculation method of auxiliary torque for emergency obstacle avoidance automatic driving based on driver's intention | |
CN109291925A (en) | An energy-saving intelligent network-connected hybrid vehicle following control method | |
CN113635879A (en) | Vehicle braking force distribution method | |
CN117829256B (en) | Prediction distribution method for man-machine co-driving steering weight coefficient based on deep reinforcement learning | |
Shen et al. | Highway eco-driving of an electric vehicle based on minimum principle | |
CN113593225B (en) | Single-point intersection vehicle control method oriented to pure internet environment | |
CN117227502A (en) | Layered vehicle queue economical driving cooperative control method | |
Hong et al. | Energy-Saving driving assistance system integrated with predictive cruise control for electric vehicles | |
Zhang et al. | Research on travel mode choice behaviors based on evolutionary game model considering the indifference threshold | |
CN118220143A (en) | A personalized human-machine collaborative lane keeping robust control method, system and medium | |
CN116811882A (en) | Vehicle following speed control method based on deep reinforcement learning | |
Yan et al. | Application of fuzzy control under time-varying universe in unmanned vehicles | |
CN116588123A (en) | Risk Perception Early Warning Strategy Method Based on Safety Potential Field Model | |
CN116176556A (en) | Method and system for torque distribution and gear selection of a hybrid electric vehicle, and a commercial vehicle | |
CN116543577A (en) | Combined control method for bus rapid transit running speed and station parking |
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 |