if (!cs.isCameraNormal) {
setMelodyToQueue(MELODY_CAM_FAILURE);
}
setMelodyToQueue(MELODY_POWER_UP);
standUp();
}
void loop() {
task_CommandService(NULL);
task_BleUploadService(NULL);
task_showBuiltInLed(NULL);
vTaskDelay(20);
static uint32_t lastT = 0;
if (millis() - lastT > 1000) {
// Serial.printf("Total heap: %d\r\n", ESP.getHeapSize());
// Serial.printf("Free heap: %d\r\n", ESP.getFreeHeap());
lastT = millis();
}
}
void loopSecondary(void *pvParameters) {
while (1) {
task_BatteryPowerListener(NULL);
task_showRGBLeds(NULL);
task_AutoWalking(NULL);
task_BuzzerService(NULL);
task_TouchPad(NULL);
vTaskDelay(50);
}
vTaskDelete(xTaskGetCurrentTaskHandle());
}
void serialEventRun() {
static String serialInputString = "";
while (Serial.available()) {
char inChar = (char)Serial.read();
serialInputString += inChar;
if (inChar == '\n') {
enterMessageQueue(serialInputString);
serialInputString = "";
}
}
}