Updated, Bresenham not working :(