Custom PX4 Firmware with the changes