Betago / Mbed 2 deprecated BETAGO

10/25/2015

Dependencies:   PID mbed MaxSonar eeprom iSerial Fork_Boss_Communication_Robot

main.cpp

Committer:
palmdotax
Date:
2015-10-16
Revision:
0:f02641e3fb91
Child:
1:7c3dbf140bfc

File content as of revision 0:f02641e3fb91:

#include"mbed.h"
#include "PID.h"
InterruptIn encoderA(D6);
InterruptIn encoderB(D5);

//DigitalIn encoderB(D5);


Serial pc(SERIAL_TX,SERIAL_RX);
 int Encoderpos = 0;
 int valocity =0;

void EncoderA()
{   if(encoderB==0)
        { Encoderpos = Encoderpos + 1;}
    else
   { Encoderpos = Encoderpos -1;}
   // pc.printf("do");
   //Encoderpos = Encoderpos + 1;
   valocity+=1;
   pc.printf("%d \n",Encoderpos);
}
  

void EncoderB()
{ 
    if(encoderA==1)
    { Encoderpos = Encoderpos + 1;}
    else
    { Encoderpos = Encoderpos -1;}
    pc.printf("%d",Encoderpos);
}

int main()
{
    pc.baud(115200);
    encoderA.rise(&EncoderA);
   pc.printf("Encode\n");
    
    
    while(1)
    {
       // pc.printf("Encode\n");
        //wait(1);
       // pc.printf("%d \n",Encoderpos);
         
    }  
}