Added timestamp to simulated tauAch. Corrected a bug in thruster allocation to reduce chattering.
Added the backcalculation to the PIFF controller. Added the controller idle mode step.
Updated the velocity controller and corrected the windup bug. Added idle mode of operation for velocity and high-level controllers.
Merge on velocity controller.