From 759805c8c83f049a2b85defc9e97dfaebe7f3444 Mon Sep 17 00:00:00 2001
From: cheykrym <cheykrym@cheykrym.cheykrym>
Date: Mon, 30 Mar 2026 03:51:48 +0300
Subject: [PATCH] add init stage 3

---
 src/main.cpp | 14 +++++++++-----
 1 file changed, 9 insertions(+), 5 deletions(-)

diff --git a/src/main.cpp b/src/main.cpp
index 0a3b451..5f2c226 100644
--- a/src/main.cpp
+++ b/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();