2024-09-22 18:09:08 +00:00
|
|
|
close all;clc;clear
|
2024-01-23 13:42:25 +00:00
|
|
|
file = [];
|
|
|
|
|
opt.robot_def = 'direct';
|
2024-09-28 13:45:14 +00:00
|
|
|
opt.KM_method = 'SCREW';
|
2024-01-23 13:42:25 +00:00
|
|
|
opt.Vel_method = 'Direct';
|
|
|
|
|
opt.LD_method = 'Direct';
|
2024-10-25 14:34:21 +00:00
|
|
|
opt.debug = false;
|
|
|
|
|
opt.robotName = 'R1000_DVT';
|
2024-10-15 23:36:50 +00:00
|
|
|
opt.reGenerate = false;
|
2024-10-16 13:30:59 +00:00
|
|
|
opt.Isreal = true;
|
2024-11-05 12:54:56 +00:00
|
|
|
opt.isJointTorqueSensor = false;
|
|
|
|
|
opt.isSixAxisFTSensor = true;
|
2024-09-28 13:45:14 +00:00
|
|
|
|
2024-10-25 15:41:23 +00:00
|
|
|
theta = zeros(9,1);
|
2024-10-25 14:34:21 +00:00
|
|
|
dtheta = zeros(9,1);
|
2024-10-25 15:41:23 +00:00
|
|
|
ddtheta = zeros(9,1);
|
2024-10-25 14:34:21 +00:00
|
|
|
robot = get_robot_R1000(theta,dtheta,ddtheta,file,opt);
|
2024-10-23 14:27:53 +00:00
|
|
|
robot = get_Kinematics(robot, opt);
|
2024-09-28 13:45:14 +00:00
|
|
|
|
2024-10-25 14:34:21 +00:00
|
|
|
% R1000_Dynamics_num;
|
2024-10-07 15:10:42 +00:00
|
|
|
% R1000_Dynamics;
|
2024-10-23 14:27:53 +00:00
|
|
|
robot = get_velocity(robot, opt);
|
|
|
|
|
robot = get_regressor(robot,opt);
|
2024-01-23 13:42:25 +00:00
|
|
|
% symbol matched
|
2024-10-15 23:36:50 +00:00
|
|
|
% verify_regressor_R1000;
|
2024-10-25 14:34:21 +00:00
|
|
|
robot = get_baseParams(robot, opt);
|
2024-11-05 15:20:47 +00:00
|
|
|
robot = estimate_dyn(robot,opt);
|