From 23a1d2e19cd4a8d45f1d44a11acdee3ceee927a4 Mon Sep 17 00:00:00 2001
From: Angel Garcia <angel.g.alvar@gmail.com>
Date: Tue, 4 Jun 2019 10:33:17 +0200
Subject: [PATCH] fix silly errors motors

---
 hover-controller/motors.cpp | 17 +++++++++--------
 1 file changed, 9 insertions(+), 8 deletions(-)

diff --git a/hover-controller/motors.cpp b/hover-controller/motors.cpp
index b9d1c66..6730e3b 100644
--- a/hover-controller/motors.cpp
+++ b/hover-controller/motors.cpp
@@ -29,19 +29,19 @@ void all_motors_start() {
 }
 
 int map_esc_per(unsigned int pin, int lv) {
-    int lv_new
+    int lv_new;
     switch(pin) {
         case MAIN_PROP_GPIO:
-            lv = map(*lv, 0, 100, MAIN_PROP_IDLE_PPM, MAIN_PROP_MAX_PPM);
-            blv_newreak;
+            lv_new = map(lv, 0, 100, MAIN_PROP_IDLE_PPM, MAIN_PROP_MAX_PPM);
+            break;
         case LEFT_PROP_GPIO:
-            lv_new = map(*lv, 0, 100, LEFT_PROP_IDLE_PPM, LEFT_PROP_MAX_PPM);
+            lv_new = map(lv, 0, 100, LEFT_PROP_IDLE_PPM, LEFT_PROP_MAX_PPM);
             break;
         case RIGHT_PROP_GPIO:
-            lv_new = map(*lv, 0, 100, RIGHT_PROP_IDLE_PPM, RIGHT_PROP_MAX_PPM);
+            lv_new = map(lv, 0, 100, RIGHT_PROP_IDLE_PPM, RIGHT_PROP_MAX_PPM);
             break;
         default:
-            lv_new = map(*lv, 0, 100, ESC_MIN, ESC_MAX);
+            lv_new = map(lv, 0, 100, ESC_MIN, ESC_MAX);
     }
     return lv_new;
 }
@@ -117,9 +117,10 @@ void motor_process(char*msg){
     if (servo_index == 'R')
         pin = RIGHT_PROP_GPIO;
     else
-    if (servo_index == 'P')
-        advance_both(&msg, &lv, offset);
+    if (servo_index == 'P') {
+        advance_both(msg, &lv, offset);
         return;
+    }
     else {
         eprintf("[motors] index not valid (%c)\n", servo_index);
         strcpy(msg, "ESC_INDX_NOK");