#include "Public.h"
DataQueue<String> mqMotion(2); // Motion message queue, When there are too many messages, some
messages can be ignored to reduce latency.
DataQueue<String> mqInfo(100); // Info message queue, Important, can not ignore.
void setup() {
Serial.begin(115200);
Serial.println("\n\nProgram begin ... ");
bleSetup();
prefs.begin(NMSPC_STORAGE);
pca.begin();
pca.releaseAllServo();
getServoOffsetFromStorage();
getLedConfigFromStorage();
cs.begin();
setupAdc();
setupBuzzer();
setupSonar();
setupRGBLED();
setupBuiltInLed();
setupTouchPad();
Serial.println("setup finished!\n\n");
startTask(TASK_MOTION_SERVICE);
startTask(TASK_SECONDRAY); // loop2