Jorn Dokter / Mbed 2 deprecated TEB_branch2

Dependencies:   mbed QEI HIDScope biquadFilter MODSERIAL FastPWM

header.h

Committer:
JordanO
Date:
2019-10-04
Revision:
19:07706535ff7b
Parent:
18:266f1ffdc9c4
Child:
20:19f7b0d5ec7b

File content as of revision 19:07706535ff7b:

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


double motorAndEncoder(voltage1, periodMotor1, voltage2, periodMotor2, dt)
    //voltage in PWM (between -1 and 1), -1 for negative direction full power, 1 for positive direction full power
    //period in seconds
    //dt the time between measurements, i.o.w. Ticker timing, for velocity calculation
    //Returns (velocityMotor1, velocityMotor2, countsMotor1[1], countsMotor2[0])
        //Velocity in radians/s