Simon Ford / Mbed 2 deprecated LabVIEW_PID

Simple PID example for LabVIEW

Dependencies:   mbed

main.cpp

Committer:
simon
Date:
2010-08-02
Revision:
0:e3b759ab4b5c
Child:
1:ddfe18427154

File content as of revision 0:e3b759ab4b5c:

#include "mbed.h"
#include "QEI.h"

PwmOut MotorA(p21);
PwmOut MotorB(p22);
Serial pc(USBTX, USBRX);
QEI Encoder(p29 ,p30, NC, 48);


int main(){
float MotorOutput = 0;
float Percentage = 0;
float NoPulses;

Encoder.reset();

    while(1) {
        pc.scanf("%f", &MotorOutput);     
        NoPulses = Encoder.getPulses();
        Percentage = (NoPulses / 48) * 100;
        pc.printf("%f\n", Percentage);

        if(MotorOutput > 50){
            MotorA = (MotorOutput - 50) * 2 / 100;
            MotorB = 0;
        }else{
            MotorA = 0;
            MotorB =  (50 - MotorOutput) * 2 / 100;
        }
        wait(0.005);
    }
}