#include <Servo.h>

#define DIR_PIN 2
#define STEP_PIN 3

const int button = 48; // un bouton sur la broche 48
const int led = 46;

Servo monServomoteur;
float actualPos=0;

void setup() {
  monServomoteur.attach(8);
  pinMode(button, INPUT_PULLUP);
  pinMode(led, OUTPUT);
  pinMode(DIR_PIN, OUTPUT);
  pinMode(STEP_PIN, OUTPUT);

  digitalWrite(led, HIGH);
  while(digitalRead(button) == LOW){
    rotate(-5, .5);
    delay(50);
  }
  digitalWrite(led,LOW);
  rotate(1200, .08);
  actualPos = 0;
  digitalWrite(led,HIGH);
  delay(2000);
}

void rotate(int steps, float speed){
  int dir = (steps > 0)? HIGH:LOW;
  steps = abs(steps);

  digitalWrite(DIR_PIN,dir);

  float usDelay = (1/speed) * 70;

  for(int i=0; i < steps; i++){
    digitalWrite(STEP_PIN, HIGH);
    delayMicroseconds(usDelay);
    digitalWrite(STEP_PIN, LOW);
    delayMicroseconds(usDelay);
  }
}


void rotateDeg(float deg, float speed){

  int dir = (deg > 0)? HIGH:LOW;
  int rotateDir = (deg > 0)? 1:-1;
  digitalWrite(DIR_PIN,dir);

  int steps = abs(deg)*(2/0.225);
  float usDelay = (1/speed) * 70;
  for(int i=0; i < steps; i++){
    actualPos += rotateDir;
    if(actualPos == 1150){
      delay(500);
      digitalWrite(led,LOW);
      rotate(2*(0-actualPos), speed);
      actualPos = -1149;
      digitalWrite(DIR_PIN,dir);
      digitalWrite(led,HIGH);
      delay(300);
    }
    if(actualPos == -1150){
      delay(500);
      digitalWrite(led,LOW);
      rotate(2*(0-actualPos), speed);
      actualPos = 1149;
      digitalWrite(DIR_PIN,dir);
      digitalWrite(led,HIGH);
      delay(300);
    }
    digitalWrite(STEP_PIN, HIGH);
    delayMicroseconds(usDelay);
    digitalWrite(STEP_PIN, LOW);
    delayMicroseconds(usDelay);
  }
}


int position;
void rotateServo(float angleBase, float angleFin){
  if(angleBase <= angleFin){
    for (position = angleBase; position <= angleFin; position++){
      monServomoteur.write(position);
    }
  }
  if(angleBase > angleFin){
    for (position = angleBase; position <= angleFin; position--){
      monServomoteur.write(position);
    }
  }
}


void loop(){
  // Fait bouger le bras de 0° à 180°
  //rotateServo(0,180);
  //for(int position = 0; position < 180; position++){
  //    monServomoteur.write(position);
  //  }


  if(digitalRead(button) == HIGH) // test si le bouton a un niveau logique HAUT
    {
        digitalWrite(led, LOW); //le bouton est relâché, la LED est allumée
    }
  else  // test si le bouton a un niveau logique différent de HAUT (donc BAS)
    {
        digitalWrite(led, HIGH); //la LED reste éteinte
    }
  delay(50);


  rotateDeg(-40, .2);
  delay(500);
  rotateDeg(10, .2);
  delay(500);
  //rotateDeg(400, .2);
  //delay(1000);
  //rotateDeg(-180, .2);
  //delay(1000);


}