Bouke Scheltinga / Mbed 2 deprecated Werk_college_23sept

Werkcollege opgave 23 september BMT K9

Dependencies:   Encoder HIDScope MODSERIAL mbed QEI biquadFilter

main.cpp

Committer:
bscheltinga
Date:
2015-10-01
Revision:
11:73817c9df1e5
Parent:
10:2f76fa4cd2a7
Child:
12:0a079e86348e

File content as of revision 11:73817c9df1e5:

#include "mbed.h"
#include "encoder.h"
#include "MODSERIAL.h"

//Motor 2
DigitalOut motor2direction(D4); //D4 en D5 zijn motor 2 (op het motorshield)
PwmOut motor2speed(D5);

Encoder encoder(D13,D12); // kanalen waar de encoder op zit
MODSERIAL pc(USBTX,USBRX); //zorgt er voor dat putty kan schrijven

//4200 counts per rev. counts/4200 = rev

int main()
{
    pc.baud(9600);
    
    while(1) {

        for (double n=0.0f; n<1.0f; n+=0.1f) {
            encoder.setPosition(0);
            motor2speed = n;
            pc.printf("position: %d\r\n", encoder.getPosition());
            wait(5);
        }
    }
}