首页 / 专利库 / 联轴器,法兰和接头 / 机械接头 / 机器人关节 / 转动关节 / 一种二自由度并联机械手控制系统的运动学正反解算法

一种二自由度并联机械手控制系统的运动学正反解算法

阅读:341发布:2023-02-01

专利汇可以提供一种二自由度并联机械手控制系统的运动学正反解算法专利检索,专利查询,专利分析的服务。并且一种二 自由度 并联机械手控制系统的运动学正反解 算法 ,属于并联机械手控制技术领域,正解是通过机械手每根轴的旋转 角 度推算出机械手的空间 姿态 以及工作端的空间 位置 ,把 电机 转角(θ1,θ2)转化为末端位置(x,y);反解是通过机械手末端位置推算出各个关节的位置及转动角度,把末端位置(x,y)转化为电机转角(θ1,θ2),把平动盘的移动转化为可控的电机转角。正解有断电保持的作用,如果系统突然断电,上电后可以从 伺服电机 的绝对值 编码器 记录的电机转角推算出出末端的坐标。采用平面几何学推导,原理清晰,可以获得工作平面内满足条件的合理解,解决了目前正解多为解析解的问题。实验证明该正反解,最终得到较为理想的机械手运动效果。,下面是一种二自由度并联机械手控制系统的运动学正反解算法专利的具体信息内容。

1.一种二自由度并联机械手控制系统的运动学正反解算法,包括由平衡杆(1)、主动臂(2)、从动臂(3)、电磁(5)、左电机(6)、右电机(7)和平动盘(4)构成的二自由度并联机械手控制系统;其特征在于,所述二自由度并联机械手控制系统的反解算法步骤如下:
(1)将二自由度并联机械手结构简化为平面四连杆铰链机构;
(2)在步骤(1)的平面四连杆铰链机构中,设主动臂长为Lt,从动臂长为Lb,电机转轴分别为A和E,转轴的轴间距为L1,平动盘长度为L2;
(3)建立以电机转轴为X轴,电机转轴间距中心点为原点的坐标系
(4)设两电机转动度分别为θ1和θ2,平动盘所在步骤(3)中坐标系的坐标为(x,y);
(5)将主动臂和从动臂都内平移L2/2,将平动盘简化成C点,轴间距缩短至L1-L2;
(6)运用几何画板,按比例绘出机械手的简化反解数学模型;
(7)从步骤(6)中可得出A点坐标 规定左轴从0°开始逆时针旋转为
正角,顺时针旋转为负角;右轴则相反。
(8)设 则向量AC=(x+l,y),与x轴正半轴夹角和模分别为:
在ΔABC中,三边长均已知,由余弦定理得: 故左电机
旋转角度为:θ1=180°-(β+α)。
同理得出右电机旋转角度:
θ2=β'-α'

2.一种二自由度并联机械手控制系统的运动学正反解算法,包括由平衡杆(1)、主动臂(2)、从动臂(3)、电磁铁(5)、左电机(6)、右电机(7)和平动盘(4)构成的二自由度并联机械手控制系统;其特征在于,所述二自由度并联机械手控制系统的正解算法步骤如下:
(1)运用几何画板,按比例绘出机械手的简化正解数学模型;
(2)规定左轴从0°开始逆时针旋转为正角,顺时针旋转为负角;右轴则相反;
(3)令 则:
(4)在直角梯形FBDG中计算出:
若直线BD在O点下方,即α1+α2≥0,如图4所示,则在ΔABD中,由余弦定理得:
若直线BD在O点上方,即α1+α2<0,如图5所示,则:
(5)在ΔCOB中,由余弦定理计算出:
(6)向量OC与x轴正半轴的夹角为 即工作端坐标为:

说明书全文

一种二自由度并联机械手控制系统的运动学正反解算法

技术领域

[0001] 本发明属于并联机械手控制技术领域,涉及一种二自由度并联机械手的控制技术,特别是涉及一种二自由度并联机械手控制系统的运动学正反解算法。

背景技术

