#include <Pushbutton.h>
#include <ZumoMotors.h>

ZumoMotors motors;
Pushbutton button(ZUMO_BUTTON);

int MOTSP = 200;
int ROT = 1540;


void setup() {



}

void loop() {
  button.waitForButton();
  for(int i = 8; i >= 0; i--){
    drawShape(i);
  }
}

void drawShape(int k) {
  for (int i = 0; i < k; i++) {
    motors.setSpeeds(MOTSP, MOTSP);
    delay(700);
    motors.setSpeeds(-MOTSP, MOTSP);
    delay(ROT / k);
  }
  motors.setSpeeds(MOTSP, -MOTSP);
  delay(ROT / k);
  motors.setSpeeds(0, 0);
  delay(400);
}