Lars van der Hoeven / Mbed 2 deprecated motorshield_01

Dependencies:   MODSERIAL mbed HIDScope

main.cpp

Committer:
lars123
Date:
2018-10-15
Revision:
0:80f93308a3cd
Child:
1:f75a3567978c

File content as of revision 0:80f93308a3cd:

#include "mbed.h"
#include "MODSERIAL.h"


PwmOut Motor2PWR(D5);
DigitalOut Motor2DIR(D4);
PwmOut Motor1PWR(D6);
DigitalOut Motor1DIR(D7);
AnalogIn Pot1(PTB2);
AnalogIn Pot2(PTB3);
MODSERIAL pc(USBTX, USBRX);

float x = 0;
float y = 0;
int main()
{
Motor1PWR.period_us(60);
while(1){
    if(Pot1<0.45f)
    {
        x = Pot1-1;
    }
    else if(Pot1>0.55f)
    {
        x = Pot1;
    }
    else
    {
        x = 0;   
    }
    
    if(Pot2<0.45f)
    {
        y = Pot2-1;
    }
    else if(Pot2>0.55f)
    {
        y = Pot2;
    }
    else
    {
        y = 0;   
    }
    pc.printf("x = %f, y = %f\r\n",x,y);
    Motor1PWR = fabs(y);
    Motor1DIR = y > 0.0f;
    Motor2PWR = fabs(x);
    Motor2DIR = x > 0.0f;
    wait(0.1f);
    }
return(0);
}