IRDYn/autogen/standard_regressor_Two_bar.m

27 lines
731 B
Matlab

function out1 = standard_regressor_Two_bar(in1,in2,in3)
%standard_regressor_Two_bar
% OUT1 = standard_regressor_Two_bar(IN1,IN2,IN3)
% This function was generated by the Symbolic Math Toolbox version 9.1.
% 10-Jan-2024 23:01:38
q2 = in1(2,:);
qd1 = in2(1,:);
qd2 = in2(2,:);
qdd1 = in3(1,:);
qdd2 = in3(2,:);
t2 = cos(q2);
t3 = sin(q2);
t4 = qd1+qd2;
t5 = qdd1+qdd2;
t6 = qd1.^2;
t7 = qdd1.*t2;
t8 = qdd1.*t3;
t9 = t4.^2;
t10 = t2.*t6;
t11 = t3.*t6;
t12 = -t8;
t13 = t7+t11;
t14 = t10+t12;
out1 = reshape([0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,qdd1,0.0,t2.*t13+t3.*(t8-t10),0.0,t13+t2.*t5-t3.*t9,t13,t14-t3.*t5-t2.*t9,t14,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,t5,t5],[2,20]);