IRDYn/codegen/base_regressor_R1000_DVT.m

21 lines
739 B
Mathematica
Raw Normal View History

2024-10-25 15:41:23 +00:00
function base_regrssor = base_regressor_R1000_DVT(theta,dtheta,ddtheta,baseQR)
2024-10-25 14:34:21 +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;
2024-11-05 15:20:47 +00:00
opt.isJointTorqueSensor = false;
opt.isSixAxisFTSensor = true;
2024-10-25 14:34:21 +00:00
file=[];
2024-11-07 13:19:53 +00:00
robot = get_robot_R1000_EVT(theta,zeros(size(dtheta)),zeros(size(ddtheta)),file,opt);
robot = get_Kinematics_EVT(robot, opt);
2024-10-25 14:34:21 +00:00
robot = get_velocity(robot, opt);
robot = get_regressor(robot, opt);
2024-10-25 15:41:23 +00:00
% get base params
robot.baseQR = baseQR;
robot.baseQR.regressor = robot.regressor.K*robot.baseQR.permutationMatrix(:,1:robot.baseQR.numberOfBaseParameters);
2024-10-25 14:34:21 +00:00
base_regrssor = robot.baseQR.regressor;