Марченко ПК41 самостійна тема 3 — Arduino Uno simulation

An interactive Arduino Uno circuit simulation you can run free in your browser on Velxio, by sophiia.

Components

Sketch code

#include <Wire.h>
#include <Servo.h>

#define TRIG 10
#define ECHO 11

#define SERVO_PIN 12

#define MOTOR_LEFT 2
#define MOTOR_RIGHT 3

#define BUMPER_LEFT 4
#define BUMPER_RIGHT 5

#define MPU_ADDR 0x68

Servo sensorServo;

volatile bool bumperTriggered = false;

const int DISTANCE_LIMIT = 20;

// Переривання кнопок D4 і D5
ISR(PCINT2_vect)
{
  if (!(PIND & _BV(PD4)) || !(PIND & _BV(PD5)))
  {
    bumperTriggered = true;

    // Негайне вимкнення обох лампочок
    PORTD &= ~(_BV(PD2) | _BV(PD3));
  }
}


// Вимірювання відстані
long getDistance()
{
  digitalWrite(TRIG, LOW);
  delayMicroseconds(2);

  digitalWrite(TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG, LOW);

  long duration = pulseIn(ECHO, HIGH, 25000);

  if (duration == 0)
    return 999;

  return duration * 0.0343 / 2;
}


// Зупинка
void stopRobot()
{
  digitalWrite(MOTOR_LEFT, LOW);
  digitalWrite(MOTOR_RIGHT, LOW);
}


// Рух вперед
void moveForward()
{
  digitalWrite(MOTOR_LEFT, HIGH);
  digitalWrite(MOTOR_RIGHT, HIGH);
}


// Імітація повороту
void turnRobot(int direction, int angle)
{
  stopRobot();

  Serial.print("Turn: ");
  Serial.println(angle);

  // Поворот праворуч
  if (direction == 1)
  {
    digitalWrite(MOTOR_LEFT, HIGH);
    digitalWrite(MOTOR_RIGHT, LOW);
  }
  // Поворот ліворуч
  else
  {
    digitalWrite(MOTOR_LEFT, LOW);
    digitalWrite(MOTOR_RIGHT, HIGH);
  }

  // Часова імітація кута
  if (angle == 90)
    delay(900);
  else
    delay(1800);

  stopRobot();
  delay(300);

  Serial.println("Turn completed");
}


// Очікування відпускання кнопок
void waitButtonsRelease()
{
  while (digitalRead(BUMPER_LEFT) == LOW ||
         digitalRead(BUMPER_RIGHT) == LOW)
  {
    delay(10);
  }

  delay(50);
}


void setup()
{
  Serial.begin(9600);

  pinMode(TRIG, OUTPUT);
  pinMode(ECHO, INPUT);

  pinMode(MOTOR_LEFT, OUTPUT);
  pinMode(MOTOR_RIGHT, OUTPUT);

  pinMode(BUMPER_LEFT, INPUT_PULLUP);
  pinMode(BUMPER_RIGHT, INPUT_PULLUP);

  sensorServo.attach(SERVO_PIN);
  sensorServo.write(90);

  // Ініціалізація гіроскопа
  Wire.begin();

  Wire.beginTransmission(MPU_ADDR);
  Wire.write(0x6B);
  Wire.write(0);
  Wire.endTransmission();

  delay(100);

  // Увімкнення переривань для D4 та D5
  PCICR |= _BV(PCIE2);
  PCMSK2 |= _BV(PCINT20) | _BV(PCINT21);

  Serial.println("Robot ready");

  moveForward();
}


void loop()
{
  // Перевірка переривання
  bool event;

  noInterrupts();
  event = bumperTriggered;
  bumperTriggered = false;
  interrupts();

  if (event)
  {
    stopRobot();

    delay(50);

    bool left = digitalRead(BUMPER_LEFT) == LOW;
    bool right = digitalRead(BUMPER_RIGHT) == LOW;

    Serial.println("BUMPER ACTIVATED!");

    if (left && right)
    {
      turnRobot(1, 180);
    }
    else if (left)
    {
      turnRobot(1, 90);
    }
    else if (right)
    {
      turnRobot(-1, 90);
    }

    waitButtonsRelease();

    moveForward();

    return;
  }

  // Контроль перешкоди
  long distance = getDistance();

  Serial.print("Distance: 

More projects by sophiia