一种适配接触式任务的人-机-环境交互装置和控制方法
本发明涉及机器人接触式作业及人机协同控制领域,更具体的说是涉及一种适配接触式任务的人-机-环境交互装置和控制方法。
背景技术:
1、在打磨、抛光等接触式作业中,机械臂末端执行器需与工件表面保持接触并施加法向力。当工件模型未知或形状复杂时,操作者常直接施力引导机械臂运动,因此装置需同时检测操作者交互力(识别引导意图)与环境接触力及扭矩(监控接触状态)。现有末端装置通常在机械臂与执行器间设置单个力传感器,操作者施力与环境力均经同一串联结构传递至该传感器,输出为叠加信号,无法分离两类力,影响控制准确性。部分装置增设握持把手,但把手、传感器与执行器间缺乏明确结构分隔,力传递路径仍重叠或串联,耦合未解;若将两只传感器、把手、执行器分散安装,则结构复杂、拆装不便,且难以适配不同机械臂或执行器,通用性差。
2、控制方法方面,现有人工干预包括遥操作、视觉跟随和重新示教。遥操作依赖额外界面,链路长、时延大;视觉跟随受视场、遮挡、光照和图像处理时延影响,实时性不足;重新示教需中断作业,流程繁琐。这些方式难以满足复杂接触任务的实时动态跟随需求。已有安全方案侧重修正小力检测精度或根据外力阈值停机,位置—力切换控制仅在不同控制模式间转换,均未解决两类力的分别感知,也未实现运动引导、姿态调整与法向力控制的协同。
3、在打磨抛光中,机械臂需根据交互力改变末端在工件表面投影方向上的运动,同时使执行器轴线接近接触面法向,并将法向力维持在期望范围。单传感器叠加信号使控制器无法区分操作者意图与接触状态,导致引导偏差、姿态失准和力控精度不足。完全依赖人工保持接触力易致疲劳,质量难一致;完全依赖预设轨迹难适应表面高度、倾角等变化。
4、综上,现有技术缺乏一种能在机械臂末端集中安装两只力传感器、使把手与执行器分别对应不同传感器及独立受力支路的双力传感交互装置,也缺乏基于该装置分别感知操作者交互力与环境接触力、并协同完成运动引导、姿态修正和法向力调节的控制方法。
技术实现思路
1、有鉴于此,本发明提供了一种适配接触式任务的人-机-环境交互装置和控制方法,通过两个分别设置在不同串联受力支路中的力传感器,分别获取操作者施加的人机交互力以及末端执行器受到的环境接触力和接触扭矩,并利用两路检测数据分别控制机械臂的平面运动、末端姿态及法向位置,从而实现操作者实时引导与机械臂自主控制的结合。
2、为了实现上述目的,本发明采用如下技术方案:
3、一种适配接触式任务的人-机-环境交互装置,包括双力传感器连接法兰、第一力传感器、操作者把手、第二力传感器、末端执行器连接法兰和末端执行器固定法兰;
4、所述双力传感器连接法兰安装于机械臂的末端;
5、所述第一力传感器的一端安装于所述双力传感器连接法兰侧部的第一传感器安装部,另一端与所述操作者把手连接,所述操作者把手、第一力传感器和双力传感器连接法兰构成人机交互力检测支路;
6、所述第二力传感器的一端安装于所述双力传感器连接法兰轴向端部的第二传感器安装部,另一端依次通过所述末端执行器连接法兰和末端执行器固定法兰与所述末端执行器连接,所述末端执行器、末端执行器固定法兰、末端执行器连接法兰、第二力传感器和双力传感器连接法兰构成环境接触力及接触扭矩检测支路。
7、优选的,所述双力传感器连接法兰包括法兰主体、用于与机械臂末端法兰连接的安装部、位于法兰主体侧部的第一传感器安装部,以及位于法兰主体轴向端部的第二传感器安装部;
8、所述第一传感器安装部的安装面朝向法兰主体侧方,用于安装第一力传感器;第二传感器安装部的安装面朝向机械臂末端法兰轴向外侧,用于安装第二力传感器;所述第一传感器安装部和第二传感器安装部均设有与相应连接对象配合的连接孔;使第一力传感器和第二力传感器分别布置在不同的受力支路中。
9、优选的,所述双力传感器连接法兰与机械臂末端之间、双力传感器连接法兰与第一力传感器之间、第一力传感器与操作者把手之间、双力传感器连接法兰与第二力传感器之间、第二力传感器与末端执行器连接法兰之间以及末端执行器连接法兰与末端执行器固定法兰之间均采用螺钉可拆卸连接,所述末端执行器可拆卸地安装于所述末端执行器固定法兰。
10、优选的,所述末端执行器连接法兰与所述末端执行器固定法兰连接,末端执行器通过末端执行器固定法兰进行安装和固定,安装完成后,第二力传感器位于双力传感器连接法兰与末端执行器之间,并沿机械臂末端轴向布置;
11、末端执行器与工件表面接触时,环境接触力和接触扭矩依次通过末端执行器、末端执行器固定法兰和末端执行器连接法兰传递至第二力传感器,由第二力传感器进行检测。
12、优选的,所述操作者把手、所述第一力传感器和所述双力传感器连接法兰构成人机交互力检测支路;末端执行器、末端执行器固定法兰、末端执行器连接法兰、第二力传感器和双力传感器连接法兰构成环境接触力及接触扭矩检测支路;
13、两个检测支路共用双力传感器连接法兰作为安装基础,两只力传感器分别检测对应对象产生的作用力;两只力传感器分别设有信号输出接口,用于与外部控制器通信连接,第一力传感器和第二力传感器分别输出人机交互力数据以及环境接触力和接触扭矩数据。
14、优选的,一种适配接触式任务的人-机-环境交互控制方法,包括:
15、步骤1:建立机器人基坐标系、工具坐标系以及环境坐标系,并完成力传感器零点标定;
16、步骤2:操作者握持把手并施加交互力,第一力传感器采集三维交互力信息;
17、步骤3:提取三维交互力信息在水平面上的两个分量,作为导纳控制输入并计算机器人末端期望加速度、期望速度及期望位置;
18、步骤4:第二力传感器实时检测环境接触力和接触扭矩,根据接触扭矩及其变化率计算末端姿态调整角速度;
19、步骤5:根据第二力传感器的检测结果,利用工具坐标系与接触点局部frenet坐标系之间的旋转关系计算法向接触力分量,根据实际法向接触力变化率与期望法向接触力变化率的差值自适应调节法向阻抗刚度参数,并根据调节后的法向阻抗刚度参数和法向阻抗控制模型计算末端法向位移补偿量;
20、步骤6:机器人控制器根据所述末端姿态调整角速度和法向位移补偿量调节机械臂末端位姿,使末端执行器与接触面保持垂直,并使法向接触力维持在设定范围内。
21、优选的,所述步骤2和步骤3均基于第一力传感器检测的人机交互力生成机械臂期望运动轨迹,导纳控制将机械臂末端与操作者之间的动力学关系描述为虚拟质量-阻尼系统模型,表达式如下:
22、;
23、其中,∈为虚拟质量矩阵,∈为虚拟阻尼矩阵,∈为期望加速度,∈为期望速度,∈为操作者与机械臂的交互力。
24、优选的,所述虚拟质量矩阵根据末端执行器质量和期望法向接触力经参考质量及参考接触力归一化后的量进行调节;所述虚拟阻尼矩阵根据人机交互力变化率进行调节。
25、优选的,所述步骤4中,根据第二力传感器检测的接触扭矩及其变化率调节姿态导纳增益矩阵,并根据所述姿态导纳增益矩阵和接触扭矩计算末端姿态调整角速度。
26、优选的,所述步骤5中,利用frenet坐标变换获得末端执行器与接触面接触点处的法向接触力分量,并建立所述接触点法线方向的阻抗控制模型,表达式如下:
27、;
28、法向位移补偿量:
29、;
30、所述法向阻抗刚度参数根据实际法向接触力变化率与期望法向接触力变化率的差值进行自适应调节,其调节关系如下:=;
31、其中,mn∈r为法向质量参数,bn∈r为法向阻尼参数,kn∈r为经自适应调节得到的当前法向阻抗刚度参数,kn0∈r为初始法向阻抗刚度参数,zn∈r为末端接触点实际法向位置,n和n分别为法向速度和法向加速度,∈r为期望法向位置,fn∈r为实际法向接触力,∈r为期望法向接触力,β为刚度调控系数,n与分别为实际法向接触力变化率和期望法向接触力变化率。
32、经由上述的技术方案可知,与现有技术相比,本发明提供了一种适配接触式任务的人-机-环境交互装置和控制方法,有益效果如下:
33、1.本发明设计了一种人-机-环境交互装置,通过在机械臂末端分别设置第一力传感器和第二力传感器,分别感知人机交互力与环境接触力,减少两类作用力在同一传感器中的直接叠加,并降低两检测通道之间的耦合影响,由于是接触式交互,且力传感器检测波特率可达到460800,响应可达毫秒级,每秒可采集6维力/力矩达4000次,为机器人运动控制与末端执行器的接触力控制提供了可靠的反馈信息。
34、2.本发明提出了一种基于人机交互力的二维导纳控制方法,利用操作者施加的人机交互力引导机械臂在水平方向运动,使机械臂能够根据操作者的施力方向和变化产生相应的运动响应,实现自然、柔顺的人机交互,降低操作者直接控制末端执行器运动的负担。在六自由度机械臂实机试验中,分别记录水平方向上x、y两个方向的人机交互力及机械臂末端对应方向的速度变化。如图8所示,当操作者在x或y方向施加交互力时,机械臂末端在相应方向产生连续的速度响应;随着交互力方向和大小发生变化,末端运动方向及速度亦相应变化。试验结果表明,第一力传感器检测的人机交互力能够经二维导纳控制转化为机械臂末端的平面运动,实现操作者对机械臂运动方向和运动过程的实时引导。
35、3.本发明还提出导纳参数自适应调节策略,根据末端执行器质量和期望接触力的归一化结果调节虚拟质量参数,并根据人机交互力变化率调节虚拟阻尼参数,从而使机器人在不同末端负载和期望接触力条件下具有相应的导纳动态特性。图8所示实机试验主要用于验证二维导纳控制下操作者交互力与机械臂末端平面运动之间的响应关系,说明操作者能够通过x、y方向交互力引导机械臂产生相应方向的运动;图8不作为导纳参数自适应调节性能的单独验证依据。
36、4.本发明提出了一种基于接触扭矩的末端姿态自适应调整方法,在机器人与环境接触过程中,根据末端接触扭矩实时调节机器人姿态,使末端执行器始终保持与接触面近似垂直,有效减小了接触过程中产生的附加扭矩及侧向作用力,提高了机器人对复杂接触面的自适应能力及加工稳定性。
37、5.本发明建立了末端接触力控制方法,通过实时检测末端法向接触力并动态调整末端法向运动,实现机器人与环境之间的稳定接触力控制。在目标法向接触力为2 n的五组实机重复试验中,五组采用相同控制配置。为便于比较,图9(a)分别截取五组试验中相同长度的稳定接触时间区间进行绘制;平均接触力、平均绝对误差、均方根误差及最大接触力则根据五组完整稳定接触区间计算。完整数据累计时长为546.72 s,五组平均接触力为2.009±0.017 n,汇总平均绝对误差为0.216 n,均方根误差为0.292 n;全过程未发生接触丢失,最大接触力为3.640 n,低于本试验预设的12 n接触力保护阈值。上述结果表明,在操作者引导机械臂进行平面运动的过程中,末端法向力控制能够连续维持约2 n的接触力,结果如图9所示。
38、6.本发明将人机交互意图识别、自适应导纳控制、姿态调整及接触力控制有机结合,实现了机器人切向运动与法向恒力控制的解耦。操作者能够通过交互力直观引导机器人完成轨迹调整,而机器人能够自主完成姿态修正及法向接触力调节,提高了系统的人机协作能力、环境适应能力以及复杂接触作业的自主控制能力。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com