Added adjustCoords, getAngle, calcAngle

Might need more for this not sure