Changed BalanceManager to use basic PID