[math] use math functions in orientation conversion
[math] wgs84_ellipsoid_to_geoid as function