I have found out there is an illegal opcode in line 43 of the code.

Those guys from MChip please verify this.

Thank you

Sam