[0002] 运动学正解就是通过机械手每根轴的旋转度推算出机械手的空间姿态以及工作端的空间位置,把电机转角(θ1,θ2)转化为末端位置(x,y),这是在系统中实现实时监控末端执行器点位功能的理论基础。运动学反解就是通过机械手末端位置推算出各个关节的位置及转动角度,这样就能把末端位置(x,y)转化为电机转角(θ1,θ2),把平动盘的移动转化为可控的电机转角。正解有断电保持的作用,如果系统突然断电,上电后可以从伺服电机的绝对值编码器记录的电机转角推算出出末端的坐标。并联机械手运动学正解的封闭解问题到目前为止没有得到全面解决,常用的解决方案是采用基于代数方程组的数值解法,该方法不足之处是推导过程复杂,实际应用过程中存在多解取舍的问题,同时反解过程较为繁琐,不够直观。

发明内容

[0003] 本发明针对上述采用基于代数方程组的数值解法存在的推导过程复杂、存在多解取舍的不足,提出一种二自由度并联机械手控制系统的运动学正反解算法,采用平面几何学推导,直观简单,可以获得工作平面内满足条件的合理解,解决了目前正解多为解析解的问题。
[0004] 本发明的技术方案是:一种二自由度并联机械手控制系统的运动学正反解算法,包括由平衡杆、主动臂、从动臂、电磁、左电机、右电机和平动盘构成的二自由度并联机械手控制系统;其特征在于,所述二自由度并联机械手控制系统的反解算法步骤如下:
[0005] (1)将二自由度并联机械手结构简化为平面四连杆铰链机构;
[0006] (2)在步骤(1)的平面四连杆铰链机构中,设主动臂长为Lt,从动臂长为Lb,电机转轴分别为A和E,转轴的轴间距为L1,平动盘长度为L2;
[0007] (3)建立以电机转轴为X轴,电机转轴间距中心点为原点的坐标系
[0008] (4)设两电机转动角度分别为θ1和θ2,平动盘所在步骤(3)中坐标系的坐标为(x,y);
[0009] (5)将主动臂和从动臂都内平移L2/2,将平动盘简化成C点,轴间距缩短至L1-L2;
[0010] (6)运用几何画板,按比例绘出机械手的简化反解数学模型;
[0011] (7)从步骤(6)中可得出A点坐标 规定左轴从0°开始逆时针旋转为正角,顺时针旋转为负角;右轴则相反。
[0012] (8)设 则向量AC=(x+l,y),与x轴正半轴夹角和模分别为:
[0013]
[0014] 在ΔABC中,三边长均已知,由余弦定理得:
[0015] 故左电机旋转角度为:θ1=180°-(β+α)。
[0016] 同理得出右电机旋转角度:
[0017] θ2=β'-α'
[0018]
[0019] 所述二自由度并联机械手控制系统的正解算法步骤如下:
[0020] (1)运用几何画板,按比例绘出机械手的简化正解数学模型;
[0021] (2)规定左轴从0°开始逆时针旋转为正角,顺时针旋转为负角;右轴则相反;
[0022] (3)令 则:
[0023]
[0024]
[0025]
[0026]
[0027] (4)在直角梯形FBDG中计算出:
[0028]
[0029] 若直线BD在O点下方,即α1+α2≥0,如图4所示,则在ΔABD中,由余弦定理得:
[0030]
[0031] 若直线BD在O点上方,即α1+α2<0,如图5所示,则:
[0032]
[0033] (5)在ΔCOB中,由余弦定理计算出:
[0034]
[0035]
[0036] (6)向量OC与x轴正半轴的夹角为 (α1可能为负角),即工作端坐标为:
[0037]
[0038] 本发明的有益效果为:本发明提出的一种二自由度并联机械手控制系统的运动学正反解算法,采用平面几何学推导,原理清晰,正解是通过机械手每根轴的旋转角度推算出机械手的空间姿态以及工作端的空间位置,把电机转角(θ1,θ2)转化为末端位置(x,y);反解是通过机械手末端位置推算出各个关节的位置及转动角度,把末端位置(x,y)转化为电机转角(θ1,θ2),把平动盘的移动转化为可控的电机转角。正解有断电保持的作用,如果系统突然断电,上电后可以从伺服电机的绝对值编码器记录的电机转角推算出出末端的坐标。可以获得工作平面内满足条件的合理解,解决了目前正解多为解析解的问题。实验证明该正反解,最终得到较为理想的机械手运动效果。附图说明
[0039] 图1为本发明二自由度并联机械手结构示意图。
[0040] 图2本发明二自由度并联机械手转化的平面四连杆机构示意图。
[0041] 图3本发明中机械手简化反解数学模型。
[0042] 图4本发明中机械手简化正解数学模型。
[0043] 图5本发明中机械手简化正解数学模型特殊情况模型。
[0044] 图中:平衡杆1、主动臂2、从动臂3、平动盘4、电磁铁5、左电机6、右电机7。

