基于螺旋空间夹角的串联和并联机器人机构的奇异裕度检测方法.pdf

摘要
申请专利号：	CN201310000492.X	申请日：	2013.01.04
公开号：	CN103077310A	公开日：	2013.05.01
当前法律状态：	授权	有效性：	有权
法律详情：	授权\|\|\|实质审查的生效IPC(主分类):G06F 19/00申请日:20130104\|\|\|公开
IPC分类号：	G06F19/00	主分类号：	G06F19/00
申请人：	同济大学
发明人：	卜王辉; 陈茂林; 李梦如
地址：	200092 上海市杨浦区四平路1239号
优先权：
专利代理机构：	上海正旦专利代理有限公司 31200	代理人：	张磊
PDF下载：	PDF下载

内容摘要

本发明涉及一种基于螺旋空间夹角的串联或并联机器人机构的奇异裕度检测方法。本发明方法在建立机器人螺旋坐标系并计算关节运动螺旋或支链约束力螺旋的基础上，计算扩展螺旋矩阵的行列式，进而表达出螺旋空间的夹角。若发现机器人在运动过程中螺旋空间夹角接近九十度，则认为机器人的奇异裕度很小；若螺旋空间夹角接近零度，则认为机器人的奇异裕度很大。这种方法的特点是，不需要借助优化算法，因而方法的计算效率高；以螺旋空间夹角作为奇异裕度指标，具有几何意义；不仅适用于串联机器人或串联支链的运动奇异裕度检测，也适用于并联机器人的静力奇异裕度检测。

权利要求书

权利要求书一种基于螺旋空间夹角的串联或并联机器人机构的奇异裕度检测方法，其特征在于具体步骤如下：
建立机器人的螺旋坐标系，判断所述机器人的类型，机器人的类型为串联机器人或并联机器人；
对于串联机器人或并联机器人的一条串联支链检测步骤如下：
(1)将螺旋坐标系的原点建立在机器人的末端执行器上，坐标系的姿态可以任意选择；
(2)计算关节运动螺旋，并组成螺旋矩阵：对于串联机器人或并联机器人的一条支链，计算串联机器人或并联机器人的一条支链的转动副运动链中各关节的运动螺旋ti，其中i = 1, 2, ..., N，N是运动螺旋的数目，将这一组运动螺旋组成一个运动螺旋矩阵Mt = {t1, t2, ...tN}；
(3) 计算N阶扩展螺旋矩阵的行列式Dt：
Dt = det ( MtT Mt ) (式1)
其中，Dt表示N阶扩展螺旋矩阵的行列式，det表示矩阵的行列式运算，T表示对矩阵的转置运算；
(4) 计算N‑1阶扩展螺旋矩阵的行列式Vti：
Vti = det ( MtiT Mti )   (式3)
其中，Vti表示N‑1阶扩展螺旋矩阵的行列式，Mti表示在螺旋矩阵Mt中去除第i条螺旋之后所获得的新矩阵；由于i = 1, 2, ..., N，因此存在N个不同的Vti；
(5) 计算螺旋空间的夹角：对于运动螺旋，运动螺旋ti与螺旋系中其余N‑1条运动螺旋构成的螺旋空间法向的夹角αi为：
(式5)
其中，||ti||表示对螺旋ti的取模运算；将N个αi中的最大值记为α；
(6) 计算机器人的奇异裕度：对于串联机器人或并联机器人的一条支链，运动奇异裕度At = 90°‑α；当螺旋空间夹角α= 90°时，表明机器人处于运动奇异状态；当螺旋空间夹角α= 0°时，表明机器人远离运动奇异状态；
对于并联机器人检测步骤如下：
(1)对于并联机器人，将螺旋坐标系的原点建立在动平台上，坐标系的姿态可以任意选择；
(2)计算关节支链约束力螺旋，并组成螺旋矩阵：对于并联机器人，计算各支链的约束力螺旋wi，其中i = 1, 2, ..., N，N是约束力螺旋的数目，将这一组约束力螺旋组成一个力螺旋矩阵Mw = {w1, w2, ...wN}；
(3) 计算N阶扩展螺旋矩阵的行列式Dw：
Dw = det ( MwT Mw ) (式2)
其中，Dw表示N阶扩展螺旋矩阵的行列式，det表示方阵的行列式运算，T表示对矩阵的转置运算；
(4) 计算N‑1阶扩展螺旋矩阵的行列式Vwi：
Vwi = det ( MwiT Mwi )   (式4)
其中，Vwi表示N‑1阶扩展螺旋矩阵的行列式，Mwi表示在螺旋矩阵Mw中去除第i条螺旋之后所获得的新矩阵；由于i = 1, 2, ..., N，因此存在N个不同的Vwi；
(5) 计算螺旋空间的夹角：对于力螺旋，螺旋wi与螺旋系中其余N‑1条力螺旋构成的螺旋空间法向的夹角βi为：
  (式6)
