Fix path calculation -> add last point to create cycle