PD+gravity Control 2DoF Planar Robotic Manipulator
バージョン 1.0.1 (2.4 KB) 作成者:
Saeed Rafee Nekoo
This code presents a simple PD+gravity control design for a two-degree-of-freedom manipulator.
Time definition and discretization is in lines 4-8.
The degree of freedom of the arm is in line 10.
The start and end points are defined in lines 12-15.
The physical parameters of the robot are set in lines 17-26.
Inverse kinematics is presented in liens 27-37, details can be found in chapter 3 of:
Schilling, R. J. (1996). Fundamentals of robotics: analysis and control. Simon & Schuster Trade.
Dynamics: lines 54-60. M, C, g matrix and vectors can be obtained in:
PD controller is in lines 62-64. Details can be found in chapter 7 of:
Schilling, R. J. (1996). Fundamentals of robotics: analysis and control. Simon & Schuster Trade.
Simple PD can be implemented by replacing line 64 with:
u(:,i)=-Kp*(q-x_des(1:2))-Kd*(dq-x_des(3:4));
引用
Saeed Rafee Nekoo (2024). PD+gravity Control 2DoF Planar Robotic Manipulator (https://www.mathworks.com/matlabcentral/fileexchange/166431-pd-gravity-control-2dof-planar-robotic-manipulator), MATLAB Central File Exchange. 取得済み .
MATLAB リリースの互換性
作成:
R2024a
すべてのリリースと互換性あり
プラットフォームの互換性
Windows macOS Linuxタグ
Community Treasure Hunt
Find the treasures in MATLAB Central and discover how the community can help you!
Start Hunting!