Add helper functions to corobot_core for matrix multiplication and covariance transforms.
Change laser_localization to check only near the current estimated pose.