Hi,
Thanks for your help.
Maybe one example. If I try in this way, I don’t get a proper solution. What could be wrong here?
a_dist = [0.00000, -0.24365, -0.21325, 0.00000, 0.00000, 0.0000];
d_dist = [0.1519, 0.00000, 0.00000, 0.11235, 0.08535, 0.0819];
alpha = [1.570796327, 0, 0, 1.570796327, -1.570796327, 0];
theta = [0, 0, 0, 0, 0, 0];
delta_theta = [1.46784724364846482e-05, 0.125194454792358717, 0.298589965416812431, -0.423762927247810284, 2.086302247193182e-05, 6.34186815268841846e-05];
delta_a = [-8.87759482873081237e-05, 0.00174067219841378407, 0.018781396149157692, -3.43075675452437408e-05, 8.01439469991615784e-05, 0];
delta_d = [0.000119445309967824986, 6.28815128450737859, 13.7825040349252923, -20.070881238468619, -6.53242862541092428e-05, 0.000412314188898782463];
delta_alpha = [0.00170780282864457789, 0.00484436940923784701, 0.00437109159076555162, 0.000652816409936640696, -0.00010301091898123893, 0];
L(1) = Link([theta(1)+delta_theta(1), d_dist(1)+delta_d(1), a_dist(1)+delta_a(1), alpha(1)+delta_alpha(1)]);
L(2) = Link([theta(2)+delta_theta(2), d_dist(2)+delta_d(2), a_dist(2)+delta_a(2), alpha(2)+delta_alpha(2)]);
L(3) = Link([theta(3)+delta_theta(3), d_dist(3)+delta_d(3), a_dist(3)+delta_a(3), alpha(3)+delta_alpha(3)]);
L(4) = Link([theta(4)+delta_theta(4), d_dist(4)+delta_d(4), a_dist(4)+delta_a(4), alpha(4)+delta_alpha(4)]);
L(5) = Link([theta(5)+delta_theta(5), d_dist(5)+delta_d(5), a_dist(5)+delta_a(5), alpha(5)+delta_alpha(5)]);
L(6) = Link([theta(6)+delta_theta(6), d_dist(6)+delta_d(6), a_dist(6)+delta_a(6), alpha(6)+delta_alpha(6)]);
Thanks you and best regards!
Mitja