add init stage 2
This commit is contained in:
parent
895fdb264e
commit
2c1e20ee0a
22
src/main.cpp
22
src/main.cpp
@ -22,7 +22,16 @@ void runStartupChecks() {
|
||||
// Этап 1: Проверка джойстика
|
||||
oledSetStage(1, TOTAL_STAGES);
|
||||
bool joyOk = joyInit();
|
||||
oledShowMain(joyOk ? "Joystick: OK" : "Joystick: NOT FOUND", "IR: NOT FOUND", "", "");
|
||||
oledShowMain(joyOk ? "Joystick: OK" : "Joystick: NOT FOUND",
|
||||
"IR: NOT FOUND",
|
||||
"", "");
|
||||
delay(DELAY_FOR_STARTUP_CHECKS);
|
||||
|
||||
// Этап 2: Проверка Face дисплея
|
||||
oledSetStage(2, TOTAL_STAGES);
|
||||
bool faceOk = false; // faceInit();
|
||||
oledShowMain("Face display: FAIL",
|
||||
"", "", "");
|
||||
delay(DELAY_FOR_STARTUP_CHECKS);
|
||||
|
||||
// Этап 3: Проверка серво и ультразвука
|
||||
@ -30,14 +39,11 @@ void runStartupChecks() {
|
||||
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);
|
||||
ultrasonicOk ? "Ultrasonic: OK" : "Ultrasonic: FAIL",
|
||||
"", "");
|
||||
delay(DELAY_FOR_STARTUP_CHECKS);
|
||||
|
||||
// TODO: Этап 4-5 (другие проверки)
|
||||
oledSetStage(4, TOTAL_STAGES);
|
||||
delay(DELAY_FOR_STARTUP_CHECKS);
|
||||
|
||||
@ -45,7 +51,7 @@ void runStartupChecks() {
|
||||
delay(DELAY_FOR_STARTUP_CHECKS);
|
||||
|
||||
// Все проверки пройдены
|
||||
oledSetSystemReady(joyOk && ultrasonicOk);
|
||||
oledSetSystemReady(joyOk && servoOk && ultrasonicOk);
|
||||
}
|
||||
|
||||
void setup() {
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user