Ramon Waninge / Mbed 2 deprecated Milestone1

Dependencies:   FastPWM mbed QEI biquadFilter HIDScope MODSERIAL

main.cpp

Committer:
efvanmarrewijk
Date:
2018-10-08
Revision:
6:3c9569087274
Parent:
5:047db32db712
Child:
7:7c005b3cf288
Child:
9:65c52c1f4a57

File content as of revision 6:3c9569087274:

#include "mbed.h"
#include "FastPWM.h"


Ticker motor;


AnalogIn pot1(A1);
AnalogIn pot2(A2);
FastPWM pin5(D5);       // Motor 2 pwm
DigitalOut pin4(D4);    // Motor 2 direction
FastPWM pin6(D6);       // Motor 1 pwm
DigitalOut pin7(D7);    // Motor 1 direction
//float u1  = pot1;

void draai(){
    float u1 = 2.0*(pot1 - 0.5);
    if (u1>0)
    {   pin4 = true;
    }
    else if(u1<0)
    {   pin4 = false;    
    }
    pin5 = fabs(u1);
    
    float u2 = 2.0*(pot2 - 0.5);
    if (u2>0)
    {   pin7 = true;
    }
    else if(u2<0)
    {   pin7 = false;    
    }
    pin6 = fabs(u2);     
}
int main(){
   
    pin5.period_us(50);
    motor.attach(draai, 0.001);
    
    pin6.period_us(50);
    motor.attach(draai, 0.001);
   while(true){
       
    }
}