面向引导驾驶员接管的线控转向系统路感建立方法及系统

摘要: 本发明涉及车辆线控转向控制,尤其涉及一种面向引导驾驶员接管的线控转向系统路感建立方法及系统。背景技术:1、线控转向系统取消或弱化了传统机械转向系统中方向盘与转向...
面向引导驾驶员接管的线控转向系统路感建立方法及系统

本发明涉及车辆线控转向控制,尤其涉及一种面向引导驾驶员接管的线控转向系统路感建立方法及系统。

背景技术:

1、线控转向系统取消或弱化了传统机械转向系统中方向盘与转向轮之间的机械连接。在线控转向系统中,路感模拟电机需要根据车辆工作状态提供不同的功能:在自动驾驶激活时,方向盘端可跟随自动驾驶系统的转向指令转动;在驾驶员参与控制时,方向盘端需要逐渐建立路感,并引导驾驶员安全完成接管,使驾驶员能够获得接近传统机械转向系统的方向盘阻力、阻尼、摩擦和回正手感。

2、在自动驾驶向驾驶员控制过渡的过程中,如果自动驾驶控制力矩突然撤销,或驾驶员路感力矩突然建立,容易造成方向盘力矩突变、方向盘跳动、驾驶员手感不连续等问题,并可能导致安全问题。在线控转向系统中,驾驶员对方向盘的触感主要来自电机生成的反馈力矩,因此控制权限的切换过程必须平顺、连续且可控。接管过程中驾驶员指令会与自动驾驶系统形成冲突,甚至可能会威胁车辆安全,因此在权限让渡过程中,需要对驾驶员进行安全引导。

3、现有控制方法中,常见方式是根据某一固定阈值直接切换控制模式,使方向盘由自动驾驶控制直接切换到驾驶员手感控制。该方式虽然逻辑简单,但在实际驾驶中容易出现控制权突变、人机协调不自然、路感建立过快或过慢等问题。或者采用驾驶员与自动驾驶平滑曲线权重分配的方法,协调人机冲突感,该方式虽然能形成平滑的手感,但缺乏可解释性,并且会引入多个控制模型,增加调参难度,并且在回正时也采用扭矩控制,会导致方向盘在零点附近抖动或存在较大的死区。

4、因此,需要一种能够根据驾驶员握持状态、手力矩、自动驾驶状态和方向盘运动状态,使用一种统一控制模型,连续计算路感模拟电机输出的方法,在权限让渡过程中逐步建立方向盘路感,并根据驾驶员接管效率、车辆稳定性、人机操纵协调性抑制人机冲突,引导驾驶员在安全边界内安全完成接管。该方法还应在驾驶员未握持方向盘且自动驾驶未激活时,能够执行方向盘回正控制,使方向盘稳定回到中位或目标回正位置。

技术实现思路

1、针对现有技术中的上述不足,本发明提供的一种面向引导驾驶员接管的线控转向系统路感建立方法及系统,解决了在接管过程中模拟转向系统路感,建立驾驶员手感,保障接管安全的问题。

2、为了达到以上目的,本发明采用的技术方案为:一种面向引导驾驶员接管的线控转向系统路感建立方法,包括以下步骤:

3、s1、采集数据,将数据存储至存储器,并根据采集的数据在安全处理模块中进行故障判断,若发生故障,则进入安全降级,并结束流程,否则,进入s2;

4、s2、在无故障条件下,通过自动驾驶状态获取模块对自动驾驶功能处于激活状态进行判断;

5、s3、针对驾驶员有接管意图时,通过握持检测模块计算接管意图强度,其中,接管意图,说明驾驶员未握持方向盘,接管意图,说明驾驶员握持方向盘;

6、s4、通过模式判断模块判断模式,当自动驾驶功能激活且驾驶员未参与控制时,利用统一控制模型,根据自动驾驶转向指令生成方向盘目标角度,供方向盘跟踪;

7、s5、当自动驾驶功能未激活且驾驶员握持方向盘时,进入驾驶员独立驾驶模式,利用统一控制模型进行路感模拟,并利用字典基函数模型模拟路面不平度激励;

8、s6、当自动驾驶功能未激活且驾驶员未握持方向盘时,进入回正控制模式,利用统一控制模型,以方向盘中位或目标回正位置为目标按照既定回正曲线执行角度控制,并根据角度误差生成回正扭矩;

