CyberWrt модуль "Робот"

[mrjinatan]

Использовал в качестве драйвера стандартную плату машинки Там практически везде стоит realtek rx2 Распиновка такая
6 пин realtek к 3 пину arduino
7 пин realtek к 4 пину arduino
11 пин realtek к 5 пину arduino
10 пин realtek к 10 пину arduino
Плюс данного метода что мы не теряем радио управление машинки
Про подключение светодиодов думаю ясно
В скетче много мусора Потом почищу и вылажу уже с возможностью посигналить

PHP код:

/*
 Скетч для роботы cyber robot с платой машинки вместо драйвера
 Для основы взят скетч MobotBTCar
 Автор mrjinatan
 Фары включаются автоматически при движении
*/


int forward = 5;     // Pin 5 - Вперед
int reverse = 6;    // Pin 6 - Назад
int left = 4;        // Pin 4 - Влево
int right = 3;        // Pin 3  - Вправо
int turbo = 8;        // Pin 8  - Не используеться
int short_lights = 8;    // Pin 8  - Передние Фары
int long_lights = 11;    // Pin 11  - Правый Поворотник
int back_lights = 12;    // Pin 12  - Левый поворотник
int reverse_lights = 9;    // Pin 9  - Задние Фары

char val;  // Variable to receive data from the serial port

void setup() {

  // initialize the digital pins as output
  pinMode(forward, OUTPUT);
  pinMode(reverse, OUTPUT);
  pinMode(left, OUTPUT);
  pinMode(right, OUTPUT);
  pinMode(turbo, OUTPUT);
  pinMode(short_lights, OUTPUT);
  pinMode(long_lights, OUTPUT);
  pinMode(back_lights, OUTPUT);
  pinMode(reverse_lights, OUTPUT);

  Serial.begin(9600);     // Start serial communication at 9600bps
}


// Fordward action
void go_forward() {
  digitalWrite(forward, HIGH);
  digitalWrite(short_lights, HIGH);
  digitalWrite(reverse, LOW);
  digitalWrite(reverse_lights, LOW);
}

// Stop Forward action
void stop_go_forward() {
  digitalWrite(forward, LOW);
}

// Reverse action
void go_reverse() {
  digitalWrite(reverse, HIGH);
  digitalWrite(forward, LOW);
  digitalWrite(short_lights, LOW);
  digitalWrite(reverse_lights, HIGH);
}

// Stop Reverse action
void stop_go_reverse() {
  digitalWrite(reverse, LOW);
  digitalWrite(reverse_lights, LOW);
}

// Turbo action
void go_turbo() {
  digitalWrite(turbo, HIGH);
  digitalWrite(forward, LOW);
  digitalWrite(reverse, LOW);
}

// Stop Turbo action
void stop_go_turbo() {
  digitalWrite(turbo, LOW);
}

// Left action
void go_left() {
  digitalWrite(left, HIGH);
  digitalWrite(right, LOW);
  digitalWrite(back_lights, HIGH);   // turn the LED on (HIGH is the voltage level)
      
}

// Right action
void go_right() {
  digitalWrite(right, HIGH);
  digitalWrite(left, LOW);
  digitalWrite(long_lights, HIGH);   // turn the LED on (HIGH is the voltage level)
}

// Stop turn action
void stop_turn() {
  digitalWrite(right, LOW);
  digitalWrite(left, LOW);
}

// Stop car
void stop_car() {
  digitalWrite(forward, LOW);
  digitalWrite(reverse, LOW);
  digitalWrite(turbo, LOW);
  digitalWrite(right, LOW);
  digitalWrite(left, LOW);
  digitalWrite(reverse_lights, LOW);
  digitalWrite(long_lights, LOW);
  digitalWrite(back_lights, LOW);
}

// Short Lights ON
void lights_on() {
  digitalWrite(short_lights, HIGH);
  digitalWrite(back_lights, HIGH);
}

// Short Lights OFF
void lights_off() {
  digitalWrite(short_lights, LOW);
  digitalWrite(back_lights, LOW);
}

// Long Lights ON
void long_lights_on() {
  digitalWrite(long_lights, HIGH);
}

// Long Lights OFF
void long_lights_off() {
  digitalWrite(long_lights, LOW);
}

// Reverse Lights ON
void back_lights_on() {
  digitalWrite(reverse_lights, HIGH);
}

// Reverse Lights OFF
void back_lights_off() {
  digitalWrite(reverse_lights, LOW);
}
  
// Read serial port and perform command
void performCommand() {
  if (Serial.available()) {
    val = Serial.read();
  }
    if (val == 'W') { // Forward
      go_forward();
    } else if (val == 'k') { // Stop Forward
      stop_go_forward();
    } else if (val == 'S') { // Backward
      go_reverse();
    } else if (val == 'k') { // Stop Backward
      stop_go_reverse();
    } else if (val == 't') { // Turbo
      go_turbo();
    } else if (val == 'k') { // Stop Turbo
      stop_go_turbo();
    } else if (val == 'D') { // Right
      go_right();
    } else if (val == 'A') { // Left
      go_left();
    } else if (val == 'k') { // Stop Turn
      stop_turn();
    } else if (val == 'x') { // Stop
      stop_car();
    } else if (val == 'k') { // Short Lights
      lights_on();
    } else if (val == 'h') { // Stop Short Lights
      lights_off();
    } else if (val == 'h') { // Long Lights
      long_lights_on();
    } else if (val == 'g') { // Stop Long Lights
      long_lights_off();
    }
  
}


void loop() {
  performCommand();
}