diff --git a/src/core/servo/servo.cpp b/src/core/servo/servo.cpp index 660245a..8980b80 100644 --- a/src/core/servo/servo.cpp +++ b/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() { diff --git a/src/core/servo/servo.h b/src/core/servo/servo.h index a2b31c7..5d306f4 100644 --- a/src/core/servo/servo.h +++ b/src/core/servo/servo.h @@ -1,6 +1,6 @@ #pragma once -void servoInit(); +bool servoInit(); void servoCenter(); void servoSetAngle(int angle); int servoGetAngle(); diff --git a/src/core/ultrasonic/ultrasonic.cpp b/src/core/ultrasonic/ultrasonic.cpp index 3a3c27e..404bb94 100644 --- a/src/core/ultrasonic/ultrasonic.cpp +++ b/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; } // измерение расстояния diff --git a/src/core/ultrasonic/ultrasonic.h b/src/core/ultrasonic/ultrasonic.h index 81320ef..81d04a3 100644 --- a/src/core/ultrasonic/ultrasonic.h +++ b/src/core/ultrasonic/ultrasonic.h @@ -1,6 +1,6 @@ #pragma once -void ultrasonicInit(); +bool ultrasonicInit(); // возвращает расстояние в см // -1 = нет эхо / ошибка