Hello there!, I stumbled upon your project and I am interested in working on it. Being a robotic engineer for two years now, I have decent experience in ROS and Gazebo and I worked with many robotic models using ROS navigation stack. Feel free to contact me if you are interested!.