Parameter tuning

PID and rho, alpha, beta values tested for simulation and hardware mode