其中，||wi||表示对螺旋wi的取模运算；将N个βi中的最大值记为β；
(6) 计算机器人的奇异裕度：对于并联机器人，静力奇异裕度Aw = 90°‑β；当螺旋空间夹角β= 90°时，表明机器人处于静力奇异状态；当螺旋空间夹角β= 0°时，表明机器人远离静力奇异状态。

说明书

说明书基于螺旋空间夹角的串联和并联机器人机构的奇异裕度检测方法
技术领域
本发明涉及一种基于螺旋空间夹角的串联或并联机器人机构的奇异裕度检测方法。
背景技术
奇异构型对串联和并联机器人的运动学和动力学的影响很大，可以分为运动奇异和静力奇异两大类。若机器人机构进入运动奇异位形，将无法通过指定末端执行器或动平台的速度来求取串联支链各关节速度；若并联机器人进入静力奇异位形，支链将无法对动平台提供必要的约束力。处于奇异状态的串联或并联机器人将不可控，甚至会损坏机器人的结构。奇异裕度表征了机器人当前位形到奇异位形的余量。因此，检测奇异裕度是机器人机构设计和运动控制的重要技术问题。
判断机器人是否处于奇异位形，可以采用机器人雅可比矩阵的最小奇异值、条件数或行列式是否等于0来判断。但雅可比矩阵的最小奇异值、条件数或行列式却不合适用来检测机器人的奇异裕度，因为它们缺乏必要的物理或几何意义，并且不是坐标不变量。因此，人们采用了一些其它方法来检测机器人的奇异裕度，例如，Voglewede和Ebert‑Uphoff 于2005年在《IEEE Transactions on Robotics》（21(6)：第1037‑1045页）的论文“Overarching framework for measuring closeness to singularities of parallel manipulators”中提出在速度域和力域中采用约束优化方法中的特征值算法来检测机器人的奇异裕度，并将奇异裕度表征为功率、刚度、动能、自然频率等具有物理意义的指标。Hubert和Merlet于2009年在《ASME Journal of Mechanisms and Robotics》（1(1)：第1‑6页）的论文“Static of parallel manipulators and closeness to singularity”中提出了计算力空间边界的算法，通过设置关节最大驱动力的阈值来检测并联机器人的奇异裕度。Liu于2012年在《ASME Journal of Mechanisms and Robotics》（4(4)：第1‑10页）的论文“A new approach for singularity analysis and closeness measurement to singularities of parallel manipulators”中通过支链传动力螺旋与关节运动螺旋或动平台运动螺旋之间的互易积来度量并联机器人的奇异裕度。这些方法往往需要借助于计算量很大的优化算法，有些方法中提出的奇异裕度指标缺乏必要的几何或物理意义，且不具备坐标不变性。
发明内容
本发明的目的在于提供一种基于螺旋空间夹角的串联或并联机器人机构的奇异裕度检测方法。这种方法不需要借助于优化算法，因此计算量较小，且具有几何意义。
本发明提出的基于螺旋空间夹角的串联或并联机器人机构的奇异裕度检测方法，具体步骤如下：
建立机器人的螺旋坐标系，判断所述机器人的类型，机器人的类型为串联机器人或并联机器人；
对于串联机器人或并联机器人的一条支链检测步骤如下：
(1)将螺旋坐标系的原点建立在机器人的末端执行器上，坐标系的姿态可以任意选择；
(2)计算关节运动螺旋，并组成螺旋矩阵：对于串联机器人或并联机器人的一条支链，计算串联机器人或并联机器人的一条串联支链的运动链中各关节的运动螺旋ti，其中i = 1, 2, ..., N，N是运动螺旋的数目，将这一组运动螺旋组成一个运动螺旋矩阵Mt = {t1, t2, ...tN}；
(3) 计算N阶扩展螺旋矩阵的行列式Dt：
Dt = det ( MtT Mt )    (式1)
其中，Dt表示N阶扩展螺旋矩阵的行列式，det表示矩阵的行列式运算，T表示对矩阵的转置运算；
(4) 计算N‑1阶扩展螺旋矩阵的行列式Vti：
Vti = det ( MtiT Mti )  (式3)
其中，Vti表示N‑1阶扩展螺旋矩阵的行列式，Mti表示在螺旋矩阵Mt中去除第i条螺旋之后所获得的新矩阵；由于i = 1, 2, ..., N，因此存在N个不同的Vti；
(5) 计算螺旋空间的夹角：对于运动螺旋，运动螺旋ti与螺旋系中其余N‑1条运动螺旋构成的螺旋空间法向的夹角αi为：
     (式5)
