IRDYn/codegen/base_regressor_R1000_EVT.m

21 lines
745 B
Mathematica
Raw Normal View History

2024-11-10 16:23:28 +00:00
function base_regrssor = base_regressor_R1000_EVT(theta,dtheta,ddtheta,baseQR)
2024-11-08 14:35:18 +00:00
opt.robot_def = 'direct';
opt.KM_method = 'SCREW';
opt.Vel_method = 'Direct';
opt.LD_method = 'Direct';
opt.debug = false;
opt.robotName = 'R1000_DVT';
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);
2024-11-10 16:23:28 +00:00
robot = get_Kinematics_R1000_EVT(robot, opt);
2024-11-08 14:35:18 +00:00
robot = get_velocity(robot, opt);
robot = get_regressor(robot, opt);
% get base params
robot.baseQR = baseQR;
robot.baseQR.regressor = robot.regressor.K*robot.baseQR.permutationMatrix(:,1:robot.baseQR.numberOfBaseParameters);
base_regrssor = robot.baseQR.regressor;