9、s7、当自动驾驶功能激活且驾驶员握持方向盘,进入驾驶员接管模式,在驾驶员接管模式下,由路感模拟电机根据人机冲突程度和车辆稳定性包络裕度,通过参数调整模块调整统一控制模型参数,引导驾驶员完成接管,其中,在接管初始阶段,基于人机冲突程度和车辆稳定性包络裕度,定义接管初始阶段统一模型参数过渡权重;在接管过渡阶段,基于人机冲突程度和车辆稳定性包络裕度,定义接管过渡阶段统一模型参数过渡权重;在接管完成阶段,基于车辆稳定性包络裕度,定义接管完成阶段统一模型参数过渡权重;

10、s8、在驾驶员接管完成后,退出自动驾驶,当驾驶员操纵方向盘超过预设限位角度时,通过提高统一控制模型中的等效刚度和等效阻尼形成限位手感,并返回预设角度范围时恢复路感模拟等效刚度和等效阻尼;

11、s9、将自动驾驶模式、驾驶员接管模式、驾驶员独立驾驶模式、回正模式、限位模拟的力矩命令输出至路感模拟电机,执行控制,完成对线控转向系统的路感建立,其中,驾驶员独立驾驶模式、回正模式为已完成接管。

12、本发明的有益效果:本发明通过协调统一模型控制参数,调整统一控制模型的力矩输出,避免接管过程中的人车扭矩冲突,通过冲突程度、驾驶员主导权、车辆稳定裕度引导驾驶员安全接管,并平滑建立驾驶员操纵路感反馈,并叠加路面纹理激励,使驾驶员获得自然、连续的方向盘手感,本发明解决了在接管过程中模拟转向系统路感,建立驾驶员手感,保障接管安全的问题。

13、进一步地,所述s1包括:

14、系统上电并完成初始化配置;

15、采集方向盘原始角度、方向盘端的路感模拟电机实际扭矩或估算扭矩、驾驶员握持状态、自动驾驶激活状态、自动驾驶转向指令和车辆状态信息;根据方向盘角度零点计算方向盘相对角度,并测量、计算或估计方向盘角速度;

16、根据采集的数据在安全处理模块中进行故障判断,若发生故障,则进入安全降级,并结束流程,否则,进入s2。

17、上述进一步方案的有益效果是:保障了线控转向系统路感模拟装置的功能安全。

18、再进一步地,所述接管意图的表达式如下:

19、

20、

21、其中,表示驾驶员的接管意图,表示上一时刻驾驶员接管意图,表示采样周期,表示握持建立时间常数,表示原始接管意图,表示驾驶员行为参数,表示松手确认阈值,表示握持确认阈值,且。

22、上述进一步方案的有益效果是:不仅能表征驾驶员是否握持方向盘,也能归一化表征驾驶员的接管意图强度。

23、再进一步地,所述统一模型的表达式如下:

24、

25、其中,表示路感电机扭矩,表示等效刚度,表示等效阻尼,表示路感电机当前转角,表示路感电机参考转角,表示参考角速度,表示模拟摩擦扭矩,表示轮胎自回正力矩,表示字典基函数模型,表示字典中的基函数总数,表示第个基函数的权重,表示第个字典基函数,表示第种字典基函数,如背景纹理基函数、颗粒冲击基函数、离散事件基函数,表示第个字典基函数的内部形状参数。

26、上述进一步方案的有益效果是:能够模拟方向盘路感的刚度、阻尼、摩擦等手感,也能叠加路面粗糙度带来的细碎手感,并且该统一控制模型涵盖了自动驾驶模式、接管模式、驾驶员独立驾驶模式、松手回正模式,避免不同模式切换控制模型。

27、再进一步地,对路面不平度激励的模拟,包括对背景纹理激励、颗粒冲击激励和离散事件激励;其中,

28、背景纹理层,用于表征连续型路表微观起伏在方向盘端形成的连续路感,其中,在背景纹理层中第个字典基函数表示为:

29、

30、其中,表示背景纹理字典基函数,表示幅值调制函数,表示谐波频率参数,表示相位参数,表示随机函数幅值系数,表示随机函数;

31、颗粒冲击层,用于表征由砂石、碎粒或颗粒状路表所引起的局部冲击感与碎振感,其中,颗粒冲击层的字典基函数采用局部衰减振荡型基函数表示为:

32、

33、其中,表示颗粒冲击字典基函数,表示衰减参数 ,表示谐波频率参数,表示相位参数;

