diff --git a/src/main.cpp b/src/main.cpp
index 1285ee6..6e3d994 100644
--- a/src/main.cpp
+++ b/src/main.cpp
@@ -98,6 +98,8 @@ enum etat_t test_ping()
 
 enum etat_t configure_servomoteur(){
   sms_sts.ServoMode(SERVO_ID);
+  sms_sts.writeByte(SERVO_ID, 0x1E, 3);	
+  sms_sts.writeByte(SERVO_ID, 0x12, 3);	// Registre de "Phase"
   return TERMINE;
 }