Teensy: Square Pattern

Make your robot walk around a square pattern.

// Square Pattern 
// 6/6/19 
// Arduino 1.8.5 

// Set up pins 
const int OnBoardLED = 13; 
int Dlay = 500; 

void setup() 
{ 
  pinMode(9,OUTPUT); // set the pin modes to output 
  pinMode(10, OUTPUT); 
  pinMode(11,OUTPUT); 
  pinMode(12,OUTPUT); 
  pinMode(OnBoardLED,OUTPUT); 
} 

void loop() 
{ 
  blinky(); // blink the light 
  forward(1000); // move forward 
  stopBot(1000); // briefly pause 
  turnRight(1);  // turn at a right angle 
} 

void blinky() 
{ 
  digitalWrite(OnBoardLED, LOW); // flash on board LED 
  delay(Dlay); 
  digitalWrite(OnBoardLED, HIGH); 
  delay(Dlay); 
} 

void forward(int amt) 
{ 
  digitalWrite(9,HIGH); // make left motor move forward 
  digitalWrite(10,LOW); 
  digitalWrite(11,HIGH); // make right motor move forward 
  digitalWrite(12,LOW); 
  delay(amt); 
} 

void stopBot(int pause) 
{ 
  digitalWrite(9,LOW); // stop both motors 
  digitalWrite(10,LOW); 
  digitalWrite(11,LOW); 
  digitalWrite(12,LOW); 
} 

void turnRight(double dlay) 
{ 
  digitalWrite(9,HIGH); // make the left motor move forward 
  digitalWrite(10,LOW); 
  digitalWrite(11,LOW); // stop the right motor 
  digitalWrite(12,LOW); 
  delay(dlay); 
}