Added a mass controller. Fixed some issues.