hector_pose_estimation_core: calculate euler angles directly in pose update without Eigen

Eigen's eulerAngles() returns wrong yaw angles in Trusty for some reason.