![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
Untuk Kontrol Atas
Dependencies: Motor mRotaryEncoder mbed
main.cpp
- Committer:
- danielgoodies
- Date:
- 2016-09-19
- Revision:
- 0:bfd2ba3d4b66
File content as of revision 0:bfd2ba3d4b66:
#include "mbed.h" #include "Motor.h" /* Pin Declaration */ Motor Motor1(D6,D7,D8); DigitalIn encoderpin1(D4); /*Encoder punya 2 buah pin input, 1 Vcc, 1 Ground */ DigitalIn encoderpin2(D5); /* Variable Declaration */ int encoder0Pos = 0; int encoder0PinALast = 0; int n = 0; int i = 0; int boolean = 0; /* Main Program */ int main() { Serial pc(USBTX,USBRX); pc.baud(9600); pc.printf(" Test Serial Monitor"); while (1) { /*if(i>=0 && i<=100 && boolean == 0) { i++; if(i==100) { boolean = 1; } } if (i<=100 && i>=0 && boolean == 1) { i--; if(i==0) { boolean = 0; } } */ for (i = 100; i >= 0 ; i--) { Motor1.speed(i*0.01); wait_ms(20); } for (i = 0; i <= 100 ; i++) { Motor1.speed(i*0.01); wait_ms(20); } //Motor1.speed(0.5); n = encoderpin1; if ((encoder0PinALast == 0) && (n == 1)) { if ((encoderpin2) == 0) { encoder0Pos--; } else { encoder0Pos++; } wait_ms(20); pc.printf("%d/n", encoder0Pos); } encoder0PinALast = n; } }