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!