I think I've finished up the PIDController class, though I should find a way to test it...