add ultrasonic

src/main.cpp

@@ -6,11 +6,13 @@
 #include "robot_state.h"
 #include "ws_server.h"
 #include "servo.h"
+#include "ultrasonic.h"
 
 void setup() {
   Serial.begin(115200);
 
   servoInit();
+  ultrasonicInit();
   actuatorsInit();
   webServerInit();
   wsInit();

src/ultrasonic.cpp

@@ -0,0 +1,38 @@
+#include <Arduino.h>
+#include "ultrasonic.h"
+
+// ===== PIN CONFIG =====
+#define TRIG_PIN 32
+#define ECHO_PIN 33
+
+// таймаут эха (30 мс ≈ 5 м)
+static const uint32_t ECHO_TIMEOUT_US = 30000;
+
+void ultrasonicInit() {
+  pinMode(TRIG_PIN, OUTPUT);
+  pinMode(ECHO_PIN, INPUT);
+
+  digitalWrite(TRIG_PIN, LOW);
+}
+
+// измерение расстояния
+int ultrasonicReadCm() {
+  // триггер
+  digitalWrite(TRIG_PIN, LOW);
+  delayMicroseconds(2);
+
+  digitalWrite(TRIG_PIN, HIGH);
+  delayMicroseconds(10);
+  digitalWrite(TRIG_PIN, LOW);
+
+  // читаем эхо
+  uint32_t duration = pulseIn(ECHO_PIN, HIGH, ECHO_TIMEOUT_US);
+
+  if (duration == 0) {
+    return -1;  // нет эха
+  }
+
+  // скорость звука ≈ 343 м/с
+  int distance = duration / 58;
+  return distance;
+}

src/ultrasonic.h

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

src/web_server.cpp

@@ -5,6 +5,7 @@
 #include "web_ui.h"
 #include "controller.h"
 #include "robot_state.h"
+#include "ultrasonic.h"
 
 static WebServer server(80);
 
@@ -68,13 +69,16 @@ void handleMode() {
 }
 
 void handleStatus() {
+  int dist = ultrasonicReadCm();
+
   String json = "{";
 
   json += "\"mode\":\"" + String(modeToStr(robot.mode)) + "\",";
   json += "\"speedL\":" + String(robot.speedL) + ",";
   json += "\"speedR\":" + String(robot.speedR) + ",";
   json += "\"rssi\":" + String(WiFi.RSSI()) + ",";
-  json += "\"uptime\":" + String(millis());
+  json += "\"uptime\":" + String(millis()) + ",";
+  json += "\"distance_cm\":" + String(dist);
 
   json += "}";
 

src/web_ui.cpp

@@ -125,13 +125,14 @@ function wsConnect(){
         `MODE=${j.mode} | ` +
         `L=${j.speedL} R=${j.speedR} | ` +
         `RSSI=${j.rssi}dBm | ` +
+        `DIST=${j.distance_cm < 0 ? '---' : j.distance_cm + 'cm'} | ` +
         `UP=${Math.floor(j.uptime/1000)}s`
         );
     }catch(e){
         st('STATUS ERR');
     }
   }
-  setInterval(updateStatus, 500);
+  setInterval(updateStatus, 5000);
 
   // управление "пока держишь" (heartbeat)
   function bindHold(btn, onPressCmd){