一种机器人碰撞检测装置及碰撞检测的方法制造方法及图纸

本发明专利技术公开了一种机器人碰撞检测装置及碰撞检测的方法，机器人碰撞检测装置由保护罩、旋转调整平台、微机电系统类型的加速度测量单元和锁紧螺钉组成；通过调整碰撞检测装置与机器人之间的连接部分和旋转调整平台可以实现微机电系统类型的加速度测量单元坐标系与机器人坐标系之间的标定；利用微机电系统类型的加速度测量单元和带阻滤波器可实现机器人末端加速度信息的测量；结合所获得的机器人末端加速度信息、机器人的运动学及其微分模型可实现机器人的碰撞检测。本发明专利技术的机器人碰撞检测装置及碰撞检测的方法能够在尽量降低系统成本的基础上有效提升机器人的碰撞检测能力。

A robot collision detection device and collision detection method

【技术实现步骤摘要】
一种机器人碰撞检测装置及碰撞检测的方法
本专利技术涉及一种机器人碰撞检测装置和碰撞检测的方法。
技术介绍
人机交互过程中机器人的安全性能至关重要，而机碰撞检测能力直接决定了机器人的安全性能。目前机器人碰撞检测普遍采用的方法可分为三种，即基于电流环的碰撞检测、基于关节力矩传感器的碰撞检测和基于电子皮肤的碰撞检测。基于电流环的碰撞检测是在对机器人动力学模型进行辨识的基础上结合电流环力矩反馈信息估计出机器人受到的外力，并判断机器人是否发生碰撞；基于关节力矩传感器的碰撞检测是直接根据关节力矩传感器的反馈信息估计出机器人所受到的外力，并判断机器人是否发生碰撞；基于电子皮肤的碰撞检测是根据机器人表面电子皮肤中的压力传感器检测信息估计出机器人是否受到外力，并判断机器人是否发生碰撞。然而，由于机器人的复杂动力学模型难以得到精确辨识，所以基于电流环的碰撞检测方法灵敏度不高且可靠性难以得到保障。此外，由于力矩传感器和电子皮肤价格昂贵，大批量的在机器人当中使用将会造成成本的急剧上升，因此基于关节力矩传感器的碰撞检测和基于电子皮肤的碰撞检测方法难以广泛应用。价格相对便宜的微机电系统类型的加速度测量单元可准确测量出系统的空间三维加速度信息，目前已经广泛运用在移动机器人的惯性导航当中，为移动机器人的部分运动感知功能提供了良好的解决方案。但其在工业、协作和医疗机器人等领域的碰撞检测功能中还未有成熟的运用，目前缺乏基于微机电系统类型的加速度测量单元的机器人碰撞检测装置，以及该装置在机器人系统中的快速标定方法，同时缺乏基于微机电系统类型的加速度测量单元的机器人系统振动特性识别方法以及完善的机器人碰撞检测方法。
技术实现思路
本专利技术的目的是为了克服现有技术中的不足，提出了一种机器人碰撞检测装置及碰撞检测方法。基于微机电系统类型的加速度测量单元设计相关装置以及检测方法，实现机器人的碰撞检测和避免功能。本专利技术机器人碰撞检测装置，由保护罩2、旋转调整平台3和微机电系统类型的加速度测量单元4组成。所述旋转调整平台3底部设有安装轴，所述保护罩设有腔室，腔室底部设轴孔，旋转调整平台3的安装轴套装于保护罩的轴孔中，旋转调整平台3与保护罩2同轴心安装。旋转调整平台3的轴肩端面与保护罩2的腔室底面贴合，旋转调整平台3固定于保护罩2腔室内。所述微机电系统类型的加速度测量单元4固装于旋转调整平台3上，其中心位于旋转调整平台3的轴线上。碰撞检测装置可通过螺纹与机器人的末端实现自由连接和拆卸。使用本专利技术装置进行机器人碰撞检测的方法，其步骤是：碰撞检测装置安装在机器人的末端。步骤1.碰撞检测装置与机器人之间的坐标标定由微机电系统类型的加速度测量单元获得自身坐标系O′-y′z′x′下所表示的机器人的末端加速度矢量a′I＝[a′Ix,a′Iy,a′Iz]T的测量值。首先，驱动机器人的末端运动使其轴线与机器人坐标系O-xyz中的z轴平行，并微调保护罩与机器人的连接部分使得a′Iz与-g(g＝9.81m/s2)之差小于设定值。其次，驱动机器人末端沿坐标系O-xyz的x轴方向往返运动，通过微调旋转调整平台使得a′Iy趋向于0。最后，当前述两个条件成立时，可认为微机电系统类型的加速度测量单元的坐标系O′-x′y′z′与机器人坐标系O-xyz对齐，实现了碰撞检测装置与机器人间的坐标系标定。步骤2结合机器人的振动特性和带阻滤波器，对碰撞检测装置微机电系统类型的加速度测量单元4测量数据滤波对机器人工作空间进行离散化，在每一个离散点处使用锤击等激振方式对机器人的末端进行激振，并对微机电系统类型的加速度测量单元所记录的加速度信号a′I进行快速傅里叶变换分析，获得该离散点处机器人的一阶固有频率f，进而获得整个工作空间中一阶固有频率f的分布情况，并确定其最大值fmax和最小值fmin，最终得到机器人一阶固有频率f的带宽范围[fmin,fmax]。使用带阻滤波器消除机器人的一阶固有振动特性对于微机电系统类型的加速度测量单元测量结果的影响。其中，带阻滤波器的阻带带宽范围与机器人的一阶固有频率f的带宽范围相同，通带带宽范围可根据实际系统是否存在其它干扰信号设定，通带最大衰减和阻带最小衰减可根据实际信号的幅值需求设置，最终获得滤波后的加速度信号a′If＝BandStopFilter(a′I)，其中BandStopFilter()表示带阻滤波器函数。步骤3机器人的碰撞检测结合机器人的Denavit–Hartenberg(DH)参数和各个关节位置θi(1<i<n,n为机器人自由度)，通过坐标系间的旋转变换，获得在机器人坐标系O-yzx下所表示的末端加速度矢量aIf＝[aIfx,aIfy,aIfz]T的测量值，即aIf＝Ra′If，其中R表示由微机电系统类型的加速度测量单元坐标系O′-y′z′x′到机器人坐标系O-yzx的旋转变换。结合运动学及其微分模型获得机器人的末端加速度其中θ＝[θ1,θ2,...,θn]T、和分别为机器人的关节位置、速度和加速度矢量，J(θ)为机器人的雅可比矩阵，为机器人的雅可比微分矩阵。根据实际灵敏度需求设定碰撞检测阈值ε，当|acx-aIfx|＞ε、|acy-aIfy|＞ε或|acz-aIfz|＞ε任一条件成立时，认为机器人与外界发生碰撞，此时机器人立即执行刹车指令。当|acx-aIfx|＞ε且|acy-aIfy|＞ε且|acz-aIfz|＞ε均成立时，认为机器人未与外界环境发生碰撞，此时机器人继续执行原有运动指令。本专利技术机器人碰撞检测装置及检测方法，较现有基于力矩传感器的碰撞检测方案和基于电子皮肤的碰撞检测方案极大地节约了成本，并克服了以往基于电流环的碰撞检测方案因所辨识动力学模型不准确所造成的碰撞检测功能灵敏度和可靠度不高的问题。本专利技术所采取的碰撞检测装置与机器人间的坐标标定方法，可快速准确的完成碰撞检装置在机器人系统中的初始标定工作。本专利技术结合机器人的振动特性和带阻滤波器，建立了碰撞检测装置的滤波方法，可有效降低机器人低阶固有振动特性对于碰撞检测装置测量信号的影响。附图说明图1是本专利技术机器人碰撞检测装置结构示意图结构示意图。图2是本专利技术机器人碰撞检测装置爆炸示意图。图3是本专利技术机器人碰撞检测装置在机器人当中的安装结构示意图。图4是本专利技术机器人碰撞检测方法的流程图。具体实施方式下面结合实施例和附图，对本专利技术方法作进一步详细说明。如图1和图2所示，所述碰撞检测装置1由保护罩2、旋转调整平台3、微机电系统类型的加速度测量单元4和锁紧螺钉5组成。所述旋转调整平台3底部设有安装轴，所述保护罩2设有腔室，腔室底部设轴孔，旋转调整平台3的安装轴套装于保护罩2的轴孔中，旋转调整平台3与保护罩2同轴心安装。旋转调整平台3的轴肩端面与保护罩2的腔室底面贴合，旋转调整平台3通过锁紧螺钉5固定于保护罩2腔室内。所述微机电系统类型的加速度测量单元4固装于旋转调整平台3上，其中心位于旋转调整平台3的轴线上本文档来自技高网...

