Fix speed and altitude calculation, use special code if using OpenTx. Send heading as well.