Commented out the #define GAZEBO_SIM for the code to work with hardware by default