Added gazebo control plugin to mtm.urdf.xacro file
Added custom gazebo controllers for all the joints