Bas van Buuren / Mbed 2 deprecated motor_input

Functie van het slaan van de bal

Dependencies:   Encoder HIDScope mbed-dsp mbed MODSERIAL

main.cpp@0:8af618dc161b, 2014-10-28 (annotated)

Committer:
BasvanBuuren
Date:
Tue Oct 28 11:50:05 2014 +0000
Revision:
0:8af618dc161b
Child:
1:729c475805f5
Functie voor het slaan van de bal

Who changed what in which revision?

UserRevisionLine numberNew contents of line
BasvanBuuren 0:8af618dc161b 1 #include "mbed.h"
BasvanBuuren 0:8af618dc161b 2 #include "HIDScope.h"
BasvanBuuren 0:8af618dc161b 3 //#include "mbed-dsp.h"
BasvanBuuren 0:8af618dc161b 4 #include "encoder.h"
BasvanBuuren 0:8af618dc161b 5
BasvanBuuren 0:8af618dc161b 6 #define MAXENCO -900
BasvanBuuren 0:8af618dc161b 7 #define MINENCO 0
BasvanBuuren 0:8af618dc161b 8
BasvanBuuren 0:8af618dc161b 9 Encoder encoderA(PTD0,PTD2);
BasvanBuuren 0:8af618dc161b 10 PwmOut m1_speed(PTA5);
BasvanBuuren 0:8af618dc161b 11 DigitalOut m1_dir(PTA4);
BasvanBuuren 0:8af618dc161b 12
BasvanBuuren 0:8af618dc161b 13 void spank();
BasvanBuuren 0:8af618dc161b 14 int y1;
BasvanBuuren 0:8af618dc161b 15
BasvanBuuren 0:8af618dc161b 16 void spank()
BasvanBuuren 0:8af618dc161b 17 {
BasvanBuuren 0:8af618dc161b 18 float enca;
BasvanBuuren 0:8af618dc161b 19 enca=encoderA.getPosition();
BasvanBuuren 0:8af618dc161b 20
BasvanBuuren 0:8af618dc161b 21 if (enca > MINENCO)
BasvanBuuren 0:8af618dc161b 22 {
BasvanBuuren 0:8af618dc161b 23 switch(y1)
BasvanBuuren 0:8af618dc161b 24 {
BasvanBuuren 0:8af618dc161b 25
BasvanBuuren 0:8af618dc161b 26 case 1:
BasvanBuuren 0:8af618dc161b 27 m1_dir=1;
BasvanBuuren 0:8af618dc161b 28 m1_speed=0.33;
BasvanBuuren 0:8af618dc161b 29 break;
BasvanBuuren 0:8af618dc161b 30 case 2:
BasvanBuuren 0:8af618dc161b 31 m1_dir=1;
BasvanBuuren 0:8af618dc161b 32 m1_speed=0.66;
BasvanBuuren 0:8af618dc161b 33 break;
BasvanBuuren 0:8af618dc161b 34 case 3:
BasvanBuuren 0:8af618dc161b 35 m1_dir=1;
BasvanBuuren 0:8af618dc161b 36 m1_speed=1.0;
BasvanBuuren 0:8af618dc161b 37 break;
BasvanBuuren 0:8af618dc161b 38 default :
BasvanBuuren 0:8af618dc161b 39 m1_speed=0;
BasvanBuuren 0:8af618dc161b 40 }
BasvanBuuren 0:8af618dc161b 41 while(enca>MAXENCO);
BasvanBuuren 0:8af618dc161b 42 m1_speed=0;
BasvanBuuren 0:8af618dc161b 43 m1_dir=0;
BasvanBuuren 0:8af618dc161b 44 while(enca<MINENCO)
BasvanBuuren 0:8af618dc161b 45 {
BasvanBuuren 0:8af618dc161b 46 m1_speed=0.4;
BasvanBuuren 0:8af618dc161b 47 }
BasvanBuuren 0:8af618dc161b 48 m1_speed=0;
BasvanBuuren 0:8af618dc161b 49 }
BasvanBuuren 0:8af618dc161b 50 }
BasvanBuuren 0:8af618dc161b 51
BasvanBuuren 0:8af618dc161b 52 int main()
BasvanBuuren 0:8af618dc161b 53 {
BasvanBuuren 0:8af618dc161b 54 while(1)
BasvanBuuren 0:8af618dc161b 55 {
BasvanBuuren 0:8af618dc161b 56 y1=3;
BasvanBuuren 0:8af618dc161b 57 spank();
BasvanBuuren 0:8af618dc161b 58 }
BasvanBuuren 0:8af618dc161b 59 }