I added a timeStep variable to perform an Integral of the angles.