add init stage 3

src/core/servo/servo.cpp

@@ -38,10 +38,16 @@ static uint32_t angleToDuty(int logicalAngle) {
              SERVO_MIN, SERVO_MAX);
 }
 
-void servoInit() {
+bool servoInit() {
   ledcSetup(SERVO_CH, servoFreq, servoRes);
   ledcAttachPin(SERVO_PIN, SERVO_CH);
+  
+  Serial.println("Servo initialized");
+  Serial.printf("  PIN → GPIO%d\n", SERVO_PIN);
+  Serial.printf("  CH  → %d\n", SERVO_CH);
+  
   servoCenter();
+  return true;
 }
 
 void servoCenter() {

src/core/servo/servo.h

@@ -1,6 +1,6 @@
 #pragma once
 
-void servoInit();
+bool servoInit();
 void servoCenter();
 void servoSetAngle(int angle);
 int  servoGetAngle();

src/core/ultrasonic/ultrasonic.cpp

@@ -8,11 +8,17 @@
 // таймаут эха (30 мс ≈ 5 м)
 static const uint32_t ECHO_TIMEOUT_US = 30000;
 
-void ultrasonicInit() {
+bool ultrasonicInit() {
   pinMode(TRIG_PIN, OUTPUT);
   pinMode(ECHO_PIN, INPUT);
 
   digitalWrite(TRIG_PIN, LOW);
+  
+  Serial.println("Ultrasonic initialized");
+  Serial.printf("  TRIG → GPIO%d\n", TRIG_PIN);
+  Serial.printf("  ECHO → GPIO%d\n", ECHO_PIN);
+  
+  return true;
 }
 
 // измерение расстояния

src/core/ultrasonic/ultrasonic.h

@@ -1,6 +1,6 @@
 #pragma once
 
-void ultrasonicInit();
+bool ultrasonicInit();
 
 // возвращает расстояние в см
 // -1 = нет эхо / ошибка