Simon Ford
/
LabVIEW_PID
Simple PID example for LabVIEW
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); } }