My CGR Localization fork from http://www.cs.cmu.edu/~coral/projects/localization/source.html