I can't seem to debug that in my code.....
I'd think that printing the actual heading and the desired heading would provide the information needed to see which way the robot should turn. Printing out which way it actually turned would confirm whether the right, or wrong, decision was made.