Well, because you are running the firmware on a different hardware platform, I am not sure how to help you diagnose. I don’t have an Arduino Mega 2560 so I won’t be able to test. To start, maybe you should check the RAM usage of the compiled firmware and make sure it’s not exceeding the capability of Mega 2560.