Finished implementation of bresenham implementation