Added matching color.

- Fix all arrays out-of-bounds issue that caused crashing.
- Fix "quit" bug that does not stop the Kinect correctly.