【POJ 1556】The Doors（计算几何）

The Doors

题目链接：POJ 1556

题目大意

给你一个 10*10 的图，你要从 (0,5) 走到 (10,5)，然后有一些横坐标会有墙壁（不一定是整数位置），然后每个墙壁有两个开口。
然后问你最少路径是多少。

思路

你发现我们肯定是在起点终点，墙开口的角之间走（否则你就可以直接直线跨越过去）

所以我们可以把这些点找出来，能走的就连边，然后直接跑最短路。

接着就是看能不能走，你就枚举中间的墙，看是不是挡住了。
然后这个不能直接用判断两线段是否有交来看，因为是可以刚好摸到的。
所以你就变形一下即可。

代码

#include<queue>
#include<cmath>
#include<cstdio>
#include<cstring>
#include<iostream>

using namespace std;

struct dot {
	double x, y; int br;
}a[8002], seg[5002][6];
int n, m;
double pl, x, y, xx, yy;
const double eps = 1e-8;
const double INF = 0x3f3f3f3f;
struct node {
	double x;
	int to, nxt;
}e[300001];
int le[8002], KK;
double dis[8002];

dot operator +(dot x, dot y) {
	return (dot){x.x + y.x, x.y + y.y, -1};
}

dot operator -(dot x, dot y) {
	return (dot){x.x - y.x, x.y - y.y, -1};
}

double operator *(dot x, dot y) {
	return x.x * y.x + x.y * y.y;
}

double operator ^(dot x, dot y) {
	return x.x * y.y - x.y * y.x;
}

double get_dis(dot x, dot y) {
	return sqrt((x - y) * (x - y));
}

bool check_meet(dot A, dot B, dot C, dot D) {
	dot CA = A - C, CB = B - C, DA = A - D, DB = B - D;
	if ((CA ^ CB) * (DA ^ DB) < eps) return 1;//注意这里等于 $0$ 是不算的，因为刚好摸到不算
	return 0;
}

bool check(dot x, dot y) {
	for (int i = x.br + 1; i <= y.br - 1; i++) {//枚举中间的墙看是否有挡住了的
		for (int j = 0; j <= 4; j += 2) {	
			if (check_meet(x, y, seg[i][j], seg[i][j + 1])) return 0;
		}
	}
	return 1;
}

void add(int x, int y, double z) {
	e[++KK] = (node){z, y, le[x]}; le[x] = KK;
	e[++KK] = (node){z, x, le[y]}; le[y] = KK;
}

priority_queue <pair<double, int>, vector<pair<double, int> >, greater<pair<double, int> > > Q;
bool in[8002];

double Dij(int s, int t) {//Dij 求最短路
	memset(in, 0, sizeof(in));
	for (int i = 1; i <= m; i++) dis[i] = INF;
	while (!Q.empty()) Q.pop();
	dis[s] = 0; Q.push(make_pair(0, s));
	while (!Q.empty()) {
		int now = Q.top().second; Q.pop();
		if (in[now]) continue;
		in[now] = 1;
		for (int i = le[now]; i; i = e[i].nxt)
			if (e[i].x + dis[now] < dis[e[i].to]) {
				dis[e[i].to] = dis[now] + e[i].x;
				Q.push(make_pair(dis[e[i].to], e[i].to));
			}
	}
	
	return dis[t];
}

int main() {
	scanf("%d", &n);
	while (n != -1) {
		m = 0;
		a[++m] = (dot){0, 5, 0};
		for (int i = 1; i <= n; i++) {
			scanf("%lf", &x);
			seg[i][0] = (dot){x, 0, -1};
			for (int j = 1; j <= 4; j++) {
				scanf("%lf", &y);
				seg[i][j] = (dot){x, y, -1};
				a[++m] = (dot){x, y, i};
			}
			seg[i][5] = (dot){x, 10, -1};
		}
		a[++m] = (dot){10, 5, n + 1};
		
		memset(le, 0, sizeof(le));
		KK = 0;
		for (int i = 1; i <= m - 1; i++)
			for (int j = i + 1; j <= m; j++) {
				if (a[i].br == a[j].br) continue;
				if (a[j].br - a[i].br == 1 || check(a[i], a[j])) add(i, j, get_dis(a[i], a[j]));
			}
		
		printf("%.2f\n", Dij(1, m));
		
		scanf("%d", &n);
	}
	
	return 0;
}