现在的位置: 首页 > 综合 > 正文

UVA 11275 3D Triangles

2019年04月06日 ⁄ 综合 ⁄ 共 2121字 ⁄ 字号 评论关闭

大意略。

简单的三维空间判三角形相交。

#include <iostream>
#include <cstdlib>
#include <cstdio>
#include <string>
#include <cstring>
#include <cmath>
#include <vector>
#include <queue>
#include <stack>
#include <algorithm>
using namespace std;

struct Point3
{
	double x, y, z;
	Point3(double x=0, double y=0, double z=0): x(x), y(y), z(z) {};
};

const double eps = 1e-8;

typedef Point3 Vector3;

int dcmp(double x)
{
	if(fabs(x) < eps) return 0; else return x < 0 ? -1 : 1;
}

Vector3 operator + (const Vector3& A, const Vector3& B) { return Vector3(A.x+B.x, A.y+B.y, A.z+B.z); }
Vector3 operator - (const Point3& A, const Point3& B) { return Vector3(A.x-B.x, A.y-B.y, A.z-B.z); }
Vector3 operator * (const Vector3& A, double p) { return Vector3(A.x*p, A.y*p, A.z*p); }
Vector3 operator / (const Vector3& A, double p) { return Vector3(A.x/p, A.y/p, A.z/p); }

bool operator == (const Point3 &a, const Point3 &b)
{
	return dcmp(a.x-b.x) == 0 && dcmp(a.y-b.y) == 0 && dcmp(a.z-b.z) == 0;
}

double Dot(Vector3 A, Vector3 B) { return A.x*B.x + A.y*B.y + A.z*B.z; }
double Length(Vector3 A) { return sqrt(Dot(A, A)); }
double Angle(Vector3 A, Vector3 B) { return acos(Dot(A, B) / Length(A) / Length(B)); }

Vector3 Cross(Vector3 A, Vector3 B) { return Vector3(A.y*B.z - A.z*B.y, A.z*B.x - A.x*B.z, A.x*B.y - A.y*B.x); }
double Area2(Point3 A, Point3 B, Point3 C) { return Length(Cross(B-A, C-A)); }



bool PointInTri(Point3 P, Point3 P0, Point3 P1, Point3 P2)
{
	double area1 = Area2(P, P0, P1);
	double area2 = Area2(P, P1, P2);
	double area3 = Area2(P, P2, P0);
	return dcmp(area1 + area2 + area3 - Area2(P0, P1, P2)) == 0;
}

bool TriSegIntersection(Point3 P0, Point3 P1, Point3 P2, Point3 A, Point3 B, Point3 &P)
{
	Vector3 n = Cross(P1-P0, P2-P0);
	if(dcmp(Dot(n, B-A)) == 0) return false;
	else
	{
		double t = Dot(n, P0-A) / Dot(n, B-A);
		if(dcmp(t) < 0 || dcmp(t-1) > 0) return false;
		P = A + (B-A)*t;
		return PointInTri(P, P0, P1, P2);
	}
}

bool TriTriIntersection(Point3 *T1, Point3 *T2)
{
	Point3 P;
	for(int i = 0; i < 3; i++)
	{
		if(TriSegIntersection(T1[0], T1[1], T1[2], T2[i], T2[(i+1)%3], P)) return true;
		if(TriSegIntersection(T2[0], T2[1], T2[2], T1[i], T1[(i+1)%3], P)) return true;		
	}
	return false;
}

Point3 read_point3()
{
	Point3 A;
	scanf("%lf%lf%lf", &A.x, &A.y, &A.z);
	return A;
}

Point3 T1[3], T2[3];

void solve()
{
	for(int i = 0; i < 3; i++) T1[i] = read_point3();
	for(int i = 0; i < 3; i++) T2[i] = read_point3();
	if(TriTriIntersection(T1, T2)) printf("1\n");
	else printf("0\n");
}

int main()
{
	int T;
	scanf("%d", &T);
	while(T--)
	{
		solve();
	}
	return 0;
}

 

抱歉!评论已关闭.