Remove magic number usage. Fix limits for FP based pid controller PID