Fix bresenham2