Tried introducing angle offset for arm movements to take into consideration the actual geometry of the arm.
Added boolean condition statements to allow for easy enable/disable drawing lines/points
Removed some of the unnecessary global declarations in the image manipulation module.
Began converting the drawing logic to discrete functions to make the if-statements easier to read.