Update sensor_interface_2560.ino

bug fixed where modes would not switch correctly. MAFR updates