一种工程机械用的负载触感反馈手柄及负载触感反馈方法与流程
本发明涉及一种工程机械用的负载触感反馈手柄及负载触感反馈方法,属于工程机械安全性。
背景技术:
1、操纵手柄是工程机械(如起重机)的重要控制部件,用于驾驶员发出回转、伸缩、变幅、卷扬等动作指令,这些指令再转化为控制各执行机构的电信号或液压信号。工程机械的作业环境复杂、负载变化大,操作过程中存在以下问题:驾驶员在负载较大或重物速度较快时快速操作手柄,可能引起动作冲击,尤其是在重载回转时手柄突然回中,会导致吊重剧烈摆动;此外,误碰手柄也可能引发工程机械的意外动作,如突然回转或重物下落,这些情况均可能造成设备损坏甚至人员安全事故。
2、为解决上述问题,已有相关技术方案被提出。
3、申请公布号为cn 116062623 a的发明专利申请公开了一种“感知工程机械负荷状态的操纵机构及控制方法”,其通过在操纵手柄两侧对称安装由电机驱动的螺纹杆,配合弹簧和挡板结构,将起吊电机的负荷状态转化为操纵手柄的外力,使操作人员通过拨动手柄的力度感知当前负载大小。然而,该方案存在以下不足:(1)仅能根据负载大小调节手柄压力,且压力的调节方向同时作用于旋转轴的两个方向,无法针对单方向进行独立调节,限制了其在复杂工况下的适用性;(2)采用弹簧作为压力传递元件,响应速度慢,无法实现阻尼的快速动态调节;(3)该手柄仅具有单个旋转轴,无法满足工程机械多动作复合操作的现实需求。
4、申请公布号为cn 121493805 a的发明专利申请公开了一种“工程机械磁吸手柄及其控制方法”,其通过在电控手柄不同方位设置触点开关和磁吸开关,当手柄转动至某一方位时,触点开关闭合,控制器控制对应方位的磁吸开关闭合,使手柄在磁吸力作用下保持于当前方位,同时结合力限器数据实现执行机构的自动化控制。然而,该方案存在以下不足:(1)手柄仅能保持在若干预设的离散方位,无法实现任意角度的连续定位;(2)保持位置固定不变,无法根据当前动作速度、负载变化等动态工况信息调节保持力矩或阻尼特性;(3)磁吸式结构仅提供锁止功能,不具备随工况连续变化的阻尼反馈能力,操作者无法通过手柄感知实时负载变化。
5、综上所述,现有技术中的工程机械操纵手柄主要存在以下技术缺陷:
6、(1)阻尼调控忽略旋转轴的当前旋转角度以及施加于旋转轴上的当前扭矩值和其方向,且缺乏双轴独立阻尼调节能力,无法针对不同动作方向分别施加差异化阻尼;
7、(2)阻尼调节方式多为机械弹簧或磁吸式,响应滞后、调节维度单一,难以实现与负载、速度等动态工况实时匹配的阻尼反馈;
8、(3)缺少极限位置保护机制,无法在手柄接近行程末端时给予操作者触觉预警和阻尼递增保护;
9、上述缺陷导致操作者无法通过手柄感知实时负载,难以实现精准操控,存在安全隐患。
技术实现思路
1、本发明的目的在于克服现有技术中的不足,提供一种工程机械用的负载触感反馈手柄及负载触感反馈方法,实现对于手柄旋转阻尼的精准控制,提高操纵感与安全性。
2、为达到上述目的,本发明是采用下述技术方案实现的:
3、第一方面,本发明提供了一种工程机械用的负载触感反馈手柄,包括:
4、手柄总成底座,
5、y轴基座,通过x旋转轴可转动地安装于所述手柄总成底座上并绕x旋转轴轴线方向旋转;
6、摇杆,通过y旋转轴可转动地安装于所述y轴基座之上并绕y旋转轴轴线方向旋转;
7、x轴阻尼电机,固定安装于所述手柄总成底座上,其输出轴与所述x旋转轴同步转动连接,用于产生绕所述x旋转轴旋转的阻尼;
8、y轴阻尼电机,固定安装于所述y轴基座上,其输出轴与所述y旋转轴转动连接,用于产生绕所述y旋转轴旋转的阻尼;
9、所述x轴阻尼电机和所述y轴阻尼电机均内置有角度检测装置和扭矩检测装置,分别用于检测x旋转轴和y旋转轴的当前旋转角度以及施加于旋转轴上的当前扭矩值和其方向;
10、手柄控制器,分别与两个阻尼电机连接,用于分别接收并根据两个旋转轴的当前旋转角度以及施加于旋转轴上的当前扭矩值和其方向,计算对应阻尼电机的目标阻尼扭矩值,并依据所述目标阻尼扭矩值控制所述x轴阻尼电机和/或所述y轴阻尼电机的输出扭矩。
11、上述设置达到的效果:通过设置双轴独立阻尼电机并内置角度和扭矩检测装置,手柄控制器能够实时感知操作者的操作意图,并据此计算输出相应的阻尼扭矩,实现了手柄阻尼的主动可控调节,使操作者能够通过手柄感知负载变化,有效解决了现有手柄无法动态反馈负载信息的问题,显著提高了操纵感和作业安全性。
12、同时,阻尼调控考虑了旋转轴的当前旋转角度以及施加于旋转轴上的当前扭矩值和其方向,随操作者的实际施力动态响应,实现了“手感随力而变”的主动阻尼控制。
13、进一步的,所述x旋转轴轴线与所述y旋转轴轴线在空间上相互垂直且相交;
14、所述手柄总成底座和y轴基座上均设置有旋转轴轴承座;
15、所述y轴基座通过x旋转轴和旋转轴轴承座可转动地安装于所述手柄总成底座上,并绕x旋转轴轴线方向旋转;
16、所述摇杆通过y旋转轴和旋转轴轴承座可转动地安装于所述y轴基座之上,并绕y旋转轴轴线方向旋转。
17、上述设置达到的效果:正交双轴结构实现了手柄在二维平面内的全向摆动,每个旋转轴独立控制、互不干涉,便于分别对两个动作方向进行精确的阻尼调节,提高了控制的灵活性和精度。
18、进一步的,所述y轴基座上相对于所述y轴阻尼电机的另一侧固定设置有平衡块,所述平衡块与所述y轴阻尼电机分别位于所述x旋转轴轴线的两侧用于平衡所述y轴阻尼电机的重量。
19、以上设置实现的效果:平衡块用于减小重力对所述x轴角度和扭矩检测的干扰。通过在y轴电机对侧配置平衡块,利用重力矩补偿原理抵消了电机自身重量对x轴旋转中心产生的偏置载荷,消除了因电机单侧悬重导致的手柄自动下垂趋势,确保x轴角度检测装置输出的角度信号为真实的操控角度,而非重力影响下的偏转角度,大幅提升了负载反馈控制的准确性和手柄中位自复位的一致性。
20、进一步的,所述手柄控制器还与车身控制器连接,用于接收所述车身控制器发送的当前负载信息以及各旋转轴对应控制机构的当前动作速度信号;
21、所述手柄控制器根据当前负载信息、各旋转轴对应的当前动作速度信号、当前旋转角度、当前扭矩值和其方向,计算所述x轴阻尼电机和/或所述y轴阻尼电机的目标反馈扭矩值,并依据所述目标反馈扭矩值控制对应的阻尼电机输出扭矩;
22、阻尼电机的所述目标反馈扭矩值由对应旋转轴的当前扭矩值及其方向状态、基础阻尼力矩与极限位置保护力矩复合而成,所述基础阻尼力矩至少根据所述当前负载信息和所述当前动作速度信号确定,所述极限位置保护力矩在所述当前旋转角度超过预设临界角度时激活并随角度增大而增大。
23、上述设置达到的效果:通过引入车身控制器的负载和速度信号,使阻尼力矩能够随工程机械实际工况动态调整;基础阻尼部分根据负载和速度提供合适的操作阻力,使操作者手感与负载轻重、动作快慢实时匹配;极限保护部分则在手柄接近极限角度时提供递增的阻力,防止操作者过度推动手柄,有效避免了因误操作导致的机械冲击或安全事故,提高了操作平稳性和安全性。
24、进一步的,所述目标反馈扭矩值的计算公式为:
25、;
26、其中,为最终博弈修正系数,为t时刻的极限位置保护力矩,为t时刻的基础阻尼力矩;r表示旋转轴的旋转方向,即操作者当前施加在对应旋转轴上的方向状态,其中1表示正向,-1表示反向,0表示无扭矩,转轴位于原点;表示当前扭矩值,即操作者当前施加在旋转轴上的实际操作扭矩大小;为硬件安全饱和截断函数:;
27、式中,为阻尼电机允许输出的最大安全力矩阈值,从而确保了人机交互的绝对物理安全;
28、其中,x轴阻尼电机的目标反馈扭矩值由x旋转轴的当前扭矩值及其方向状态、x轴阻尼电机的基础阻尼力矩与极限位置保护力矩复合而成;
29、y轴阻尼电机的目标反馈扭矩值由y旋转轴的当前扭矩值及其方向状态、y轴阻尼电机的基础阻尼力矩与极限位置保护力矩复合而成。
30、上述设置达到的效果:通过该公式将基础阻尼、极限保护力矩以及操作者当前施加扭矩经博弈修正系数复合,并经过硬件安全限幅,既实现了对操作意图的智能响应,又确保了输出扭矩不超过安全阈值,兼顾了操控灵活性与物理安全,从算法层面杜绝了因过大反馈力矩导致操作者受伤或设备损坏的风险。
31、进一步的,所述最终博弈修正系数的计算方法包括:
32、定义为工程机械动作安全权重:
33、=;
34、其中,为安全风险增长因子,为基础权重;
35、计算动态协同因子:
36、;
37、其中,为人类操作轻便性权重;
38、结合操作者主动反向拉杆制动时的状态识别,对最终博弈修正系数进行自适应修正:
39、其中,为人机协同反向卸力因子。
40、上述设置达到的效果:通过定义工程机械动作安全权重和人类操作轻便性权重,计算动态协同因子,并在操作者反向拉杆制动时进行自适应修正,使得阻尼力矩能够根据负载和速度权衡安全与轻便,在紧急制动时降低阻尼以辅助操作者快速回撤,提升了人机协同安全性,避免了因阻尼过大阻碍紧急避险操作。
41、进一步的,所述基础阻尼力矩的计算表达式为:;
42、其中,为t时刻的基础阻尼力矩;l为当前负载信息,s为当前动作速度信号,s(t)为t时刻的当前动作速度信号,d(t)为t时刻的当前旋转角度,为d(t)的0.5阶分数阶导数,为随当前负载信息l变化的负载自适应阻尼项,为随当前负载信息l变化的微动敏感控制增益;为方向判定函数:
43、;
44、所述当前负载信息包括由力矩限制器lmi获取的工程机械实际负载率;
45、所述各旋转轴对应控制机构的当前动作速度信号包括x旋转轴和y旋转轴的转动控制动作的实际机构运动速度;
46、所述x轴阻尼电机的基础阻尼力矩由x旋转轴转动控制动作的实际机构运动速度、x旋转轴的当前旋转角度、x旋转轴的方向状态和当前负载信息进行计算;
47、所述y轴阻尼电机的基础阻尼力矩由y旋转轴转动控制动作的实际机构运动速度、y旋转轴的当前旋转角度、y旋转轴的方向状态和当前负载信息进行计算。
48、上述设置达到的效果:通过引入负载自适应阻尼项和0.5阶分数阶导数项,使得阻尼力矩在重载或高速时增大,在轻载或慢速时减小,同时分数阶导数能有效抑制手柄高频抖动,既保证了高速运动时的平稳性,又确保了微动对位的精确性。
49、进一步的,工程机械重载自适应阻尼项的计算公式为:
50、;
51、其中,为固定基础阻尼,为设定的固定值,为阻尼调节系数;
52、微动敏感控制增益的计算公式为:
53、;
54、其中,为分数阶微动敏感系数,为基础微动刚度。
55、上述设置达到的效果:负载自适应阻尼项随负载率二次方增长,使得重载时手柄沉重感明显,警示操作者谨慎操作;微动敏感控制增益随负载线性增加,增强了重载下的微动控制灵敏度,两者结合实现了负载适配的阻尼特性,使操作者在不同负载下均能获得舒适且安全的操作手感。
56、进一步的,所述极限位置保护力矩的计算公式为:
57、;
58、式中,为触觉预警临界角度,为物理硬死区角度,为安全刚度系数;
59、所述x轴阻尼电机的极限位置保护力矩由x旋转轴的当前旋转角度进行计算;
60、所述y轴阻尼电机的极限位置保护力矩由y旋转轴的当前旋转角度进行计算。
61、上述设置达到的效果:当手柄越过触觉预警临界角度后,保护力矩按正切函数急剧增大,形成虚拟能量壁垒,阻止手柄继续推向极限位置,有效防止误操作导致的机械碰撞或超限事故;同时,该力矩在临界角度以内为零,不影响正常操作行程。
62、进一步的,所述手柄控制器还用于:
63、判断旋转轴上的方向状态所对应的动作是否为限制动作方向;若旋转轴上的方向状态指向限制动作方向,则控制对应的阻尼电机输出对应旋转轴的阻止向该限制动作方向运动的阻尼扭矩,且该阻尼扭矩的值为最大安全力矩阈值,以限制操作者继续向该方向掰动所述摇杆,同时允许所述摇杆向安全方向复位。
64、上述设置达到的效果:该方案实现了一种“智能非对称限动”保护逻辑。区别于现有技术只能将手柄锁死在固定位置,本发明能够实时辨析操作意图的方向性。当工程机械力限器触发臂架防过载、防后倾或卷扬防过放等限动条件时,手柄仅在危险方向一侧施加不可逾越的刚性阻尼,而在安全返回方向一侧保持零阻尼或低阻尼。这使得操作者无需刻意观察屏幕报警提示,只需凭手柄端的“堵转”力感即可获知动作受限,并本能地沿着无阻尼的安全方向回撤手柄,既防止了危险动作的继续执行,又保障了紧急避险的快速响应通道畅通无阻。
65、进一步的,所述手柄控制器还用于:控制所述阻尼电机输出主动驱动力矩以使所述摇杆保持在预设倾斜角度并持续输出所述动作控制信号。
66、上述设置达到的效果:该优化方案在纯被动阻尼反馈的基础上,拓展了手柄的主动控制能力。当工程机械需要进行长时间、恒定速度的回转或伸缩动作时(如连续回转找位),控制器可锁定当前倾角并使阻尼电机以位置闭环模式维持该角度,无需操作者持续施力维持手柄偏角。这一“电控驻留”功能有效减轻了操作者的肌肉负担,降低了长期作业的职业疲劳度,同时避免了因人为手部细微抖动导致的动作指令波动,进一步提升了稳钩和精准定位的性能。
67、第二方面,本发明提供一种工程机械用的负载触感反馈方法,应用于第一方面所述的手柄,包括:
68、步骤s1,获取工程机械的当前负载信息l和旋转轴控制的实际机构当前动作速度信号s;获取阻尼电机内置的角度检测装置反馈的旋转轴的当前旋转角度d;获取所述阻尼电机内置的扭矩检测装置反馈的旋转轴的当前扭矩值t及其方向r;
69、步骤s2,根据所述当前负载信息l、所述当前动作速度信号s和所述当前旋转角度d计算基础阻尼力矩tbase;
70、步骤s3,根据所述当前旋转角度d计算极限位置保护力矩tlimit;
71、步骤s4,根据所述当前负载信息l和所述当前动作速度信号s确定最终博弈修正系数;
72、步骤s5,根据所述旋转轴的当前扭矩值t及其方向r、基础阻尼力矩tlimit与所述极限位置保护力矩tlimit,结合所述最终博弈修正系数,再经硬件安全限幅处理,得到目标反馈扭矩值tm;
73、步骤s6,输出控制信号:根据所述目标反馈扭矩值tm控制对应的阻尼电机输出反馈扭矩,同时根据所述当前旋转角度d生成动作控制信号并发送至所述车身控制器。
74、上述设置达到的效果:该方法通过获取负载、速度、角度、扭矩等多维信息,依次计算基础阻尼、极限保护和博弈修正系数,最终合成目标扭矩并输出,形成了完整的闭环反馈控制流程。该方法能够实时响应操作者意图和工程机械状态,实现了从“被动感受”到“主动感知”的升级,有效提升了操作安全性、舒适性和作业效率。
75、与现有技术相比,本发明所达到的有益效果:
76、1、本发明采用带有负载调节阻尼的手柄,可以提高操作者的操纵感,阻尼根据负载和操作输入实时调节,可以使操作者有效感知当前负载大小,提高操作安全性,适当的阻尼能够减少手柄输入带来的波动,提高操作的平顺性。
77、2、本发明通过设置x轴阻尼电机和y轴阻尼电机分别独立控制两个正交旋转轴的阻尼,配合各阻尼电机内置的角度检测装置和扭矩检测装置,实现了手柄双轴阻尼的独立可控调节。手柄控制器能够实时获取每个旋转轴的当前旋转角度及操作者施加的扭矩大小和方向,并据此计算输出相应的阻尼扭矩。相比现有单轴手柄或双轴联动调节方案,本发明能够针对不同动作方向分别施加差异化阻尼,满足了工程机械多动作复合操作的精准控制需求。
78、3、通过在y轴基座上相对于y轴阻尼电机的对侧设置平衡块,利用重力矩补偿原理抵消了电机自身重量对x轴旋转中心产生的偏置载荷,消除了因电机单侧悬重导致的手柄自动下垂趋势,确保角度检测装置输出的角度信号为真实操控角度而非重力影响下的偏转角度,大幅提升了负载反馈控制的准确性和手柄中位自复位的一致性。
79、4、本发明通过引入工程机械的当前负载信息和动作速度信号构建基础阻尼力矩,使阻尼能够随工况动态调节。具体地,负载自适应阻尼项随负载呈二次方增长,重载时手柄明显沉重,操作者从手感上即可感知当前吊重状态,避免在不知情下进行危险高速动作;轻载时手柄轻便灵活,降低操作疲劳。
80、5、本发明首次在工程机械手柄控制中引入0.5阶分数阶导数项,该分数阶项具有高频放大、低频抑制的幅频特性:当操作者手部产生高频生理性抖动时,分数阶项产生显著的粘滞阻力实现物理防抖,而在慢速匀速操作时阻力极小,确保毫米级精准对位。微动敏感控制增益随负载线性增加,进一步增强了重载工况下的微动操控灵敏度。由此,本发明有效解决了大惯性工况下“高空微动对准”与“高速防摇摆”的相互制约难题,使手柄在低速微调时灵敏精准、在高速运行时沉稳安全。
81、6、动作速度信号来自车身控制器反馈的实际机构运动速度而非手柄角度指令值,这使得阻尼能够反映执行机构的真实响应状态,避免了仅依据手柄角度估算速度所带来的滞后和偏差。
82、7、当手柄越过触觉预警临界角度后,保护力矩按正切函数急剧增大并趋近于无穷大,形成三阶段触觉反馈。相比现有技术中仅在硬死区处机械限位的方案,本发明使操作者仅凭手感即可感知手柄剩余行程,无需目视确认,有效防止了因过度操作导致的机械碰撞或超限事故。
83、8、本发明通过统一的数学表达式将操作扭矩大小、扭矩方向、旋转角度、负载信息、动作速度五个维度输入变量有机融合,并经过硬件安全饱和函数限幅,确保输出扭矩不超过最大安全力矩阈值。各变量相互作用、协同决策:角度与负载、速度分别控制位置安全和运动平稳;扭矩方向与动作速度经博弈修正系数判断反向制动状态;负载与速度共同决定工程机械动作安全权重;扭矩方向与扭矩大小共同表征操作者施力意图强度。这种多变量融合的控制架构,使本发明能够同时响应“手柄状态”和“工程机械工况”三个层面的信息,实现了从“开环操控”到“闭环力反馈”的质变。综上,本发明从根本上解决了现有技术中阻尼单一、响应滞后、方向无差别、缺乏触觉预警、缺少紧急制动辅助等多项技术缺陷,显著提升了工程机械的操作安全性、精准性和舒适性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com