Since I knew that the beginning of the code would have the diagnostic routine based on holding "0+2" I looked for any cmpi commands. This is what starts the diagnostic mode:
cmpi.b #5,($FFE30F).w
Then I figured out that whole row from the binary: 0=1, 2=4, so it is seeing if 5 is there. The rest was relatively easy. See the attached image.