Part1 – [DIY Robot][Matlab Robotics Toolbox][manipulator simulation][1] – Robot Kinematics
1. Differential Kinematics and Jacobian
1.1. Manipulability Ellipsoid
clear;
global Arm3D;
Robot3DMotion( [0 pi/4 pi/2 ]);
% 자코비안의 병진운동성분만 출력
Jt = Arm3D.jacob0(Arm3D.getpos(),'trans')
% 자코비안의 회전운동성분만 출력
Jr = Arm3D.jacob0(Arm3D.getpos(),'rot');
% 자코비안 전체 출력
J = Arm3D.jacob0(Arm3D.getpos());
% manipulability measure
w = abs( det(Jt) )
%manipulability ellipsoid 표시
Arm3D.vellipse( Arm3D.getpos());
0 Comments