multicore work

master
Yorick GEOFFRE 2 years ago
parent c91f3567e7
commit 94ba49a17c

@ -3,9 +3,12 @@ const int pwmPins[] = {A1, A2, A3};
const float minDutyCycle[numPins] = {5.98, 6.03, 6.03}; const float minDutyCycle[numPins] = {5.98, 6.03, 6.03};
const float maxDutyCycle[numPins] = {12.08, 12.02, 11.94}; const float maxDutyCycle[numPins] = {12.08, 12.02, 11.94};
const float deadzone = 0.1; const float deadzone = 0.1;
volatile float mappedDutyCycles[numPins] = {0.0, 0.0, 0.0};
void setup() { void setup() {
Serial.begin(9600); Serial.begin(9600);
delay(5000);
for (int i = 0; i < numPins; i++) { for (int i = 0; i < numPins; i++) {
pinMode(pwmPins[i], INPUT); pinMode(pwmPins[i], INPUT);
} }
@ -23,19 +26,36 @@ void loop() {
float dutyCycle = (float)highDuration / (float)period * 100.0; float dutyCycle = (float)highDuration / (float)period * 100.0;
// Map the duty cycle value to the range of -1.0 to 1.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 // Apply deadzone
if (mappedDutyCycle > -deadzone && mappedDutyCycle < deadzone) { if (mappedDutyCycles[i] > -deadzone && mappedDutyCycles[i] < deadzone) {
mappedDutyCycle = 0.0; mappedDutyCycles[i] = 0.0;
}
} }
// Print the mapped duty cycle in a format suitable for the Serial Plotter delay(10); // Wait for 10ms before the next reading
Serial.print(mappedDutyCycle); }
// 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]);
if (i < numPins - 1) { if (i < numPins - 1) {
Serial.print(","); Serial.print(", ");
} else { } else {
Serial.println(); Serial.println();
} }
} }
delay(10); // Wait for 10ms before the next transmission
} }
Loading…
Cancel
Save