-
Notifications
You must be signed in to change notification settings - Fork 12
/
Copy pathbasic_elements_3D.cpp
239 lines (203 loc) · 8.45 KB
/
basic_elements_3D.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
//
// 3 次元幾何
//
// verified:
// AOJ 0115 Starship UAZ Advance
// http://judge.u-aizu.ac.jp/onlinejudge/description.jsp?id=0115
// AOJ 1523 Cone Cut
// http://judge.u-aizu.ac.jp/onlinejudge/description.jsp?id=1523
//
#include <iostream>
#include <vector>
#include <cmath>
#include <iomanip>
using namespace std;
//------------------------------//
// 3 次元幾何ライブラリ一式
//------------------------------//
using DD = double;
const DD INF = 1LL<<60; // to be set appropriately
const DD EPS = 1e-10; // to be set appropriately
const DD PI = acosl(-1.0);
DD torad(int deg) {return (DD)(deg) * PI / 180;}
DD todeg(DD ang) {return ang * 180 / PI;}
/* Point */
struct Point3D {
DD x, y, z;
Point3D(DD x = 0.0, DD y = 0.0, DD z = 0.0) : x(x), y(y), z(z) {}
friend ostream& operator << (ostream &s, const Point3D &p) {return s << '(' << p.x << ", " << p.y << ", " << p.z << ')';}
};
Point3D operator + (const Point3D &p, const Point3D &q) {return Point3D(p.x + q.x, p.y + q.y, p.z + q.z);}
Point3D operator - (const Point3D &p, const Point3D &q) {return Point3D(p.x - q.x, p.y - q.y, p.z - q.z);}
Point3D operator * (const Point3D &p, DD a) {return Point3D(p.x * a, p.y * a, p.z * a);}
Point3D operator * (DD a, const Point3D &p) {return Point3D(a * p.x, a * p.y, a * p.z);}
Point3D operator / (const Point3D &p, DD a) {return Point3D(p.x / a, p.y / a), p.z / a;}
Point3D cross (const Point3D &p, const Point3D &q) {
return Point3D(p.y * q.z - p.z * q.y, p.z * q.x - p.x * q.z, p.x * q.y - p.y * q.x);
}
DD dot(const Point3D &p, const Point3D &q) {return p.x * q.x + p.y * q.y + p.z * q.z;}
DD norm(const Point3D &p) {return dot(p, p);}
DD abs(const Point3D &p) {return sqrt(dot(p, p));}
bool eq(const Point3D &p, const Point3D &q) {return abs(p - q) < EPS;}
DD area(const Point3D &a, const Point3D &b, const Point3D &c) { return abs(cross(b - a, c - a)) / 2; }
struct Line3D : vector<Point3D> {
Line3D(const Point3D &a = Point3D(), const Point3D &b = Point3D()) {
this->push_back(a);
this->push_back(b);
}
friend ostream& operator << (ostream &s, const Line3D &l) {return s << '{' << l[0] << ", " << l[1] << '}';}
};
struct Sphere : Point3D {
DD r;
Sphere(const Point3D &p = Point3D(), DD r = 0.0) : Point3D(p), r(r) {}
friend ostream& operator << (ostream &s, const Sphere &c) {return s << '(' << c.x << ", " << c.y << ", " << c.r << ')';}
};
struct Plane : vector<Point3D> {
Plane(const Point3D &a = Point3D(), const Point3D &b = Point3D(), const Point3D &c = Point3D()) {
this->push_back(a);
this->push_back(b);
this->push_back(c);
}
friend ostream& operator << (ostream &s, const Plane &p) {
return s << '{' << p[0] << ", " << p[1] << ", " << p[2] << '}';
}
};
Point3D proj(const Point3D &p, const Line3D &l) {
DD t = dot(p - l[0], l[1] - l[0]) / norm(l[1] - l[0]);
return l[0] + (l[1] - l[0]) * t;
}
Point3D proj(const Point3D &p, const Plane &pl) {
Point3D ph = cross(pl[1] - pl[0], pl[2] - pl[0]);
Point3D pt = proj(p, Line3D(pl[0], pl[0] + ph));
return p + (pl[0] - pt);
}
Point3D refl(const Point3D &p, const Line3D &l) {
return p + (proj(p, l) - p) * 2;
}
Point3D refl(const Point3D &p, const Plane &pl) {
return p + (proj(p, pl) - p) * 2;
}
bool isinterPL(const Point3D &p, const Line3D &l) {
return (abs(p - proj(p, l)) < EPS);
}
DD distancePL(const Point3D &p, const Line3D &l) {
return abs(p - proj(p, l));
}
DD distanceLL(const Line3D &l, const Line3D &m) {
Point3D nv = cross(l[1] - l[0], m[1] - m[0]);
if (abs(nv) < EPS) return distancePL(l[0], m);
Point3D p = m[0] - l[0];
return abs(dot(nv, p)) / abs(nv);
}
vector<Point3D> crosspoint(const Line3D &l, const Plane &pl) {
vector<Point3D> res;
Point3D ph = cross(pl[1] - pl[0], pl[2] - pl[0]);
DD baseLength = dot(l[1] - l[0], ph);
if (abs(baseLength) < EPS) return vector<Point3D>();
DD crossLength = dot(pl[0] - l[0], ph);
DD ratio = crossLength / baseLength;
res.push_back(l[0] + (l[1] - l[0]) * ratio);
return res;
}
vector<Point3D> crosspointSPL(const Line3D &s, const Plane &pl) {
vector<Point3D> res;
Point3D ph = cross(pl[1] - pl[0], pl[2] - pl[0]);
DD baseLength = dot(s[1] - s[0], ph);
if (abs(baseLength) < EPS) return vector<Point3D>();
DD crossLength = dot(pl[0] - s[0], ph);
DD ratio = crossLength / baseLength;
if (ratio < -EPS || ratio > 1.0 + EPS) return vector<Point3D>();
res.push_back(s[0] + (s[1] - s[0]) * ratio);
return res;
}
//------------------------------//
// Exapmles
//------------------------------//
// AOJ 0115 Starship UAZ Advance
void solveAOJ0115() {
Point3D my, en, bar[3];
cin >> my.x >> my.y >> my.z >> en.x >> en.y >> en.z;
for (int i = 0; i < 3; ++i) {
cin >> bar[i].x >> bar[i].y >> bar[i].z;
}
Line3D myen(my, en);
Plane barier(bar[0], bar[1], bar[2]);
vector<Point3D> cps = crosspointSPL(myen, barier);
if (cps.empty()) cout << "HIT" << endl;
else {
Point3D cp = cps[0];
if (area(cp, bar[1], bar[2]) + area(cp, bar[2], bar[0]) + area(cp, bar[0], bar[1]) - area(bar[0], bar[1], bar[2]) > EPS)
cout << "HIT" << endl;
else
cout << "MISS" << endl;
}
}
// 2 次元
struct Point {
DD x, y;
Point(DD x = 0.0, DD y = 0.0) : x(x), y(y) {}
friend ostream& operator << (ostream &s, const Point &p) {return s << '(' << p.x << ", " << p.y << ')';}
};
inline Point operator + (const Point &p, const Point &q) {return Point(p.x + q.x, p.y + q.y);}
inline Point operator - (const Point &p, const Point &q) {return Point(p.x - q.x, p.y - q.y);}
inline Point operator * (const Point &p, DD a) {return Point(p.x * a, p.y * a);}
inline Point operator * (DD a, const Point &p) {return Point(a * p.x, a * p.y);}
inline Point operator * (const Point &p, const Point &q) {return Point(p.x * q.x - p.y * q.y, p.x * q.y + p.y * q.x);}
inline Point operator / (const Point &p, DD a) {return Point(p.x / a, p.y / a);}
inline Point conj(const Point &p) {return Point(p.x, -p.y);}
inline Point rot(const Point &p, DD ang) {return Point(cos(ang) * p.x - sin(ang) * p.y, sin(ang) * p.x + cos(ang) * p.y);}
inline Point rot90(const Point &p) {return Point(-p.y, p.x);}
inline DD cross(const Point &p, const Point &q) {return p.x * q.y - p.y * q.x;}
inline DD dot(const Point &p, const Point &q) {return p.x * q.x + p.y * q.y;}
inline DD norm(const Point &p) {return dot(p, p);}
inline DD abs(const Point &p) {return sqrt(dot(p, p));}
inline DD amp(const Point &p) {DD res = atan2(p.y, p.x); if (res < 0) res += PI*2; return res;}
inline bool eq(const Point &p, const Point &q) {return abs(p - q) < EPS;}
inline bool operator < (const Point &p, const Point &q) {return (abs(p.x - q.x) > EPS ? p.x < q.x : p.y < q.y);}
inline bool operator > (const Point &p, const Point &q) {return (abs(p.x - q.x) > EPS ? p.x > q.x : p.y > q.y);}
inline Point operator / (const Point &p, const Point &q) {return p * conj(q) / norm(q);}
struct Line : vector<Point> {
Line(Point a = Point(0.0, 0.0), Point b = Point(0.0, 0.0)) {
this->push_back(a);
this->push_back(b);
}
friend ostream& operator << (ostream &s, const Line &l) {return s << '{' << l[0] << ", " << l[1] << '}';}
};
Point proj(const Point &p, const Line &l) {
DD t = dot(p - l[0], l[1] - l[0]) / norm(l[1] - l[0]);
return l[0] + (l[1] - l[0]) * t;
}
vector<Point> crosspoint(const Line &l, const Line &m) {
vector<Point> res;
DD d = cross(m[1] - m[0], l[1] - l[0]);
if (abs(d) < EPS) return vector<Point>();
res.push_back(l[0] + (l[1] - l[0]) * cross(m[1] - m[0], m[1] - l[0]) / d);
return res;
}
void solveAOJ1523() {
Point3D X, Y, P;
DD r;
cin >> X.x >> X.y >> X.z >> Y.x >> Y.y >> Y.z >> r >> P.x >> P.y >> P.z;
Line3D l(X, Y);
Point3D PH = proj(P, l);
Point x(0, abs(X - Y));
Point y(0, 0);
Point p(abs(P-PH), abs(PH-Y));
Point a(r, 0);
Point b(-r, 0);
vector<Point> vc = crosspoint(Line(p, a), Line(x, b));
Point c = vc[0];
vector<Point> vd = crosspoint(Line(p, b), Line(x, a));
Point d = vd[0];
Point m = (c + d)/2;
Point h = proj(x, Line(c, d));
DD tsr = r * abs(x.y - m.y) / abs(x - y);
DD sr = sqrt(tsr * tsr - m.x * m.x);
DD tot = PI * r * r * abs(x-y) / 3;
DD sol = PI * abs(c - d) * sr * abs(x - h) / 6;
cout << fixed << setprecision(9) << sol << " " << tot-sol << endl;
}
int main() {
solveAOJ0115();
//solveAOJ1523();
}