Regressore.. - Ingegneria Meccanica, Nucleare e della Produzione

5.1. Studio di cinematica diretta, cinematica differenziale e dinamicaJp[4] = Transpose[{jpl[4, 1], jpl[4, 2], jpl[4, 3],jpl[4, 4], {0, 0, 0}, {0, 0, 0}}];Jo[4] = Transpose[{jol[4, 1], jol[4, 2], jol[4, 3],jol[4, 4], {0, 0, 0}, {0, 0, 0}}];Calcolo del Jacobiano del link 5Jp[5] = Transpose[{jpl[5, 1], jpl[5, 2], jpl[5, 3], jpl[5, 4],jpl[5, 5], {0, 0, 0}}];Jo[5] = Transpose[{jol[5, 1], jol[5, 2], jol[5, 3], jol[5, 4],jol[5, 5], {0, 0, 0}}];Calcolo del Jacobiano del link 6Jp[6] = Transpose[{jpl[6, 1], jpl[6, 2], jpl[6, 3], jpl[6, 4], jpl[6, 5],jpl[6, 6]}];Jo[6] = Transpose[{jol[6, 1], jol[6, 2], jol[6, 3], jol[6, 4], jol[6, 5],jol[6, 6]}];Calcolo dei tensori d’inerzia baricentrici in terna fissaI0[i_] := R0[i].Ig[i].Transpose[R0[i]];Calcolo dei contributi alla matrice d’inerzia BBp[i_] := m[i]*Transpose[Jp[i]].Jp[i];Bo[i_] := Transpose[Jo[i]].I0[i].Jo[i];Costruzione della matrice d’inerzia BB = Sum[Bp[i] + Bo[i], {i, 1, 6}];Calcolo di C (matrice delle forze centrifughe e di Coriolis)calcolo i simboli di Christoffelch[i_, j_, k_] :=1/2 (D[B[[i, j]], q[t][[k]]] + D[B[[i, k]], q[t][[j]]] -D[B[[j, k]], q[t][[i]]])calcolo gli elementi della matrice Cc[i_, j_] := Sum[ch[i, j, k]*qp[t][[k]], {k, 1, 6}]Costruzione della matrice CCoriolis = {{c[1, 1], c[1, 2], c[1, 3], c[1, 4], c[1, 5], c[1, 6]}, {c[2, 1],26