其中，||ti||表示对螺旋ti的取模运算；将N个αi中的最大值记为α；
(6) 计算机器人的奇异裕度：对于串联机器人或并联机器人的一条支链，运动奇异裕度At = 90°‑α；当螺旋空间夹角α= 90°时，表明机器人处于运动奇异状态；当螺旋空间夹角α= 0°时，表明机器人远离运动奇异状态；
对于并联机器人检测步骤如下：
(1)对于并联机器人，将螺旋坐标系的原点建立在动平台上，坐标系的姿态可以任意选择；
(2)计算关节支链约束力螺旋，并组成螺旋矩阵：对于并联机器人，计算各支链的约束力螺旋wi，其中i = 1, 2, ..., N，N是约束力螺旋的数目，将这一组约束力螺旋组成一个力螺旋矩阵Mw = {w1, w2, ...wN}；
(3) 计算N阶扩展螺旋矩阵的行列式Dw：
Dw = det ( MwT Mw ) (式2)
其中，Dw表示N阶扩展螺旋矩阵的行列式，det表示方阵的行列式运算，T表示对矩阵的转置运算；
(4) 计算N‑1阶扩展螺旋矩阵的行列式Vwi：
Vwi = det ( MwiT Mwi )    (式4)
其中，Vwi表示N‑1阶扩展螺旋矩阵的行列式，Mwi表示在螺旋矩阵Mw中去除第i条螺旋之后所获得的新矩阵；由于i = 1, 2, ..., N，因此存在N个不同的Vwi；
(5) 计算螺旋空间的夹角：对于力螺旋，螺旋wi与螺旋系中其余N‑1条力螺旋构成的螺旋空间法向的夹角βi为：
  (式6)