具体实施方式

[0045] 下面结合附图对本发明作进一步说明:
[0046] 如图1所示,一种二自由度并联机械手控制系统采用的是启帆设备公司生产的型号为SW-300的两自由度并联机械手,该装置由伺服电机、主动臂、从动臂和平动盘构成。静平台上安装两个伺服电机,由NJ控制器发出指令给伺服驱动器,驱动伺服电机经减速器带动主动臂转动,与主动臂连接的从动臂动作,进而控制平动盘在平面内作二维移动。同时,平动盘安装不同机构可以进行手抓、钳夹和吸取等不同的动作。图1中,平动盘安装的是电磁铁,当平动盘移动到铁质物体上方时,通过控制器的指令使电磁铁通电来达到吸取目标的要求。
[0047] 如图2-3所示,一种二自由度并联机械手控制系统的运动学正反解算法,包括由平衡杆1、主动臂2、从动臂3、电磁铁5、左电机6、右电机7和平动盘4构成的二自由度并联机械手控制系统;二自由度并联机械手控制系统的反解算法步骤如下:
[0048] (1)将二自由度并联机械手结构简化为平面四连杆铰链机构;
[0049] (2)在步骤(1)的平面四连杆铰链机构中,设主动臂长为Lt,从动臂长为Lb,电机转轴分别为A和E,转轴的轴间距为L1,平动盘长度为L2;
[0050] (3)建立以电机转轴为X轴,电机转轴间距中心点为原点的坐标系;
[0051] (4)设两电机转动角度分别为θ1和θ2,平动盘所在步骤(3)中坐标系的坐标为(x,y);
[0052] (5)将主动臂和从动臂都内平移L2/2,将平动盘简化成C点,轴间距缩短至L1-L2;
[0053] (6)运用几何画板,按比例绘出机械手的简化反解数学模型;
[0054] (7)从步骤(6)中可得出A点坐标 规定左轴从0°开始逆时针旋转为正角,顺时针旋转为负角;右轴则相反。
[0055] (8)设 则向量AC=(x+l,y),与x轴正半轴夹角和模分别为:
[0056]
[0057] 在ΔABC中,三边长均已知,由余弦定理得:
[0058] 故左电机旋转角度为:θ1=180°-(β+α)。
[0059] 同理得出右电机旋转角度:
[0060] θ2=β'-α'
[0061]
[0062] 如图4-5所示,一种二自由度并联机械手控制系统的运动学正解算法步骤如下:
[0063] (1)运用几何画板,按比例绘出机械手的简化正解数学模型;
[0064] (2)规定左轴从0°开始逆时针旋转为正角,顺时针旋转为负角;右轴则相反;
[0065] (3)令 则:
[0066]
[0067]
[0068]
[0069]
[0070] (4)在直角梯形FBDG中计算出:
[0071]
[0072] 若直线BD在O点下方,即α1+α2≥0,如图4所示,则在ΔABD中,由余弦定理得:
[0073]
[0074] 若直线BD在O点上方,即α1+α2<0,如图5所示,则:
[0075]
[0076] (5)在ΔCOB中,由余弦定理计算出:
[0077]
[0078]
[0079] (6)向量OC与x轴正半轴的夹角为 (α1可能为负角),即工作端坐标为:
[0080] 本发明中正解是通过机械手每根轴的旋转角度推算出机械手的空间姿态以及工作端的空间位置,把电机转角(θ1,θ2)转化为末端位置(x,y);反解是通过机械手末端位置推算出各个关节的位置及转动角度,把末端位置(x,y)转化为电机转角(θ1,θ2),把平动盘的移动转化为可控的电机转角。正解有断电保持的作用,如果系统突然断电,上电后可以从伺服电机的绝对值编码器记录的电机转角推算出出末端的坐标。推导简单,原理清晰,采用平面几何学推导,可以获得工作平面内满足条件的合理解,解决了目前正解多为解析解的问题。实验证明该正反解,最终得到较为理想的机械手运动效果。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