MD 机械臂设计及其定点转动Minimum-Snap轨迹规划我要分享

MD manipulator design and its minimum snap trajectory planning

md 机械臂设计 Minimum-Snap

关注次数: 462

下载次数: 4

文件大小: 10.5M

代码分类: 仿真计算

开发平台: matlab

下载需要积分: 2积分

版权声明:如果侵犯了您的权益请与我们联系,我们将在24小时内删除。

代码描述

中文说明:

Part 01 机械臂设计

设计一个六自由度机械臂,分析证明其操作器尖端的灵巧工作空间,并用蒙特卡洛方法验证了灵巧工作空间的正确性。

Part 02 Minimum-Snap 轨迹规划

令操作臂尖端位置固定,使其绕灵巧工作空间的某个内点作定点转动。选择三维空间中一段封闭圆作为第三关节目标轨迹,生成多个离散轨迹点。利用逆运动学求解得到每个离散轨迹点对应的各关节变量,利用MATLAB Robotics Toolbox生成机械臂绕定点旋转动画,采用Minimum Snap方法进行**轨迹规划,**将其抽象化为经典QP二次优化问题求解。

最终利用MATLAB进行动态演示,并实现在固定球坐标系下任意变化位置参数的演示交互界面



English Description:

Part 01 manipulator design A 6-DOF manipulator is designed, and the dexterous workspace of the manipulator tip is analyzed and proved. The correctness of the dexterous workspace is verified by Monte Carlo method. Part 02 minimum snap trajectory planning The tip of the operating arm is fixed to rotate around an inner point of the smart workspace. A closed circle in 3D space is selected as the target trajectory of the third joint to generate multiple discrete trajectory points. The inverse kinematics is used to get the joint variables corresponding to each discrete trajectory point, the MATLAB robotics toolbox is used to generate the rotation animation of the manipulator around the fixed point, and the minimum snap method is used for * * trajectory planning, which is abstracted into the classical QP quadratic optimization problem. Finally, Matlab is used for dynamic demonstration, and the demonstration interface of arbitrarily changing position parameters in fixed spherical coordinate system is realized


代码预览

Code/Assignment1/

Code/Assignment1/main.m

Code/Assignment1/monte.m

Code/Assignment2/

Code/Assignment2/Main.asv

Code/Assignment2/Main.m

Code/Assignment2/Toolbox 源码修改部分/

Code/Assignment2/Toolbox 源码修改部分/RTBPlotGYM.m

Code/Assignment2/Toolbox 源码修改部分/plot.m

Code/Assignment2/Toolbox 源码修改部分/teach.m

Code/Assignment2/getAbeq.m

Code/Assignment2/getCt.m

Code/Assignment2/getM.m

Code/Assignment2/getQ.m

Code/Assignment2/get_q.m

Doc/

Doc/机械臂设计及其定点转动Minimum-Snap轨迹规划.docx

Doc/机械臂设计及其定点转动Minimum-Snap轨迹规划.pdf

Img/

Img/DH.png

Img/pva.jpg

Img/res.jpg

Img/res.png

Img/teach.png

ReadMe.md

Video/

Video/te20.mp4

Video/te45.mp4

Video/te80.mp4

Video/交互界面1.gif

Video/交互界面2.gif