其中，||wi||表示对螺旋wi的取模运算；将N个βi中的最大值记为β；
(6) 计算机器人的奇异裕度：对于并联机器人，静力奇异裕度Aw = 90°‑β；当螺旋空间夹角β= 90°时，表明机器人处于静力奇异状态；当螺旋空间夹角β= 0°时，表明机器人远离静力奇异状态。
本发明可以根据步骤(3)与步骤(4)分别计算N阶和N‑1阶扩展运动螺旋矩阵或N阶和N‑1阶扩展力螺旋矩阵的行列式。
本发明可以根据步骤(5)计算螺旋空间的夹角，以此衡量机器人的奇异裕度。
本发明具有的有益效果是：
(1) 提出的机器人奇异裕度检测方法不需要借助优化算法，提高了奇异裕度的计算效率；
(2) 这种方法以螺旋空间的夹角作为奇异裕度的评价指标，具有几何意义；
(3) 能够用于检测串联机器人或并联机器人支链的运动奇异裕度；
(4) 能够用于检测并联机器人的静力奇异裕度。
附图说明
图1是含机器人奇异裕度检测的流程图。
图2是3R平面机器人机构示意图。
图3是3‑UPU并联机器人示意图。
图中：1、基座，2、1号转动副，3、1号连杆，4、2号转动副，5、2号连杆，6、3号转动副，7、3号连杆，8、末端执行器，9、螺旋坐标系，10、动平台，11、万向副，12、移动副。
具体实施方式
下面通过实施例结合附图进一步说明本发明。
实施例1：下面结合3R平面机器人对本发明作进一步说明。机器人奇异裕度检测的流程图见图1所示，包括以下关键步骤：
(1) 建立机器人的螺旋坐标系；
(2) 计算关节运动螺旋，并组成螺旋矩阵；
(3) 计算N阶扩展螺旋矩阵的行列式；
(4) 计算N‑1阶扩展螺旋矩阵的行列式；
(5) 计算螺旋空间的夹角；
(6) 计算机器人的奇异裕度。
以图2所示的3R平面机器人机构为例。3R平面机器人有3个转动副，设3根连杆的长度均为0.5m，设1号连杆与水平线的夹角为45°，2号连杆与水平线的夹角为0°，3号连杆与水平线的夹角为90°。
(1) 建立3R平面机器人的螺旋坐标系。如图2所示，在机器人末端执行器8处建立螺旋坐标系9，螺旋坐标系9原点位于末端执行器8中心，螺旋坐标系的x轴水平向右，螺旋坐标系的y轴竖直向上。
(2) 计算3个关节的运动螺旋，并组成螺旋矩阵。经计算，1号转动副2的运动螺旋为t1 = (0, 0, 1, ‑0.853553, 0.853553, 0)T，t2 = (0, 0, 1, ‑0.5, 0.5, 0)T，t3 = (0, 0, 1, 0, ‑0.5, 0)T。运动螺旋矩阵为Mt = {t1, t2, t3}。
(3) 计算3阶扩展螺旋矩阵的行列式。根据(式1)，3阶扩展螺旋矩阵的行列式Dt = det ( MtT Mt ) = 0.03125。
(4) 计算2阶扩展螺旋矩阵的行列式。由于3阶螺旋系中共有3个2阶螺旋系，因此根据(式3)分别计算3个2阶扩展螺旋矩阵的行列式Vt1 = det ( Mt1T Mt1 ) = 1.3125，Vt2 = det ( Mt2T Mt2 ) = 2.7428，Vt3 = det ( Mt3T Mt3 ) = 0.25。
(5) 计算螺旋空间的夹角。由于存在3个2阶螺旋系，因此根据(式5)分别计算螺旋空间的3个夹角：
，
，
，
因此，α = 85.0002°。
(6) 计算机器人的奇异裕度。3R平面机器人处于图2构型时的运动奇异裕度At = 90°‑α = 4.9998°。
实施例2：下面结合3‑UPU并联机器人对本发明作进一步说明。机器人奇异裕度检测的流程图见图1所示，包括以下关键步骤：
(1) 建立机器人的螺旋坐标系；
(2) 计算关节运动螺旋，并组成螺旋矩阵；
(3) 计算N阶扩展螺旋矩阵的行列式；
(4) 计算N‑1阶扩展螺旋矩阵的行列式；
(5) 计算螺旋空间的夹角；
(6) 计算机器人的奇异裕度。
以图2所示的3‑UPU并联机器人机构为例。3‑UPU并联机器人动平台10和基座之间通过3条支链相连，每条支链由2个万向副11和1个移动副12构成，其中移动副是驱动关节。基座上的3个万向副呈等边三角形布置，三角形边长为0.5m，基础坐标系原点O处于三角形中心。动平台上的3个万向副也呈等边三角形布置，三角形边长为0.2m，动平台工具坐标系原点P处于三角形中心。动平台中心P点在(0, 0.1m, 1m)位置。
(1) 建立3‑UPU并联机器人的螺旋坐标系。如图3所示，在3‑UPU并联机器人动平台10处建立螺旋坐标系9，螺旋坐标系9原点为位于动平台10中心。
(2) 计算3条支链的约束力螺旋，并组成力螺旋矩阵。经计算，3条支链对动平台共有6个约束力螺旋，分别为w1={0, 0, 0, 0.0433, 0.025, 1}，w2={‑3.75, 10.825, 43.301, ‑17.321, ‑10, 1}，w3= {0, 0, 0, ‑0.0433, 0.025, 1}，w4={‑3.75, ‑2.165, 43.301, 17.321, ‑10, 1}，w5= {0, 0, 0, 0, 0.1, 1}，w6={‑3.75, ‑2.165, ‑21.651, 0, ‑10, 1}。力螺旋矩阵为Mw={ w1, w2, w3, w4, w5, w6}。
(3) 计算6阶扩展螺旋矩阵的行列式。根据(式2)，6阶扩展螺旋矩阵的行列式Dw= det (MwT Mw ) = 422.351。
(4) 计算5阶扩展螺旋矩阵的行列式。由于6阶螺旋系中共有6个5阶螺旋系，因此根据(式4)分别计算6个5阶扩展螺旋矩阵的行列式Vw1= det (Mw1T Mw1 ) = 3.337，Vw2= det (Mw2T Mw2 ) = 3.437，Vw3= det (Mw3T Mw3 ) = 13.449，Vw4= det (Mw4T Mw4 ) = 615895，Vw5= det (Mw5T Mw5 ) = 615895，Vw6= det (Mw6T Mw6 ) = 611740。
(5) 计算螺旋空间的夹角。由于存在6个5阶螺旋系，因此根据(式6)分别计算螺旋空间的6个夹角：

因此，β = 88.5018°。
(6) 计算机器人的奇异裕度。3‑UPU并联机器人处于图3构型时的静力奇异裕度Aw= 90°‑β= 1.4982°。

资源描述

《基于螺旋空间夹角的串联和并联机器人机构的奇异裕度检测方法.pdf》由会员分享，可在线阅读，更多相关《基于螺旋空间夹角的串联和并联机器人机构的奇异裕度检测方法.pdf（10页珍藏版）》请在专利查询网上搜索。

1、(10)申请公布号 CN 103077310 A (43)申请公布日 2013.05.01 CN 103077310 A *CN103077310A* (21)申请号 201310000492.X (22)申请日 2013.01.04 G06F 19/00(2006.01) (71)申请人同济大学地址 200092 上海市杨浦区四平路 1239 号 (72)发明人卜王辉陈茂林李梦如 (74)专利代理机构上海正旦专利代理有限公司 31200 代理人张磊 (54) 发明名称基于螺旋空间夹角的串联和并联机器人机构的奇异裕度检测方法 (57) 摘要本发明涉及一种基于螺旋空间夹角的串。

