Is this correct?
if (x >= 0) {
>.......angle = pi4 - pi4 * (x-yabs) / (x+yabs);
} else {
.......angle = pi34 - pi4 * (x+yabs) / (yabs-x);
}
Shouldn't it be:
if (x >= 0) {
>.......angle = pi34 - pi4 * (x-yabs) / (x+yabs);
} else {
.......angle = pi34 - pi4 * (x+yabs) / (yabs-x);
}