Added adjustCoords, getAngle, calcAngle

May need more things, not sure