Added function to draw line according to algorithm. Still needs to get the correct points
Merged drawLine, and removed some unsued imports