18 lines
588 B
Mathematica
18 lines
588 B
Mathematica
|
function standard_regrssor = standard_regressor_R1000_EVT(theta,dtheta,ddtheta)
|
||
|
|
opt.robot_def = 'direct';
|
||
|
|
opt.KM_method = 'SCREW';
|
||
|
|
opt.Vel_method = 'Direct';
|
||
|
|
opt.LD_method = 'Direct';
|
||
|
|
opt.debug = false;
|
||
|
|
opt.robotName = 'R1000_EVT';
|
||
|
|
opt.reGenerate = false;
|
||
|
|
opt.Isreal = true;
|
||
|
|
opt.isJointTorqueSensor = false;
|
||
|
|
opt.isSixAxisFTSensor = true;
|
||
|
|
file=[];
|
||
|
|
|
||
|
|
robot = get_robot_R1000_EVT(theta,zeros(size(dtheta)),zeros(size(ddtheta)),file,opt);
|
||
|
|
robot = get_Kinematics_R1000_EVT(robot, opt);
|
||
|
|
robot = get_velocity(robot, opt);
|
||
|
|
robot = get_regressor(robot, opt);
|
||
|
|
standard_regrssor = robot.regressor.K;
|