Add Logarithmic Map for Isometry (SE(3) -> se(3))

[yixing312]

Thank you for maintaining this repository! I am currently using the Isometry struct to represent transformations in SE(3). It would be beneficial for my project if Isometry could directly support the logarithmic map from SE(3) to its Lie algebra se(3).