Двигатель постоянного тока

gxfdg

авпп

Рис. 1.

Рис. 2.

Рис. 3.

Рис. 4.

int ldp = 4;    // Left direction pin
int rdp = 7;    // Right direction pin
int lsp = 5;    // Left speed pin
int rsp = 6;    // Right speed pin
int D = 10;     // difference

void setup() {
  pinMode(ldp, OUTPUT);
  pinMode(rdp, OUTPUT);
  delay(1000);
}

void loop() {
  digitalWrite(ldp, HIGH);
  digitalWrite(rdp, HIGH);
  analogWrite(lsp, 150 - D);
  analogWrite(rsp, 150 + D);
  delay(2000);
  analogWrite(lsp, 0);
  analogWrite(rsp, 0);
  delay(1000);
}

Прог. 1.

Функции пользователя

Пп

int ldp = 4;    // Left direction pin
int rdp = 7;    // Right direction pin
int lsp = 5;    // Left speed pin
int rsp = 6;    // Right speed pin
int D = 10;     // difference

void left() {

}

void right() {

}

void forward(int sp) {            // Вперёд(Скорость)
  digitalWrite(ldp, HIGH);
  digitalWrite(rdp, HIGH);
  analogWrite(lsp, sp - D);
  analogWrite(rsp, sp + D);
}

void stopCar() {                  // Останов
  analogWrite(lsp, 0);
  analogWrite(rsp, 0);
}

void setup() {
  pinMode(ldp, OUTPUT);
  pinMode(rdp, OUTPUT);
  delay(1000);
}

void loop() {
  forward(150);
  delay(2000);
  stopCar();
  delay(1000);
}

Прог. 2.

Задание 1. Напишите функции поворот направо, налево разворот на месте и вокруг колеса, движение назад.

Задание 2. Напишите программы движения робота по тректории овал, прямоугольник, восьмёрка.

Arduino