ICP Scan Registration

[stevenwaslander]

Evaluate 2D scan registration methods and either code up a clean simple one, or select the best available one to use (fastest, most reliable). Ensure a set of options are available to be set for how to use the scan registration method, and tune the options for some generic sets of laser scanner and Kinect (2D) parameters.