merged, compiling, working in gazebo, added sensor_msgs