Correction to code after testing.
Verified MODE0 works.