How to get consistent yaw and pitch angular velocity measurements in a moving frame of reference
With some help, I was able to figure out code, that does what I need. I've uploaded it here. Hopefully somebody find it useful, it has comments describing the steps being taken, but in all honesty I do not understand the maths behind it.