fixed a bug with true heading