Fix printing floating points in PidController