Removed some annoying standard output messages.
Updated position control gains and added integrator.