proj6: basic scan matching using libicp, need to calculate covariance roughly