In plane and height error

[stefangachter]

Sometimes it is convenient to have the translation error split up into in-plane and height error. Assuming that reference trajectory is gravity aligned, then in-plane error is distance of x- and y-components and height error is z-component. The implementation adds two pose relations in-plane-part and height-part and computes the error accordingly.