Robotics
/
IRDYn
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Merge pull request 'add check in verify regressor' (#1) from feature/add-checker into main 

Reviewed-on: #1
This commit is contained in:
cosmic_power 2024-09-19 16:15:27 +00:00
parent 0926a14dfd 599ffa1af8
commit 2a3760ebb4
1 changed files with 2 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
verify_regressor.m
View File

@ -56,6 +56,8 @@ j=1;
Vlinear(:, j+1) = BodyVelToLinearVel(V2(:,j+1),G(:,:,j)*M12); Vlinear(:, j+1) = BodyVelToLinearVel(V2(:,j+1),G(:,:,j)*M12);
j=2; j=2;
Vlinear(:, j+1) = BodyVelToLinearVel(V2(:,j+1),G(:,:,j)*M23); Vlinear(:, j+1) = BodyVelToLinearVel(V2(:,j+1),G(:,:,j)*M23);
%% Check if screw method is equal to regressor
isequal(simplify(tau),simplify(tau_mat))
%% Numerical %% Numerical
clear pi; clear pi;
ndof = robot.ndof; ndof = robot.ndof;