codigo no pendulo invertido