From 94ba49a17cdcce62375db421d7b823efea04715f Mon Sep 17 00:00:00 2001
From: "yorick.geoffre" <yorick.geoffre@etu.uca.fr>
Date: Fri, 21 Apr 2023 19:22:18 +0200
Subject: [PATCH] multicore work

---
 piconaut-caaar.ino | 34 +++++++++++++++++++++++++++-------
 1 file changed, 27 insertions(+), 7 deletions(-)

diff --git a/piconaut-caaar.ino b/piconaut-caaar.ino
index 90a776a..9381678 100644
--- a/piconaut-caaar.ino
+++ b/piconaut-caaar.ino
@@ -3,9 +3,12 @@ const int pwmPins[] = {A1, A2, A3};
 const float minDutyCycle[numPins] = {5.98, 6.03, 6.03};
 const float maxDutyCycle[numPins] = {12.08, 12.02, 11.94};
 const float deadzone = 0.1;
+volatile float mappedDutyCycles[numPins] = {0.0, 0.0, 0.0};
 
 void setup() {
   Serial.begin(9600);
+  delay(5000);
+
   for (int i = 0; i < numPins; i++) {
     pinMode(pwmPins[i], INPUT);
   }
@@ -23,19 +26,36 @@ void loop() {
     float dutyCycle = (float)highDuration / (float)period * 100.0;
 
     // Map the duty cycle value to the range of -1.0 to 1.0
-    float mappedDutyCycle = mapFloat(dutyCycle, minDutyCycle[i], maxDutyCycle[i], -1.0, 1.0);
+    mappedDutyCycles[i] = mapFloat(dutyCycle, minDutyCycle[i], maxDutyCycle[i], -1.0, 1.0);
 
     // Apply deadzone
-    if (mappedDutyCycle > -deadzone && mappedDutyCycle < deadzone) {
-      mappedDutyCycle = 0.0;
+    if (mappedDutyCycles[i] > -deadzone && mappedDutyCycles[i] < deadzone) {
+      mappedDutyCycles[i] = 0.0;
     }
+  }
+
+  delay(10); // Wait for 10ms before the next reading
+}
+
+// Running on core1
+void setup1() {
+  delay(5000);
+}
+
+void loop1() {
+  // Print the pin name and the mapped duty cycle in a format suitable for the Serial Plotter
+  for (int i = 0; i < numPins; i++) {
+    Serial.print("Pin ");
+    Serial.print(pwmPins[i]);
+    Serial.print(": ");
+    Serial.print(mappedDutyCycles[i]);
 
-    // Print the mapped duty cycle in a format suitable for the Serial Plotter
-    Serial.print(mappedDutyCycle);
     if (i < numPins - 1) {
-      Serial.print(",");
+      Serial.print(", ");
     } else {
       Serial.println();
     }
   }
-}
\ No newline at end of file
+
+  delay(10); // Wait for 10ms before the next transmission
+}