monkey2/modules/std/geom/plane.monkey2

Namespace std.geom

#rem monkeydoc @hidden
#end
Alias Planef:Plane<Float>

#rem monkeydoc @hidden
#end
Struct Plane<T>

	Field n:Vec3<T>
	Field d:T
	
	Method New()
	End
	
	Method New( n:Vec3<T>,d:T )
		
		Self.n=n
		Self.d=d
	End
	
	Method New( p:Vec3<T>,n:Vec3<T> )
		
		Self.n=n
		Self.d=-n.Dot( p )
	End
	
	Method New( v0:Vec3<T>,v1:Vec3<T>,v2:Vec3<T> )
		
		n=(v1-v0).Cross(v2-v0).Normalize()
		d=-n.Dot( v0 )
	End
	
	Operator-:Plane()
	
		Return New Plane( -n,-d )
	End
	
	Method Distance:Double( p:Vec3<T> )
		
		Return n.Dot( p )+d
	End
	
	Method Nearest:Vec3<T>( p:Vec3<T> )
		
		Return p-n*Distance( p )
	End
	
	Method TIntersect:Double( line:Line<T> )
		
		Return -Distance( line.o )/n.Dot( line.d )
	End
	
	Method Intersect:Vec3<T>( line:Line<T> )
		
		Return line * TIntersect( line )
	End
	
	Method Intersect:Line<T>( p:Plane<T> )
		
		Local v:=n.Cross( p.n ).Normalize()

		Local o:=p.Intersect( New Line<T>( n*-d,n.Cross( v ) ) )
		
		Return New Line<T>( o,v )
	End
	
End