Firmware for Nxt Robot from CS3240