Moved code that was assuming Twist msg in cmd_vel
Changed requested_velocity type to float in TurtlebotSensorState.msg