SITL: fixed compass vector to be based on yaw not GPS heading

Many thanks to Randy for noticing this, and apologies for the wasted time!