34、离散事件层,用于表征接缝、井盖、减速带、边缘台阶及短时突发型路面事件,其中,单峰脉冲作为离散事件字典基函数表示为:

35、

36、其中,表示离散事件字典基函数,表示单峰脉冲的持续时间参数。

37、上述进一步方案的有益效果是:以三角函数为基函数通过加权和的形式模拟了复杂、高频、随机的路面粗糙导致的方向盘振动效果,提供了更加真实的手感;

38、再进一步地,进入回正控制模式时,统一模型的参数表示为:

39、

40、其中,表示路感电机参考转角,表示回正曲线输出的目标转角,表示等效刚度,表示回正时的刚度,表示等效阻尼,表示回正时的阻尼,表示模拟摩擦扭矩,表示回正时的摩擦补偿。

41、上述进一步方案的有益效果是:回正模式采用与其他模式相同的控制模型,但实现了对回正位置的跟踪,避免零点震荡,降低了控制复杂度;

42、再进一步地,所述人机冲突程度的表达式如下:

43、

44、其中,表示人机冲突程度,表示路感电机当前转角,表示自动驾驶系统转角指令,表示转角冲突归一化基准,表示路感电机当前角速度,表示自动驾驶系统角速度指令,表示角速度归一化基准;

45、所述车辆稳定性包络裕度的表达式如下:

46、

47、其中,表示车辆稳定性包络裕度,表示横摆角速度,表示横向位移偏差,和分别表示横摆角速度和横向位移偏差的安全边界。

48、上述进一步方案的有益效果是:通过上述方案,为驾驶员接管过程中路感建立提供了冲突指标和车辆稳定性指标,为后续路感建立过程中降低人机冲突,保障车辆安全提供了指标;

49、再进一步地,所述接管初始阶段统一模型参数过渡权重的表达式如下:

50、

51、其中,表示接管初始阶段统一模型参数过渡权重,表示驾驶员的接管意图,表示人机冲突程度,表示车辆稳定性包络裕度;

52、在接管初始阶段,统一控制模型的参数变化表示:

53、

54、其中,表示等效刚度,表示上一时刻等效刚度,表示驾驶员独立驾驶时的等效刚度,表示等效阻尼,表示上一时刻等效阻尼,表示驾驶员独立驾驶时的等效阻尼,表示模拟摩擦扭矩,表示上一时刻的模拟摩擦扭矩,表示驾驶员独立驾驶时的模拟摩擦扭矩,表示路感电机参考转角,表示上一时刻路感电机参考转角,,,,表示等效刚度的初始值,表示,表示等效阻尼的初始值,表示,表示模拟摩擦扭矩的初始值。

55、上述进一步方案的有益效果是:该技术方案在接管初始阶段人机冲突未显现时,将统一模型控制参数由自动驾驶参数向驾驶员独立驾驶参数小幅平滑过渡;

56、再进一步地,所述接管过渡阶段统一模型参数过渡权重的表达式如下:

57、

58、其中,表示接管过渡阶段统一模型参数过渡权重,表示驾驶员的接管意图,表示人机冲突程度,表示车辆稳定性包络裕度;

59、在接管过渡阶段,统一控制模型的参数变化表示为:

60、

61、其中,表示等效刚度,表示上一时刻等效刚度,表示驾驶员独立驾驶时的等效刚度,表示等效阻尼,表示上一时刻等效阻尼,表示驾驶员独立驾驶时的等效阻尼,表示过渡阶段与冲突相关的补偿阻尼,表示模拟摩擦扭矩,表示上一时刻的模拟摩擦扭矩,表示驾驶员独立驾驶时的模拟摩擦扭矩,表示路感电机参考转角,表示上一时刻路感电机参考转角。

62、上述进一步方案的有益效果是:该技术方案用于驾驶员接管意图进一步强化,人机冲突凸显时,基于驾驶员接管意图、冲突程度和安全包络决定驾驶权限由自动驾驶向驾驶员的转移速度;

63、再进一步地,所述接管完成阶段统一模型参数过渡权重的表达式如下:

64、

65、其中,表示接管完成阶段统一模型参数过渡权重,表示驾驶员的接管意图,表示车辆稳定性包络裕度;

66、在接管完成阶段,统一控制模型的参数变化表示为:

67、

68、其中,表示等效刚度,表示驾驶员独立驾驶时的等效刚度,表示保护性刚度,表示等效阻尼,表示驾驶员独立驾驶时的等效阻尼,表示保护性阻尼,表示模拟摩擦扭矩,表示保护性摩擦扭矩,表示路感电机参考转角。

