Finish polygon drawing on last point
Add some tests for drawing polygons