作业型飞行机器人的四自由度机械臂遥操作系统及方法
专利汇可以提供作业型飞行机器人的四自由度机械臂遥操作系统及方法专利检索，专利查询，专利分析的服务。并且本 发明 涉及一种作业型飞行 机器人 的四 自由度 机械臂 遥 操作系统 及方法，包括飞行机器人和控制终端；所述飞行机器人包括四旋翼无人机、从端控制单元、RealSense 深度相机 和四自由度机械臂；所述四自由度机械臂接于四旋翼无人机底部；所RealSense深度相机设置于四旋翼无人机底部前端。本发明通过传输双向信息反馈实现功能，可对于某些复杂且人不能或者不易到达的环境实时远距离作业，同时，机械臂可离线工作实时完成指令任务。，下面是作业型飞行机器人的四自由度机械臂遥操作系统及方法专利的具体信息内容。
1.一种作业型飞行机器人的四自由度机械臂遥操作系统，其特征在于，包括飞行机器人和控制终端；所述飞行机器人包括四旋翼无人机、从端控制单元、RealSense深度相机和四自由度机械臂；所述四自由度机械臂接于四旋翼无人机底部；所RealSense深度相机设置于四旋翼无人机底部前端。
2.根据权利要求1所述的一种作业型飞行机器人的四自由度机械臂遥操作系统，其特征在于：所述四自由度机械臂由MX-64R舵机组成，包括绕Z轴旋转的关节1、绕X轴旋转的关节2与关节3和可实行抓紧释放工作的末端执行器，实现末端执行器抓取释放为第四自由度。
3.根据权利要求1所述的一种飞行机器人的四自由度机械臂遥操作系统，其特征在于：
所述关节1、关节2、关节3和末端执行器处连接架采用特殊轻质材料3D打印，标准连接件采用铝合金连接件。
4.根据权利要求2所述的一种作业型飞行机器人的四自由度机械臂遥操作系统，其特征在于：所述从端控制单元采用Arduino megaADK从端控制器，所述四自由度机械臂利用MAX485模块与Arduino mega ADK从端控制器实现半双工异步串口通信。
5.根据权利要求1所述的一种作业型飞行机器人的四自由度机械臂遥操作系统，其特征在于：所述控制终端通过zigbee模块与从端控制单元无线连接。
6.一种作业型飞行机器人的四自由度机械臂遥操作系统的控制方法，其特征在于，包括以下步骤：
步骤S1:控制终端通过RealSense深度相机实时检测远端作业环境；
步骤S2:实时点击图像系统上待抓取点，主端窗体控制系统对该点所表示的物体进行轮廓提取，将轮廓作为识别特征提取特征点，得到三维位姿估计点；
步骤S3:利用雅可比伪逆和牛顿迭代法改进后的逆解算法，基于四自由度机械臂的当前空间位姿，计算出末端执行器能够连续平稳不跳变运动到达目标点的最优解；
步骤S4:通过zigbee将每个转角信息传输至从端控制单元，同时从端控制单元反馈信号给控制终端；
骤S5:从端控制单元控制末端执行器实现抓取或释放目标物作业。
7.根据权利要求5所述的一种作业型飞行机器人的四自由度机械臂遥操作系统的控制方法，其特征在于，所述步骤S2具体为：
步骤S21:通过RealSense深度相机提取目标物轮廓；
步骤S22:以目标物的轮廓作为目标物的识别特征，提取轮廓中心点；
步骤S23:对RealSense深度相机和四自由度机械臂立体标定，并对目标物进行三维重建，实现对目标物空间定位，得到三维位姿估计点。
8.根据权利要求6所述的一种作业型飞行机器人的四自由度机械臂遥操作系统的控制方法，其特征在于，对所述四自由度机械臂(3)D-H建模具体如下：
获取四自由度机械臂D-H参数，包括ai、αi、di和θi，
其中ai表示沿 轴，从 移动到 的距离；αi表示绕 轴，从 旋转到 的角度；di表示沿 轴，从 移动到 的距离；θi表示绕 轴，从 旋转到 的角度；
由四自由度机械臂(3)D-H参数列出连杆坐标系{i}相对于坐标系{i-1}的变换矩阵：
其中Rot(zi-1,θi)表示绕zi-1轴旋转θi角度；Trans(zi-1,di)表示沿zi-1轴移动di距离；
Trans(xi,ai)表示沿xi轴移动ai距离；Rot(xi,ai)表示绕xi轴旋转αi角度；
根据矩阵变换关系式(1)，对于每组确定关节1(4)、关节2(5)、关节3(6)的转角，可以唯一的计算得到末端执行器(7)相对于基坐标下的空间坐姿为：
结合式(2)对所述四自由度机械臂(3)给定末端位姿，由
反算到每个关节的关节角时有多解情况；
在求解的过程中延用牛顿迭代法的思想，将第n次求解结果作为第n+1次迭代初值，所述四自由度机械臂(3)的微分运动矢量为：
其中d对应关节的微分平移；δ对应关节的微分旋转矢量；J(θ)是一个相对于基坐标系的6×3雅可比矩阵；
将式(4)中的微分用差分近似表示为
D＝J(θ)Δθ (5)
由Δθ＝θn+1-θn建立牛顿迭代法的基本形式为：
θn+1＝θn+J-1(θn)Dn (6)
微分运动也可以表示为由当前位姿Tcur运动到目标位姿Tend：
Tend＝Tcur(I+Δ)
即
其中I为单位对角矩阵；
结合式(7)，根据微分变换算子
Δ＝Trans(dx,dy,dz)Rot(k,dθ)-I (8)
求得微分运动矢量为：
D＝[dx dy dz δx δy δz]T (9)。
9.根据权利要求7所述的一种作业型飞行机器人的四自由度机械臂遥操作系统的控制方法，其特征在于，为了避免所述四自由度机械臂在奇异位形处无法求解的现象，在迭代过程中使用雅可比伪逆矩阵J+(θn)代替其逆矩阵J-1(θn)，具体如下：
步骤1：在迭代的过程中若初值偏离θ0所求根θ，牛顿迭代法则可能发散，为保证单调性，添加牛顿下山法算法：
||D(θk+1)||＜||D(θk)|| (10)
初选下山因子从λ＝1，逐次将λ减半进行判断，直至满足式(10)成立为止；
步骤2：在迭代过程中存在雅可比矩阵J(θn)的逆矩阵可能不存在的情况，用其广义逆J+(θn)替代，迭代公式为：
θn+1＝θn+λJ+(θn)Dn (11)
其中0＜λ≤1；
步骤3：对于奇异位形的求解，继续迭代方法可能会造成雅克比矩阵不可逆的情况，为此将上一次迭代结果作微调，即
θ0＝θ0+σ (12)
其中σ的取值为一微小角度值；
步骤4：根据所述四自由度机械臂的机械结构给每个关节角转动范围添加预设约束条件，确保四自由度机械臂不被损坏。
作业型飞行机器人的四自由度机械臂遥操作系统及方法
技术领域
背景技术
发明内容
具体实施方式
1 -90 a1 d1 θ1 [-80°，80°]
2 0 a2 0 θ2 [-170°，-10°]
3 90 a3 0 θ3 [-130°，-130°]
| 标题 | 发布/更新时间 | 阅读量 |
|---|---|---|
| 基于WINDOWS平台工业机器人运动控制器及控制方法 | 2020-05-12 | 615 |
| 一种直驱式类人双足机器人 | 2020-05-12 | 603 |
| 机器人及其柔性控制方法与装置 | 2020-05-08 | 763 |
| 一种组合式弱扭转连续型机械臂连接关节 | 2020-05-08 | 633 |
| 一种镜片自动掰落放料机构 | 2020-05-12 | 538 |
| 一种谐波减速器及机器人关节驱动器 | 2020-05-11 | 126 |
| IPMC曲线驱动器及基于IPMC与硅胶材料的柔性关节四足机器人单腿系统 | 2020-05-11 | 661 |
| 拟人机器人的小腿组件及拟人机器人 | 2020-05-11 | 945 |
| 一种异构多机器人协同作业教育实训系统 | 2020-05-11 | 327 |
| 机器人三四关节组合体 | 2020-05-11 | 919 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台，是提供专利分析，专利查询，专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据，免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析，涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度，系统通过AI智能系统对图表进行解读，只需1分钟，一键生成行业专利分析报告。
