vato007/picar
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Initialise arrays on the stack in esp32 servo

Browse Source
This commit is contained in:
Piv
2022-07-31 17:50:03 +09:30
parent 985213311d
commit 26647017c3
1 changed files with 5 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
esp32/src/main.cpp
View File

@@ -33,27 +33,25 @@ void setupServos(uint8_t size, uint8_t *calibrationValues)
void modifyServo(uint8_t channel, uint8_t newAngle) void modifyServo(uint8_t channel, uint8_t newAngle)
{ {
if(servos.count(channel) > 0){ if (servos.count(channel) > 0)
{
servos[channel]->write(newAngle); servos[channel]->write(newAngle);
} }
} }
void loop() void loop()
{ {
uint8_t *header = new uint8_t[2]; uint8_t header[2];
Serial.readBytes(header, 2); Serial.readBytes(header, 2);
if (header[0] == 0) if (header[0] == 0)
{ {
uint8_t *calibration = new uint8_t[2 * header[1]]; uint8_t calibration[2 * header[1]];
Serial.readBytes(calibration, header[1]); Serial.readBytes(calibration, header[1]);
setupServos(header[1], calibration); setupServos(header[1], calibration);
delete [] calibration;
} }
else else
{ {
modifyServo(header[0], header[1]); modifyServo(header[0], header[1]);
} }
delete [] header;
} }