merged, compiling, gazebo working, added joint_names_ vector