Jorn Dokter / Mbed 2 deprecated TEB_branch2

Dependencies:   mbed QEI HIDScope biquadFilter MODSERIAL FastPWM

header.h

Committer:
JordanO
Date:
2019-10-03
Revision:
18:266f1ffdc9c4
Parent:
15:95034d92bc76
Child:
19:07706535ff7b

File content as of revision 18:266f1ffdc9c4:

double ControllerPID(double e, double Ts); //e = error, Ts = sampling time


double motorAndEncoder(voltage1, periodMotor1, voltage2, periodMotor2, directionMotor1, directionMotor2, dt)
    //voltage in PWM (between 0 and 1)
    //period in seconds
    //dt the time between measurements, i.o.w. Ticker timing
    //directionMotor either 1 or 0
    //Returns (velocityMotor1, velocityMotor2, countsMotor1[1], countsMotor2[0])
        //Velocity in radians/s