main.cpp

00001 #include "mbed.h"
00002 #include "Encoder.h"
00003 int main() {
00004     Encoder angEncoder(p5, p6, p7, p21);
00005     Serial pc(USBTX, USBRX);   
00006     DigitalOut led1(LED1);  
00007     led1 = 1; 
00008     
00009     //zero_ang = 1
00010     angEncoder.init(0);                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                     angEncoder.init(0);
00011     while(1){
00012     int s = angEncoder.angle();
00013     pc.printf("%f\n\r", s);
00014     
00015     }
00016 
00017     }