22 lines
585 B
Matlab
22 lines
585 B
Matlab
function frctn = ur10_frctn_rgsr(qd_fltrd)
|
|
% xi = 1e-4;
|
|
% cont_Clmb_frcn = 0;
|
|
%
|
|
% frctn = zeros(6,3);
|
|
% if cont_Clmb_frcn
|
|
% for i = 1:6
|
|
% frctn(i,:) = [qd_fltrd(i), tanh(qd_fltrd(i)/xi), 1];
|
|
% end
|
|
% else
|
|
% for i = 1:6
|
|
% frctn(i,:) = [qd_fltrd(i), sign(qd_fltrd(i)), 1];
|
|
% end
|
|
% end
|
|
frctn = zeros(6,18);
|
|
% for i = 1:6
|
|
% frctn(i,3*i-2:3*i) = [qd_fltrd(i), sign(qd_fltrd(i)), 1];
|
|
% end
|
|
for i = 1:6
|
|
frctn(i,3*i-2:3*i) = [qd_fltrd(i), tanh(qd_fltrd(i)/1e-2), 1];
|
|
end
|
|
end |