Finished MCU->NXT interface!!! :D