main.cpp

00001 #include "mbed.h"
00002 #include "MotorDC.h"
00003 
00004 
00005 MotorDC Motors(p22, p6, p7); //definiranje pinova PWM-a , smjer1,smjer2
00006 AnalogIn pot(p15);
00007 DigitalOut LED_1(LED1);   //Digitalni izlaz - LED1
00008 InterruptIn button(p9);  //interrupt , služi za promjenu smjera vrtnje - tipkalo
00009 float Potenciometar;
00010 int pin;             
00011 
00012 void flip()
00013 {
00014     pin = !pin;
00015     LED_1 = !LED_1;
00016 }
00017 int main() {
00018     button.rise(&flip);  //na rastući brid , ako je vrjednost PIN-a 1 , smjer vrtnje je smjer1, inače smjer2 - vrijednost od potenciometra učitava se pozitivno ili negativno (0 - 1 ili od 0 - -1)
00019     while(1) {
00020         if (pin == 1){
00021         Potenciometar = pot.read();
00022         Motors.speed(-Potenciometar);
00023         }
00024                 else {
00025         Potenciometar = pot.read();
00026         Motors.speed(Potenciometar);
00027         }
00028            }
00029 }