29 lines
613 B
C
29 lines
613 B
C
|
|
#include <math.h>
|
|
#define ALEN(a,b,c,d) sqrt(((b)-(a))*((b)-(a))+((d)-(c))*((d)-(c)))
|
|
|
|
float trncst(x,y,iorder,ncity,n)
|
|
float x[],y[];
|
|
int iorder[],n[],ncity;
|
|
{
|
|
float xx[7],yy[7],de;
|
|
int j,ii;
|
|
|
|
n[4]=1 + (n[3] % ncity);
|
|
n[5]=1 + ((n[1]+ncity-2) % ncity);
|
|
n[6]=1 + (n[2] % ncity);
|
|
for (j=1;j<=6;j++) {
|
|
ii=iorder[n[j]];
|
|
xx[j]=x[ii];
|
|
yy[j]=y[ii];
|
|
}
|
|
de = -ALEN(xx[2],xx[6],yy[2],yy[6]);
|
|
de -= ALEN(xx[1],xx[5],yy[1],yy[5]);
|
|
de -= ALEN(xx[3],xx[4],yy[3],yy[4]);
|
|
de += ALEN(xx[1],xx[3],yy[1],yy[3]);
|
|
de += ALEN(xx[2],xx[4],yy[2],yy[4]);
|
|
de += ALEN(xx[5],xx[6],yy[5],yy[6]);
|
|
return de;
|
|
}
|
|
#undef ALEN
|