Code for registering and tracking objects in 6-dof space - View it on GitHub