一道几何题

• [1558] Racing Cheat

• 时间限制: 1000 ms　内存限制: 65535 K
• 问题描述
• Building buildings all day is so boring, so XadillaX organized a race in Minecraft.
  

  To increase the difficulty and fun, XadillaX build some walls on the racing ground. The racing ground is a rectangle and all the walls are on the ground with negligible thick. That means the thick of the wall can be ignored. So on the small map, it look like that:

  In fact, everyone's speed in Minecraft is the same. We assume that the ground is N * N miles, there're W walls and the speed of each player is 1 mile per second. The starting point is (0, 0) and the destination is (N, N).
  Hungar gets the small map, so he can cheat! But he's too stupid to cheat. Can you help Hungar to calculate out the minimum time that Hungar can get to the destination from the starting point?
  

  
  
• 输入
• This problem contains several cases.
  The first line of each case are two numbers, N and W. N indicates the side length of the city and W is the number of walls. (1.0 <= N <= 100.0, 0 <= M <= 50)
  Then follow M lines. Each line has two coordinates x1 y1 x2 y2, indicates the WALLi. You can assume that no two walls are intersected.
  
• 输出
• For each case, you should print the minimum second that Hungar can get to the destination, two decimal places.
• 样例输入

• 10 3
  1.0 1.0 1.0 5.0
  9.0 5.0 9.0 9.0
  5.0 2.5 5.0 7.5
  10 1
  1.0 1.0 9.0 9.0
  

• 样例输出

• 14.64
  14.14

http://acm.nbut.cn:8081/Problem/view.xhtml?id=1558

下午比赛的一道题。

double EPS=1e-10;
// 考虑误差的加法运算
double add(double a,double b)
{
    if(fabs(a+b)0 左转，  d1 <0 右转
    double d2=(p2-p1)^(q2-p1);
    double d3=(q2-q1)^(p1-q1);
    double d4=(q2-q1)^(p2-q1);
    if(d1*d2<0 && d3*d4 <0)    // 中间是 &&
        return 1;
    return 0;
}

struct Line{
       Point s , t ;
       void read(){
            scanf("%lf%lf%lf%lf" ,&s.x,&s.y,&t.x,&t.y) ;
       }
}line[58] ;
int  m ;
vector > List[120] ;

int  ok(Point a , Point b){
     for(int i = 1 ; i <= m ; i++){
          if(intersection(a,b,line[i].s , line[i].t))  return 0 ;
     }
     return 1 ;
}

queue qq ;
double  dist[200] ;
bool    in[200] ;
double  spfa(){
        int i ;
        while(! qq.empty()) qq.pop() ;
        memset(in , 0 , sizeof(in)) ;
        for(i = 0 ; i <= 2*m+1 ; i++) dist[i] = 1000000000 ;
        dist[0] = 0 ;
        in[0] = 1 ;
        qq.push(0) ;
        while(! qq.empty()){
             int u = qq.front() ; qq.pop() ;
             in[u] = 0 ;
             for(int i = 0 ; i < List[u].size() ; i++){
                   int v = List[u][i].first ;
                   double w = List[u][i].second ;
                   if(dist[u] + w < dist[v]){
                         dist[v] = dist[u] + w ;
                         if(! in[v]){
                               in[v] = 1 ;
                               qq.push(v) ;
                         }
                   }
             }
        }
        return dist[2*m+1] ;
}

int  main(){
     double n  ;
     int i , j;
     while(cin>>n>>m){
          Point S(0 , 0) , T(n , n) ;
          for(i = 1 ; i <= m ; i++)  line[i].read() ;
          for(i = 0 ; i <= m*2+1 ; i++) List[i].clear() ;
          for(i = 1 ; i <= m ; i++){
               List[i*2-1].push_back(make_pair(i*2 , line[i].s.dist(line[i].t))) ;
               List[i*2].push_back(make_pair(i*2-1 , line[i].s.dist(line[i].t))) ;
          }
          for(i = 1 ; i <= m ; i++){
              if(ok(S , line[i].s))
                   List[0].push_back(make_pair(i*2-1 , S.dist(line[i].s))) ;
              if(ok(S , line[i].t))
                   List[0].push_back(make_pair(i*2 , S.dist(line[i].t))) ;
          }
           for(i = 1 ; i <= m ; i++){
              if(ok(T , line[i].s))
                   List[i*2-1].push_back(make_pair(m*2+1 , T.dist(line[i].s))) ;
              if(ok(T , line[i].t))
                   List[i*2].push_back(make_pair(m*2+1 , T.dist(line[i].t))) ;
          }
          if(ok(S , T)) List[0].push_back(make_pair(2*m+1 , S.dist(T))) ;
          for(i = 1 ; i <= m ; i++){
              for(j = i+1 ; j <= m ; j++){
                   if(ok(line[i].s , line[j].s)){
                       List[i*2-1].push_back(make_pair(j*2-1 , line[i].s.dist(line[j].s))) ;
                       List[j*2-1].push_back(make_pair(i*2-1 , line[i].s.dist(line[j].s))) ;
                   }
                   if(ok(line[i].s , line[j].t)){
                       List[i*2-1].push_back(make_pair(j*2 , line[i].s.dist(line[j].t))) ;
                       List[j*2].push_back(make_pair(i*2-1 , line[i].s.dist(line[j].t))) ;
                   }
                   if(ok(line[i].t , line[j].s)){
                       List[i*2].push_back(make_pair(j*2-1 , line[i].t.dist(line[j].s))) ;
                       List[j*2-1].push_back(make_pair(i*2 , line[i].t.dist(line[j].s))) ;
                   }
                   if(ok(line[i].t , line[j].t)){
                       List[i*2].push_back(make_pair(j*2 , line[i].t.dist(line[j].t))) ;
                       List[j*2].push_back(make_pair(i*2 , line[i].t.dist(line[j].t))) ;
                   }
              }
          }
          printf("%.2lf\n" , spfa()) ;
     }
     return 0 ;
}