Improved all utils. Added a mass controller.