一种基于视频与力觉融合反馈的机械臂柔顺递枪控制方法及装置与流程
本发明涉及电动汽车充电辅助,具体为一种基于视频与力觉融合反馈的机械臂柔顺递枪控制方法及装置。
背景技术:
1、随着电动汽车快充技术的发展,大功率直流充电枪及配套线缆的重量可达数公斤至十余公斤,半自动递枪充电系统应运而生。该系统通过导轨机械臂将充电枪递送至车辆充电口外侧的目标递枪停靠位,由用户手动接管后完成插接。在人机交接过程中存在显著的技术矛盾:若机械臂在用户尚未握稳时直接释放夹持,重枪易下坠砸伤用户或损坏充电接口;若机械臂夹持过紧或释放时机滞后,用户难以顺利取枪,使用体验较差。因此,精准判断用户握持状态并实现负载的平顺转移,是提升递枪系统安全性与易用性的核心问题。
2、目前,机器人视觉与力觉融合的柔顺控制技术已在工业装配领域得到应用。例如公开号为cn121403414a的中国专利申请公开了一种基于视觉与力觉融合的机器人控制系统,通过人工智能处理单元解析视觉特征并预测力学参数,结合自适应阻抗控制单元动态融合位置指令与力觉反馈,实现精密装配场景下的柔顺调控;公开号为cn114131617a的中国专利申请公开了一种工业机器人的智能柔顺控制方法,通过位置伺服环、机器人动力学模型与阻抗控制模型相结合,分别输出位置驱动量与力驱动量,提升末端执行器的控制柔顺度。但上述技术均面向机器与工件的自动化交互场景,其控制目标为工件的精准装配与加工,未针对人机交接场景建立用户握持状态识别、负载逐步转移、承接闭环校验的完整逻辑,也未考虑充电枪交接中重力补偿、下坠防护、人员安全等特殊需求,无法直接应用于机械臂递枪的人机交接场景。
3、综上,现有递枪相关技术仍存在诸多缺陷:其一,全自动插枪的力控方案以机器对接为核心,缺乏对用户施加力、握持状态的建模与判断,安全边界与交接逻辑不匹配;其二,单纯依靠按钮指令或单一传感器信号确认接管,无法区分碰触与真握持,误判率高;其三,直接释放夹持的方式缺少负载过渡过程,易引发充电枪下坠风险;其四,视觉、力觉、握持检测等多源信息未形成融合判定机制,难以兼顾交接的安全性与平顺性。
技术实现思路
1、本发明的目的在于提供一种基于视频与力觉融合反馈的机械臂柔顺递枪控制方法及装置,以解决上述背景技术中提出现有机械臂递枪系统难以精准识别用户真实握持状态,直接释放充电枪易引发下坠风险,且缺乏负载平顺转移与闭环校验机制,导致人机交接安全性与平顺性不足的问题。
2、为实现上述目的,本发明提供如下技术方案:
3、一种基于视频与力觉融合反馈的机械臂柔顺递枪控制装置,包括滑台、充电机械臂、充电枪夹持机构、末端第二感知模块、末端六维力/力矩传感器、枪柄握持检测传感器、关节电流采集模块以及站端控制器;
4、所述充电机械臂安装于滑台上,所述充电枪夹持机构设于充电机械臂的末端执行端,用于夹持固定充电枪;所述末端六维力/力矩传感器串接于充电机械臂末端法兰与充电枪夹持机构之间,用于采集包含枪体自重、惯性力与外接触力的六维合成力旋量;所述枪柄握持检测传感器布设于充电枪枪柄的握持区域,用于输出用户握持接触状态信号;所述末端第二感知模块固定于充电机械臂末端侧方,用于采集用户手部的图像与深度信息;所述关节电流采集模块接入充电机械臂各关节的驱动回路,用于采集关节电流以间接反映关节力矩;
5、所述站端控制器分别与上述各模块信号连接,被配置为:在充电机械臂将充电枪递送至目标递枪停靠位后,维持机械臂的高刚度承重姿态与托举力;对视觉信息与力觉信息进行时间同步与融合处理,依据手部位置、握持检测信号与外力特征的多源证据判定用户接管状态;判定用户握持稳定后,控制机械臂切换为低刚度柔顺跟随模式,并按负载分担因子分阶段降低托举力与夹持力,且每一阶段校验充电枪负载的用户承接状态;用户完成接管后,控制机械臂沿避让方向执行安全让位动作;所述装置用于辅助用户接管充电枪,不驱动机械臂执行自动插枪动作。
6、作为优选,所述站端控制器内置重力与惯性补偿标定单元,用于离线辨识充电枪与线缆的等效质量、质心位置及传感器零偏,并在线根据机械臂当前姿态计算并扣除重力与惯性分量,提取仅由用户施加的外力旋量,外力提取满足:
7、;
8、其中,为末端六维力/力矩传感器直接采集的六维合成力旋量;为通过机械臂正运动学得到的当前姿态矩阵对应的充电枪与线缆重力旋量,由离线辨识的等效质量与质心位置结合实时姿态计算得到;为由末端加速度计算得到的惯性力旋量,末端加速度由关节速度差分或运动学估计获取;为离线标定得到的传感器零偏力旋量;提取得到的作为柔顺控制与接管判定的核心输入量。
9、作为优选,所述站端控制器内置阻抗控制单元,采用导纳控制律实现柔顺跟随,控制律满足:
10、;
11、其中,为预设的期望惯性矩阵,为预设的期望阻尼矩阵,为预设的期望刚度矩阵,为末端实际位置与参考位置的偏差向量;所述阻抗控制单元配置为承重保持阶段采用高刚度参数,柔顺跟随阶段采用低刚度参数,且沿用户拉拽方向的刚度低于其余自由度,实现各向异性柔顺特性。
12、作为优选,所述站端控制器内置带迟滞特性的有限状态机,状态依次包括到位承重态、手部接近态、接触触发态、握稳确认态、柔顺跟随态、分阶段卸载态、接管完成态、安全让位态以及异常态;状态切换由多源融合置信度驱动,融合置信度计算满足:
13、;
14、其中,、、分别为预先标定的视觉模态、握持检测模态、力觉模态的权重系数;为由末端第二感知模块输出的手部位于枪柄邻域且呈现握持手势的置信度,由手部关键点检测与深度信息计算得到;为枪柄握持检测传感器输出的激活程度;为外力沿合理方向且幅值超过阈值的置信度;当且稳定持续设定时长时,切换至握稳确认态,退出判定采用低于进入阈值的迟滞阈值以避免抖动。
15、作为优选,还包括急停碰撞检测模块,所述站端控制器内置异常保护单元,用于基于广义动量观测器估计外部关节力矩残差,力矩残差计算满足:
16、;
17、其中,为系统动量,为机械臂关节空间惯性矩阵,由机械臂动力学参数计算得到;为由关节电流采集模块换算得到的关节驱动力矩;为科氏力与离心力矩阵,为关节空间重力项;为观测器积分增益;当力矩残差超阈值、外力超限、拉拽方向落入危险锥或人员进入危险区时,异常保护单元触发机械臂提高刚度、暂停或沿安全方向回撤,与急停碰撞检测模块、关节电流采集模块形成三重冗余碰撞判定。
18、另一方面,本发明还提供一种基于视频与力觉融合反馈的机械臂柔顺递枪控制方法,采用上述基于视频与力觉融合反馈的机械臂柔顺递枪控制装置执行,包括以下步骤:
19、s101到位承重:控制充电机械臂沿滑台移动并将充电枪递送至目标递枪停靠位,进入高刚度承重保持模式,维持充电枪姿态与托举力,保持枪头朝向充电口且与车身、用户保持安全距离;
20、s102多模态信号采集与同步:通过机械臂末端的末端第二感知模块采集用户手部图像与深度信息,通过末端六维力/力矩传感器采集六维合成力旋量,同时采集充电枪夹持机构开合状态、枪柄握持检测传感器信号与关节电流信号,并对所有信号打上统一时间戳,按控制周期完成时间对齐;
21、s103力补偿与接管状态融合判定:对采集的力信号进行重力与惯性补偿,提取用户施加的外力旋量;融合视觉手部信息、枪柄握持信号与外力特征,判定用户是否握持充电枪并达到稳握状态;
22、s104柔顺跟随与分阶段卸载:判定用户握稳后,控制机械臂切换为低刚度柔顺跟随模式,沿用户拉拽方向自适应降低末端刚度;同时引入负载分担因子,分阶段逐步降低机械臂托举力与夹持机构夹持力,且每一阶段校验充电枪负载是否被用户承接;
23、s105安全让位与异常处置:当负载分担因子达到1且夹持机构完全释放后,判定用户完成接管,控制机械臂沿避让方向退出递枪区域并保持安全距离;交接过程中检测到异常工况时,立即触发暂停、回撤或重新提示;
24、所述方法用于辅助用户接管充电枪,不驱动机械臂执行自动插枪动作。
25、作为优选,步骤s103中,判定用户达到稳握状态前,还包括握持稳定性评估步骤:计算握持稳定度,握持稳定度由外力幅值、外力平稳性、接触点数、拉拽方向一致性与保持时长共同表征,满足:
26、;
27、其中,为用户施加外力的幅值,由补偿后的外力旋量计算得到;为设定窗口内外力的时域方差,反映力的平稳程度;为枪柄握持检测阵列输出的有效触点数;为拉拽方向与预设合理方向的夹角余弦值,由外力方向向量与预设方向向量计算得到;为握持状态的持续时长;仅当握持稳定度达到预设阈值并维持设定窗口时长后,方进入分阶段卸载步骤。
28、作为优选,步骤s104中,分阶段卸载过程中,机械臂托举力与夹持力按负载分担因子平滑递减,分别满足:
29、;
30、;
31、其中,为负载分担因子,初始值为0,代表机械臂全承重;为离线标定得到的充电枪与线缆等效质量,为重力加速度;为初始夹持力,为释放临界夹持力;
32、每完成一步负载分担后,通过外力信号校验充电枪是否存在下坠趋势:若检测到竖直方向外力突变或下坠位移,则回退当前卸载步、恢复全承重并提示用户;若用户持续承接,则继续增大负载分担因子,直至时释放充电枪夹持机构。
33、作为优选,步骤s105中,异常工况包括超限拉拽、反向拉拽、碰撞检测与人员入侵危险区;其中碰撞检测采用基于广义动量观测器的无传感器检测方式,结合关节电流采集与急停碰撞检测模块形成三重冗余判定;当检测到异常工况时,立即提高机械臂末端刚度并暂停运动,必要时沿远离用户与车身的安全方向回撤,待异常解除且重新确认握持状态后,再恢复交接流程。
34、作为优选,整个交接过程遵循人机协作安全约束:全程限制末端接触力峰值与运动速度,且人员距离充电枪越近,末端运动速度上限越低;当人员进入预设危险区域时,立即停止所有递枪相关动作;所有融合判定与卸载步骤不满足条件时,均降级为保持承重并提示用户的安全状态,优先保证交接安全性。
35、与现有技术相比,本发明的有益效果是:
36、1、本发明通过视觉手部感知、枪柄握持检测与力觉检测的多源信息融合判定机制,结合迟滞判定逻辑,可有效区分用户短暂碰触与稳定握持状态,降低单一传感器信号导致的误判概率,避免出现提前释放或延迟释放的异常工况;配合末端力的重力与惯性补偿方法,提取仅由用户施加的外力作为判定依据,进一步提升接管状态识别的准确性,从判定层面保障人机交接的安全性。
37、2、本发明采用高刚度承重保持与低刚度柔顺跟随的双模式切换策略,结合各向异性刚度设置,在维持充电枪姿态稳定的同时,降低用户拉拽取枪的施力阻力;通过负载分担因子实现分阶段逐步卸载,并在每一卸载阶段执行负载承接闭环校验,可实现枪体负载从机械臂到用户的平滑过渡,从过程层面避免充电枪突然下坠的风险,提升交接过程的平顺性。
38、3、本发明构建了包含力超限检测、广义动量观测器碰撞检测、人员危险区入侵检测的多重异常保护机制,结合状态机的异常降级逻辑与安全让位策略,全程遵循人机协作安全约束,可在异常工况下快速触发暂停、回撤或降级处理,提升系统在真实场站环境下的运行可靠性与环境适应性,符合人机协作的相关安全规范要求。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com