Sorry that asking is easier than answering, but this is your find out so I need to ask from you. I still think that att_to_thrust_vector’s coordinates is relative to att_to body frame because it is the result of the multiplication with att_to_rot_matrix. These coordinates relates to att_to body frame unit vectors, not the inertial frame unit vectors of x, y, z in NED inertial frame.