Small modification to fit the firmware under 6010 bytes.