四轴六轴机械臂基础运动仿真实验（Matlab）

博主最近在学一本叫做《A Mathematical Introduction to Robotic Manipulation》的机器人学教材，并且在学习之余根据了老师的要求完成了一个仿真项目（MATLAB）：

Analyze workspaces of 4 axis robot and 6 axis robot, find the intersection area firstly.
Compute the forward kinematics of 4 axis robot and design a point P in intersection area.
Take P as input, compute inverse kinematics of 6 axis robot.
Take result from step3 as input to compute the forward kinematics of 6 axis robot to verify it is coincident with point P.
2 plots are necessary:
①inverse kinematics converge trend.
②In 3D space, point P as result of forward kinematics(color red), and point P’ as result of step 4, P and P’ should be coincident in theory.

从一个项目的角度进行分析，我们首先应该通览全部要求。然后决定我们每一步应该完成什么工作：

博主进行分析后一步步确定要完成的步骤如下：

1.根据已知的四轴与六轴的物理参数，大概设计四轴与六轴机械臂的基座位置，使其具有交集。在这过程中需要写出各个轴的twist坐标为了后续的运算做准备。

（为了演示的时候更加形象生动，博主使用了robotic toolbox用DH法建模，在进行正逆解运算时仍采用POE法）

（在计算交集区域时，采用约束方程，根据机械臂的运动特点将其边界提取成几个方程，并将其解算出来。大概使用了高数下的内容就足够）

2.根据之前的twist坐标设计一个在交集区域的P点。

约束方程如下所示：

3.将得到的点P放入六轴机械臂的工作空间做逆运动解。因为博主学的是牛顿迭代法（Newton-Raphson Algorithm），因此这里用此方法求解：

首先构建运动学方程：

已知：

·机器人参数：

·目标点：

Newton-Raphon Algorithm：

a.初始化参数：

b.计算当前的关节角：

c.计算jacobian矩阵

d.计算Jacobian的伪逆解

If n≤6,

Else

更新

e.重复以上步骤直到收敛即趋近零

4.将解算到的θ代入六轴的POE中，观看P*与P是否重合。

在这个项目中重点是在于解题思路，如何将老师提的要求一步一步完成并且展示出来，而那些机械臂参数都是些可以代替的数据。（本次项目中博主使用的是李群四轴和六轴机械臂的参数）

如果有需要的话我再详细地解析这个项目。

希望大家共同进步学习。

代码已放到GitHub上：

https://github.com/KevinJune/robotic

四轴六轴机械臂基础运动仿真实验（Matlab）相关推荐

【机械仿真】基于matlab简化几何解法六轴机械臂位置规划【含Matlab源码 2128期】
⛄一.获取代码方式获取代码方式1: 完整代码已上传我的资源:[机械仿真]基于matlab简化几何解法六轴机械臂位置规划[含Matlab源码 2128期] 点击上面蓝色字体,直接付费下载,即可. 获取 ...
基于MATLAB的关节型六轴机械臂轨迹规划仿真（2021实测完整代码）
我是一个目录基于MATLAB的关节型六轴机械臂轨迹规划仿真 1 实验目的 2 实验内容 2.1标准D-H参数法 2.2实验中使用的Matlab函数 3实验结果 4 全部代码基于MATLAB的关节型 ...
【关于通用六轴机械臂的动力学最小集参数】
在我做动力学仿真来求解通用六轴机械臂的关节力矩时候,用牛顿欧拉公式以及线性分离形式都能求出关节力矩与matlab自带的仿真环境Simmechanics做对比,结果ok,但实际用最小参数集来求解关节力矩 ...
Qt中动态显示六轴机械臂的STL三维模型
Qt中动态显示六轴机械臂的STL三维模型运动仿真 STL模型 openGL显示STL ASCII格式的STL文件读取STL文件 openGL中显示STL模型运动学变换两个坑最终效果运动仿真 ...
【机械】基于简化几何解法的六轴机械臂位置规划附matlab代码
1 内容介绍基于简化几何解法的六轴机械臂位置规划附matlab代码 2 部分代码 clc; clear; %载入数据 importfile('shuiping.mat'); theta_shuipi ...
【机器人原理与实践（三）】六轴机械臂正逆解控制
文章目录 3.1 空间转换矩阵的理解 3.1.1平移变换 3.1.2旋转变换 3.2 D-H参数法 3.3 建立机械臂模型 3.3.1 机械臂模型介绍 3.3.2 使用Matlab进行示教仿真 3.4 ...
六轴机械臂DIY（四）机械模型重建及DH法建模
通过本系列文章的前三篇,一个小型桌面舵机机械臂我们就获得了,但一个控制单关节实现整体运动的机械臂无非就是一个桌面玩具,根本就不能称之为"机器人",因此在接下来的文章中我们会使用机器 ...
机械臂——六轴机械臂逆解
环境:MATLAB 2017B+Robotics Toolbox 9.10.0 前期准备:完成机械臂数学模型的建立+计算机械臂工作空间 https://blog.csdn.net/Kalenee/ar ...
六轴机械臂DIY（一）机械臂DIY总体规划
一直想搞一个六轴机械臂玩玩,查了查网上的资料,发现这个开源项目已经较为成熟,但没有一个总体的教程.正好我可以记录一下我接下来的DIY过程,作为一个项目日记.(当然不确定项目会不会烂尾) 本项目参考gi ...