Cleanup logmap stuff

[fergujm2]

I am pretty sure that I can replace all of my

Pose3::Logmap(a.between(b))

with

a.localCoordinates(b)

And that would likely be less code and probably faster as well.