Update firmware.ino

Final version. Bank switching working. Very well optimized.