AutoBalance - PID Controller

I have another question, which are the equations of the P, I and D?
Mine are right? I have to limit the I?

I'm trying to tune it but seems that there is something wrong...