Update to fit Face-Vertex notation
Update to fit Face-Vertex notation

Updated createRigidBodyCopy to fit within the Face-Vertex notation
(instead of prior XData-YData-ZData notation)

rpiRobotics/matlab-rigid-body-viz,ChopChopperDan/matlab-rigid-body-viz