Added a transformation estimation method that uses point-to-plane LM and per-correspondence weights.

Jochen,

Could you please have a quick look, as it is not nice to accept my own pull requests :-) ?

Thanks!