19 lines
472 B
Mathematica
19 lines
472 B
Mathematica
|
function GravityForce = calculateGravityForce(thetaMea)
|
||
|
|
% Example:
|
||
|
|
% thetalist = [0;0;0;0;0;pi/2;0;0;0];
|
||
|
|
% calculateGravityForce([thetalist])
|
||
|
|
|
||
|
|
% code start
|
||
|
|
opt.robot_def = 'direct';
|
||
|
|
opt.KM_method = 'SCREW';
|
||
|
|
opt.Vel_method = 'Direct';
|
||
|
|
opt.LD_method = 'Direct';
|
||
|
|
opt.debug = true;
|
||
|
|
opt.robotName = 'R1000_EVT';
|
||
|
|
opt.reGenerate = false;
|
||
|
|
opt.Isreal = true;
|
||
|
|
|
||
|
|
robot = get_robot_R1000(opt);
|
||
|
|
robot = get_Kinematics(robot, opt);
|
||
|
|
GravityForce = getGravityForce(thetaMea, robot, opt);
|