机械手指及其判定方法
本发明属于机器人末端执行器,具体涉及一种机械手指及其判定方法。
背景技术:
1、在机器人技术领域,机械手作为机器人与外部环境进行物理交互的关键末端执行器,其性能直接影响机器人的操作能力和应用范围。欠驱动腱绳驱动自适应机械手是近年来受到较多关注的一类机械手方案,其代表性工作包括公开(公告)号us08973958b2的美国专利公开的机械手指包围和夹紧抓握。这类机械手的基本工作原理为:每根手指由多个首尾铰接的指节组成,一根腱绳依次穿过各指节上端的通孔,腱绳的近端固定于由电机驱动的绕线轮上,远端固定于最末端指节。电机旋转带动绕线轮收紧腱绳,腱绳的拉力使各指节从近端向远端依次向内转动,从而以包络的方式贴合于被抓握物体的表面,实现自适应抓握。
2、然而,上述现有技术在以下三个方面存在不足。
3、第一,在抓握力的维持方面,现有欠驱动自适应机械手的驱动轮与绕线轮之间通常为一体成型件或通过平键、花键等固定连接方式实现周向固定,绕线轮在手指外壳内部无轴向移动自由度。当全部指节均已贴合物体表面、腱绳无法继续收短时,绕线轮被腱绳拉住而堵转,此时若要保持抓握力,电机必须持续通电以输出保持力矩——如果电机断电,腱绳张力随即消失,各指节在指节间扭簧的弹力作用下向外张开,物体将被释放。换言之,现有技术依赖电机持续通电、控制器持续输出扭矩来维持抓握力。若要实现断电保持,则必须额外增加电磁制动器、蜗轮蜗杆自锁减速器等装置,或引入力传感器和位置传感器构建闭环力控系统。这些附加装置增加了机械手的体积、重量、成本和控制系统复杂度,且力传感器在长期使用中存在零点漂移和标定失效等问题。
4、第二,在指节长度的适应性方面,现有欠驱动自适应机械手的各指节相对于手指外壳根部的轴向位置是固定的,手指的总指长在工作过程中不可调节。当面对尺寸差异较大的被抓握物体时——例如从抓取直径数毫米的螺栓到抓取直径上百毫米的球体——手指的指长无法根据物体尺寸进行调整,只能依赖固定指节数量所产生的有限包络半径来适应不同尺寸的物体。对于尺寸超出包络半径范围的物体,要么需要更换整个末端执行器,要么需要依赖机械手指以外的其他手段如机械臂的位置调整来弥补,增加了系统集成的复杂性。
5、第三,在抓握时序的控制方面,现有欠驱动自适应机械手中不存在与腱绳配合的压板机构和力锁止机构,腱绳收紧的终止时刻由控制器的预设参数如预设转动圈数、预设电流阈值或预设时间决定,而非由指节实际贴合物体的物理状态决定。预设参数无法预知被抓握物体的实际尺寸、形状和刚度,导致抓握完成判定存在不确定性:预设值偏大时可能夹伤物体或使电机堵转过载,预设值偏小时指节尚未充分贴合物体即停机,抓握失败。此外,现有技术中也未设置指节闭合阻力与抓握压力建立之间的机械式梯度区分结构,腱绳收紧过程中指节闭合和抓握压力建立两个阶段在物理上没有明确的分界,这使得控制程序难以通过简单的电流或位置参数来区分这两个阶段。
技术实现思路
1、本发明的一个目的是解决以下问题:在腱绳驱动多指节自适应机械手指中,如何通过机构自身的力学状态变化来自动检测到全部指节已完成对被握物体的贴合这一抓握完成状态,并在检测到该状态的同一时刻机械式地自动锁定腱绳张力,使抓握力得以在电机断电后仍被保持。该问题的解决难点在于,需要将传动件设计为既能正常传递扭矩、又能在受阻时自动脱离并锁止的双功能构件。
2、为实现上述目的,本发明提供的一种机械手指,包括:壳体,其内部形成有容纳腔,容纳腔沿轴向依次具有第一腔段和第二腔段,第二腔段的内壁设有沿周向分布的多个齿状槽;绕线轮,可转动地置于容纳腔内,绕线轮具有朝向第一腔段的第一端面和朝向第二腔段的第二端面,第一端面开设有梯形凹槽,第二端面开设有弹簧座槽,绕线轮的周面设有腱绳固定部;复位弹簧,置于容纳腔的第二腔段内,复位弹簧的一端抵接于容纳腔的底面,另一端抵接于绕线轮的弹簧座槽;驱动轮,可转动地置于容纳腔的第一腔段内,驱动轮具有朝向绕线轮的驱动端面,驱动端面设有梯形凸起,梯形凸起的形状与梯形凹槽的形状互补,梯形凸起嵌入梯形凹槽中;电机,固定于壳体,电机的输出轴与驱动轮固定连接;压板组件,包括压板座、压板和压板扭簧,压板座固定于容纳腔的前端,压板通过转轴可转动地安装于压板座,压板扭簧套设于转轴,压板扭簧的一端抵接压板、另一端抵接压板座,压板具有远离转轴的自由端;腱绳,其一端固定于绕线轮的腱绳固定部,另一端自绕线轮引出后,经压板的自由端的上表面,从壳体的前端开口穿出;多个指节,按由近端至远端的顺序通过铰接轴首尾铰接,相邻指节之间的铰接轴上套设有指节扭簧,每个指节的上部开设有通孔,腱绳依次穿过各指节的通孔,腱绳的末端固定于最远端指节。
3、本发明提供的一种机械手指抓取终止时机的判定方法,机械手指为根据所述的机械手指,包括以下步骤:向电机通入正向驱动电流,使电机以正向旋转,正向旋转使腱绳收短;在电机正向旋转期间,以预设的采样间隔多次获取电机的工作电流值,得到电流采样序列;对于电流采样序列中采样时间相邻的一对前次采样值和后次采样值,计算后次采样值减去前次采样值所得的电流差值;当同时满足第一条件、第二条件和第三条件时,停止向电机通入驱动电流;第一条件为:电流差值小于预设的负差值阈值;第二条件为:后次采样值小于预设的低电流阈值;第三条件为:在获取后次采样值的时刻之前的预设回溯时长内,存在至少一个工作电流值大于预设的高电流阈值,高电流阈值大于低电流阈值。
4、优选地,当同时满足第一条件、第二条件和第三条件时,停止向电机通入驱动电流,包括:在第一条件、第二条件和第三条件首次同时满足的时刻,继续向电机通入正向驱动电流,并以预设的采样间隔继续获取后续的工作电流值;若自时刻起计的预设确认采样次数内所获取的全部工作电流值均小于低电流阈值,则在获取预设确认采样次数个后续工作电流值之后,停止向电机通入驱动电流;若在获取预设确认采样次数个后续工作电流值之前的任一采样时刻,所获取的工作电流值大于或等于低电流阈值,则放弃本次第一条件、第二条件和第三条件的满足,返回多次获取电机的工作电流值的步骤。
5、优选地,电流差值按照以下方式获得:在电流采样序列中,以后次采样值为终点取连续l个采样值作为后段序列,计算后段序列中l个采样值的算术平均值,得到后段均值,l为大于等于2的整数;在电流采样序列中,以前次采样值为终点取连续l个采样值作为前段序列,计算前段序列中l个采样值的算术平均值,得到前段均值;以后段均值减去前段均值所得的差值作为电流差值。
6、优选地,预设的高电流阈值按照以下方式确定:在向电机通入正向驱动电流之后的一个预设初始采样时段内,以预设的采样间隔连续获取m个初始工作电流值,m为大于等于2的整数;计算m个初始工作电流值的算术平均值,得到空载电流均值;以空载电流均值与预设偏移值之和作为高电流阈值。
7、本发明提供的一种机械手指释放终止时机的判定方法,机械手指为根据所述的机械手指,包括以下步骤:向电机通入反向驱动电流,使电机以反向旋转;在电机反向旋转期间,以预设的采样间隔多次获取电机的工作电流值,得到反向电流采样序列;对于反向电流采样序列中采样时间相邻的一对前次反向采样值和后次反向采样值,计算后次反向采样值减去前次反向采样值所得的反向电流差值;当反向电流差值大于预设的正差值阈值时,记录该后次反向采样值的采样时刻为再嵌合时刻;在再嵌合时刻之后,继续向电机通入反向驱动电流,并继续以预设的采样间隔获取后续的工作电流值;当后续的工作电流值小于预设的释放电流阈值时,停止向电机通入驱动电流。
8、优选地,记录该后次反向采样值的采样时刻为再嵌合时刻,包括:在反向电流差值大于正差值阈值的时刻,继续向电机通入反向驱动电流,并以预设的采样间隔继续获取后续的反向工作电流值;若自时刻起计的预设再嵌合确认采样次数内所获取的全部反向工作电流值均大于预设的再嵌合持续电流阈值,则以时刻作为再嵌合时刻;若在获取预设再嵌合确认采样次数个反向工作电流值之前的任一采样时刻,所获取的反向工作电流值小于或等于再嵌合持续电流阈值,则放弃本次反向电流差值大于正差值阈值的满足,返回多次获取电机的工作电流值的步骤。
9、优选地,当后续的工作电流值小于预设的释放电流阈值时,停止向电机通入驱动电流,包括:在后续的工作电流值首次小于释放电流阈值的时刻,继续向电机通入反向驱动电流,并以预设的采样间隔继续获取再后续的工作电流值;若自时刻起计的预设释放确认采样次数内所获取的全部工作电流值均小于释放电流阈值,则在获取预设释放确认采样次数个再后续工作电流值之后,停止向电机通入驱动电流;若在获取预设释放确认采样次数个再后续工作电流值之前的任一采样时刻,所获取的工作电流值大于或等于释放电流阈值,则放弃本次后续的工作电流值小于释放电流阈值的满足,返回继续以预设的采样间隔获取后续的工作电流值的步骤。
10、优选地,自向电机通入反向驱动电流的时刻起,记录电机反向旋转的累计持续时间;
11、若在累计持续时间达到预设的最大盲寻时长之前,反向电流差值大于正差值阈值的条件未被满足,则在累计持续时间达到预设的最大盲寻时长之时,停止向电机通入驱动电流,并输出再嵌合失败信号;其中,所述预设的最大盲寻时长大于驱动轮完成一整圈旋转所需的时间。
12、本发明至少具有以下有益效果:
13、1、在抓握力维持方面,通过驱动轮与绕线轮之间的梯形斜面可分离配合、复位弹簧的轴向弹性支撑以及壳体内壁齿状槽的周向约束三者的协同,当全部指节贴合物体后,绕线轮因受阻而产生轴向移动并落入齿状槽中被周向锁定,驱动轮同时脱离,腱绳张力由齿状槽的机械约束维持,电机可以断电,抓握力不因断电而丢失。这一效果的技术根源在于:梯形斜面的存在使得周向阻力能够被分解出轴向推力分量,将绕线轮无法继续转动这一力学边界条件转化为绕线轮轴向移动并落入齿状槽的运动序列,从而在传动件内部实现了从扭矩传递到分离锁定的一次状态切换。与常规依靠电机保持力矩或外置制动器维持抓握力的方案相比,本方案在锁定后不消耗电能来维持抓握力。
14、2、在抓握完成判定的自主性方面,无论是机械层面的梯形分离锁定动作,还是控制方法层面的电流脱载检测,其触发判据均来源于机构自身的物理状态——全部指节贴合——而非预设的位置值、时间值或电流绝对值。这意味着对于不同尺寸的物体,锁定自动在指节实际贴合物体的那一刻发生,抓握判定时刻与物体尺寸自动匹配,不需要针对不同物体设置不同的控制参数。
15、3、在指节长度可调与自适应包络的兼容性方面,通过指外壳内部的滑轨作为指节单元和自适应机构壳体的公共运动基准、以及壳体前端与最近指节的嵌合连接,实现了自适应机构跟随指节单元沿滑轨同步移动。腱绳从壳体前端穿出后依次穿过各工作指节上端通孔的路径在任意指节伸出量下均保持整体平移,腱绳对各指节的相对约束关系不因伸出量的变化而改变,从而使得同一套自适应包络抓取机构能够在不同指节数量配置下一致地工作。
16、4、在无传感器条件下的控制可靠性方面,电流采样的分段均值差值算法利用了对连续多个采样点取平均来抑制pwm纹波的原理,在不增加硬件滤波电路的情况下提升了差值计算的信噪比。动态高电流阈值通过在每个抓取周期初始的自由旋转期内采集空载电流均值并以此为基准加偏移值来确定高电流阈值,使得阈值自动跟随供电电压、电机温度和个体差异的变化,同一控制程序无需修改参数即可在不同工况下工作。三组确认窗口分别针对抓取脱载过渡期的回弹振荡、释放盲寻阶段的微接触脉冲、以及释放末期的阶梯卸力波动这三种不同的瞬态干扰现象,利用在确认窗口时长内条件持续满足代替单次条件满足作为决策依据,降低了因采样时刻与干扰尖峰偶然对齐导致的误判概率。盲寻超时保护利用一整圈旋转时间这一机构固有几何量作为判定基准,区分尚未对齐与不可能对齐两种状态,在不增加传感器的前提下为控制系统提供了故障检测能力。
17、本发明的其它优点、目标和特征将部分通过下面的说明体现,部分还将通过对本发明的研究和实践而为本领域的技术人员所理解。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com