fixed regression: missing float constants
Map<SO3/SE3> unit tests and related bug fix
one step towards bug fix: SO3 map (float unit test cause EXC_BAD_ACCESS)
Access data through coeffs().
Switch order of so3 and translation in SE3 class to help create packed structure.