Jorik Burghardt / Mbed 2 deprecated template_biorobotics

Motor speed controlled by potmeter

Dependencies:   mbed QEI HIDScope biquadFilter MODSERIAL FastPWM

main.cpp

Committer:
s1932896
Date:
2019-10-03
Revision:
9:c9cff697f4ab
Parent:
5:78a5043b6658
Child:
10:76dfdbdd20cd

File content as of revision 9:c9cff697f4ab:

#include "mbed.h"
//#include "HIDScope.h"
#include "QEI.h"
#include "MODSERIAL.h"
//#include "BiQuad.h"
#include "FastPWM.h"

DigitalOut motor1(D4);
PwmOut e1(D5);
PwmOut e2(D6);
DigitalOut motor2(D7); 

DigitalIn encoder1a(D12);
DigitalIn encoder1b(D13);
AnalogIn pot1(A1);
AnalogIn pot2(A2);

MODSERIAL pc(USBTX, USBRX);

int main()
{
  pc.baud(115200);
  pc.printf("\r\nStarting...\r\n\r\n");
QEI enc1(D12,D13,NC,64,QEI::X4_ENCODING);
  
  while(true)
  {
    
    pc.printf("%i   ",enc1.getPulses());
    pc.printf("%i   ",enc1.getRevolutions());
    pc.printf("%f\r\n",pot1.read());
    wait_ms(100);
    }
    
}