Migrated Kinect code into Autonomous