main.cpp

00001 #include "mbed.h"
00002 #include "encoder.h"
00003 #include "MODSERIAL.h"
00004 #include "HIDScope.h"
00005  
00006 Serial pc(USBTX, USBRX); // tx, rx
00007 DigitalOut led(LED_RED);
00008 DigitalOut motor2direction(D4); //D4 en D5 zijn motor 2 (op het motorshield)
00009 PwmOut motor2speed(D5);
00010 DigitalIn button1(SW3);
00011 HIDScope scope(1);
00012 Ticker ScopeTime;
00013 
00014 void ScopeSend()//Functie die de gegevens voor de scope uitleest en doorstuurt
00015 {
00016     scope.set(0, motor2direction.read());
00017     scope.send();
00018 }
00019 
00020 int main()
00021 {
00022     motor2direction = 0;
00023     motor2speed = 0;
00024     led = 1;
00025     pc.baud(9600);
00026     pc.printf("Tot aan loop werkt");
00027     ScopeTime.attach_us(&ScopeSend, 10e4);
00028     
00029     
00030     while(true)
00031     {
00032            char c = pc.getc();
00033            
00034            switch(c)
00035            {
00036                 case 'f':
00037                 {
00038                     motor2direction = 1;
00039                     motor2speed = 0.5f;
00040                     pc.printf("het werkt\n");
00041                     wait(1);
00042                     led = 0;
00043                     wait(0.2f);
00044                     motor2speed = 0;
00045                     led = 1;
00046                     break;
00047                 }
00048                 
00049                 case 'r':
00050                  {
00051                     motor2direction = 0;
00052                     motor2speed = 0.5f;
00053                     pc.printf("dit werkt ook\n");
00054                     wait(1);
00055                     led = 0;
00056                     wait(0.2f);
00057                     motor2speed = 0;
00058                     led = 1;
00059                     break;
00060                 }
00061             }
00062     }   
00063 }