Дамир128
#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);
}
Featured
Advertisement
Category
Action