add init stage 3
This commit is contained in:
parent
57c07b07db
commit
759805c8c8
14
src/main.cpp
14
src/main.cpp
@ -25,10 +25,16 @@ void runStartupChecks() {
|
||||
oledShowMain(joyOk ? "Joystick: OK" : "Joystick: NOT FOUND", "IR: NOT FOUND", "", "");
|
||||
delay(DELAY_FOR_STARTUP_CHECKS);
|
||||
|
||||
// TODO: Этап 2-5 (другие проверки)
|
||||
oledSetStage(2, TOTAL_STAGES);
|
||||
// Этап 3: Проверка серво и ультразвука
|
||||
oledSetStage(3, TOTAL_STAGES);
|
||||
bool servoOk = servoInit();
|
||||
bool ultrasonicOk = ultrasonicInit();
|
||||
oledShowMain(servoOk ? "Servo: OK" : "Servo: FAIL",
|
||||
ultrasonicOk ? "Ultrasonic: OK" : "Ultrasonic: FAIL",
|
||||
"", "");
|
||||
delay(DELAY_FOR_STARTUP_CHECKS);
|
||||
|
||||
// TODO: Этап 3-5 (другие проверки)
|
||||
oledSetStage(3, TOTAL_STAGES);
|
||||
delay(DELAY_FOR_STARTUP_CHECKS);
|
||||
|
||||
@ -39,7 +45,7 @@ void runStartupChecks() {
|
||||
delay(DELAY_FOR_STARTUP_CHECKS);
|
||||
|
||||
// Все проверки пройдены
|
||||
oledSetSystemReady(joyOk); // пока только джойстик влияет
|
||||
oledSetSystemReady(joyOk && ultrasonicOk);
|
||||
}
|
||||
|
||||
void setup() {
|
||||
@ -50,8 +56,6 @@ void setup() {
|
||||
// Запуск проверок
|
||||
runStartupChecks();
|
||||
|
||||
servoInit();
|
||||
ultrasonicInit();
|
||||
// faceInit();
|
||||
actuatorsInit();
|
||||
webServerInit();
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user