From a923aeaad22db58bb59a57e9fb0efe8820c2d8b5 Mon Sep 17 00:00:00 2001
From: Alexander B <alexandre.bobkov@gmail.com>
Date: Sun, 5 Jan 2025 00:56:48 -0500
Subject: [PATCH] RC

---
 ESP-IDF_Robot/main/rc.h | 40 ++++++++++++++++++++++++++++++++++++++++
 1 file changed, 40 insertions(+)

diff --git a/ESP-IDF_Robot/main/rc.h b/ESP-IDF_Robot/main/rc.h
index 09c2aed61..727a4378e 100644
--- a/ESP-IDF_Robot/main/rc.h
+++ b/ESP-IDF_Robot/main/rc.h
@@ -85,6 +85,46 @@ static void update_pwm (int x, int y) {
         x = x_sum / sample;
         y = y_sum / sample;
         s++;
+
+        if ((x > 0 && x < 500) && (y > 500)) {
+            ESP_LOGW("RC", "FORWARD");
+            // Both sides rotate in forward direction.
+            m.motor1_rpm_pcm = y;   // left, forward
+            m.motor2_rpm_pcm = y;   // right, forward
+            m.motor3_rpm_pcm = 0;
+            m.motor4_rpm_pcm = 0;
+        }
+        else if ((x > 0 && x < 500) && (y < -200)) {
+        ESP_LOGW("RC", "REVERSE");
+        // Both sides rotate in reverse direction.
+        m.motor1_rpm_pcm = 0;
+        m.motor2_rpm_pcm = 0;
+        m.motor3_rpm_pcm = -y;
+        m.motor4_rpm_pcm = -y;
+    }
+    else if ((y < 0 && y > -200) && (x < -1000)) {
+        ESP_LOGW("RC", "LEFT");
+        // Left side rotates in forward direction, right side rotates in reverse direction.
+        m.motor1_rpm_pcm = -x;
+        m.motor2_rpm_pcm = 0;
+        m.motor3_rpm_pcm = -x;
+        m.motor4_rpm_pcm = 0;
+    }
+    else if ((y < 0 && y > -200) && (x > 1000)) {
+        ESP_LOGW("RC", "RIGHT");
+        // Right side rotates in forward direction, left side rotates in reverse direction.
+        m.motor1_rpm_pcm = 0;
+        m.motor2_rpm_pcm = x; 
+        m.motor3_rpm_pcm = 0;
+        m.motor4_rpm_pcm = x; 
+    }
+    else {
+        ESP_LOGW("RC", "STAND STILL");
+        m.motor1_rpm_pcm = 0;
+        m.motor2_rpm_pcm = 0;
+        m.motor3_rpm_pcm = 0;
+        m.motor4_rpm_pcm = 0;
+    }
     }
     else {
         x_sum = 0;