Added 3D point and line and tests