FPV Heading

Just fixing an small error on #493.

When merged will close #475.