2、联或并联机器人机构的奇异裕度检测方法。本发明方法在建立机器人螺旋坐标系并计算关节运动螺旋或支链约束力螺旋的基础上，计算扩展螺旋矩阵的行列式，进而表达出螺旋空间的夹角。若发现机器人在运动过程中螺旋空间夹角接近九十度，则认为机器人的奇异裕度很小；若螺旋空间夹角接近零度，则认为机器人的奇异裕度很大。这种方法的特点是，不需要借助优化算法，因而方法的计算效率高；以螺旋空间夹角作为奇异裕度指标，具有几何意义；不仅适用于串联机器人或串联支链的运动奇异裕度检测，也适用于并联机器人的静力奇异裕度检测。 (51)Int.Cl. 权利要求书 2 页说明书 5。

3、页附图 2 页 (19)中华人民共和国国家知识产权局 (12)发明专利申请权利要求书2页说明书5页附图2页 (10)申请公布号 CN 103077310 A CN 103077310 A *CN103077310A* 1/2 页 2 1. 一种基于螺旋空间夹角的串联或并联机器人机构的奇异裕度检测方法，其特征在于具体步骤如下：建立机器人的螺旋坐标系，判断所述机器人的类型，机器人的类型为串联机器人或并联机器人；对于串联机器人或并联机器人的一条串联支链检测步骤如下： (1) 将螺旋坐标系的原点建立在机器人的末端执行器上，坐标系的姿态可以任意选择； (2) 计算关节。

4、运动螺旋，并组成螺旋矩阵：对于串联机器人或并联机器人的一条支链，计算串联机器人或并联机器人的一条支链的转动副运动链中各关节的运动螺旋 ti，其中 i = 1, 2, ., N， N是运动螺旋的数目，将这一组运动螺旋组成一个运动螺旋矩阵Mt = t1, t2, .tN ； (3) 计算 N 阶扩展螺旋矩阵的行列式 Dt： Dt = det ( MtT Mt ) ( 式 1) 其中， Dt表示 N 阶扩展螺旋矩阵的行列式， det 表示矩阵的行列式运算， T 表示对矩阵的转置运算； (4) 计算 N-1 阶扩展螺旋矩阵的行列式 Vti： Vti = det ( MtiT Mti )。

5、 ( 式 3) 其中， Vti表示 N-1 阶扩展螺旋矩阵的行列式， Mti表示在螺旋矩阵 Mt中去除第 i 条螺旋之后所获得的新矩阵；由于 i = 1, 2, ., N，因此存在 N 个不同的 Vti； (5) 计算螺旋空间的夹角：对于运动螺旋，运动螺旋 ti与螺旋系中其余 N-1 条运动螺旋构成的螺旋空间法向的夹角 i为： ( 式 5) 其中， |ti| 表示对螺旋 ti的取模运算；将 N 个 i中的最大值记为； (6) 计算机器人的奇异裕度：对于串联机器人或并联机器人的一条支链，运动奇异裕度At = 90- ；当螺旋空间夹角= 90时，表明机器人处于运。

6、动奇异状态；当螺旋空间夹角 = 0时，表明机器人远离运动奇异状态；对于并联机器人检测步骤如下： (1) 对于并联机器人，将螺旋坐标系的原点建立在动平台上，坐标系的姿态可以任意选择； (2) 计算关节支链约束力螺旋，并组成螺旋矩阵：对于并联机器人，计算各支链的约束力螺旋 wi，其中 i = 1, 2, ., N， N 是约束力螺旋的数目，将这一组约束力螺旋组成一个力螺旋矩阵 Mw = w1, w2, .wN ； (3) 计算 N 阶扩展螺旋矩阵的行列式 Dw： Dw = det ( MwT Mw ) ( 式 2) 其中， Dw表示 N 阶扩展螺旋矩阵的行列式。

7、， det 表示方阵的行列式运算， T 表示对矩阵的转置运算； (4) 计算 N-1 阶扩展螺旋矩阵的行列式 Vwi：权利要求书 CN 103077310 A 2 2/2 页 3 Vwi = det ( MwiT Mwi ) ( 式 4) 其中， Vwi表示 N-1 阶扩展螺旋矩阵的行列式， Mwi表示在螺旋矩阵 Mw中去除第 i 条螺旋之后所获得的新矩阵；由于 i = 1, 2, ., N，因此存在 N 个不同的 Vwi； (5) 计算螺旋空间的夹角：对于力螺旋，螺旋 wi与螺旋系中其余 N-1 条力螺旋构成的螺旋空间法向的夹角 i为： ( 式 6) 其中，。

