swapped heading angle of second/fourth quadrant, not sure why my algorithm was flawed