press buttons on biorobotics shield to rotate motor in certain direction

Dependencies:   Encoder HIDScope MODSERIAL mbed

main.cpp

Committer:
Vigilance88
Date:
2015-09-20
Revision:
1:e0c4625bbbab
Parent:
0:4bfe85fb30ab
Child:
2:1656c259189f

File content as of revision 1:e0c4625bbbab:

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

 
Encoder encoder1(D13,D12);
DigitalOut motor2direction(D4); //D4 en D5 zijn motor 2 (op het motorshield)
PwmOut motor2speed(D5);
 
 
int main()
{
    int position = encoder1.getPosition();
    Serial pc(USBTX,USBRX);
    pc.baud(9600);
    motor2speed=0.0f;
    motor2direction=1;
   
    
    if(stop_knop.read() == 0) {
        motor2speed=0.0f;
    }
    while (true) {
        
          pc.printf("pos: %d, speed %f \r\n",encoder1.getPosition(), encoder1.getSpeed());
    }
}