8、|wi| 表示对螺旋 wi的取模运算；将 N 个 i中的最大值记为； (6) 计算机器人的奇异裕度：对于并联机器人，静力奇异裕度Aw = 90- ；当螺旋空间夹角 = 90时，表明机器人处于静力奇异状态；当螺旋空间夹角 = 0时，表明机器人远离静力奇异状态。权利要求书 CN 103077310 A 3 1/5 页 4 基于螺旋空间夹角的串联和并联机器人机构的奇异裕度检测方法技术领域 0001 本发明涉及一种基于螺旋空间夹角的串联或并联机器人机构的奇异裕度检测方法。背景技术 0002 奇异构型对串联和并联机器人的运动学和动力学的影响很大，可以分为运动。

9、奇异和静力奇异两大类。若机器人机构进入运动奇异位形，将无法通过指定末端执行器或动平台的速度来求取串联支链各关节速度；若并联机器人进入静力奇异位形，支链将无法对动平台提供必要的约束力。处于奇异状态的串联或并联机器人将不可控，甚至会损坏机器人的结构。奇异裕度表征了机器人当前位形到奇异位形的余量。因此，检测奇异裕度是机器人机构设计和运动控制的重要技术问题。 0003 判断机器人是否处于奇异位形，可以采用机器人雅可比矩阵的最小奇异值、条件数或行列式是否等于 0 来判断。但雅可比矩阵的最小奇异值、条件数或行列式却不合适用来检测机器人的奇异裕度，因为它们缺乏必要的物理或几。

10、何意义，并且不是坐标不变量。因此，人们采用了一些其它方法来检测机器人的奇异裕度，例如， Voglewede 和 Ebert-Uphoff 于 2005 年在 IEEE Transactions on Robotics （21(6) ：第 1037-1045 页）的论文 “Overarching framework for measuring closeness to singularities of parallel manipulators” 中提出在速度域和力域中采用约束优化方法中的特征值算法来检测机器人的奇异裕度，并将奇异裕度表征为功率、刚度、动能、自然频率等。

11、具有物理意义的指标。 Hubert 和 Merlet 于 2009 年在 ASME Journal of Mechanisms and Robotics （1(1) ：第 1-6 页）的论文 “Static of parallel manipulators and closeness to singularity” 中提出了计算力空间边界的算法，通过设置关节最大驱动力的阈值来检测并联机器人的奇异裕度。Liu 于 2012 年在 ASME Journal of Mechanisms and Robotics （4(4) ：第 1-10 页）的论文 “A new approach f。

12、or singularity analysis and closeness measurement to singularities of parallel manipulators” 中通过支链传动力螺旋与关节运动螺旋或动平台运动螺旋之间的互易积来度量并联机器人的奇异裕度。这些方法往往需要借助于计算量很大的优化算法，有些方法中提出的奇异裕度指标缺乏必要的几何或物理意义，且不具备坐标不变性。发明内容 0004 本发明的目的在于提供一种基于螺旋空间夹角的串联或并联机器人机构的奇异裕度检测方法。这种方法不需要借助于优化算法，因此计算量较小，且具有几何意义。 0005 本发明提出。

13、的基于螺旋空间夹角的串联或并联机器人机构的奇异裕度检测方法，具体步骤如下：建立机器人的螺旋坐标系，判断所述机器人的类型，机器人的类型为串联机器人或并说明书 CN 103077310 A 4 2/5 页 5 联机器人；对于串联机器人或并联机器人的一条支链检测步骤如下： (1) 将螺旋坐标系的原点建立在机器人的末端执行器上，坐标系的姿态可以任意选择； (2) 计算关节运动螺旋，并组成螺旋矩阵：对于串联机器人或并联机器人的一条支链，计算串联机器人或并联机器人的一条串联支链的运动链中各关节的运动螺旋 ti，其中 i = 1, 2, ., N， N 是运动螺旋的数目。

14、，将这一组运动螺旋组成一个运动螺旋矩阵 Mt = t1, t2, .tN ； (3) 计算 N 阶扩展螺旋矩阵的行列式 Dt： Dt = det ( MtT Mt ) ( 式 1) 其中， Dt表示 N 阶扩展螺旋矩阵的行列式， det 表示矩阵的行列式运算， T 表示对矩阵的转置运算； (4) 计算 N-1 阶扩展螺旋矩阵的行列式 Vti： Vti = det ( MtiT Mti ) ( 式 3) 其中， Vti表示 N-1 阶扩展螺旋矩阵的行列式， Mti表示在螺旋矩阵 Mt中去除第 i 条螺旋之后所获得的新矩阵；由于 i = 1, 2, ., N，因此存在 N 个不同的。

