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 !

 
	 
					 
				
				
				 
				
				
				




 
				
				
				
 
				
				
				







 
  
	
 
					

