NXT integration

- Integrating NXT robot into the system
- Minor fixes