Дамир128

Text Views: 53 • 5 days ago • Never expires
#include <Servo.h>

Servo esc; // Выход на регулятор скорости WSDT120A

// Пины подключения датчиков и света
const int PIN_RC_IN     = 2;  // Сигнал газа от приёмника (канал CH2)
const int PIN_ESC_OUT   = 3;  // Выход газа на регулятор WSDT120A
const int PIN_HEADLIGHT = 6;  // Белые фары (через резистор 220 Ом)
const int PIN_STOPLIGHT = 7;  // Красные стоп-сигналы (через резистор 220 Ом)
const int PIN_BUZZER    = 8;  // Активный зуммер (пищалка)
const int PIN_TRIG      = 9;  // Ультразвуковой датчик HC-SR04 (Trig)
const int PIN_ECHO      = 10; // Ультразвуковой датчик HC-SR04 (Echo)
const int PIN_LIGHT     = A0; // Фоторезистор (датчик темноты)
const int PIN_RAIN      = A1; // Красный датчик дождя/воды

void setup() {
  esc.attach(PIN_ESC_OUT);
  pinMode(PIN_RC_IN, INPUT);
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
  pinMode(PIN_HEADLIGHT, OUTPUT);
  pinMode(PIN_STOPLIGHT, OUTPUT);
  pinMode(PIN_BUZZER, OUTPUT);

  esc.writeMicroseconds(1500); // Нейтраль при включении
  Serial.begin(9600);
}

long getDistanceCm() {
  digitalWrite(PIN_TRIG, LOW);
  delayMicroseconds(2);
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);
  long duration = pulseIn(PIN_ECHO, HIGH, 25000);
  if (duration == 0) return 999;
  return duration * 0.034 / 2;
}

void loop() {
  // 1. Читаем сигнал газа от приёмника (если не подключён — нейтраль 1500)
  unsigned long throttle = pulseIn(PIN_RC_IN, HIGH, 25000);
  if (throttle < 900 || throttle > 2100) throttle = 1500;

  // 2. Считываем расстояние, освещённость и датчик дождя
  long dist = getDistanceCm();
  int lightVal = analogRead(PIN_LIGHT); // Меньше 400 = темно
  int rainVal  = analogRead(PIN_RAIN);  // Больше 300 = дождь/вода

  // 3. Автоматические фары в темноте
  digitalWrite(PIN_HEADLIGHT, (lightVal < 400) ? HIGH : LOW);

  // 4. Экстренное автоторможение перед препятствием ближе 45 см
  if (dist < 45 && throttle > 1540) {
    esc.writeMicroseconds(1500);       // Стоп / нейтраль
    digitalWrite(PIN_STOPLIGHT, HIGH); // Стоп-сигналы
    digitalWrite(PIN_BUZZER, HIGH);    // Пищалка
  } else {
    // Ограничение скорости до 60% при дожде
    if (rainVal > 300 && throttle > 1750) {
      throttle = 1750;
    }
    esc.writeMicroseconds(throttle);
    digitalWrite(PIN_STOPLIGHT, (throttle < 1460) ? HIGH : LOW);
    digitalWrite(PIN_BUZZER, LOW);
  }

  // Вывод данных в Монитор порта на ноутбуке
  Serial.print("Dist: "); Serial.print(dist);
  Serial.print(" cm | Light: "); Serial.print(lightVal);
  Serial.print(" | Rain: "); Serial.println(rainVal);
  delay(40);
}
🛡️

Ad Blocker Detected

PasteBin.site is free to use thanks to our sponsors. Please consider disabling your ad blocker or whitelisting our site to support our servers.

Learn More