Werkend motorscript met led feedback
Dependencies: Encoder MODSERIAL mbed HIDScope
Fork of frdm_Motortryout2 by
main.cpp@6:866d461c7be8, 2015-09-21 (annotated)
- 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?
User | Revision | Line number | New 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 | } |