I don't know if anyone is still searching this topic, but referring to the orthogonal issue I have found a solution.
After all calculations are done the W(yaw) was inverted. I was getting a value of 180 and when taught through the 3 point method in User Frame Set Up page, it was -180.
Once I inverted the Yaw the orthogonal issue went away!!