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 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();
}
}
}
delay(10); // Wait for 10ms before the next transmission
}

Loading…
Cancel
Save