15、Vti； (5) 计算螺旋空间的夹角：对于运动螺旋，运动螺旋 ti与螺旋系中其余 N-1 条运动螺旋构成的螺旋空间法向的夹角 i为： ( 式 5) 其中， |ti| 表示对螺旋 ti的取模运算；将 N 个 i中的最大值记为； (6) 计算机器人的奇异裕度：对于串联机器人或并联机器人的一条支链，运动奇异裕度At = 90- ；当螺旋空间夹角= 90时，表明机器人处于运动奇异状态；当螺旋空间夹角 = 0时，表明机器人远离运动奇异状态；对于并联机器人检测步骤如下： (1) 对于并联机器人，将螺旋坐标系的原点建立在动平台上，坐标系的姿态可以任意选择；。

16、(2) 计算关节支链约束力螺旋，并组成螺旋矩阵：对于并联机器人，计算各支链的约束力螺旋 wi，其中 i = 1, 2, ., N， N 是约束力螺旋的数目，将这一组约束力螺旋组成一个力螺旋矩阵 Mw = w1, w2, .wN ； (3) 计算 N 阶扩展螺旋矩阵的行列式 Dw： Dw = det ( MwT Mw ) ( 式 2) 其中， Dw表示 N 阶扩展螺旋矩阵的行列式， det 表示方阵的行列式运算， T 表示对矩阵的转置运算； (4) 计算 N-1 阶扩展螺旋矩阵的行列式 Vwi： Vwi = det ( MwiT Mwi ) ( 式 4) 其中， Vwi表示。

17、N-1 阶扩展螺旋矩阵的行列式， Mwi表示在螺旋矩阵 Mw中去除第 i 条螺旋之后所获得的新矩阵；由于 i = 1, 2, ., N，因此存在 N 个不同的 Vwi；说明书 CN 103077310 A 5 3/5 页 6 (5) 计算螺旋空间的夹角：对于力螺旋，螺旋 wi与螺旋系中其余 N-1 条力螺旋构成的螺旋空间法向的夹角 i为： ( 式 6) 其中， |wi| 表示对螺旋 wi的取模运算；将 N 个 i中的最大值记为； (6) 计算机器人的奇异裕度：对于并联机器人，静力奇异裕度Aw = 90- ；当螺旋空间夹角 = 90时，表明机器人处于静力。

18、奇异状态；当螺旋空间夹角 = 0时，表明机器人远离静力奇异状态。 0006 本发明可以根据步骤 (3) 与步骤 (4) 分别计算 N 阶和 N-1 阶扩展运动螺旋矩阵或 N 阶和 N-1 阶扩展力螺旋矩阵的行列式。 0007 本发明可以根据步骤 (5) 计算螺旋空间的夹角，以此衡量机器人的奇异裕度。 0008 本发明具有的有益效果是： (1) 提出的机器人奇异裕度检测方法不需要借助优化算法，提高了奇异裕度的计算效率； (2) 这种方法以螺旋空间的夹角作为奇异裕度的评价指标，具有几何意义； (3) 能够用于检测串联机器人或并联机器人支链的运动奇异裕度； (4) 能够用于检。

19、测并联机器人的静力奇异裕度。附图说明 0009 图 1 是含机器人奇异裕度检测的流程图。 0010 图 2 是 3R 平面机器人机构示意图。 0011 图 3 是 3-UPU 并联机器人示意图。 0012 图中： 1、基座， 2、 1 号转动副， 3、 1 号连杆， 4、 2 号转动副， 5、 2 号连杆， 6、 3 号转动副， 7、 3 号连杆， 8、末端执行器， 9、螺旋坐标系， 10、动平台， 11、万向副， 12、移动副。具体实施方式 0013 下面通过实施例结合附图进一步说明本发明。 0014 实施例 1 ：下面结合 3R 平面机器人对本发明作进一步说明。机器人。

20、奇异裕度检测的流程图见图 1 所示，包括以下关键步骤： (1) 建立机器人的螺旋坐标系； (2) 计算关节运动螺旋，并组成螺旋矩阵； (3) 计算 N 阶扩展螺旋矩阵的行列式； (4) 计算 N-1 阶扩展螺旋矩阵的行列式； (5) 计算螺旋空间的夹角； (6) 计算机器人的奇异裕度。 0015 以图 2 所示的 3R 平面机器人机构为例。3R 平面机器人有 3 个转动副，设 3 根连杆的长度均为 0.5m，设 1 号连杆与水平线的夹角为 45， 2 号连杆与水平线的夹角为 0， 3 号连杆与水平线的夹角为 90。说明书 CN 103077310 A 6 4/5 。

21、页 7 0016 (1) 建立 3R 平面机器人的螺旋坐标系。如图 2 所示，在机器人末端执行器 8 处建立螺旋坐标系9，螺旋坐标系9原点位于末端执行器8中心，螺旋坐标系的x轴水平向右，螺旋坐标系的 y 轴竖直向上。 0017 (2) 计算3个关节的运动螺旋，并组成螺旋矩阵。经计算， 1号转动副2的运动螺旋为 t1 = (0, 0, 1, -0.853553, 0.853553, 0)T， t2 = (0, 0, 1, -0.5, 0.5, 0)T， t3 = (0, 0, 1, 0, -0.5, 0)T。运动螺旋矩阵为 Mt = t1, t2, t3。 0018 (3) 计。

