Upgraded bresenham, fill tool wip