弹丸取放特种机器人的建模与控制方法
专利汇可以提供弹丸取放特种机器人的建模与控制方法专利检索，专利查询，专利分析的服务。并且本 发明 属于程序控制机械手技术，具体涉及一种弹丸取放特种 机器人 的建模与控制方法。该方法实现了对弹丸取放特种机器人的控制，使得机器人的取放弹丸动作精准可靠，其步骤是：1、 坐标系 确定；2、获取弹丸取放特种机器人的D‑H参数；3、通过D‑H参数利用齐次变换矩阵的方式进行坐标系变换，得到 位置 信息0T5；4、得到运动学正解公式和运动学逆解公式并输入至上位机；5、上位机对弹丸取放特种机器人进行控制完成取放弹丸动作。，下面是弹丸取放特种机器人的建模与控制方法专利的具体信息内容。
1.一种弹丸取放特种机器人的建模与控制方法，其特征在于，包括以下步骤：
1)获取弹丸取放特种机器人的运动学正解和运动学逆解；
1.1)分别建立弹丸取放特种机器人的五个运动轴的坐标系，记为OXiYiZi；i＝1～5，i代表当前运动轴；其中，Zi轴为第i个运动轴的方向；Xi轴为沿Zi-1轴和Zi轴的共法线方向；Yi轴通过右手定则确定；
定义基坐标系为OX0Y0Z0；基坐标系的原点为安装弹丸取放特种机器人可伸缩平台与补给车的连接点在X1轴的投影；基座标系OX0Y0Z0的方向和弹丸取放特种机器人第1运动轴的坐标系OX1Y1Z1的方向一致；
1.2)获取弹丸取放特种机器人的D-H参数；所述D-H参数为弹丸取放特种机器人第1运动轴坐标系与基坐标系之间的相对位置和方向信息以及弹丸取放特种机器人中每两个运动轴坐标系之间的相对位置和方向信息，其包括连杆扭角αi-1、连杆长度ai-1、连杆偏距di以及连杆夹角θi；
其中，连杆扭角αi-1为使Zi-1轴绕Xi-1轴旋转到与Zi同一平面内所需要旋转的角度；
连杆长度ai-1为使Zi-1轴沿Xi-1轴移动到与Zi轴同一直线所需要平移的距离；
连杆偏距di为使坐标系OXi-1Yi-1Zi-1和坐标系OXiYiZi的原点重合所需要沿Zi轴的平移距离；
连杆夹角θi为使Xi-1轴沿Zi轴旋转到与Xi同一直线上所需要旋转的角度；
1.3)通过D-H参数利用齐次变换矩阵的方式进行坐标系变换，得到弹丸取放特种机器人末端中心点相对于基坐标系的位置信息0T5；
1.4)通过弹丸取放特种机器人末端中心点相对于基坐标系的位置信息建立弹丸取放特种机器人的运动学正解公式和弹丸取放特种机器人的运动学逆解公式；
2)将步骤1.4)获得的弹丸取放特种机器人的运动学正解公式和运动学逆解公式输入上位机；
3)输入弹丸取放特种机器人末端输出轴相对于基座标系需要到达的目标位置(X,Y,Z,A,B,C)；
4)通过运动学逆解公式获得5个运动轴各自的位置指令信息(θ1,d2,θ3,θ4,θ5)；
5)5个运动轴各自的位置指令信息分别乘以比例系数Ki得到每个运动轴其电机对应要转动的脉冲数；然后将计算得到的脉冲数发送给控制各个轴动作的电机驱动器，电机驱动器分别对各自电机进行控制；所述Ki代表第i个轴的位置指令信息和该轴脉冲数的比例关系；
6)获取各个电机编码器反馈的各电机实际走过的位置脉冲数，分别乘以1/Ki，得到5个运动轴各自的实际位置信息(θ1′,d2′,θ3′,θ4′,θ5′)，然后根据运动学正解，得到弹丸取放特种机器人末端中心点到达的实际位置(X′,Y′,Z′,A′,B′,C′)，并在上位机上进行显示；
7)判断弹丸取放动作是否成功；若步骤6)实际位置(X′,Y′,Z′,A′,B′,C′)和步骤3)的目标位置(X,Y,Z,A,B,C)相同，则说明弹丸取放成功；
若步骤6)实际位置(X′,Y′,Z′,A′,B′,C′)和步骤3)的目标位置(X,Y,Z,A,B,C)不同，则将目标位置(X,Y,Z,A,B,C)作为输入再次重复步骤3)至步骤7)，直至弹丸取放成功。
2.根据权利要求1所述的弹丸取放特种机器人的建模与控制方法，其特征在于:所述步骤1.3)具体是：
从OXi-1Yi-1Zi-1到坐标系OXiYiZi的齐次变换矩阵i-1Ti依次表示为：
将上述5个齐次变换矩阵相乘，得到弹丸取放特种机器人末端中心点相对于基坐标系
0
的位置信息T5：
0T5＝0T11T22T33T44T5。
3.根据权利要求1所述的弹丸取放特种机器人的建模与控制方法，其特征在于:所述弹丸取放特种机器人的运动学正解公式为：
4.根据权利要求1所述的弹丸取放特种机器人的建模与控制方法，其特征在于:所述弹丸取放特种机器人运动学逆解公式为：
θ3＝±arccos{[(X-a4cosA-d5sinA-a0)2+(Y-a4sinA+d5cosA)2-a32-(a1+a2)2]/2a3(a1+a2)}
弹丸取放特种机器人的建模与控制方法
技术领域
背景技术
发明内容
具体实施方式
种机器人末端中心点相对于基坐标系的位置信息T5；
| 标题 | 发布/更新时间 | 阅读量 |
|---|---|---|
| 一种用于机械原理反转法的多机构单模型教具 | 2020-05-27 | 23 |
| 具有轮足复合推进功能的便携式移动装置 | 2020-05-18 | 462 |
| 一种管道清洗机器人及控制方法 | 2020-05-19 | 897 |
| 一种高效节能往复活塞式发动机 | 2020-05-11 | 225 |
| 一种综合位姿误差模型与刚度补偿的机器人精度补偿方法 | 2020-05-23 | 852 |
| 一种基于四阶矩估计的工业机器人可靠性计算方法 | 2020-05-21 | 986 |
| 播种单体调偏装置 | 2020-05-15 | 345 |
| 一种连杆式吸吮按摩器 | 2020-05-12 | 624 |
| 一种两级变压缩比活塞连杆组件 | 2020-05-25 | 171 |
| 多连杆冷锻压力机滑块侧向力方向保持装置 | 2020-05-18 | 365 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台，是提供专利分析，专利查询，专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据，免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析，涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度，系统通过AI智能系统对图表进行解读，只需1分钟，一键生成行业专利分析报告。
