Sicily Hansel and Grethel

【题意】

给定两个点相对于Hansel and Grethel的横纵坐标，以及它们与北方向的夹角[0,360)，求Hansel and Grethel所在位置的坐标。

【思路】

根据两个参考点坐标和方向角，求出两条直线的方程，两条直线的交点就是所求的坐标。

求直线方程时分斜率存在和斜率不存在两种情况，斜率存在时分(0,90]υ(270,360)和(90,180)υ(180,270]两种情况。其实两种情况应该可以合并，我看有人写的代码很短。我写的代码比较长，但是思路是比较直接的，很多功能重复的地方也就多复制几次好了。

值得注意的一点就是两个double型的值相比较是不能用等于号的。以后遇到这样的题最重要的是要细心一步一步来，不要把会做的题做错了。

#include<iostream>
#include<cmath>
#include<cstdio>
using namespace std;

const double pi=acos(-1.0);   //还是计算出来精确，手动赋值不行 

double get_k(double a)      //由一个点所处的角度得到直线斜率 
{
      double k;
      if((a>0 && a<=90) || (a>270 && a<360))
      {
               k=tan((90-a)*pi/180);
      }
      else if((a>90 && a<180) || (a>180 && a<=270))
      {
              k=tan((270-a)*pi/180);
      } 
      return k;
}

int main()
{
    int t;
    cin>>t;
    while(t--)
    {
              double x1,y1,a1,x2,y2,a2;
              scanf("%lf%lf%lf%lf%lf%lf",&x1,&y1,&a1,&x2,&y2,&a2); 
              double k1,k2,x,y,a,b;
              
              if((a1!=0 && a1!=180)  && (a2!=0 && a2!=180))   //两条直线斜率都存在 
              {
                      k1=get_k(a1);
                      k2=get_k(a2);
                      
                      if(fabs(k1-k2)>0.00000001)
                      { 
                              a=k1*x1-y1;     //a、b为中间变量 
                              b=k2*x2-y2;
                              x=(a-b)/(k1-k2);
                              y=k1*x-a;
                              
                              printf("%.4lf ",x);
                              printf("%.4lf\n",y);
                      }
                      else
                      {
                              x=(x1+x2)/2;
                              y=(y1+y2)/2;
                              
                              printf("%.4lf ",x);
                              printf("%.4lf\n",y);
                      }
              }
              else if( (a1==0 || a1==180) && (a2!=0 && a2!=180) )   //直线1斜率不存在，直线2存在 
              {
                      k2=get_k(a2);
                      x=x1;
                      y=k2*(x1-x2)+y2;
                      
                      printf("%.4lf ",x);
                      printf("%.4lf\n",y);
              }
              else if( (a2==0 || a2==180) && (a1!=0 && a1!=180) )  //直线1斜率存在，直线2不存在 
              {
                      k1=get_k(a1);
                      x=x2;
                      y=k1*(x2-x1)+y1;
                      
                      printf("%.4lf ",x);
                      printf("%.4lf\n",y);
              }
              else                                    //两条直线斜率都不存在 
              {
                      x=x1;
                      y=(y1+y2)/2;
                      
                      printf("%.4lf ",x);
                      printf("%.4lf\n",y);
              }
    }
     return 0;
}