Werkend motorscript met led feedback

Dependencies:   Encoder MODSERIAL mbed HIDScope

Fork of frdm_Motortryout2 by Robert Schulte

Committer:
Margreeth95
Date:
Mon Sep 21 11:45:59 2015 +0000
Revision:
6:866d461c7be8
Parent:
5:672798238952
Child:
7:7fce8b4db9d8
Startup HIDSCope;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Rvs94 0:c8684fed9b61 1 #include "mbed.h"
Rvs94 0:c8684fed9b61 2 #include "encoder.h"
Rvs94 0:c8684fed9b61 3 #include "MODSERIAL.h"
Margreeth95 6:866d461c7be8 4 #include "HIDScope.h"
Rvs94 0:c8684fed9b61 5
Rvs94 0:c8684fed9b61 6 Serial pc(USBTX, USBRX); // tx, rx
Rvs94 3:051c91b04acd 7 DigitalOut led(LED_RED);
Rvs94 0:c8684fed9b61 8 DigitalOut motor2direction(D4); //D4 en D5 zijn motor 2 (op het motorshield)
Rvs94 0:c8684fed9b61 9 PwmOut motor2speed(D5);
Rvs94 0:c8684fed9b61 10 DigitalIn button1(SW3);
Margreeth95 6:866d461c7be8 11 HIDScope scope(1);
Margreeth95 6:866d461c7be8 12
Margreeth95 6:866d461c7be8 13 void ScopeSend()
Margreeth95 6:866d461c7be8 14 {
Margreeth95 6:866d461c7be8 15 scope.set(0, motor2direction.read());
Margreeth95 6:866d461c7be8 16 scope.send();
Margreeth95 6:866d461c7be8 17 }
Rvs94 0:c8684fed9b61 18
Rvs94 0:c8684fed9b61 19 int main()
Rvs94 0:c8684fed9b61 20 {
Rvs94 3:051c91b04acd 21 motor2direction = 0;
Rvs94 0:c8684fed9b61 22 motor2speed = 0;
Rvs94 3:051c91b04acd 23 led = 1;
Rvs94 0:c8684fed9b61 24 pc.baud(9600);
Rvs94 0:c8684fed9b61 25 while(true)
Rvs94 0:c8684fed9b61 26 {
Margreeth95 4:69c6cc1247c1 27 char c = pc.getc();
Margreeth95 4:69c6cc1247c1 28 switch(c)
Margreeth95 4:69c6cc1247c1 29 {
Margreeth95 4:69c6cc1247c1 30 case 'f':
Rvs94 0:c8684fed9b61 31 {
Rvs94 3:051c91b04acd 32 motor2direction = 1;
Rvs94 0:c8684fed9b61 33 motor2speed = 0.5f;
Margreeth95 4:69c6cc1247c1 34 pc.printf("het werkt\n");
Rvs94 1:4e65a72b622e 35 wait(1);
Rvs94 3:051c91b04acd 36 led = 0;
Rvs94 1:4e65a72b622e 37 wait(0.2f);
Rvs94 1:4e65a72b622e 38 motor2speed = 0;
Rvs94 3:051c91b04acd 39 led = 1;
Margreeth95 4:69c6cc1247c1 40 break;
Rvs94 0:c8684fed9b61 41 }
Margreeth95 4:69c6cc1247c1 42
Margreeth95 4:69c6cc1247c1 43 case 'r':
Margreeth95 4:69c6cc1247c1 44 {
Margreeth95 5:672798238952 45 motor2direction = 0;
Margreeth95 4:69c6cc1247c1 46 motor2speed = 0.5f;
Margreeth95 4:69c6cc1247c1 47 pc.printf("dit werkt ook\n");
Margreeth95 4:69c6cc1247c1 48 wait(1);
Margreeth95 4:69c6cc1247c1 49 led = 0;
Margreeth95 4:69c6cc1247c1 50 wait(0.2f);
Margreeth95 4:69c6cc1247c1 51 motor2speed = 0;
Margreeth95 4:69c6cc1247c1 52 led = 1;
Margreeth95 4:69c6cc1247c1 53 break;
Margreeth95 4:69c6cc1247c1 54 }
Margreeth95 4:69c6cc1247c1 55 }
Rvs94 0:c8684fed9b61 56 }
Rvs94 0:c8684fed9b61 57 }