Code from my research project with TurtleBot and the XBox Kinect, summer 2012