38 lines
1.1 KiB
Matlab
38 lines
1.1 KiB
Matlab
function [stewart] = computeJacobian(stewart)
|
|
% computeJacobian -
|
|
%
|
|
% Syntax: [stewart] = computeJacobian(stewart)
|
|
%
|
|
% Inputs:
|
|
% - stewart - With at least the following fields:
|
|
% - geometry.As [3x6] - The 6 unit vectors for each strut expressed in {A}
|
|
% - geometry.Ab [3x6] - The 6 position of the joints bi expressed in {A}
|
|
% - actuators.K [6x1] - Total stiffness of the actuators
|
|
%
|
|
% Outputs:
|
|
% - stewart - With the 3 added field:
|
|
% - geometry.J [6x6] - The Jacobian Matrix
|
|
% - geometry.K [6x6] - The Stiffness Matrix
|
|
% - geometry.C [6x6] - The Compliance Matrix
|
|
|
|
assert(isfield(stewart.geometry, 'As'), 'stewart.geometry should have attribute As')
|
|
As = stewart.geometry.As;
|
|
|
|
assert(isfield(stewart.geometry, 'Ab'), 'stewart.geometry should have attribute Ab')
|
|
Ab = stewart.geometry.Ab;
|
|
|
|
assert(isfield(stewart.actuators, 'k'), 'stewart.actuators should have attribute k')
|
|
Ki = stewart.actuators.k;
|
|
|
|
J = [As' , cross(Ab, As)'];
|
|
|
|
K = J'*diag(Ki)*J;
|
|
|
|
C = inv(K);
|
|
|
|
stewart.geometry.J = J;
|
|
stewart.geometry.K = K;
|
|
stewart.geometry.C = C;
|
|
|
|
end
|