Désolée du retard !
/*****Mesure********* (cm)*/ const int COAX =3.6; const int FEMUR =5; const int TIBIAS=10; /**************************/ const int Y_LARGEUR=8.6; const int X_LONGEUR=11.1; const int HAUTEUR=5; const int HAUTEUR_CORPS=5.5; const int EMPATTEMENT=8; const int DISTANCE_patte_G=6;
void IK() { //IK simple (hauteur , latéral , longitudinal ) : double deplacementcentreX; double deplacementcentreY; double deplacementcentreZ; double Offset_Y = (X_LONGEUR / 2) + deplacementcentreY; double Offset_X = Y_LARGEUR / 2 + deplacementcentreX; double Offset_Z = HAUTEUR - (HAUTEUR_CORPS / 2) + deplacementcentreZ; double L = sqrt(pow(HAUTEUR,2)+pow(EMPATTEMENT,2)); //Calcul de l'hypothénuse (Pythagore) Serial.print(L, DEC); Serial.println(); /***Al-Kashi***/ double alpha = acos((-pow(FEMUR,2) + pow(TIBIAS,2) + pow(L,2))/ (2*TIBIAS*L)); double beta = acos((pow(FEMUR,2) - pow(TIBIAS,2) + pow(L,2))/ (2*FEMUR*L)); double gamma = acos((pow(FEMUR,2) + pow(TIBIAS,2) - pow(L,2))/ (2*FEMUR*TIBIAS)); alpha = alpha*57.3; beta = beta*57.3; gamma = gamma*57.3; Serial.print(alpha, DEC); Serial.println(); Serial.print(beta, DEC); Serial.println(); Serial.print(gamma, DEC); Serial.println(); }
hypothenuse = 9.4339809417
//en degrée :
alpha = 29.6365776062
beta = 81.4718017578
gamma = 68.9048843383
Quand pense-tu, cela te semble correcte ?
J'ai pris toutes les dimensions que tu m'a montrée sur t'es schéma
il y a juste hauteur_corps et hauteur la différence ou je suis pas sur, il s'agit de l’épaisseur du corps du robot !