The P motor is being sintonized and the pi_control limits are been checked. For now the code is working.