From a43131639ab9e9a24920849d509ebac3ac7d97c8 Mon Sep 17 00:00:00 2001
From: Samuel <samuel.kay@poivron-robotique.fr>
Date: Sun, 10 Aug 2025 17:38:35 +0200
Subject: [PATCH] WIP

---
 src/main.cpp | 2 ++
 1 file changed, 2 insertions(+)

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;
 }