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:
- 0:4bfe85fb30ab
- Child:
- 1:e0c4625bbbab
File content as of revision 0:4bfe85fb30ab:
#include "mbed.h" #include "encoder.h" DigitalOut motor2direction(D6); //D4 en D5 zijn motor 2 (op het motorshield) PwmOut motor2speed(D7); DigitalOut motor1direction(D4); //D6 en D7 voor motor 1 (op het motorshield) PwmOut motor1speed(D5); InterruptIn stop_knop(D8); int main() { Encoder motor2(D13,D12); int position = motor2.getPosition(); Serial pc(USBTX,USBRX); pc.baud(9600); motor2speed=0.0f; motor2direction=1; wait(0.5); if(stop_knop.read() == 0) { motor2speed=0.0f; } while (true) { while (position <= 12000) { motor2direction = 1; motor2speed = 0.1f; wait(0.1); pc.printf("while1: pos: %d, speed %f \r\n",motor2.getPosition(), motor2.getSpeed()); } while (position >= 70000) { motor2direction = 0; motor2speed = 0.1f; wait(0.1); pc.printf("while2: pos: %d, speed %f \r\n",motor2.getPosition(), motor2.getSpeed()); } while (position <= 700 && position >=4) { motor2speed = 0.1f; wait(0.1); } } }