angular velocity works

but heading still won't calculate....???