Graham算法求凸包 PKU1113

#include<stdio.h>
#include<stdlib.h>
#include<string.h>
#include<iostream>
#include<math.h>
#include<algorithm>
using namespace std;
/* 
PointSet[]：输入的点集 
ch[]：输出的凸包上的点集，按照逆时针方向排列 
n：PointSet中的点的数目 
len：输出的凸包上的点的个数 
*/  
struct Point  
{  
    float x,y;  
};  
//小于0,说明向量p0p1的极角大于p0p2的极角  
float multiply(Point p1,Point p2,Point p0)  
{  
    return((p1.x-p0.x)*(p2.y-p0.y)-(p2.x-p0.x)*(p1.y-p0.y));  
}  
  
float dis(Point p1,Point p2)  
{  
    return(sqrt((p1.x-p2.x)*(p1.x-p2.x)+(p1.y-p2.y)*(p1.y-p2.y)));  
}  
  
  
void Graham_scan(Point PointSet[],Point ch[],int n,int &len)  
{  
    int i,j,k=0,top=2;  
    Point tmp;  
  
    //找到最下且偏左的那个点  
    for(i=1;i<n;i++)  
        if ((PointSet[i].y<PointSet[k].y)||((PointSet[i].y==PointSet[k].y)&&(PointSet[i].x<PointSet[k].x)))  
            k=i;  
    //将这个点指定为PointSet[0]  
    tmp=PointSet[0];  
    PointSet[0]=PointSet[k];  
    PointSet[k]=tmp;  
  
    //按极角从小到大,距离偏短进行排序  
    for (i=1;i<n-1;i++)  
    {  
        k=i;  
        for (j=i+1;j<n;j++)  
            if( (multiply(PointSet[j],PointSet[k],PointSet[0])>0)  
                ||((multiply(PointSet[j],PointSet[k],PointSet[0])==0)  
                    &&(dis(PointSet[0],PointSet[j])<dis(PointSet[0],PointSet[k]))) )  
                k=j;//k保存极角最小的那个点,或者相同距离原点最近  
        tmp=PointSet[i];  
        PointSet[i]=PointSet[k];  
        PointSet[k]=tmp;  
    }  
    //第三个点先入栈  
    ch[0]=PointSet[0];  
    ch[1]=PointSet[1];  
    ch[2]=PointSet[2];  
    //判断与其余所有点的关系  
    for (i=3;i<n;i++)  
    {  
        //不满足向左转的关系,栈顶元素出栈  
        while(multiply(PointSet[i],ch[top],ch[top-1])>=0) top--;  
        //当前点与栈内所有点满足向左关系,因此入栈.  
        ch[++top]=PointSet[i];  
    }  
    len=top+1;  
}  
  
const int maxN=1010;  
Point PointSet[maxN];  
Point ch[maxN];  
int n;  
int len;  
  
int main()  
{  
    double ans=0;  
    int d;  
    cin>>n>>d;  
    for(int i=0;i<n;i++)  
        cin>>PointSet[i].x>>PointSet[i].y;//input the data;  
    Graham_scan(PointSet,ch,n,len);  
    for(int i=0;i<len;i++)  
        ans+=dis(ch[i],ch[(i+1)%len]);  
    ans+=2*d*acos(-1.0); //等价于圆形周长  
    cout<<(int)(ans+0.5)<<endl; //四舍五入  
    return 0;  
}