From c91e9de20a2d4b2cfcef97013a80de123cfc0d28 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Sergi=20Hern=C3=A1ndez?= <shernand@iri.upc.edu>
Date: Wed, 5 Oct 2016 23:23:09 +0200
Subject: [PATCH] Solved a bug: incremented the current servo index after each
 iteration.

---
 src/motion_manager.c | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/src/motion_manager.c b/src/motion_manager.c
index 8077fcd..afb91e3 100755
--- a/src/motion_manager.c
+++ b/src/motion_manager.c
@@ -295,7 +295,7 @@ void manager_init(uint16_t period_us)
       // set the action current angles
       manager_current_angles[i]=manager_servos[i].current_angle<<9;
       manager_num_servos++;
-      current=0;
+      current++;
     }
     else
     {
-- 
GitLab