main/src/georegression/geometry/UtilShape3D_F64.java
public static void polygon2Dto3D(Polygon2D_F64 polygon2D , Se3_F64  polyToWorld , FastQueue<Point3D_F64> output )
	{
		output.resize(polygon2D.size());

		for (int i = 0; i < polygon2D.size(); i++) {
			Point2D_F64 p2 = polygon2D.get(i);
			Point3D_F64 p3 = output.get(i);
			p3.set(p2.x, p2.y,0);
			SePointOps_F64.transform(polyToWorld,p3,p3);
		}
	}
public static void polygon2Dto3D(Polygon2D_F64 polygon2D , Se3_F64  polyToWorld , FastQueue<Point3D_F64> output )
	{
		output.resize(polygon2D.size());

		for (int i = 0; i < polygon2D.size(); i++) {
			Point2D_F64 p2 = polygon2D.get(i);
			Point3D_F64 p3 = output.get(i);
			p3.set(p2.x, p2.y,0);
			SePointOps_F64.transform(polyToWorld,p3,p3);
		}
	}
Converts a 2D polygon into a 3D polygon. The 2D points will lie on the x-y plane (e.g. (x,y,0)) and are
converted to 3D using polyToWorld.

@param polygon2D (Input) polygon
@param polyToWorld (Output) transform from 2D to 3D coordinate system.
@param output