Real-time correlative scan matching
Numerical Recipes in C, 2nd Edition.