quad_parameters.m

L_sh_f_x = L_sh_f(1);L_sh_h_x = L_sh_h(1);L_th_h_x=L_th_h(1);L_th_f_x=L_th_f(1);L_th_h_mid_x=L_th_h_mid(1);L_h_x=L_h(1);
L_sh_f_y = L_sh_f(2);L_sh_h_y = L_sh_h(2);L_th_h_y=L_th_h(2);L_th_f_y=L_th_f(2);L_th_h_mid_y=L_th_h_mid(2);L_h_y=L_h(2); 
L_sh_f_z = L_sh_f(3);L_sh_h_z = L_sh_h(3);L_th_h_z=L_th_h(3);L_th_f_z=L_th_f(3);L_th_h_mid_z=L_th_h_mid(3);L_h_z=L_h(3); 

d_sh_fr_x=d_sh_fr(1);d_sh_fl_x=d_sh_fl(1);d_sh_hr_x= d_sh_hr(1);d_sh_hl_x=d_sh_hl(1);
d_th_fr_x=d_th_fr(1);d_th_fl_x=d_th_fl(1);d_th_hr_x=d_th_hr(1);d_th_hl_x=d_th_hl(1);d_th_mid_hr_x=d_th_mid_hr(1);d_th_mid_hl_x=d_th_mid_hl(1);
d_hip_fr_x=d_hip_fr(1);d_hip_fl_x=d_hip_fl(1);d_hip_hr_x=d_hip_hr(1);d_hip_hl_x=d_hip_hl(1);d_b_x=d_b(1);
d_sh_fr_y=d_sh_fr(2);d_sh_fl_y=d_sh_fl(2);d_sh_hr_y=d_sh_hr(2);d_sh_hl_y=d_sh_hl(2);
d_th_fr_y=d_th_fr(2);d_th_fl_y=d_th_fl(2);d_th_hr_y=d_th_hr(2);d_th_hl_y=d_th_hl(2);d_th_mid_hr_y=d_th_mid_hr(2);d_th_mid_hl_y=d_th_mid_hl(2);
d_hip_fr_y=d_hip_fr(2);d_hip_fl_y=d_hip_fl(2);d_hip_hr_y=d_hip_hr(2);d_hip_hl_y=d_hip_hl(2);d_b_y=d_b(2);
d_sh_fr_z=d_sh_fr(3);d_sh_fl_z=d_sh_fl(3);d_sh_hr_z=d_sh_hr(3);d_sh_hl_z=d_sh_hl(3);
d_th_fr_z=d_th_fr(3);d_th_fl_z=d_th_fl(3);d_th_hr_z=d_th_hr(3);d_th_hl_z=d_th_hl(3);d_th_mid_hr_z=d_th_mid_hr(3);d_th_mid_hl_z=d_th_mid_hl(3);
d_hip_fr_z=d_hip_fr(3);d_hip_fl_z=d_hip_fl(3);d_hip_hr_z=d_hip_hr(3);d_hip_hl_z=d_hip_hl(3);d_b_z=d_b(3);