【技术保护点】
1.一种机器人碰撞检测装置，由保护罩(2)、旋转调整平台(3)和加速度测量单元(4)组成；其特征是：所述旋转调整平台底部设有安装轴，所述保护罩设有腔室，腔室底部设轴孔，旋转调整平台的安装轴套装于保护罩的轴孔中，旋转调整平台与保护罩同轴心安装；旋转调整平台的轴肩端面与保护罩的腔室底面贴合，旋转调整平台固定于保护罩腔室内；所述加速度测量单元固装于旋转调整平台上，其中心位于旋转调整平台3的轴线上。/n

【技术特征摘要】
1.一种机器人碰撞检测装置，由保护罩(2)、旋转调整平台(3)和加速度测量单元(4)组成；其特征是：所述旋转调整平台底部设有安装轴，所述保护罩设有腔室，腔室底部设轴孔，旋转调整平台的安装轴套装于保护罩的轴孔中，旋转调整平台与保护罩同轴心安装；旋转调整平台的轴肩端面与保护罩的腔室底面贴合，旋转调整平台固定于保护罩腔室内；所述加速度测量单元固装于旋转调整平台上，其中心位于旋转调整平台3的轴线上。


2.一种使用权利要求1所述的机器人碰撞检测装置进行机器人碰撞检测的方法，其步骤是：
碰撞检测装置安装在机器人的末端；
步骤1.碰撞检测装置与机器人之间的坐标标定
由加速度测量单元获得自身坐标系O′-x′y′z′下所表示的机器人的末端加速度矢量a′I＝[a′Ix,a′Iy,a′Iz]T的测量值；
假设碰撞检测装置不存在安装误差，当机器人处于静止时，受到重力加速度的影响有a′Ix＝0,a′Iy＝0,a′Iz＝-g，其中g＝9.81m/s2；当上述条件存在较大误差时，首先微调保护罩与机器人的连接部分，使得a′Iz与-g之差小于设定值；其次，驱动机器人末端沿其自身坐标系O-xyz的x轴方向往返运动，通过微调旋转调整平台使得a′Iy趋向于0；最后，当前述两个条件成立时，则认为微机电系统类型的加速度测量单元的坐标系O′-x′y′z′与机器人坐标系O-xyz对齐，实现了碰撞检测装置与机器人间的坐标系标定；
步骤2结合机器人的振动特性和带阻滤波器，对碰撞检测装置的加速度测量单元测量数据滤波
对工作空间进行离散化，在每一个离散点对机器人的末端进行激振，并对加速度测量单元所记录的加速度信号a′I进行傅里叶变换分析，获得该离散点处机器人的一阶固有频率f，...

【专利技术属性】
技术研发人员：臧家炜，张圣，钱巍，
申请(专利权)人：南京埃斯顿自动化股份有限公司，
类型：发明
国别省市：江苏;32