//Motor-ATTiny Pins
const int T4_Blue = 3; 
const int T1_Black = 0; 
const int T3_Red = 2; 
const int T2_Yellow = 1; 
const int maxnumberofsteps = 48;
//Step Control
int currentstep = 0; // Indicates in which step I am (0,47)-> your motor do 48 steps in one rotation
int current_location = 0; // Indicates in which position I am (0 to 11)
int num_of_steps = 0;
String inString = "";

//Hall Effect 
int hallsensor = 4;//pin PB3
int digitalVal;//digital readings

#define step_delay 500 

void stepMotor(int step_t) {
   switch (step_t) //
  {
    case 0:
    //Serial.println("Yellow/Red HIGH");
       digitalWrite(T4_Blue, LOW);
       digitalWrite(T1_Black, LOW);
       digitalWrite(T3_Red, HIGH);
       digitalWrite(T2_Yellow, HIGH);

    break;
    
    case 1:
       digitalWrite(T2_Yellow, LOW);
       digitalWrite(T4_Blue, LOW);
       digitalWrite(T1_Black, HIGH);
       digitalWrite(T3_Red, HIGH);


    break;

    case 2:
       digitalWrite(T3_Red, LOW);
       digitalWrite(T2_Yellow, LOW); 
       digitalWrite(T4_Blue, HIGH);
       digitalWrite(T1_Black, HIGH);
  
    break;

    case 3:
       digitalWrite(T1_Black, LOW);
       digitalWrite(T3_Red, LOW);
       digitalWrite(T4_Blue, HIGH);
       digitalWrite(T2_Yellow, HIGH);
    break;
    
  }
 // Serial.print("step_t ");
  //Serial.print(step_t);    
 }

// Move x steps (negative will move backwards)
void step(int steps_to_move)
{
  int steps_left = abs(steps_to_move);  // how many steps to take

  int direction = 0;

  // determine direction based on whether steps_to_mode is + or -:

  if (steps_to_move > 0) {
    direction = 1;
  }

  if (steps_to_move < 0) {
    direction  = 0;
  }

  // decrement the number of steps, moving one step each time:

  while (steps_left > 0)

  {

    // increment or decrement the step number,

    // depending on direction:

    if (direction == 1)

    {
      currentstep++;

      if (currentstep == maxnumberofsteps) {
        currentstep = 0;
      }
    }
    else // direction==0
    {
      if (currentstep == 0) {
        currentstep = maxnumberofsteps;
      }
      currentstep--;
    }
    // decrement the steps left:
    steps_left--;

    // step the motor to step number 0, 1, ..., {3 or 10}
    stepMotor(currentstep % 4);
      //Serial.print("Stepleft: ");
  //Serial.println(steps_left);
  delay (step_delay);
  }

}

//Move to position
void moveToLocation(int location){
  num_of_steps = (location - current_location)*4; // Each location is 30 degrees. You have then 4 steps per locations

  current_location = location;
 Serial.print("steps: ");
 Serial.println(num_of_steps);
  step (num_of_steps);
  }


void setup() {

  pinMode(T4_Blue, OUTPUT);
  pinMode(T1_Black, OUTPUT);
  pinMode(T3_Red, OUTPUT);
  pinMode(T2_Yellow, OUTPUT);
  Serial.swap(1);
  Serial.begin(9600);

  pinMode(hallsensor,INPUT);
  
  //step(5);
  while (true){
    step(1);
    digitalVal = digitalRead(hallsensor);
    if (digitalVal==LOW){ //low = detect
      break;
    }
    else{
      }
  } 
  currentstep=0;
}

void loop() {

// put your main code here, to run repeatedly:
    //for location10, 11 and 12, which are more than 1 byte
  while (Serial.available()>0) {
   int inChar = Serial.read();
    if (isDigit(inChar)) {
      // convert the incoming byte to a char and add it to the string:
      inString += (char)inChar;
    }
    // if you get a newline, print the string, then the string's value:
    if (inChar == '\n') {
      //Serial.print("Value:");
      int location = inString.toInt();
      //Serial.println(location);
      //Serial.print("String: ");
      //Serial.println(inString);
      // clear the string for new input:
      
      inString = "";//
      
      Serial.print("location: ");
      Serial.println(location);
      moveToLocation(location);
      //step(location);
    }
  }
/*
for (int i=0; i<=48; i++){ //It should do ¼

Serial.println(i);

stepMotor(i%4); //module result from 0 to 4

delay(2000);

Serial.println("Moving 12");
step(12);
delay (5000);
Serial.println("Moving 24");
step(24);
delay(5000);
Serial.println("Moving 48");
step(48);
delay(5000);

Serial.println("location 3");
moveToLocation(3);
Serial.println(current_location);
delay (5000);
Serial.println("location 5");
moveToLocation(5);
Serial.println(current_location);
delay(5000);
Serial.println("location 11");
moveToLocation(11);
Serial.println(current_location);
delay(5000);
Serial.println("location 6");
moveToLocation(6);
Serial.println(current_location);
delay(5000);*/

}