Meant to be Seen

I'm using a shield k1 in my hmd. The problem is that it has annoyng tendency to drift. Especially the yaw axis.
I tried to compensate the drift in a android to mouse script with limited success but when the roll axis change (the tablet is of course held horizontally) the yaw drift is there again. What am i doing wrong?
I also need to know if there is a matematical functtion that i can use to compensate the drift (without using a camera) when i am using trackir functions.
Thanks in advance.

I was actually able to fix the mouse script by using the raw gyro data. And now works perfectly with FPS games.
I still need suggestion on how complensate the drift in trackir emulation thanks again.