69、上述进一步方案的有益效果是:该技术方案用于处理驾驶员稳定握持方向盘已经占据主导地位时,参数已经以驾驶员独立驾驶时的参数为主,但安全包络仍作为底层保护机制,防止车辆逼近安全边界时系统失去约束能力。

70、本发明还提供了一种面向引导驾驶员接管的线控转向系统路感建立系统,包括:

71、安全处理模块,用于采集数据,将数据存储至存储器,并根据采集的数据进行故障判断,若发生故障,则进入安全降级,并结束流程,否则,进入第二处理模块;

72、自动驾驶状态获取模块,用于在无故障条件下,对自动驾驶功能处于激活状态进行判断;

73、握持检测模块,用于针对驾驶员有接管意图时,计算接管意图强度,其中,接管意图,说明驾驶员未握持方向盘,接管意图,说明驾驶员握持方向盘;

74、模式判断模块,用于当自动驾驶功能激活且驾驶员未参与控制时,根据自动驾驶转向指令生成方向盘目标角度,供方向盘跟踪;

75、路感模拟模块,用于当自动驾驶功能未激活且驾驶员握持方向盘时,进入驾驶员独立驾驶模式,利用统一控制模型进行路感模拟,并利用字典基函数模型对路面不平度激励进行模拟;

76、回正控制模块,用于当自动驾驶功能未激活且驾驶员未握持方向盘时,进入回正控制模式,利用统一控制模型,以方向盘中位或目标回正位置为目标按照既定回正曲线执行角度控制,并根据角度误差生成回正扭矩;

77、参数调整模块,用于当自动驾驶功能激活且驾驶员握持方向盘,进入驾驶员接管模式,在驾驶员接管模式下,由路感模拟电机根据人机冲突程度和车辆稳定性包络裕度,通过调整统一控制模型参数,引导驾驶员完成接管,其中,在接管初始阶段,基于人机冲突程度和车辆稳定性包络裕度,定义接管初始阶段统一模型参数过渡权重;在接管过渡阶段,基于人机冲突程度和车辆稳定性包络裕度,定义接管过渡阶段统一模型参数过渡权重;在接管完成阶段,基于车辆稳定性包络裕度,定义接管完成阶段统一模型参数过渡权重;

78、限位模拟模块,用于在驾驶员接管完成后,退出自动驾驶,当驾驶员操纵方向盘超过预设限位角度时,通过提高统一控制模型中的等效刚度和等效阻尼形成限位手感,并返回预设角度范围时恢复路感模拟等效刚度和等效阻尼;

79、执行控制模块,用于将自动驾驶模式、驾驶员接管模式、驾驶员独立驾驶模式、回正模式、限位模拟的力矩命令输出至路感模拟电机,执行控制,完成对线控转向系统的路感建立,其中,驾驶员独立驾驶模式、回正模式为已完成接管.。

80、本发明的有益效果:

81、本发明通过协调统一模型控制参数,调整统一控制模型的力矩输出,避免接管过程中的人车扭矩冲突,通过冲突程度、驾驶员主导权、车辆稳定裕度引导驾驶员安全接管,并平滑建立驾驶员操纵路感反馈,并叠加路面纹理激励,使驾驶员获得自然、连续的方向盘手感,本发明至少具有以下有益效果:

82、1、本发明提出一种线控转向路感模拟统一控制模型,在自动驾驶、驾驶员接管、驾驶员独立驾驶、松手回正、软限位中都采用相同的控制表达方法,只需平滑切换参数,即可满足不同模式对路感模拟电机的控制需求。

83、2、本发明通过平滑参数过渡逐步建立方向盘路感,使驾驶员在接入控制过程中建立连续、自然的模拟路感。

84、3、本发明根据安全包络、冲突程度引导驾驶员进行接管,并在此过程中降低冲突程度,保障接管安全。

85、4、本发明在方向盘手感上叠加了路面不平度激励模型,通过设置三种具有统一表达形式的不平度模型,实现对背景纹理、颗粒冲击、离散事件的手感模拟。

86、5、当方向盘进入限位区域时,通过增大等效刚度和等效阻尼实现自然限位手感。

87、6、当驾驶员未握持方向盘且自动驾驶未激活时,通过角度控制和扭矩闭环实现方向盘平顺回正,避免纯扭矩模式导致的震荡、超调。