Rosalyn Sleurink / Mbed 2 deprecated frdm_countdegrees

Test programma voor de encoder

Dependencies:   Encoder MODSERIAL mbed

main.cpp@1:8a78b9be5e0e, 2015-09-18 (annotated)

Committer:
roosalyn
Date:
Fri Sep 18 14:13:33 2015 +0000
Revision:
1:8a78b9be5e0e
Parent:
0:f5c7335c5903 
a program to test the encoder and the output to putty; position works, speed doesn't work

Who changed what in which revision?

UserRevisionLine numberNew contents of line
roosalyn 0:f5c7335c5903 1 #include "mbed.h"
roosalyn 0:f5c7335c5903 2 #include "encoder.h"
roosalyn 0:f5c7335c5903 3 #include "MODSERIAL.h"
roosalyn 0:f5c7335c5903 4
roosalyn 0:f5c7335c5903 5 Encoder encoder1(D13,D12);
roosalyn 0:f5c7335c5903 6 DigitalOut motor2direction(D4); //D4 en D5 zijn motor 2 (op het motorshield)
roosalyn 0:f5c7335c5903 7 PwmOut motor2speed(D5);
roosalyn 0:f5c7335c5903 8 MODSERIAL pc(USBTX,USBRX);
roosalyn 1:8a78b9be5e0e 9 int round = 4200; //4200 is gelijk aan 360 graden!!!! :D
roosalyn 0:f5c7335c5903 10
roosalyn 0:f5c7335c5903 11 int main()
roosalyn 0:f5c7335c5903 12 {
roosalyn 0:f5c7335c5903 13 encoder1.setPosition(0);
roosalyn 0:f5c7335c5903 14 pc.baud(9600);
roosalyn 0:f5c7335c5903 15 motor2direction = 1;
roosalyn 0:f5c7335c5903 16 motor2speed = 0.2f;
roosalyn 0:f5c7335c5903 17
roosalyn 0:f5c7335c5903 18 while (true) {
roosalyn 1:8a78b9be5e0e 19 pc.printf("pos: %d, speed: %.20f\r\n", encoder1.getPosition(), encoder1.getSpeed());
roosalyn 0:f5c7335c5903 20
roosalyn 1:8a78b9be5e0e 21 if (encoder1.getPosition()>10*round){
roosalyn 0:f5c7335c5903 22 motor2speed=0.0;
roosalyn 0:f5c7335c5903 23 }
roosalyn 0:f5c7335c5903 24
roosalyn 0:f5c7335c5903 25 }
roosalyn 0:f5c7335c5903 26 }