Orientation angle

Using this function, you’ll get the orientation matrix. Please check out this post: Local Joint Coordinate & Rotation Matrix problem