- re-organized directory structure so that there is an experimental directory
  * moved MotionSe3PointCrossCovariance in there since it always fails but I don't want to delete it
- updated auto code generator for new directory structure
- fixed gradle intellij submodule names
- Added UtilPlane3D.planeToWorld()
- Added ClosestPoint3D.closestPointOrigin()