#include "motor.h"

Motor m1(22,24,8);
Motor m2(23,25,9);
int a,b,c,d;
int pr;

void setup()
{
  Serial.begin(9600);  
  
  pinMode(40,INPUT);
  pinMode(42,INPUT);
  pinMode(44,INPUT);
  pinMode(46,INPUT);  
}

void loop()
{
  a=digitalRead(40);
  b=digitalRead(42);
  c=digitalRead(44);
  d=digitalRead(46);  
  
/*  
  if( a==1 )
  {
    m1.forward();
    Serial.print("FW");
  }else if( b==1 ){
    m1.startMotor();  
        Serial.print("START");
  }else if( c==1 ){
    m1.stopMotor();  
        Serial.print("STOP");
  }else if( d==1 ){
    m1.backward();
        Serial.print("BW");
  }
*/
  
  if( Serial.available()>0 )
  {
    pr=Serial.read();

    if( pr=='A' )m1.forward();
    if( pr=='B' )m1.backward();  
    if( pr=='C' )m1.stopMotor();
    if( pr=='D' )m1.startMotor();    
    if( pr=='E' )m1.breakMotor();
    if( pr=='F' )m1.changeMotorSpeed( m1.getMotorSpeed()+10 );
    if( pr=='G' )m1.changeMotorSpeed( m1.getMotorSpeed()-10 );
    
    if( pr=='a' )m2.forward();
    if( pr=='b' )m2.backward();  
    if( pr=='c' )m2.stopMotor();
    if( pr=='d' )m2.startMotor();    
    if( pr=='e' )m2.breakMotor();
    if( pr=='f' )m2.changeMotorSpeed( m2.getMotorSpeed()+10 );
    if( pr=='g' )m2.changeMotorSpeed( m2.getMotorSpeed()-10 );    
  }
  
  delay(500);
  
}