Math Lib: add isect_line_line_epsilon_v3
This commit is contained in:
		@@ -130,7 +130,12 @@ int isect_line_sphere_v2(const float l1[2], const float l2[2], const float sp[2]
 | 
			
		||||
int isect_seg_seg_v2_point(const float v1[2], const float v2[2], const float v3[2], const float v4[2], float vi[2]);
 | 
			
		||||
bool isect_seg_seg_v2(const float v1[2], const float v2[2], const float v3[2], const float v4[2]);
 | 
			
		||||
 | 
			
		||||
int isect_line_line_v3(const float v1[3], const float v2[3],
 | 
			
		||||
int isect_line_line_epsilon_v3(
 | 
			
		||||
        const float v1[3], const float v2[3],
 | 
			
		||||
        const float v3[3], const float v4[3], float i1[3], float i2[3],
 | 
			
		||||
        const float epsilon);
 | 
			
		||||
int isect_line_line_v3(
 | 
			
		||||
        const float v1[3], const float v2[3],
 | 
			
		||||
        const float v3[3], const float v4[3],
 | 
			
		||||
        float i1[3], float i2[3]);
 | 
			
		||||
bool isect_line_line_strict_v3(const float v1[3], const float v2[3],
 | 
			
		||||
 
 | 
			
		||||
@@ -1562,7 +1562,10 @@ bool isect_axial_line_tri_v3(const int axis, const float p1[3], const float p2[3
 | 
			
		||||
 * 1 - lines are coplanar, i1 is set to intersection
 | 
			
		||||
 * 2 - i1 and i2 are the nearest points on line 1 (v1, v2) and line 2 (v3, v4) respectively
 | 
			
		||||
 */
 | 
			
		||||
int isect_line_line_v3(const float v1[3], const float v2[3], const float v3[3], const float v4[3], float i1[3], float i2[3])
 | 
			
		||||
int isect_line_line_epsilon_v3(
 | 
			
		||||
        const float v1[3], const float v2[3],
 | 
			
		||||
        const float v3[3], const float v4[3], float i1[3], float i2[3],
 | 
			
		||||
        const float epsilon)
 | 
			
		||||
{
 | 
			
		||||
	float a[3], b[3], c[3], ab[3], cb[3], dir1[3], dir2[3];
 | 
			
		||||
	float d, div;
 | 
			
		||||
@@ -1588,7 +1591,7 @@ int isect_line_line_v3(const float v1[3], const float v2[3], const float v3[3],
 | 
			
		||||
		return 0;
 | 
			
		||||
	}
 | 
			
		||||
	/* test if the two lines are coplanar */
 | 
			
		||||
	else if (d > -0.000001f && d < 0.000001f) {
 | 
			
		||||
	else if (UNLIKELY(fabsf(d) <= epsilon)) {
 | 
			
		||||
		cross_v3_v3v3(cb, c, b);
 | 
			
		||||
 | 
			
		||||
		mul_v3_fl(a, dot_v3v3(cb, ab) / div);
 | 
			
		||||
@@ -1628,6 +1631,14 @@ int isect_line_line_v3(const float v1[3], const float v2[3], const float v3[3],
 | 
			
		||||
	}
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int isect_line_line_v3(
 | 
			
		||||
        const float v1[3], const float v2[3],
 | 
			
		||||
        const float v3[3], const float v4[3], float i1[3], float i2[3])
 | 
			
		||||
{
 | 
			
		||||
	const float epsilon = 0.000001f;
 | 
			
		||||
	return isect_line_line_epsilon_v3(v1, v2, v3, v4, i1, i2, epsilon);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/** Intersection point strictly between the two lines
 | 
			
		||||
 * \return false when no intersection is found
 | 
			
		||||
 */
 | 
			
		||||
 
 | 
			
		||||
		Reference in New Issue
	
	Block a user