modify the PID parameter of angle;
Add the module of display