22、算 3 阶扩展螺旋矩阵的行列式。根据 ( 式 1)， 3 阶扩展螺旋矩阵的行列式 Dt = det ( MtT Mt ) = 0.03125。 0019 (4) 计算2阶扩展螺旋矩阵的行列式。由于3阶螺旋系中共有3个2阶螺旋系，因此根据(式3)分别计算3个2阶扩展螺旋矩阵的行列式Vt1 = det ( Mt1T Mt1 ) = 1.3125， Vt2 = det ( Mt2T Mt2 ) = 2.7428， Vt3 = det ( Mt3T Mt3 ) = 0.25。 0020 (5) 计算螺旋空间的夹角。由于存在 3 个 2 阶螺旋系，因此根据 ( 式 5) 分别计算螺旋空间的 3。

23、个夹角：，，，因此， = 85.0002。 0021 (6) 计算机器人的奇异裕度。3R 平面机器人处于图 2 构型时的运动奇异裕度 At = 90 - = 4.9998。 0022 实施例 2 ：下面结合 3-UPU 并联机器人对本发明作进一步说明。机器人奇异裕度检测的流程图见图 1 所示，包括以下关键步骤： (1) 建立机器人的螺旋坐标系； (2) 计算关节运动螺旋，并组成螺旋矩阵； (3) 计算 N 阶扩展螺旋矩阵的行列式； (4) 计算 N-1 阶扩展螺旋矩阵的行列式； (5) 计算螺旋空间的夹角； (6) 计算机器人的奇异裕度。 0023 以图 2 所。

24、示的 3-UPU 并联机器人机构为例。3-UPU 并联机器人动平台 10 和基座之间通过 3 条支链相连，每条支链由 2 个万向副 11 和 1 个移动副 12 构成，其中移动副是驱动关节。基座上的3个万向副呈等边三角形布置，三角形边长为0.5m，基础坐标系原点O处于三角形中心。动平台上的3个万向副也呈等边三角形布置，三角形边长为0.2m，动平台工具坐标系原点 P 处于三角形中心。动平台中心 P 点在 (0, 0.1m, 1m) 位置。 0024 (1) 建立 3-UPU 并联机器人的螺旋坐标系。如图 3 所示，在 3-UPU 并联机器人动说明书 CN 1030。

25、77310 A 7 5/5 页 8 平台 10 处建立螺旋坐标系 9，螺旋坐标系 9 原点为位于动平台 10 中心。 0025 (2) 计算 3 条支链的约束力螺旋，并组成力螺旋矩阵。经计算， 3 条支链对动平台共有 6 个约束力螺旋，分别为 w1=0, 0, 0, 0.0433, 0.025, 1， w2=-3.75, 10.825, 43.301, -17.321, -10, 1， w3= 0, 0, 0, -0.0433, 0.025, 1， w4=-3.75, -2.165, 43.301, 17.321, -10, 1， w5= 0, 0, 0, 0, 0.1, 1， w6=。

26、-3.75, -2.165, -21.651, 0, -10, 1。力螺旋矩阵为 Mw= w1, w2, w3, w4, w5, w6。 0026 (3) 计算 6 阶扩展螺旋矩阵的行列式。根据 ( 式 2)， 6 阶扩展螺旋矩阵的行列式 Dw= det (MwT Mw ) = 422.351。 0027 (4) 计算5阶扩展螺旋矩阵的行列式。由于6阶螺旋系中共有6个5阶螺旋系，因此根据(式4)分别计算6个5阶扩展螺旋矩阵的行列式Vw1= det (Mw1T Mw1 ) = 3.337， Vw2= det (Mw2T Mw2 ) = 3.437， Vw3= det (Mw3T Mw3 )。

27、 = 13.449， Vw4= det (Mw4T Mw4 ) = 615895， Vw5= det (Mw5T Mw5 ) = 615895， Vw6= det (Mw6T Mw6 ) = 611740。 0028 (5) 计算螺旋空间的夹角。由于存在 6 个 5 阶螺旋系，因此根据 ( 式 6) 分别计算螺旋空间的 6 个夹角：因此， = 88.5018。 0029 (6) 计算机器人的奇异裕度。3-UPU 并联机器人处于图 3 构型时的静力奇异裕度 Aw= 90 -= 1.4982。说明书 CN 103077310 A 8 1/2 页 9 图 1 说明书附图 CN 103077310 A 9 2/2 页 10 图 2 图 3 说明书附图 CN 103077310 A 10 。

展开阅读全文