Was accidentally getting bank instead of heading with get_relHdg

Will probably need to modify controller gains