// speed, direc1, direc2, dp1, m1, dp2, m2, deg

void setup() {
  pinMode(3, OUTPUT);
  pinMode(2, OUTPUT);
  pinMode(4, OUTPUT);
  pinMode(5, OUTPUT);
  pinMode(A1, OUTPUT);
  pinMode(A0, OUTPUT);
  //ChangeMotorBy(3,2,90,0,100);
  //ChangeMotorBy(5,4,90,1,100);
  delay(100);
  Start2Motorfor(255,0,1,2,3,4,5,90);
  Start2Motorfor(255,1,0,2,3,4,5,90);
  analogWrite(A0, 255);
  analogWrite(A1, 255);

//speed 1-255, direction 1/0 1= counterclockwise 0= clockwise, degrees
}
 
void loop() {

}

void ChangeMotorBy(int motor,int dmotor, int po, int dir, int speed) {
for (int i = 0; i < po/1.8; i++){
StartMotor(speed,dir,dmotor,motor);
}
}


void StartMotor(int sp, int direc, int dpin, int MOTOR){
  if (direc == 0) {
    digitalWrite(dpin, HIGH);
  }
  if (direc == 1) {
    digitalWrite(dpin, LOW);
  }
 digitalWrite(MOTOR, HIGH);
 digitalWrite(MOTOR, LOW);
 delay(map(sp,1,255,1,20));
}

void Start2Motorfor(int sp, int direc1,int direc2, int dpin1, int MOTOR1, int dpin2, int MOTOR2, int deg){
  if (direc1 == 0) {
    digitalWrite(dpin1, HIGH);
  }
  if (direc1 == 1) {
    digitalWrite(dpin1, LOW);
  }
   if (direc2 == 0) {
    digitalWrite(dpin2, HIGH);
  }
  if (direc2 == 1) {
    digitalWrite(dpin2, LOW);
  }
 for (int i = 0; i < deg/1.8; i++){
 digitalWrite(MOTOR1, HIGH);
 digitalWrite(MOTOR2, HIGH);
 digitalWrite(MOTOR1, LOW);
 digitalWrite(MOTOR2, LOW);
 delay(map(sp,1,255,1,20));
 }
}