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

Reviewed-on: #1

verify_regressor.m

@@ -56,6 +56,8 @@ j=1;
 Vlinear(:, j+1) = BodyVelToLinearVel(V2(:,j+1),G(:,:,j)*M12);
 j=2;
 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
 clear pi;
 ndof = robot.ndof;