summaryrefslogtreecommitdiff
path: root/texmf-dist/scripts/ketcindy/ketlibC
diff options
context:
space:
mode:
Diffstat (limited to 'texmf-dist/scripts/ketcindy/ketlibC')
-rw-r--r--texmf-dist/scripts/ketcindy/ketlibC/ketcommon.h1559
-rw-r--r--texmf-dist/scripts/ketcindy/ketlibC/surflib.h1888
-rw-r--r--texmf-dist/scripts/ketcindy/ketlibC/surflibhead.h49
3 files changed, 3496 insertions, 0 deletions
diff --git a/texmf-dist/scripts/ketcindy/ketlibC/ketcommon.h b/texmf-dist/scripts/ketcindy/ketlibC/ketcommon.h
new file mode 100644
index 00000000..bfcbbf23
--- /dev/null
+++ b/texmf-dist/scripts/ketcindy/ketlibC/ketcommon.h
@@ -0,0 +1,1559 @@
+int length2(double gdata[][2]);
+int length3(double gdata[][3]);
+int length4(double gdata[][4]);
+int length5(double gdata[][5]);
+int length2i(int gdata[][2]);
+void copyd(int from, int upto, double q[], double p[]);
+void copyi(int from, int upto, int q[], int p[]);
+int addptd2(double gdata[][2], double pt[2]);
+int addptd3(double gdata[][3], double pt[3]);
+int addptd4(double gdata[][4], double pt[4]);
+int addptd5(double gdata[][5], double pt[5]);
+int add2(double gdata[][2], double x, double y);
+int add3(double gdata[][3], double x, double y, double z);
+int push2(double x, double y, double ptL[][2]);
+int push3(double x, double y, double z, double ptL[][3]);
+int push4(double x, double y, double z, double w, double ptL[][4]);
+int push5(double x, double y, double z, double w, double u, double ptL[][5]);
+void pull2(int num, double ptL[][2],double pt[2]);
+void pull3(int num, double ptL[][3],double pt[3]);
+void pull4(int num, double ptL[][4],double pt[4]);
+void pull5(int num, double ptL[][5],double pt[5]);
+int appendd2(int level, int from,int upto, double gdata[][2],double mat[][2]);
+int appendd3(int level, int from,int upto, double gdata[][3],double mat[][3]);
+int prependd2(int from,int upto, double gdata[][2],double mat[][2]);
+int appendd1(double numvec[], double num);
+int appendi1(int numvec[],int num);
+int prependi1(int num, int numvec[]);
+int removei2(int nrmv,int mat[][2]);
+int dataindexi1(int out[],int din[][2]);
+int dataindexd1(double out[],int din[][2]);
+int dataindexd2(int level,double out[][2],int din[][2]);
+int dataindexd3(int level, double out[][3],int din[][2]);
+int dataindexd4(int level, double out[][4],int din[][2]);
+void dispmatd1(int from, int upto, double mat[]);
+void dispmatd2(int from, int upto, double mat[][2]);
+void dispmatd3(int from, int upto, double mat[][3]);
+void dispmatd4(int from, int upto, double mat[][4]);
+void dispmatd5(int from, int upto, double mat[][5]);
+void dispmatd6(int from, int upto, double mat[][6]);
+void dispmati2(int from, int upto, int mat[][2]);
+void dispmati1(int from, int upto, int mat[]);
+int readdata3(const char *fname, double out[][3]);
+int readdata2(const char *fname, double out[][2]);
+int output2(const char *var, const char *fname, int level, double out[][2]);
+void simplesort(double number[]);
+int memberi(int a, int list[]);
+double dotprod(int dim, double p[], double q[]);
+double dist(int dim, double p[], double q[]);
+void pointoncurve(double t, double gdata[][2], double eps, double pt[]);
+int partcrv(double a,double b,double pkL[][2], double pL[][2]);
+int partcrv3(double a,double b,double pkL[][3], double pL[][3]);
+int connectseg(double pdata[][2], double eps, double out[][2]);
+void koutenseg(double a[2], double b[2], double c[2], double d[2],
+ double eps, double eps2, double out[4]);
+double paramoncurve(double p[2], int n, double ptL[][2]);
+void nearestptpt(double pa[2], double pL[][2], double ans[4]);
+int intersectselfPp(double data1[][2],double eps,double eps1s,double kL[][4]);
+int intersectcrvsPp(double data1[][2], double data2[][2],
+ double eps,double eps1s, double kL[][4]);
+int dropnumlistcrv(double qd[][2], double eps1, int out[]);
+int increasept2(double ptL[][2], int nn, double out[][2]);
+int increasept3(double ptL[][3], int nn, double out[][3]);
+void bezierpt(double t, double p0[2], double p3[2],
+ double p1[2], double p2[2], double ptout[2]);
+int bezier(double ptL[][2], double ctrL[][4], int num, double out[][2]);
+int ospline(int level, double ptL[][2], int num, double out[][2]);
+void bezierpt3(double t, double p0[3], double p3[3],
+ double p1[3], double p2[3], double ptout[3]);
+int bezier3(double ptL[][3], double ctrL[][6], int num, double out[][3]);
+int ospline3(int level, double ptL[][3], int num, double out[][3]);
+
+const double Inf=99999;
+const int Infint=30000;
+
+int length2(double gdata[][2]){
+ return floor(gdata[0][0]+0.5);
+}
+
+int length3(double gdata[][3]){
+ return floor(gdata[0][0]+0.5);
+}
+
+int length4(double gdata[][4]){
+ return floor(gdata[0][0]+0.5);
+}
+
+int length5(double gdata[][5]){
+ return floor(gdata[0][0]+0.5);
+}
+
+int length2i(int gdata[][2]){
+ return gdata[0][0];
+}
+
+void copyd(int from, int upto, double q[], double p[]){
+ int i;
+ for(i=from; i<=upto; i++){
+ p[i]=q[i];
+ }
+}
+
+void copyi(int from, int upto, int q[], int p[]){
+ int i;
+ for(i=from; i<=upto; i++){
+ p[i]=q[i];
+ }
+}
+
+int push2(double x, double y, double ptL[][2]){
+ int nall=length2(ptL);
+ nall++;
+ ptL[nall][0]=x; ptL[nall][1]=y;
+ ptL[0][0]=nall;
+ return nall;
+}
+
+int push3(double x, double y, double z, double ptL[][3]){
+ int nall=length3(ptL);
+ nall++;
+ ptL[nall][0]=x; ptL[nall][1]=y; ptL[nall][2]=z;
+ ptL[0][0]=nall;
+ return nall;
+}
+
+int push4(double x, double y, double z, double w, double ptL[][4]){
+ int nall=length4(ptL);
+ nall++;
+ ptL[nall][0]=x; ptL[nall][1]=y;
+ ptL[nall][2]=z; ptL[nall][3]=w;
+ ptL[0][0]=nall;
+ return nall;
+}
+
+int push5(double x, double y, double z, double w, double u, double ptL[][5]){
+ int nall=length5(ptL);
+ nall++;
+ ptL[nall][0]=x; ptL[nall][1]=y;
+ ptL[nall][2]=z; ptL[nall][3]=w; ptL[nall][4]=u;
+ ptL[0][0]=nall;
+ return nall;
+}
+
+void pull3(int num, double ptL[][3],double pt[3]){
+ pt[0]=ptL[num][0]; pt[1]=ptL[num][1]; pt[2]=ptL[num][2];
+}
+
+void pull2(int num, double ptL[][2],double pt[2]){
+ pt[0]=ptL[num][0]; pt[1]=ptL[num][1];
+}
+
+void pull4(int num, double ptL[][4],double pt[4]){
+ pt[0]=ptL[num][0]; pt[1]=ptL[num][1];
+ pt[2]=ptL[num][2]; pt[3]=ptL[num][3];
+}
+
+void pull5(int num, double ptL[][5],double pt[5]){
+ pt[0]=ptL[num][0]; pt[1]=ptL[num][1];
+ pt[2]=ptL[num][2]; pt[3]=ptL[num][3]; pt[4]=ptL[num][4];
+}
+
+int add2(double gdata[][2], double x, double y){
+ int nall;
+ nall=push2(x, y, gdata);
+ return nall;
+}
+
+int add3(double gdata[][3], double x, double y, double z){
+ int nall;
+ nall=push3(x, y, z,gdata);
+ return nall;
+}
+
+int addptd3(double gdata[][3], double pt[3]){
+ int nall;
+ nall=push3(pt[0],pt[1],pt[2],gdata);
+ return nall;
+}
+
+int addptd2(double gdata[][2], double pt[2]){
+ int nall;
+ nall=push2(pt[0],pt[1],gdata);
+ return nall;
+}
+
+int addptd4(double gdata[][4], double pt[4]){
+ int nall;
+ nall=push4(pt[0],pt[1],pt[2],pt[3],gdata);
+ return nall;
+}
+
+int addptd5(double gdata[][5], double pt[5]){
+ int nall;
+ nall=push5(pt[0],pt[1],pt[2],pt[3],pt[4],gdata);
+ return nall;
+}
+
+int appendd2(int level, int from,int upto, double gdata[][2],double mat[][2]){
+ int j, np, nall=length2(mat);
+ np=upto-from+1;
+ if(np<0){np=0;}
+ if(np>0){
+ if(level>0){
+ if(nall>0){
+ nall=add2(mat,Inf, level);
+ }
+ }
+ for(j=1; j<=np; j++){
+ mat[nall+j][0]=gdata[from+j-1][0];
+ mat[nall+j][1]=gdata[from+j-1][1];
+ }
+ }
+ mat[0][0]=nall+np;
+ return nall+np;
+}
+
+int appendd3(int level, int from,int upto, double gdata[][3],double mat[][3]){
+ int j, np, nall=length3(mat);
+ np=upto-from+1;
+ if(np<0){np=0;}
+ if(np>0){
+ if(level>0){
+ if(nall>0){
+ nall=add3(mat,Inf, level, 0);
+ }
+ }
+ for(j=1; j<=np; j++){
+ mat[nall+j][0]=gdata[from+j-1][0];
+ mat[nall+j][1]=gdata[from+j-1][1];
+ mat[nall+j][2]=gdata[from+j-1][2];
+ }
+ }
+ mat[0][0]=nall+np;
+ return nall+np;
+}
+
+int prependd2(int from,int upto, double gdata[][2],double mat[][2]){
+ int j,np, nall=length2(mat);
+ if(from<=upto){
+ np=upto-from+1;
+ for(j=nall; j>=1; j--){
+ mat[np+j][0]=mat[j][0];
+ mat[np+j][1]=mat[j][1];
+ }
+ for(j=1; j<=np; j++){
+ mat[j][0]=gdata[from+j-1][0];
+ mat[j][1]=gdata[from+j-1][1];
+ }
+ }else{
+ np=from-upto+1;
+ for(j=nall; j>=1; j--){
+ mat[np+j][0]=mat[j][0];
+ mat[np+j][1]=mat[j][1];
+ }
+ for(j=1; j<=np; j++){
+ mat[nall+j][0]=gdata[from-j+1][0];
+ mat[nall+j][1]=gdata[from-j+1][1];
+ }
+ }
+ mat[0][0]=nall+np;
+ return nall+np;
+}
+
+int appendd1(double numvec[], double num){
+ int n;
+ n=floor(numvec[0]+0.5);
+ numvec[n+1]=num;
+ numvec[0]=n+1;
+ return n+1;
+}
+
+int appendi1(int numvec[],int num){
+ int n;
+ n=numvec[0];
+ numvec[n+1]=num;
+ numvec[0]=n+1;
+ return n+1;
+}
+
+int prependi1(int num, int numvec[]){
+ int i,n;
+ n=numvec[0];
+ for(i=n; i>=1; i--){
+ numvec[i+1]=numvec[i];
+ }
+ numvec[1]=num;
+ numvec[0]=n+1;
+ return n+1;
+}
+
+int removei2(int nrmv,int mat[][2]){
+ int j,nall=mat[0][0];
+ if(nall>0){
+ for(j=nrmv; j<=nall-1; j++){
+ mat[j][0]=mat[j+1][0];
+ mat[j][1]=mat[j+1][1];
+ }
+ mat[0][0]=nall-1;
+ return nall-1;
+ }
+ else{
+ mat[0][0]=0;
+ return 0;
+ }
+}
+
+int dataindexd1(double out[],int din[][2]){
+ int n1=1, j, ctr=0, nall=floor(out[0]+0.5);
+ if(nall==0){
+ din[0][0]=0;
+ return 0;
+ }
+ for(j=1; j<=nall; j++){
+ if(out[j]>Inf-1){
+ ctr++;
+ din[ctr][0]=n1;
+ din[ctr][1]=j-1;
+ n1=j+1;
+ }
+ }
+ ctr++;
+ din[ctr][0]=n1;
+ din[ctr][1]=nall;
+ din[0][0]=ctr;
+ return ctr;
+}
+
+int dataindexd2(int level,double out[][2],int din[][2]){
+ int n1=1, j, ctr=0, nall=length2(out);
+ if(nall==0){
+ din[0][0]=0;
+ return 0;
+ }
+ for(j=1; j<=nall; j++){
+ if(out[j][0]>Inf-1){
+ if((level==0) || (out[j][1]==level)){
+ ctr++;
+ din[ctr][0]=n1;
+ din[ctr][1]=j-1;
+ n1=j+1;
+ }
+ }
+ }
+ ctr++;
+ din[ctr][0]=n1;
+ din[ctr][1]=nall;
+ din[0][0]=ctr;
+ return ctr;
+}
+
+int dataindexd3(int level, double out[][3],int din[][2]){
+ int n1=1, j, ctr=0, nall=length3(out);
+ if(nall==0){
+ din[0][0]=0;
+ return 0;
+ }
+ for(j=1; j<=nall; j++){
+ if(out[j][0]>Inf-1){
+ if((level==0) || (out[j][1]==level)){
+ ctr++;
+ din[ctr][0]=n1;
+ din[ctr][1]=j-1;
+ n1=j+1;
+ }
+ }
+ }
+ ctr++;
+ din[ctr][0]=n1;
+ din[ctr][1]=nall;
+ din[0][0]=ctr;
+ return ctr;
+}
+
+int dataindexd4(int level, double out[][4],int din[][2]){
+ int n1=1, j, ctr=0, nall=length4(out);
+ if(nall==0){
+ din[0][0]=0;
+ return 0;
+ }
+ for(j=1; j<=nall; j++){
+ if(out[j][0]>Inf-1){
+ if((level==0) || (out[j][1]==level)){
+ ctr++;
+ din[ctr][0]=n1;
+ din[ctr][1]=j-1;
+ n1=j+1;
+ }
+ }
+ }
+ ctr++;
+ din[ctr][0]=n1;
+ din[ctr][1]=nall;
+ din[0][0]=ctr;
+ return ctr;
+}
+
+int dataindexi1(int out[],int din[][2]){
+ int n1=1, j, ctr=0, nall=out[0], ninfp=0;
+ if(nall==0){
+ din[0][0]=0; din[0][1]=-1;
+ return 0;
+ }
+ for(j=1; j<=nall; j++){
+ if(out[j]==Infint){
+ ctr++;
+ if(j==ninfp+1){
+ din[ctr][0]=0; din[ctr][1]=-1;
+ }
+ else{
+ din[ctr][0]=n1; din[ctr][1]=j-1;
+ }
+ ninfp=j;
+ n1=j+1;
+ }
+ }
+ ctr++;
+ if(out[nall]==Infint){
+ din[ctr][0]=0; din[ctr][1]=0;
+ }
+ else{
+ din[ctr][0]=n1; din[ctr][1]=nall;
+ }
+ din[0][0]=ctr;
+ return ctr;
+}
+
+void dispmatd1(int from, int upto, double mat[]){
+ int i;
+ for(i=from; i<upto+1; i++){
+ printf("%d %7.5f\n",i,mat[i]);
+ }
+}
+
+void dispmatd2(int from, int upto, double mat[][2]){
+ int i;
+ for(i=from; i<upto+1; i++){
+ printf("%3d %7.5f %7.5f\n",i,mat[i][0],mat[i][1]);
+ }
+}
+
+void dispmatd3(int from, int upto, double mat[][3]){
+ int i;
+ for(i=from; i<upto+1; i++){
+ printf("%3d %7.5f %7.5f %7.5f\n",i,mat[i][0],mat[i][1],mat[i][2]);
+ }
+}
+
+void dispmatd4(int from, int upto, double mat[][4]){
+ int i;
+ for(i=from; i<upto+1; i++){
+ printf("%3d %7.5f %7.5f ",i,mat[i][0],mat[i][1]);
+ printf("%7.5f %7.5f\n",mat[i][2],mat[i][3]);
+ }
+}
+
+void dispmatd5(int from, int upto, double mat[][5]){
+ int i;
+ for(i=from; i<upto+1; i++){
+ printf("%3d %7.5f %7.5f ",i,mat[i][0],mat[i][1]);
+ printf("%7.5f %7.5f %7.5f\n",mat[i][2],mat[i][3],mat[i][4]);
+ }
+}
+
+void dispmatd6(int from, int upto, double mat[][6]){
+ int i;
+ for(i=from; i<upto+1; i++){
+ printf("%3d %7.5f %7.5f %7.5f ",i,mat[i][0],mat[i][1],mat[i][2]);
+ printf("%7.5f %7.5f %7.5f\n",mat[i][3],mat[i][4],mat[i][5]);
+ }
+}
+
+void dispmati2(int from, int upto, int mat[][2]){
+ int i;
+ for(i=from; i<upto+1; i++){
+ printf("%3d %d %d\n",i,mat[i][0],mat[i][1]);
+ }
+}
+
+void dispmati1(int from, int upto, int mat[]){
+ int i;
+ for(i=from; i<upto+1; i++){
+ printf("%3d %d\n",i,mat[i]);
+ }
+}
+
+int readdata3(const char *fname, double out[][3]){
+ double data[DsizeL][4];
+ int i, j, ndata, nall;
+ FILE *fp;
+ fp=fopen(fname,"r");
+ if(fp==NULL){
+ printf("file not found\n");
+ return 0;
+ }
+ ndata=0;
+ i=1;
+ while( ! feof(fp) && i<DsizeL){
+ for(j=0;j<=3;j++){
+ fscanf(fp,"%lf",&data[i][j]);
+ }
+ i++;
+ ndata++;
+ }
+ ndata--;
+ fclose(fp);
+ out[0][0]=0; nall=0;
+ for(i=1; i<=ndata; i++){
+ nall=add3(out, data[i][1], data[i][2], data[i][3]);
+ }
+ return nall;
+}
+
+int output2(const char *var, const char *fname, int level, double out[][2]){
+ int nall=length2(out), ndin, din[DsizeM][2],i,j;
+ double tmpd[2];
+ FILE *fp;
+ fp=fopen(fname,"w");
+ if (fp == NULL) {
+ printf("cannot open\n");
+ return -1;
+ }
+ ndin=dataindexd2(level, out,din);
+ fprintf(fp,"%s//\n",var);
+ for(i=1; i<=ndin; i++){
+ fprintf(fp,"start//\n");
+ fprintf(fp,"[");
+ for(j=din[i][0]; j<=din[i][1]; j++){
+ pull2(j,out,tmpd);
+ fprintf(fp,"[ %7.5f, %7.5f]",tmpd[0],tmpd[1]);
+ if(j<din[i][1]){
+ fprintf(fp,",");
+ }
+ }
+ fprintf(fp,"]//\n");
+ if(i<ndin){
+ fprintf(fp,"end//\n");
+ }
+ else{
+ fprintf(fp,"end////\n");
+ }
+ }
+ fclose(fp);
+ return 0;
+}
+
+int readdata2(const char *fname, double out[][2]){
+ double data[DsizeL][3];
+ int i, j, ndata, nall;
+ FILE *fp;
+ fp=fopen(fname,"r");
+ if(fp==NULL){
+ printf("file not found\n");
+ return 0;
+ }
+ ndata=0;
+ i=1;
+ while( ! feof(fp) && i<DsizeL){
+ for(j=0;j<=2;j++){
+ fscanf(fp,"%lf",&data[i][j]);
+ }
+ i++;
+ ndata++;
+ }
+ ndata--;
+ fclose(fp);
+ out[0][0]=0; nall=0;
+ for(i=1; i<=ndata; i++){
+ nall=add2(out, data[i][1], data[i][2]);
+ }
+ return nall;
+}
+
+void simplesort(double number[]){
+ int i,j, total=number[0];
+ double tmp;
+ for (i=1; i<=total; i++) {
+ for (j=i+1; j<=total; j++) {
+ if (number[i] > number[j]) {
+ tmp = number[i];
+ number[i] = number[j];
+ number[j] = tmp;
+ }
+ }
+ }
+}
+
+int memberi(int a, int list[]){
+ int i, n=list[0];
+ for(i=1; i<=n; i++){
+ if(a==list[i]){
+ return 1;
+ }
+ }
+ return 0;
+}
+
+double dotprod(int dim, double p[], double q[]){
+ double ans;
+ ans=p[0]*q[0]+p[1]*q[1];
+ if(dim>2){
+ ans=ans+p[2]*q[2];
+ }
+ return ans;
+}
+
+double dist(int dim, double p[], double q[]){
+ double tmp;
+ tmp=pow(q[0]-p[0],2)+pow(q[1]-p[1],2);
+ if(dim>2){
+ tmp=tmp+pow(q[2]-p[2],2);
+ }
+ return sqrt(tmp);
+}
+
+void pointoncurve(double t, double gdata[][2], double eps, double pt[]){
+ double pa[2],pb[2], s;
+ int n, nall;
+ n=floor(t+eps);
+ s=fmax(t-n,0);
+ nall=length2(gdata);
+ if(n>=nall){
+ pull2(nall,gdata,pt);
+// pt[0]=gdata[nall][0]; pt[1]=gdata[nall][1];
+ }
+ else{
+ pull2(n,gdata,pa);
+ pull2(n+1,gdata,pb);
+ pt[0]=(1-s)*pa[0]+s*pb[0];
+ pt[1]=(1-s)*pa[1]+s*pb[1];
+ }
+}
+
+int partcrv(double a,double b,double pkL[][2], double pL[][2]){
+ int i, is, ie, nall;
+ double eps=pow(10,-3.2);
+ is=ceil(a);
+ ie=floor(b);
+ nall=0;
+ if(a<is-eps){
+ nall++;
+ pL[nall][0]=(is-a)*pkL[is-1][0]+(1-is+a)*pkL[is][0];
+ pL[nall][1]=(is-a)*pkL[is-1][1]+(1-is+a)*pkL[is][1];
+ }
+ for(i=is; i<=ie; i++){
+ nall++;
+ pL[nall][0]=pkL[i][0];
+ pL[nall][1]=pkL[i][1];
+ }
+ if(b>ie+eps){
+ nall++;
+ pL[nall][0]=(1-b+ie)*pkL[ie][0]+(b-ie)*pkL[ie+1][0];
+ pL[nall][1]=(1-b+ie)*pkL[ie][1]+(b-ie)*pkL[ie+1][1];
+ }
+ pL[0][0]=nall;
+ return nall;
+}
+
+int partcrv3(double a,double b,double pkL[][3], double pL[][3]){
+ int i, is, ie, nall;
+ double eps=pow(10,-3.2);
+ is=ceil(a);
+ ie=floor(b);
+ nall=0;
+ if(a<is-eps){
+ nall++;
+ pL[nall][0]=(is-a)*pkL[is-1][0]+(1-is+a)*pkL[is][0];
+ pL[nall][1]=(is-a)*pkL[is-1][1]+(1-is+a)*pkL[is][1];
+ pL[nall][2]=(is-a)*pkL[is-1][2]+(1-is+a)*pkL[is][2];
+ }
+ for(i=is; i<=ie; i++){
+ nall++;
+ pL[nall][0]=pkL[i][0];
+ pL[nall][1]=pkL[i][1];
+ pL[nall][2]=pkL[i][2];
+ }
+ if(b>ie+eps){
+ nall++;
+ pL[nall][0]=(1-b+ie)*pkL[ie][0]+(b-ie)*pkL[ie+1][0];
+ pL[nall][1]=(1-b+ie)*pkL[ie][1]+(b-ie)*pkL[ie+1][1];
+ pL[nall][2]=(1-b+ie)*pkL[ie][2]+(b-ie)*pkL[ie+1][2];
+ }
+ pL[0][0]=nall;
+ return nall;
+}
+
+int connectseg(double pdata[][2], double eps, double out[][2]){
+ int din[DsizeM][2], nd, nq, i, j, flg, st, en, ntmp;
+ int nall=length2(pdata), nout=0;
+ double qd[DsizeM][2], ah[2], ao[2], p[2], q[2], tmp[2];
+ out[0][0]=0;
+ nd=dataindexd2(0,pdata,din);
+ qd[0][0]=0;
+ nq=appendd2(0,din[1][0],din[1][1],pdata,qd);
+ nd=removei2(1,din);
+ while(nd>0){
+ pull2(1,qd,ah);
+ pull2(nq,qd,ao);
+ flg=0;
+ for(j=1; j<=nd; j++){
+ st=din[j][0];
+ en=din[j][1];
+ pull2(st,pdata,p);
+ pull2(en,pdata,q);
+ if(dist(2,p,ao)<eps){
+ nq=appendd2(0,st+1,en,pdata,qd);
+ nd=removei2(j,din);
+ flg=1;
+ break;
+ }
+ if(dist(2,q,ao)<eps){
+ nq=appendd2(0,en-1,st,pdata,qd);
+ nd=removei2(j,din);
+ flg=1;
+ break;
+ }
+ if(dist(2,p,ah)<eps){
+ nq=prependd2(en,st+1,pdata,qd);
+ nd=removei2(j,din);
+ flg=1;
+ break;
+ }
+ if(dist(2,q,ah)<eps){
+ nq=prependd2(st,en-1,pdata,qd);
+ nd=removei2(j,din);
+ flg=1;
+ break;
+ }
+ }
+ if(flg==0){
+ nout=appendd2(2,1,nq,qd,out);
+ qd[0][0]=0;
+ nq=appendd2(0,din[1][0],din[1][1],pdata,qd);
+ nd=removei2(1,din);
+ }
+ }
+ if(nq>0){
+ nout=appendd2(2,1,nq,qd,out);
+ }
+ return nout;
+}
+
+void koutenseg(double a[2], double b[2], double c[2], double d[2],
+ double eps, double eps2, double out[4]){
+ double v[2], epss,eps0=Eps, sv2, p1, p2, q1,q2,m1, m2, M1, M2, t;
+ double tmp1d2[2], tmp2d1, p[2], q[2];
+ v[0]=b[0]-a[0]; v[1]=b[1]-a[1];
+ sv2=pow(v[0],2.0)+pow(v[1],2.0);
+ if(sv2<pow(10,-6.0)){
+ out[0]=Inf;
+ return;
+ }
+ p[0]=c[0]-a[0]; p[1]=c[1]-a[1];
+ q[0]=d[0]-a[0]; q[1]=d[1]-a[1];
+ epss=fmin(eps2, eps/sqrt(sv2));
+ p1=(p[0]*v[0]+p[1]*v[1])/sv2;
+ p2=(-p[0]*v[1]+p[1]*v[0])/sv2;
+ q1=(q[0]*v[0]+q[1]*v[1])/sv2;
+ q2=(-q[0]*v[1]+q[1]*v[0])/sv2;
+ m1=-epss; M1=1+epss;
+ m2=-epss; M2=epss;
+ if((fmax(p1,q1)<m1) || (fmin(p1,q1)>M1)){
+ out[0]=Inf;
+ return;
+ }
+ if((fmax(p2,q2)<m2) || (fmin(p2,q2)>M2)){
+ out[0]=Inf;
+ return;
+ }
+ if(p2*q2<0){
+ t=p1-(q1-p1)/(q2-p2)*p2;
+ if((t>m1)&& (t<M1)){
+ if((t>-eps0) && (t<1+eps0)){
+ tmp1d2[0]=a[0]+t*v[0]; tmp1d2[1]=a[1]+t*v[1];
+ tmp2d1=fmin(fmax(t,0),1);
+ out[0]=tmp1d2[0]; out[1]=tmp1d2[1];
+ out[2]=tmp2d1; out[3]=0;
+ }
+ else{
+ tmp1d2[0]=a[0]+t*v[0]; tmp1d2[1]=a[1]+t*v[1];
+ tmp2d1=fmin(fmax(t,0),1);
+ out[0]=tmp1d2[0]; out[1]=tmp1d2[1];
+ out[2]=tmp2d1; out[3]=1;
+ }
+ return;
+ }
+ if((p1<m1)||(p1>M1)||(p2<m2)||(p2>M2)){
+ if((q1<m1)||(q1>M1)||(q2<m2)||(q2>M2)){
+ out[0]=Inf;
+ return;
+ }
+ t=fmin(fmax(q1,0),1);
+ tmp1d2[0]=a[0]+t*v[0]; tmp1d2[1]=a[1]+t*v[1];
+ out[0]=tmp1d2[0]; out[1]=tmp1d2[1];
+ out[2]=t; out[3]=1;
+ return;
+ }
+ t=fmin(fmax(p1,0),1);
+ tmp1d2[0]=a[0]+t*v[0]; tmp1d2[1]=a[1]+t*v[1];
+ out[0]=tmp1d2[0]; out[1]=tmp1d2[1];
+ out[2]=t; out[3]=1;
+ return;
+ }
+ if((p1>-eps0)&&(p1<1+eps0)&&(p2>-eps0)&&(p2<eps0)){
+ t= p1;
+ tmp1d2[0]=a[0]+t*v[0]; tmp1d2[1]=a[1]+t*v[1];
+ out[0]=tmp1d2[0]; out[1]=tmp1d2[1];
+ out[2]=t; out[3]=0;
+ return;
+ }
+ if((q1>-eps0)&&(q1<1+eps0)&&(q2>-eps0)&&(q2<eps0)){
+ t= q1;
+ tmp1d2[0]=a[0]+t*v[0]; tmp1d2[1]=a[1]+t*v[1];
+ out[0]=tmp1d2[0]; out[1]=tmp1d2[1];
+ out[2]=t; out[3]=0;
+ return;
+ }
+ if((p1<m1)||(p1>M1)||(p2<m2)||(p2>M2)){
+ if((q1<m1)||(q1>M1)||(q2<m2)||(q2>M2)){
+ out[0]=Inf;
+ return;
+ }
+ t=fmin(fmax(q1,0),1);
+ tmp1d2[0]=a[0]+t*v[0]; tmp1d2[1]=a[1]+t*v[1];
+ out[0]=tmp1d2[0]; out[1]=tmp1d2[1];
+ out[2]=t; out[3]=1;
+ return;
+ }
+ if((q1<m1)||(q1>M1)||(q2<m2)||(q2>M2)){
+ t=fmin(fmax(p1,0),1);
+ tmp1d2[0]=a[0]+t*v[0]; tmp1d2[1]=a[1]+t*v[1];
+ out[0]=tmp1d2[0]; out[1]=tmp1d2[1];
+ out[2]=t; out[3]=1;
+ return;
+ }
+ if(fabs(p2)<fabs(q2)){
+ t=fmin(fmax(p1,0),1);
+ }
+ else{
+ t=fmin(fmax(q1,0),1);
+ }
+ tmp1d2[0]=a[0]+t*v[0]; tmp1d2[1]=a[1]+t*v[1];
+ out[0]=tmp1d2[0]; out[1]=tmp1d2[1];
+ out[2]=t; out[3]=1;
+ return;
+}
+
+double paramoncurve(double p[2], int n, double ptL[][2]){
+ double pa[2], pb[2], v[2], w[2], o[2], d2, s;
+ int nptL=length2(ptL);
+ if(n==nptL){
+ return nptL;
+ }
+ else{
+ pull2(n,ptL,pa);
+ pull2(n+1,ptL,pb);
+ v[0]=pb[0]-pa[0]; v[1]=pb[1]-pa[1];
+ w[0]=p[0]-pa[0]; w[1]=p[1]-pa[1];
+ o[0]=0; o[1]=0;
+ d2=pow(dist(2,v,o),2.0);
+ s=dotprod(2,v,w)/d2;
+ s=fmin(fmax(s,0),1);
+ return n+s;
+ }
+}
+
+void nearestptpt(double pa[2], double pL[][2], double pt[4]){
+ double eps0=pow(10,-6.0), p[2], pm[2], im, sm, s;
+ double ans[7], a1,a2, b1,b2, v1, v2, x1, x2, t, tmpd1;
+ int i, n, npL=length2(pL);
+ ans[0]=pa[0]; ans[1]=pa[1];
+ ans[2]=1;
+ p[0]=pL[1][0]; p[1]=pL[1][1];
+ ans[3]=p[0]; ans[4]=p[1];
+ ans[5]=1; ans[6]=dist(2,pa,p);
+ pm[0]=pL[1][0]; pm[1]=pL[1][1];
+ im=1;
+ sm=dist(2,pm,pa);
+ for(i=1; i<=npL-1; i++){
+ a1=pL[i][0]; a2=pL[i][1];
+ b1=pL[i+1][0]; b2=pL[i+1][1];
+ v1=b1-a1; v2=b2-a2;
+ x1=pa[0]; x2=pa[1];
+ tmpd1=pow(v2,2.0)+pow(v1,2.0);
+ if(fabs(tmpd1)<eps0){
+ continue;
+ }
+ t=(-a2*v2-v1*a1+v1*x1+x2*v2)/tmpd1;
+ if(t<-eps0){
+ p[0]=a1; p[1]=a2;
+ }
+ else if(t>1+eps0){
+ p[0]=b1; p[1]=b2;
+ }
+ else{
+ p[0]=a1+t*v1; p[1]=a2+t*v2;
+ }
+ s=dist(2,p,pa);
+ if(s<sm-eps0){
+ tmpd1=paramoncurve(p,i,pL);
+ pm[0]=p[0]; pm[1]=p[1];
+ im=tmpd1; sm=s;
+ }
+ }
+ if(sm<ans[6]){
+ ans[0]=pa[0]; ans[1]=pa[1];
+ ans[2]=n;
+ ans[3]=pm[0]; ans[4]=pm[1];
+ ans[5]=im; ans[6]=sm;
+ }
+ pt[0]=ans[3]; pt[1]=ans[4];
+ pt[2]=ans[5]; pt[3]=ans[6];
+}
+
+int intersectselfPp(double data1[][2],double eps,double eps1s,double kL[][4]){
+ double a[2], b[2], tmpd2[2], tmpd4[4], tmpd5[5], p[2], q[2], t, s;
+ double eps0=pow(10,-5.0);
+ double tmpd1, tmp1d1, tmp2d1;
+ int i, j, k, n, is, ndata1,nkL, ntmp, ntmp1,flg, closed=0;
+ ndata1=length2(data1);
+ p[0]=data1[1][0]; p[1]=data1[1][1];
+ q[0]=data1[ndata1][0]; q[1]=data1[ndata1][1];
+ if(dist(2,p,q)<Eps){closed=1;}
+ kL[0][0]=0; nkL=0;
+ for(i=1; i<=ndata1; i++){
+ ntmp=0; tmpd1=Inf;
+ pull2(i,data1,a);
+ nearestptpt(a, data1, tmpd4);
+ n=floor(tmpd4[2]+0.5);
+ if(n==i){continue;}
+ if(closed==1){
+ if((i==1)&&(n==ndata1)){continue;}
+ if((i==ndata1)&&(n==1)){continue;}
+ }
+ ntmp1=floor(tmpd4[2]+Eps);
+ if((tmpd4[3]<eps1s)&&(ntmp1!=i)){
+ if(ntmp<ntmp1){
+ ntmp=ntmp1;
+ tmpd1=tmpd4[3];
+ nkL=addptd4(kL,tmpd4);
+ }
+ else if(tmpd4[3]<tmpd1){
+ tmpd1=tmpd4[3];
+ kL[0][0]--;
+ nkL=addptd4(kL,tmpd4);
+ }
+ }
+ }
+ return nkL;
+}
+
+/*
+int intersectcrvsPptest(double data1[][2], double data2[][2],
+ double eps1,double eps2, double kL[][4]){
+ double t, s, a[2], b[2], p[2], q[2];
+ double sqeps=pow(10,-10.0), eps0=pow(10,-2.0);
+ double tmp1d2[2],tmp2d2[2],tmpd4[4],tmp1d4[4],tmpd5[5];
+ double tmpd1,tmp1d1,tmp2d1, kL0[DsizeL][5], ds;
+ int i, j, k, n, is, nkL, nall, ndata1,ndata2,ntmp, ntmp1, flg;
+ ndata1=length2(data1);
+ ndata2=length2(data2);
+ if(ndata1==ndata2){
+ tmp1d1=0; tmp2d1=0;
+ for(i=1; i<=ndata1; i++){
+ tmp1d1=tmp1d1+pow(data1[i][0]-data2[i][0],2.0);
+ tmp1d1=tmp1d1+pow(data1[i][1]-data2[i][1],2.0);
+ tmp2d1=tmp2d1+pow(data1[i][0]-data2[ndata2-i+1][0],2.0);
+ tmp2d1=tmp2d1+pow(data1[i][1]-data2[ndata2-i+1][1],2.0);
+ }
+ tmp1d1=sqrt(tmp1d1); tmp2d1=sqrt(tmp2d1);
+ if((tmp1d1<Eps)||(tmp2d1<Eps)){
+ kL[0][0]=0; nkL=0;
+ return nkL;
+ }
+ }
+ kL0[0][0]=0; nkL=0;
+ for(i=1; i<=ndata1; i++){
+ ntmp=0; tmpd1=Inf;
+ pull2(i,data1,a);
+ nearestptpt(a, data2, tmpd4);
+ tmp1d1=floor(tmpd4[2]+Eps); //17.06.03
+ a[0]=tmpd4[0]; a[1]=tmpd4[1];
+ nearestptpt(a, data1, tmpd4);
+ tmpd5[0]=tmpd4[0]; tmpd5[1]=tmpd4[1];
+ tmpd5[2]=tmpd4[2]; tmpd5[3]=tmp1d1;
+ tmpd5[4]=tmpd4[3];
+ nkL=addptd5(kL0,tmpd5);
+ }
+ kL[0][0]=0; nall=0;
+ p[0]=Inf; p[1]=0;
+ for(i=1; i<=nkL; i++){
+ if(kL0[i][4]<eps2){
+ q[0]=kL0[i][0]; q[1]=kL0[i][1];
+ if(dist(2,p,q)>eps2){
+ nall=push4(kL0[i][0],kL0[i][1],kL0[i][2],kL0[i][3],kL);
+ p[0]=kL0[i][0]; p[1]=kL0[i][1];
+ ds=kL0[i][4];
+ continue;
+ }
+ if(kL0[i][4]<ds){
+ kL[0][0]--;
+ nall=push4(kL0[i][0],kL0[i][1],kL0[i][2],kL0[i][3],kL);
+ p[0]=kL0[i][0]; p[1]=kL0[i][1];
+ ds=kL0[i][4];
+ }
+ }
+ }
+ return nall;
+}
+*/
+
+int intersectcrvsPp(double data1[][2], double data2[][2],
+ double eps,double eps1s, double kL[][4]){
+ double t, s, a[2], b[2], p[2], q[2];
+ double sqeps=pow(10,-10.0), eps0=pow(10,-2.0);
+ double tmp1d2[2],tmp2d2[2],tmpd4[4],tmp1d4[4],tmpd5[5];
+ double tmpd1,tmp1d1,tmp2d1;
+ int i, j, k, n, is, ndata1, ndata2, nkL,nkL1,nkL2,ntmp, ntmp1, flg;
+ ndata1=length2(data1);
+ ndata2=length2(data2);
+ if(ndata1==ndata2){
+ tmp1d1=0; tmp2d1=0;
+ for(i=1; i<=ndata1; i++){
+ tmp1d1=tmp1d1+pow(data1[i][0]-data2[i][0],2.0);
+ tmp1d1=tmp1d1+pow(data1[i][1]-data2[i][1],2.0);
+ tmp2d1=tmp2d1+pow(data1[i][0]-data2[ndata2-i+1][0],2.0);
+ tmp2d1=tmp2d1+pow(data1[i][1]-data2[ndata2-i+1][1],2.0);
+ }
+ tmp1d1=sqrt(tmp1d1); tmp2d1=sqrt(tmp2d1);
+ if((tmp1d1<Eps)||(tmp2d1<Eps)){
+ kL[0][0]=0; nkL=0;
+ return nkL;
+ }
+ }
+ kL[0][0]=0; nkL=0;
+ for(i=1; i<=ndata1;i++){
+ ntmp=0; tmpd1=Inf;
+ pull2(i,data1,a);
+ nearestptpt(a, data2, tmpd4);
+ tmp1d1=floor(tmpd4[2]+Eps); //17.06.03
+ a[0]=tmpd4[0]; a[1]=tmpd4[1];
+ nearestptpt(a, data1, tmpd4);
+ if(tmpd4[3]<eps1s){
+ flg=0;
+ p[0]=tmpd4[0]; p[1]=tmpd4[1];
+ for(j=1; j<=nkL; j++){
+ q[0]=kL[j][0]; q[1]=kL[j][1];
+ if(dist(2,p,q)<eps0){
+ flg=1;
+ break;
+ }
+ }
+ if(flg==1){continue;}
+ ntmp1=floor(tmpd4[2]+Eps);
+ if(ntmp<ntmp1){
+ ntmp=ntmp1;
+ tmpd1=tmpd4[3];
+ tmp1d4[0]=tmpd4[0]; tmp1d4[1]=tmpd4[1];
+ tmp1d4[2]=tmpd4[2]; tmp1d4[3]=tmp1d1;
+ nkL=addptd4(kL,tmp1d4);
+ }
+ else if(tmpd4[3]<tmpd1){
+ tmpd1=tmpd4[3];
+ kL[0][0]--;
+ tmp1d4[0]=tmpd4[0]; tmp1d4[1]=tmpd4[1];
+ tmp1d4[2]=tmpd4[2]; tmp1d4[3]=tmp1d1;
+ nkL=addptd4(kL,tmp1d4);
+ }
+ }
+ }
+ return nkL;
+}
+
+int intersectcrvsPpold(double data1[][2], double data2[][2],
+ double eps,double eps1s, double kL[][4]){
+// 17.05.22
+ double kL1[DsizeL][5], kL2[DsizeL][5];
+ double t, s, a[2], b[2], p[2], q[2];
+ double sqeps=pow(10,-10.0), eps0=pow(10,-6.0);
+ double tmp1d2[2],tmp2d2[2],tmpd4[4],tmpd5[5];
+ double tmpd1,tmp1d1,tmp2d1;
+ int i, j, k, n, is, ndata1, ndata2, nkL,nkL1,nkL2,ntmp,flg;
+ ndata1=length2(data1);
+ ndata2=length2(data2);
+ if(ndata1==ndata2){
+ tmp1d1=0; tmp2d1=0;
+ for(i=1; i<=ndata1; i++){
+ tmp1d1=tmp1d1+pow(data1[i][0]-data2[i][0],2.0);
+ tmp1d1=tmp1d1+pow(data1[i][1]-data2[i][1],2.0);
+ tmp2d1=tmp2d1+pow(data1[i][0]-data2[ndata2-i+1][0],2.0);
+ tmp2d1=tmp2d1+pow(data1[i][1]-data2[ndata2-i+1][1],2.0);
+ }
+ tmp1d1=sqrt(tmp1d1); tmp2d1=sqrt(tmp2d1);
+ if((tmp1d1<eps0)||(tmp2d1<eps0)){
+ kL[0][0]=0; nkL=0;
+ return nkL;
+ }
+ }
+ kL1[0][0]=0; nkL1=0;
+ kL2[0][0]=0; nkL2=0;
+ for(i=1; i<=ndata1-1; i++){
+ pull2(i,data1,a);
+ pull2(i+1,data1,b);
+ for(j=1; j<=ndata2-1; j++){
+ pull2(j, data2, p);
+ pull2(j+1, data2, q);
+ koutenseg(a,b,p,q,eps,eps1s,tmpd4);
+ if(tmpd4[0]<Inf-1){
+ ntmp=floor(tmpd4[3]+Eps);
+ if(ntmp==0){
+ tmpd5[0]=tmpd4[0]; tmpd5[1]=tmpd4[1];
+ tmpd5[2]=tmpd4[2]; tmpd5[3]=i; tmpd5[4]=j;
+ nkL1=addptd5(kL1,tmpd5);
+ }
+ else{
+ tmpd5[0]=tmpd4[0]; tmpd5[1]=tmpd4[1];
+ tmpd5[2]=tmpd4[2]; tmpd5[3]=i; tmpd5[4]=j;
+ nkL2=addptd5(kL2,tmpd5);
+ }
+ }
+ }
+ }
+ kL[0][0]=0; nkL=0;
+ if(nkL1>0){
+ pull5(1,kL1,tmpd5);
+ p[0]=tmpd5[0]; p[1]=tmpd5[1];
+ t=tmpd5[2];
+ i=floor(tmpd5[3]+Eps);
+ j=floor(tmpd5[4]+Eps);
+ tmpd4[0]=p[0]; tmpd4[1]=p[1];
+ tmpd4[2]=i+t; tmpd4[3]=j;
+ nkL=addptd4(kL,tmpd4);
+ }
+ for(n=2; n<=nkL1; n++){
+ pull5(n,kL1,tmpd5);
+ p[0]=tmpd5[0]; p[1]=tmpd5[1];
+ flg=0;
+ for(k=1; k<=nkL; k++){
+ pull4(k,kL,tmpd4);
+ tmp1d2[0]=tmpd4[0]; tmp1d2[1]=tmpd4[1];
+ if(pow(dist(2,p,tmp1d2),2.0)<sqeps){
+ flg=1;
+ break;
+ }
+ }
+ if(flg==0){
+ tmpd4[0]=p[0]; tmpd4[1]=p[1];
+ t=tmpd5[2];
+ i=floor(tmpd5[3]+Eps);
+ j=floor(tmpd5[4]+Eps);
+ tmpd4[2]=t+i; tmpd4[3]=j;
+ nkL=addptd4(kL,tmpd4);
+ }
+ }
+ for(n=1; n<=nkL2; n++){
+ pull5(n,kL2,tmpd5);
+ p[0]=tmpd5[0]; p[1]=tmpd5[1];
+ flg=0;
+ for(k=1; k<=nkL; k++){
+ pull4(k,kL,tmpd4);
+ tmp1d2[0]=tmpd4[0]; tmp1d2[1]=tmpd4[1];
+ if(pow(dist(2,p,tmp1d2),2.0)<sqeps){
+ flg=1;
+ break;
+ }
+ }
+ if(flg==0){
+ tmpd4[0]=p[0]; tmpd4[1]=p[1];
+ t=tmpd5[2];
+ i=floor(tmpd5[3]+Eps);
+ j=floor(tmpd5[4]+Eps);
+ tmpd4[2]=i+t; tmpd4[3]=j;
+ nkL=addptd4(kL,tmpd4);
+ }
+ }
+ return nkL;
+}
+
+int dropnumlistcrv(double qd[][2], double eps1, int out[]){
+ int i,j,k, nout,nall=length2(qd), nd, se, en, npd, nptL;
+ int din[DsizeM][2],ptL[DsizeL];
+ double eps=pow(10.0,-6.0), pd[DsizeL][2], p[2], tmp2d[2];
+ out[0]=0; nout=0;
+ nd=dataindexd2(2,qd,din);
+ for(j=1; j<=nd; j++){
+ se=din[j][0]; en=din[j][1];
+ pd[0][0]=0; npd=0;
+ npd=appendd2(0,se,en,qd,pd);
+ ptL[0]=0; nptL=0;
+ nptL=appendi1(ptL,1);
+ pull2(1,pd,p);
+ for(k=2; k<=npd-1; k++){
+ pull2(k,pd,tmp2d);
+ if(dist(2,p,tmp2d)>eps1){
+ nptL=appendi1(ptL,k);
+ pull2(k,pd,p);
+ }
+ }
+ pull2(npd-1,pd,p);
+ pull2(npd,pd,tmp2d);
+ if(dist(2,p,tmp2d)>eps){ // eps -> eps1 ?
+ nptL=appendi1(ptL,npd);
+ }
+ if(nptL==1){ptL[0]=0; nptL=0;}
+ if(nout>0){
+ nout=appendi1(out,Infint);
+ }
+ for(i=1; i<=nptL; i++){
+ nout=appendi1(out,ptL[i]);
+ }
+ }
+ out[0]=nout;
+ return nout;
+}
+
+int increasept2(double ptL[][2], int nn, double out[][2]){
+ int ii, jj, npt, nall;
+ double tmpd2[2];
+ npt=length2(ptL);
+ out[0][0]=0;
+ for(ii=1; ii<=npt-1; ii++){
+ for(jj=0; jj<nn; jj++){
+ tmpd2[0]=ptL[ii][0]+1.0*jj/nn*(ptL[ii+1][0]-ptL[ii][0]);
+ tmpd2[1]=ptL[ii][1]+1.0*jj/nn*(ptL[ii+1][1]-ptL[ii][1]);
+ addptd2(out,tmpd2);
+ }
+ }
+ nall=appendd2(0,npt,npt,ptL,out);
+ return nall;
+}
+
+int increasept3(double ptL[][3], int nn, double out[][3]){
+ int ii, jj, npt, nall;
+ double tmpd3[3];
+ npt=length3(ptL);
+ out[0][0]=0;
+ for(ii=1; ii<=npt-1; ii++){
+ for(jj=0; jj<nn; jj++){
+ tmpd3[0]=ptL[ii][0]+1.0*jj/nn*(ptL[ii+1][0]-ptL[ii][0]);
+ tmpd3[1]=ptL[ii][1]+1.0*jj/nn*(ptL[ii+1][1]-ptL[ii][1]);
+ tmpd3[2]=ptL[ii][2]+1.0*jj/nn*(ptL[ii+1][2]-ptL[ii][2]);
+ addptd3(out,tmpd3);
+ }
+ }
+ nall=appendd3(0,npt,npt,ptL,out);
+ return nall;
+}
+
+void bezierpt(double t, double p0[], double p3[], double p1[], double p2[],
+ double pout[]){
+ double p4[2], p5[2], p6[2], p7[2], p8[2];
+ int i, flg3=1;
+ if(p2[0]>Inf-1){
+ for(i=0; i<2; i++){
+ p2[i]=p3[i];
+ }
+ flg3=0;
+ }
+ for(i=0; i<2; i++){
+ p4[i]=(1-t)*p0[i]+t*p1[i];
+ }
+ for(i=0; i<2; i++){
+ p5[i]=(1-t)*p1[i]+t*p2[i];
+ }
+ for(i=0; i<2; i++){
+ p6[i]=(1-t)*p2[i]+t*p3[i];
+ }
+ for(i=0; i<2; i++){
+ p7[i]=(1-t)*p4[i]+t*p5[i];
+ }
+ if(flg3==0){
+ for(i=0; i<2; i++){
+ pout[i]=p7[i];
+ }
+ }
+ else{
+ for(i=0; i<2; i++){
+ p8[i]=(1-t)*p5[i]+t*p6[i];
+ }
+ for(i=0; i<2; i++){
+ pout[i]=(1-t)*p7[i]+t*p8[i];
+ }
+ }
+}
+
+int bezier(double ptL[][2], double ctrL[][4], int num, double out[][2]){
+ double p0[2], p3[2], p1[2], p2[2], pt[2], dt=1.0/num;
+ int i, j, n, nall;
+ out[0][0]=0; nall=0;
+ nall=appendd2(0,1,1,ptL,out);
+ n=length2(ptL);
+ for(i=1; i<=n-1; i++){
+ pull2(i,ptL, p0);
+ pull2(i+1,ptL, p3);
+ p1[0]=ctrL[i][0]; p1[1]=ctrL[i][1];
+ p2[0]=ctrL[i][2]; p2[1]=ctrL[i][3];
+ for(j=1; j<=num; j++){
+ bezierpt(j*dt,p0,p3,p1,p2,pt);
+ nall=push2(pt[0],pt[1], out);
+ }
+ }
+ return nall;
+}
+
+int ospline(int level, double ptL[][2], int num, double out[][2]){
+ double ctrlist[DsizeM][4], eps0=pow(10,-6.0), tmp, cc;
+ double p[2], q[2], p0[2], p3[2], p1[2], p2[2], pQ[2], pR[2];
+ double ptlist[DsizeM][2], tmpmd2[DsizeM][2];
+ int nd, i, j, npt, nall, nctr, flg, ndin, closed, din[DsizeM][2], ntmp;
+ out[0][0]=0;
+ if(num==1){
+ npt=length2(ptL);
+ for(i=0; i<=npt; i++){
+ out[i][0]=ptL[i][0]; out[i][1]=ptL[i][1];
+ }
+ nall=length2(out);
+ return nall;
+ }
+ ndin=dataindexd2(level,ptL,din);
+ for(nd=1; nd<=ndin; nd++){
+ ptlist[0][0]=0;
+ npt=appendd2(0,din[nd][0],din[nd][1],ptL,ptlist);
+ if(npt==2){
+ appendd2(2, 1,npt,ptlist,out);
+ continue;
+ }
+ closed=0;
+ pull2(1,ptlist,p);
+ pull2(npt,ptlist,q);
+ if(dist(2,p,q)<eps0){
+ closed=1;
+ }
+ ctrlist[0][0]=0; nctr=0;
+ for(i=1; i<=npt-1; i++){
+ flg=0;
+ pull2(i, ptlist,p1);
+ pull2(i+1, ptlist,p2);
+ if((i==1)||(i==npt-1)){
+ flg=1;
+ if(closed==0){
+ pQ[0]=(p1[0]+2*p2[0])/3.0;
+ pQ[1]=(p1[1]+2*p2[1])/3.0;
+ pR[0]=(2*p1[0]+p2[0])/3.0;
+ pR[1]=(2*p1[1]+p2[1])/3.0;
+ nctr++;
+ ctrlist[nctr][0]=pQ[0]; ctrlist[nctr][1]=pQ[1];
+ ctrlist[nctr][2]=pR[0]; ctrlist[nctr][3]=pR[1];
+ flg=2;
+ }
+ else{
+ if(i==1){
+ pull2(npt-1, ptlist,p0);
+ pull2(i+2, ptlist,p3);
+ }
+ else{
+ pull2(i-1, ptlist, p0);
+ pull2(2, ptlist, p3);
+ }
+ }
+ }
+ if(flg<=1){
+ if(flg==0){
+ pull2(i-1, ptlist, p0);
+ pull2(i+2, ptlist, p3);
+ }
+ p[0]=p2[0]-p0[0]; p[1]=p2[1]-p0[1];
+ q[0]=p3[0]-p1[0]; q[1]=p3[1]-p1[1];
+ tmp=1+sqrt((1+dotprod(2,p,q)/dist(2,p0,p2)/dist(2,p1,p3))/2);
+ cc=4*dist(2,p1,p2)/3/(dist(2,p0,p2)+dist(2,p1,p3))/tmp;
+ pQ[0]=p1[0]+cc*(p2[0]-p0[0]); pQ[1]=p1[1]+cc*(p2[1]-p0[1]);
+ pR[0]=p2[0]+cc*(p1[0]-p3[0]); pR[1]=p2[1]+cc*(p1[1]-p3[1]);
+ nctr++;
+ ctrlist[nctr][0]=pQ[0]; ctrlist[nctr][1]=pQ[1];
+ ctrlist[nctr][2]=pR[0]; ctrlist[nctr][3]=pR[1];
+ }
+ }
+ if(closed==0){
+ p1[0]=ctrlist[2][0]; p1[1]=ctrlist[2][1];
+ pull2(2, ptlist, p2);
+ pQ[0]=p2[0]+(p2[0]-p1[0]); pQ[1]=p2[1]+(p2[1]-p1[1]);
+ ctrlist[1][0]=pQ[0]; ctrlist[1][1]=pQ[1];
+ ctrlist[1][2]=Inf; ctrlist[1][3]=0;
+ p1[0]=ctrlist[nctr-1][2]; p1[1]=ctrlist[nctr-1][3];
+ pull2(nctr,ptlist,p2);
+ pQ[0]=p2[0]+(p2[0]-p1[0]); pQ[1]=p2[1]+(p2[1]-p1[1]);
+ ctrlist[nctr][0]=pQ[0]; ctrlist[nctr][1]=pQ[1];
+ ctrlist[nctr][2]=Inf; ctrlist[1][3]=0;
+ }
+ ctrlist[0][0]=nctr;
+ if(length2(ptlist)>2){
+ ntmp=bezier(ptlist,ctrlist,num, tmpmd2);
+ nall=appendd2(2,1,ntmp,tmpmd2,out);
+ }
+ }
+ return nall;
+}
+
+void bezierpt3(double t, double p0[], double p3[], double p1[], double p2[],
+ double pout[]){
+ double p4[3], p5[3], p6[3], p7[3], p8[3];
+ int i, flg3=1;
+ if(p2[0]>Inf-1){
+ for(i=0; i<3; i++){
+ p2[i]=p3[i];
+ }
+ flg3=0;
+ }
+ for(i=0; i<3; i++){
+ p4[i]=(1-t)*p0[i]+t*p1[i];
+ }
+ for(i=0; i<3; i++){
+ p5[i]=(1-t)*p1[i]+t*p2[i];
+ }
+ for(i=0; i<3; i++){
+ p6[i]=(1-t)*p2[i]+t*p3[i];
+ }
+ for(i=0; i<3; i++){
+ p7[i]=(1-t)*p4[i]+t*p5[i];
+ }
+ if(flg3==0){
+ for(i=0; i<3; i++){
+ pout[i]=p7[i];
+ }
+ }
+ else{
+ for(i=0; i<3; i++){
+ p8[i]=(1-t)*p5[i]+t*p6[i];
+ }
+ for(i=0; i<3; i++){
+ pout[i]=(1-t)*p7[i]+t*p8[i];
+ }
+ }
+}
+
+int bezier3(double ptL[][3], double ctrL[][6], int num, double out[][3]){
+ double p0[3], p3[3], p1[3], p2[3], pt[3], dt=1.0/num;
+ int i, j, n, nall;
+ out[0][0]=0; nall=0;
+ nall=appendd3(0,1,1,ptL,out);
+ n=length3(ptL);
+ for(i=1; i<=n-1; i++){
+ pull3(i,ptL, p0);
+ pull3(i+1,ptL, p3);
+ p1[0]=ctrL[i][0]; p1[1]=ctrL[i][1]; p1[2]=ctrL[i][2];
+ p2[0]=ctrL[i][3]; p2[1]=ctrL[i][4]; p2[2]=ctrL[i][5];
+ for(j=1; j<=num; j++){
+ bezierpt3(j*dt,p0,p3,p1,p2,pt);
+ nall=push3(pt[0],pt[1],pt[2], out);
+ }
+ }
+ return nall;
+}
+
+int ospline3(int level, double ptL[][3], int num, double out[][3]){
+ double ctrlist[DsizeM][6], eps0=pow(10,-6.0), tmp, cc;
+ double p[3], q[3], p0[3], p3[3], p1[3], p2[3], pQ[3], pR[3];
+ double ptlist[DsizeM][3], tmpmd2[DsizeM][3];
+ int nd, i, j, n, npt, nall, nctr, closed, flg, ndin, din[DsizeM][2], ntmp;
+ out[0][0]=0; nall=0;
+ if(num==1){
+ npt=length3(ptL);
+ for(i=0; i<=npt; i++){
+ out[i][0]=ptL[i][0]; out[i][1]=ptL[i][1]; out[i][2]=ptL[i][2];
+ }
+ nall=length3(out);
+ return nall;
+ }
+ ndin=dataindexd3(2,ptL,din);
+ for(nd=1; nd<=ndin; nd++){
+ ptlist[0][0]=0;
+ npt=din[nd][1]-din[nd][0];
+ if(npt<=3){
+ n=appendd3(0, din[nd][0], din[nd][0], ptL, ptlist);
+ for(i=1; i<=npt-1; i++){
+ pull3(din[nd][0]+i,ptL,p);
+ pull3(din[nd][0]+i+1,ptL,q);
+ for(j=1; j<=num; j++){
+ p1[0]=p[0]+1.0*j/num*(q[0]-p[0]);
+ p1[1]=p[1]+1.0*j/num*(q[1]-p[1]);
+ p1[2]=p[2]+1.0*j/num*(q[2]-p[2]);
+ n=addptd3(ptlist,p1);
+ }
+ }
+ nall=appendd3(2, 1,n,ptlist,out);
+ continue;
+ }
+ appendd3(0,din[nd][0],din[nd][1],ptL,ptlist);
+ closed=0;
+ pull3(1,ptlist,p);
+ pull3(npt,ptlist,q);
+ if(dist(3,p,q)<eps0){closed=1;}
+ ctrlist[0][0]=0; nctr=0;
+ for(i=1; i<=npt-1; i++){
+ flg=0;
+ pull3(i, ptlist,p1);
+ pull3(i+1, ptlist,p2);
+ if((i==1)||(i==npt-1)){
+ flg=1;
+ if(closed==0){
+ pQ[0]=(p1[0]+2*p2[0])/3.0;
+ pQ[1]=(p1[1]+2*p2[1])/3.0;
+ pQ[2]=(p1[2]+2*p2[2])/3.0;
+ pR[0]=(2*p1[0]+p2[0])/3.0;
+ pR[1]=(2*p1[1]+p2[1])/3.0;
+ pR[2]=(2*p1[2]+p2[2])/3.0;
+ nctr++;
+ ctrlist[nctr][0]=pQ[0]; ctrlist[nctr][1]=pQ[1]; ctrlist[nctr][2]=pQ[2];
+ ctrlist[nctr][3]=pR[0]; ctrlist[nctr][4]=pR[1]; ctrlist[nctr][5]=pR[2];
+ flg=2;
+ }
+ else{
+ if(i==1){
+ pull3(npt-1, ptlist,p0);
+ pull3(i+2, ptlist,p3);
+ }
+ else{
+ pull3(i-1, ptlist, p0);
+ pull3(2, ptlist, p3);
+ }
+ }
+ }
+ if(flg<=1){
+ if(flg==0){
+ pull3(i-1, ptlist, p0);
+ pull3(i+2, ptlist, p3);
+ }
+ p[0]=p2[0]-p0[0]; p[1]=p2[1]-p0[1]; p[2]=p2[2]-p0[2];
+ q[0]=p3[0]-p1[0]; q[1]=p3[1]-p1[1]; q[2]=p3[2]-p1[2];
+ tmp=1+sqrt((1+dotprod(3,p,q)/dist(3,p0,p2)/dist(3,p1,p3))/2);
+ cc=4*dist(3,p1,p2)/3/(dist(3,p0,p2)+dist(3,p1,p3))/tmp;
+ pQ[0]=p1[0]+cc*(p2[0]-p0[0]); pQ[1]=p1[1]+cc*(p2[1]-p0[1]);
+ pQ[2]=p1[2]+cc*(p2[2]-p0[2]);
+ pR[0]=p2[0]+cc*(p1[0]-p3[0]); pR[1]=p2[1]+cc*(p1[1]-p3[1]);
+ pR[2]=p2[2]+cc*(p1[2]-p3[2]);
+ nctr++;
+ ctrlist[nctr][0]=pQ[0]; ctrlist[nctr][1]=pQ[1]; ctrlist[nctr][2]=pQ[2];
+ ctrlist[nctr][3]=pR[0]; ctrlist[nctr][4]=pR[1]; ctrlist[nctr][5]=pR[2];
+ }
+ }
+ if(closed==0){
+ p1[0]=ctrlist[2][0]; p1[1]=ctrlist[2][1]; p1[2]=ctrlist[2][2];
+ pull3(2, ptlist, p2);
+ pQ[0]=p2[0]+(p2[0]-p1[0]); pQ[1]=p2[1]+(p2[1]-p1[1]);
+ pQ[2]=p2[2]+(p2[2]-p1[2]);
+ ctrlist[1][0]=pQ[0]; ctrlist[1][1]=pQ[1]; ctrlist[1][2]=pQ[2];
+ ctrlist[1][3]=Inf; ctrlist[1][4]=0; ctrlist[1][5]=0;
+ p1[0]=ctrlist[nctr-1][3]; p1[1]=ctrlist[nctr-1][4]; p1[2]=ctrlist[nctr-1][5];
+ pull3(nctr,ptlist,p2);
+ pQ[0]=p2[0]+(p2[0]-p1[0]); pQ[1]=p2[1]+(p2[1]-p1[1]);
+ pQ[2]=p2[2]+(p2[2]-p1[2]);
+ ctrlist[nctr][0]=pQ[0]; ctrlist[nctr][1]=pQ[1]; ctrlist[nctr][2]=pQ[2];
+ ctrlist[nctr][3]=Inf; ctrlist[1][4]=0; ctrlist[1][5]=0;
+ }
+ ctrlist[0][0]=nctr;
+ if(length3(ptlist)>2){
+ ntmp=bezier3(ptlist,ctrlist,num, tmpmd2);
+ nall=appendd3(2,1,ntmp,tmpmd2,out);
+ }
+ }
+ return nall;
+}
diff --git a/texmf-dist/scripts/ketcindy/ketlibC/surflib.h b/texmf-dist/scripts/ketcindy/ketlibC/surflib.h
new file mode 100644
index 00000000..1b2f6c48
--- /dev/null
+++ b/texmf-dist/scripts/ketcindy/ketlibC/surflib.h
@@ -0,0 +1,1888 @@
+// 17.06.16 crvsfparadata changed ( num of devision )
+
+int output3(const char *var, const char *fname, int level, double out[][3]){
+ int nall=floor(out[0][0]+0.5), ndin, din[DsizeM][2],i,j;
+ double tmpd[3];
+ FILE *fp;
+ fp=fopen(fname,"w");
+ if (fp == NULL) {
+ printf("cannot open\n");
+ return -1;
+// exit(1);
+ }
+ ndin=dataindexd3(level, out,din);
+ fprintf(fp,"%s//\n",var); //17.05.29
+// fprintf(fp,"%s3d//\n",var2);
+ for(i=1; i<=ndin; i++){
+ fprintf(fp,"start//\n");
+ fprintf(fp,"[");
+ for(j=din[i][0]; j<=din[i][1]; j++){
+ pull3(j,out,tmpd);
+ fprintf(fp,"[ %7.5f, %7.5f, %7.5f]",tmpd[0],tmpd[1],tmpd[2]);
+ if(j<din[i][1]){
+ fprintf(fp,",");
+ }
+ }
+ fprintf(fp,"]//\n");
+ if(i<ndin){
+ fprintf(fp,"end//\n");
+ }
+ else{
+ fprintf(fp,"end////\n");
+ }
+ }
+ fclose(fp);
+ return 0;
+}
+
+int output3h(const char *var, const char *varh, const char *fname, double out[][3]){
+ // 17.06.09
+ double out1[DsizeLL][3], tmpd[3];
+ int din1[DsizeM][2],ndin2, din2[DsizeM][2], i, j;
+ FILE *fp;
+ fp=fopen(fname,"w");
+ if (fp == NULL) {
+ printf("cannot open\n");
+ return -1;
+ }
+ dataindexd3(3,out,din1);
+ out1[0][0]=0;
+ appendd3(0, din1[1][0],din1[1][1],out,out1);
+ ndin2=dataindexd3(2, out1,din2);
+ fprintf(fp,"%s//\n",var);
+ for(i=1; i<=ndin2; i++){
+ fprintf(fp,"start//\n");
+ fprintf(fp,"[");
+ for(j=din2[i][0]; j<=din2[i][1]; j++){
+ pull3(j,out1,tmpd);
+ fprintf(fp,"[ %7.5f, %7.5f, %7.5f]",tmpd[0],tmpd[1],tmpd[2]);
+ if(j<din2[i][1]){
+ fprintf(fp,",");
+ }
+ }
+ fprintf(fp,"]//\n");
+ fprintf(fp,"end//\n");
+ }
+ out1[0][0]=0;
+ fprintf(fp,"%s//\n",varh); //17.06.16from
+ appendd3(0, din1[2][0],din1[2][1],out,out1);
+ ndin2=dataindexd3(2, out1,din2);
+ for(i=1; i<=ndin2; i++){
+ fprintf(fp,"start//\n");
+ fprintf(fp,"[");
+ for(j=din2[i][0]; j<=din2[i][1]; j++){
+ pull3(j,out1,tmpd);
+ fprintf(fp,"[ %7.5f, %7.5f, %7.5f]",tmpd[0],tmpd[1],tmpd[2]);
+ if(j<din2[i][1]){
+ fprintf(fp,",");
+ }
+ }
+ fprintf(fp,"]//\n");
+// if(i<ndin2){
+ fprintf(fp,"end//\n");
+// }
+// else{
+// fprintf(fp,"end////\n");
+// }
+ }
+ fprintf(fp,"//\n");
+ fclose(fp);
+ return 0;
+}
+
+int writedataC(const char *fname, double out[][3]){
+ int i, nall;
+ FILE *fp;
+ nall=length3(out);
+ fp=fopen(fname,"w");
+ for(i=1; i<=nall; i++){
+ fprintf(fp,"%7.5f %7.5f %7.5f\n",out[i][0],out[i][1],out[i][2]);
+ }
+ fprintf(fp,"%7.5f %7.5f %7.5f\n",Inf,Inf,Inf);
+ fclose(fp);
+ return nall;
+}
+
+int readdataC(const char *fname, double data[][3]){
+ int i, j, ndata=0;
+ FILE *fp;
+ fp=fopen(fname,"r");
+ if(fp==NULL){
+ printf("file not found\n");
+ return 1;
+ }
+ while( ! feof(fp) && ndata<DsizeL){
+ ndata++;
+ for(j=0;j<=2;j++){
+ fscanf(fp,"%lf",&data[ndata][j]);
+ }
+ if(data[ndata][1]==Inf){
+ ndata--;
+ break;
+ }
+ }
+ fclose(fp);
+ data[0][0]=ndata;
+ return ndata;
+}
+
+void parapt(double pt3[3],double pt2[2]){
+ if(fabs(pt3[0])>Inf-1){
+ pt2[0]=pt3[0]; pt2[1]=pt3[1];
+ }
+ else{
+ pt2[0]=-pt3[0]*sin(PHI)+pt3[1]*cos(PHI);
+ pt2[1]=-pt3[0]*cos(PHI)*cos(THETA)-pt3[1]*sin(PHI)*cos(THETA)+pt3[2]*sin(THETA);
+ }
+}
+
+int projpara(double p3[][3], double p2[][2]){
+ double pt3[3], pt2[2];
+ int i, nall, nall2;
+ nall=length3(p3);
+ p2[0][0]=0;
+ for(i=1; i<=nall; i++){
+ pull3(i,p3,pt3);
+ parapt(pt3,pt2);
+ nall2=addptd2(p2,pt2);
+ }
+ return nall2;
+}
+
+double invparapt(double ph, double fh[][2], double fk[][3],double out[3]){
+ int n, nfk=length3(fk), nph=length2(fh);
+ double s0=ph-n, ak[3], bk[3], ah[2], bh[2], pk[3];
+ if(nfk>2){
+ n=trunc(ph);
+ s0=ph-n;
+ if(ph>nph-Eps){
+ out[0]=fk[nfk][0]; out[1]=fk[nfk][1]; out[2]=fk[nfk][2];
+ return nph;
+ }
+ }
+ else{
+ n=1;
+ s0=ph-1;
+ }
+ ak[0]=fk[n][0]; ak[1]=fk[n][1]; ak[2]=fk[n][2];
+ bk[0]=fk[n+1][0]; bk[1]=fk[n+1][1]; bk[2]=fk[n+1][2];
+ ah[0]=fh[n][0]; ah[1]=fh[n][1];
+ bh[0]=fh[n+1][0]; bh[1]=fh[n+1][1];
+ out[0]=(1-s0)*ak[0]+s0*bk[0];
+ out[1]=(1-s0)*ak[1]+s0*bk[1];
+ out[2]=(1-s0)*ak[2]+s0*bk[2];
+ return n+s0;
+}
+
+int surfcurve(int level, double crv[][2], double pdata[][3]){
+ double p2[2], pt[3];
+ int i, n, nall;
+ n=length2(crv);
+ pdata[0][0]=0;
+ for(i=1; i<=n; i++){
+ pull2(i,crv,p2);
+ surffun(p2[0],p2[1],pt);
+ nall=addptd3(pdata,pt);
+ }
+ return nall;
+}
+
+int xyzax3data(double x0, double x1, double y0, double y1, double z0, double z1,
+ double out[][3]){
+ int nall;
+ double pd3[10][3];
+ out[0][0]=0; nall=0;
+ pd3[0][0]=2;
+ pd3[1][0]=x0; pd3[1][1]=0; pd3[1][2]=0;
+ pd3[2][0]=x1; pd3[2][1]=0; pd3[2][2]=0;
+ nall=appendd3(2,1,2,pd3,out);
+ pd3[1][0]=0; pd3[1][1]=y0; pd3[1][2]=0;
+ pd3[2][0]=0; pd3[2][1]=y1; pd3[2][2]=0;
+ nall=appendd3(2,1,2,pd3,out);
+ pd3[1][0]=0; pd3[1][1]=0; pd3[1][2]=z0;
+ pd3[2][0]=0; pd3[2][1]=0; pd3[2][2]=z1;
+ nall=appendd3(2,1,2,pd3,out);
+ return nall;
+}
+
+void evlptablepara(void){
+ int i, j;
+ double u,v,u1,u2,v1,v2,pt1[3],pt2[3],pt2d1[2],pt2d2[2],dxu,dyu,dxv,dyv;
+ double du=(Urng[1]-Urng[0])/Mdv, dv=(Vrng[1]-Vrng[0])/Ndv;
+ for (j= 0; j < Ndv+1; j++) {
+ v=Vrng[0]+j*dv;
+ v1=v-Eps/2; v2=v+Eps/2;
+ for (i = 0; i < Mdv+1; i++) {
+ u=Urng[0]+i*du;
+ u1=u-Eps/2; u2=u+Eps/2;
+ surffun(u1,v,pt1); parapt(pt1,pt2d1);
+ surffun(u2,v,pt2); parapt(pt2,pt2d2);
+ dxu=(pt2d2[0]-pt2d1[0])/Eps;
+ dyu=(pt2d2[1]-pt2d1[1])/Eps;
+ surffun(u,v1,pt1); parapt(pt1,pt2d1);
+ surffun(u,v2,pt2); parapt(pt2,pt2d2);
+ dxv=(pt2d2[0]-pt2d1[0])/Eps;
+ dyv=(pt2d2[1]-pt2d1[1])/Eps;
+ Zval[j][i]=dxu*dyv-dxv*dyu;
+ }
+ }
+ for (i = 0; i < Mdv+1; i++) {
+ Xval[i]=Urng[0]+i*du;
+ }
+ for (j= 0; j < Ndv+1; j++) {
+ Yval[j]=Vrng[0]+j*dv;
+ }
+};
+
+int implicitplot(double out[][2]){
+ int i, j, k, ctrq=0,ctr, nall;
+ double pl[5][2], vl[5], ql[11][2], out2[DsizeM][2];
+ ctr=0;
+ for (j = 0; j < Ndv; j++) {
+ for (i = 0; i < Mdv; i++) {
+ pl[0][0]=Xval[i]; pl[0][1]=Yval[j]; vl[0]=Zval[j][i];
+ pl[1][0]=Xval[i+1]; pl[1][1]=Yval[j]; vl[1]=Zval[j][i+1];
+ pl[2][0]=Xval[i+1]; pl[2][1]=Yval[j+1]; vl[2]=Zval[j+1][i+1];
+ pl[3][0]=Xval[i]; pl[3][1]=Yval[j+1]; vl[3]=Zval[j+1][i];
+ pl[4][0]=Xval[i]; pl[4][1]=Yval[j]; vl[4]=Zval[j][i];
+ ctrq=0;
+ for (k = 0; k < 4; k++) {
+ if(fabs(vl[k])<=Eps){
+ ql[ctrq][0]=pl[k][0];
+ ql[ctrq][1]=pl[k][1];
+ ctrq++;
+ }
+ else if(vl[k]>Eps){
+ if(vl[k+1]< -Eps){
+ ql[ctrq][0]=1/(vl[k]-vl[k+1])*(-vl[k+1]*pl[k][0]+vl[k]*pl[k+1][0]);
+ ql[ctrq][1]=1/(vl[k]-vl[k+1])*(-vl[k+1]*pl[k][1]+vl[k]*pl[k+1][1]);
+ ctrq++;
+ }
+ }
+ else{
+ if(vl[k+1]>Eps){
+ ql[ctrq][0]=1/(-vl[k]+vl[k+1])*(vl[k+1]*pl[k][0]-vl[k]*pl[k+1][0]);
+ ql[ctrq][1]=1/(-vl[k]+vl[k+1])*(vl[k+1]*pl[k][1]-vl[k]*pl[k+1][1]);
+ ctrq++;
+ }
+ }
+ }
+ if(ctrq==2){
+ if(ctr>0){
+ ctr++;
+ out[ctr][0]=Inf;
+ out[ctr][1]=2; // 2 <- 0 ?
+ }
+ ctr++;
+ out[ctr][0]=ql[0][0];
+ out[ctr][1]=ql[0][1];
+ ctr++;
+ out[ctr][0]=ql[1][0];
+ out[ctr][1]=ql[1][1];
+ }
+ }
+ }
+ out[0][0]=ctr;
+ if(ctr>0){
+ nall=connectseg(out, Eps, out2);
+ out[0][0]=0;
+ nall=appendd2(2,1,nall,out2,out);
+ }
+ return nall;
+}
+
+int cuspsplitpara(double pdata[][2], double outkL[][3]){
+ int i, j, ng, n, nd, ndd, ndrop, is, ncusp=0, ncusppt,st, en, npk,nph, cflg;
+ int cusp[DsizeM], cuspflg;
+ int ntmp,ntmp1,ntmp2, ntmpnum, noutkL=0, noutk=0, nout=0;
+ int din[DsizeM][2], dind[DsizeM][2], drop[DsizeL], tmpnum[DsizeM];
+ double eps=pow(10.0,-6.0);
+ double vtmp, vtmp1,kaku,cva, ps[2], pe[2],v1[2],v2[2];
+ double tmp[2],tmp1[2],tmp2[2],pt3d[3],pt2d[2],q3d[3],q2d[2];
+ double ptk[DsizeM][3],pth[DsizeM][2], outk[DsizeM][3];
+ double ptxy[DsizeM][2],tmp3d[DsizeM][3];
+ double tmp3d1[DsizeM][3],tmp3d2[DsizeM][3],tmp2d[DsizeM][2];
+ outkL[0][0]=0;
+ cusp[0]=0;
+ Cuspsplitpt[0][0]=0;
+ nd=dataindexd2(0,pdata,din);
+ for(ng=1; ng<=nd; ng++){
+ ptk[0][0]=0; pth[0][0]=0;
+ st=din[ng][0]; en=din[ng][1];
+ ptxy[0][0]=0;
+ n=appendd2(0,st,en,pdata,ptxy);
+ npk=0; nph=0;
+ for(i=1; i<=en-st+1; i++){
+ pull2(st+i-1,pdata,tmp);
+ surffun(tmp[0],tmp[1],pt3d);
+ parapt(pt3d,pt2d);
+ if(i==1){
+ npk=addptd3(ptk,pt3d);
+ nph=addptd2(pth,pt2d);
+ }
+ else{
+ pull2(nph,pth,tmp1);
+ if(dist(2,tmp1,pt2d)>eps){
+ npk=addptd3(ptk,pt3d);
+ nph=addptd2(pth,pt2d);
+ }
+ }
+ }
+ if(nph==0){
+ npk=0;
+ return 0;
+ };
+ pull2(1,pth,ps);
+ pull2(nph,pth,pe);
+ cflg=0;
+ if(dist(2,ps,pe)<Eps1){cflg=1;}
+ ncusp=0; cusp[0]=0;
+ cva=cos(10*M_PI/180);
+ for(i=1; i<=nph-1; i++){
+ if(nph==2){break;}
+ pull2(i,pth,tmp);
+ tmp[0]=pth[i][0]; tmp[1]=pth[i][1];
+ if(i==1){
+ if(cflg==0){continue;}
+ pull2(nph-1,pth,tmp1);
+ }
+ else{
+ pull2(i-1,pth,tmp1);
+ }
+ pull2(i+1,pth,tmp2);
+ v1[0]=tmp[0]-tmp1[0]; v1[1]=tmp[1]-tmp1[1];
+ v2[0]=tmp2[0]-tmp[0]; v2[1]=tmp2[1]-tmp[1];
+ vtmp=v1[0]*v2[0]+v1[1]*v2[1];
+ tmp[0]=0; tmp[1]=0;
+ vtmp=vtmp/(dist(2,v1,tmp)*dist(2,v2,tmp));
+ cuspflg=0;
+ if(vtmp<cva){
+ pt2d[0]=pth[i][0]; pt2d[1]=pth[i][1];
+ kaku=acos(vtmp)*180/M_PI;
+ if(v1[0]*v2[1]-v1[1]*v2[0]<0){
+ kaku=-kaku;
+ }
+ cuspflg=0;
+ for(j=i+1; j<=nph-1; j++){
+ if(fabs(kaku)>90){
+ cuspflg=1;
+ break;
+ }
+ pull2(j,pth,q2d);
+ if(dist(2,pt2d,q2d)>Eps1){
+ break;
+ }
+ v1[0]=q2d[0]-pth[j-1][0]; v1[1]=q2d[1]-pth[j-1][1];
+ v2[0]=pth[j+1][0]-q2d[0]; v2[1]=pth[j+1][1]-q2d[1];
+ vtmp=v1[0]*v2[0]+v1[1]*v2[1];
+ tmp[0]=0; tmp[1]=0;
+ vtmp=vtmp/(dist(2,v1,tmp)*dist(2,v2,tmp));
+ vtmp=acos(vtmp)*180/M_PI;
+ if(v1[0]*v2[1]-v1[1]*v2[0]<0){
+ vtmp=-vtmp;
+ }
+ kaku=kaku+vtmp;
+ }
+ if(cuspflg==1){
+ ntmp=trunc((i+j)*0.5);
+ i=j;
+ if(cusp[0]==0){
+ ncusp=appendi1(cusp,ntmp);
+ }
+ else{
+ ncusp=appendi1(cusp,ntmp);
+ }
+ }
+ }
+ }
+ if(cflg==0){
+ ncusp=prependi1(1,cusp);
+ ncusp=appendi1(cusp,nph);
+ }
+ else if(ncusp==0){
+ ncusp=prependi1(1,cusp);
+ ncusp=appendi1(cusp,nph);
+ }
+ else if(cusp[1]==1){
+ ncusp=appendi1(cusp,nph);
+ }
+ else{
+ ntmp=cusp[1];
+ ntmp1=nph;
+ tmp2d[0][0]=0;
+ n=appendd2(0,ntmp,ntmp1,pth,tmp2d);
+ n=appendd2(0,2,ntmp,pth,tmp2d);
+ pth[0][0]=0;
+ nph=appendd2(0,1,n,tmp2d,pth);
+ tmp3d[0][0]=0;
+ n=appendd3(0,ntmp,ntmp1,ptk,tmp3d);
+ n=appendd3(0,2,ntmp,ptk,tmp3d);
+ ptk[0][0]=0;
+ npk=appendd3(0,1,n,tmp3d,ptk);
+ for(i=1; i<=cusp[0]; i++){
+ cusp[i]=cusp[i]-ntmp+1;
+ }
+ ncusp=appendi1(cusp,nph);
+ }
+ if(ncusp==2){
+ pull2(nph,pth,tmp);
+ if(npk>=2){
+ ncusppt=addptd2(Cuspsplitpt,tmp);
+ noutkL=appendd3(2,1,npk,ptk,outkL);
+ }
+ continue;
+ }
+ outk[0][0]=0;
+ is=1;
+ for(i=1; i<=ncusp-1; i++){
+ ntmp1=cusp[is]; ntmp2=cusp[i+1];
+ pull2(ntmp1,pth,tmp1);
+ pull2(ntmp2,pth,tmp2);
+ if(dist(2,tmp1,tmp2)>Eps1){
+ tmp3d[0][0]=0;
+ n=appendd3(0,ntmp1,ntmp2,ptk,tmp3d);
+ noutk=appendd3(2,1,n,tmp3d,outk);
+ ncusppt=addptd2(Cuspsplitpt,tmp2);
+ is=i+1;
+ }
+ }
+ noutkL=appendd3(2,1,noutk,outk,outkL);
+ }
+ n=projpara(outkL,tmp2d);
+ ndrop=dropnumlistcrv(tmp2d,Eps1*0.5,drop);
+ nd=dataindexd3(2,outkL,din);
+ ndd=dataindexi1(drop,dind);
+ tmp3d2[0][0]=0; ntmp2=0;
+ for(i=1; i<=nd; i++){
+ tmp3d[0][0]=0; ntmp=0;
+ ntmp=appendd3(0,din[i][0],din[i][1],outkL,tmp3d);
+ tmpnum[0]=0; ntmpnum=0;
+ for(j=dind[i][0]; j<=dind[i][1]; j++){
+ ntmpnum=appendi1(tmpnum,drop[j]);
+ }
+ tmp3d1[0][0]=0; ntmp1=0;
+ for(j=1; j<=ntmpnum; j++){
+ pt3d[0]=tmp3d[tmpnum[j]][0];
+ pt3d[1]=tmp3d[tmpnum[j]][1];
+ pt3d[2]=tmp3d[tmpnum[j]][2];
+ ntmp1=addptd3(tmp3d1,pt3d);
+ }
+ if(ntmp1>0){
+ ntmp2=appendd3(2,1,ntmp1,tmp3d1,tmp3d2);
+ }
+ }
+ outkL[0][0]=0; noutkL=0;
+ noutkL=appendd3(0,1,ntmp2,tmp3d2,outkL);
+ return noutkL;
+}
+
+int makexybdy(double ehL[][2]){
+ int i, nehL, ntmpd2;
+ double ptd3[3],ptd2[2],tmpd2[DsizeM][2],du,dv;
+ ehL[0][0]=0; nehL=0;
+ du=(Urng[1]-Urng[0])/Mdv;
+ dv=(Vrng[1]-Vrng[0])/Ndv;
+ if(DrawE==1){
+ tmpd2[0][0]=0; ntmpd2=0;
+ for(i=0; i<=Ndv; i++){
+ surffun(Urng[1],Vrng[0]+i*dv,ptd3);
+ ntmpd2=push2(ptd3[0],ptd3[1],tmpd2);
+ }
+ nehL=appendd2(2,1,ntmpd2,tmpd2,ehL);
+ }
+ if(DrawN==1){
+ tmpd2[0][0]=0; ntmpd2=0;
+ for(i=0; i<=Mdv; i++){
+ surffun(Urng[0]+i*du,Vrng[1],ptd3);
+ ntmpd2=push2(ptd3[0],ptd3[1],tmpd2);
+ }
+ nehL=appendd2(2,1,ntmpd2,tmpd2,ehL);
+ }
+ if(DrawW==1){
+ tmpd2[0][0]=0; ntmpd2=0;
+ for(i=0; i<=Ndv; i++){
+ surffun(Urng[0],Vrng[0]+i*dv,ptd3);
+ ntmpd2=push2(ptd3[0],ptd3[1],tmpd2);
+ }
+ nehL=appendd2(2,1,ntmpd2,tmpd2,ehL);
+ }
+ if(DrawS==1){
+ tmpd2[0][0]=0; ntmpd2=0;
+ for(i=0; i<=Mdv; i++){
+ surffun(Urng[0]+i*du,Vrng[0],ptd3);
+ ntmpd2=push2(ptd3[0],ptd3[1],tmpd2);
+ }
+ nehL=appendd2(2,1,ntmpd2,tmpd2,ehL);
+ }
+ return nehL;
+}
+
+int partitionseg(double fig[][2],double gL[][2], int ns, double out[]){
+ int nother, ndin, din[DsizeM][2], ndin2, din2[DsizeM][2];
+ int npar,nkouL, nout, ng;
+ int npt=length2(fig), ngL=length2(gL), npp;
+ int i, j, jj, n, k, ntmp1, ntmp2, ntmp3,tmp2i1[DsizeM], flg;
+ double eps0=pow(10,-5.0),tmp1d2[2], tmp2d2[2],tmpd4[4], dtmp, s;
+ double p[2], q[2], pd3[3], ans[4], tmp1d1[DsizeM], tmp2d1[DsizeM], tmp3d1[DsizeM];
+ double other[DsizeM], parL[DsizeM], g[DsizeM][2], kouL[DsizeM][4];
+ if(ns>1){
+ ndin=dataindexd1(Otherpartition,din);
+ other[0]=0; nother=0;
+ for(i=din[ns][0]; i<=din[ns][1]; i++){
+ dtmp=Otherpartition[i];
+ nother++;
+ other[nother]=dtmp;
+ }
+ }
+ else{
+ other[0]=0; nother=0;
+ Otherpartition[0]=0;
+ ndin=dataindexd2(2,gL,din);
+ for(i=1; i<=ndin-1; i++){
+ Otherpartition[i]=Inf; Otherpartition[0]++;
+ }
+ }
+ parL[1]=1; parL[2]=npt;
+ parL[0]=2; npar=2;
+ if(nother>0){
+ for(i=1; i<=nother; i++){
+ npar=appendd1(parL,other[i]);
+ }
+ }
+ ndin=dataindexd2(2,gL,din);
+ for(n=ns; n<=ndin; n++){
+ g[0][0]=0;
+ ng=appendd2(0,din[n][0],din[n][1],gL,g);
+ flg=0;
+ for(i=1; i<=ng; i++){
+ pull2(i,fig,tmp1d2);
+ pull2(i,g,tmp2d2);
+ if(dist(2,tmp1d2,tmp2d2)>Eps){
+ flg=1;
+ break;
+ }
+ }
+ if(flg==0){
+ nkouL=intersectselfPp(fig,Eps1, Eps2,kouL);
+ }
+ else{
+ nkouL=intersectcrvsPp(fig, g, Eps1, Eps2, kouL);
+ pull2(1,fig,tmp1d2);
+ nearestptpt(tmp1d2,g,ans);
+ if((ans[3]>eps0)&&(ans[3]<Eps1)){
+ tmpd4[0]=ans[0]; tmpd4[1]=ans[1];
+ tmpd4[2]=1; tmpd4[3]=floor(ans[2]+Eps);
+ nkouL=addptd4(kouL, tmpd4);
+ }
+ pull2(npt,fig,tmp1d2);
+ nearestptpt(tmp1d2,g, ans);
+ tmpd4[0]=ans[0]; tmpd4[1]=ans[1];
+ tmpd4[2]=ans[2]; tmpd4[3]=ans[3];
+ if((tmpd4[3]>eps0)&&(tmpd4[3]<Eps1)){
+ tmpd4[2]=npt; tmpd4[3]=floor(ans[2]+Eps);
+ nkouL=addptd4(kouL, tmpd4);
+ }
+ }
+ for(i=1; i<=nkouL; i++){
+ p[0]=kouL[i][0]; p[1]=kouL[i][1]; //dim(kouL)=4
+ s=kouL[i][2];
+ npar=appendd1(parL,s);
+ k=floor(kouL[i][3]+Eps);
+ s=paramoncurve(p,k,g);
+ ndin2=dataindexd1(Otherpartition,din2);
+ ntmp1=din2[n][1]-din2[n][0]+1;
+ for(j=1; j<=ntmp1; j++){
+ tmp1d1[j]=Otherpartition[din2[n][0]+j-1];
+ }
+ tmp1d1[0]=ntmp1;
+ ntmp1=appendd1(tmp1d1,s);
+ simplesort(tmp1d1);
+ tmp2d1[0]=0; ntmp2=0;
+ for(j=1; j<=ndin2; j++){
+ tmp3d1[0]=0; ntmp3=0;
+ ndin2=dataindexd1(Otherpartition,din2);
+ for(jj=din2[j][0]; jj<=din2[j][1]; jj++){
+ ntmp3=appendd1(tmp3d1,Otherpartition[jj]);
+ }
+ if(j!=n){
+ for(jj=1; jj<=ntmp3; jj++){
+ ntmp2=appendd1(tmp2d1,tmp3d1[jj]);
+ }
+ }
+ else{
+ for(jj=1; jj<=ntmp1; jj++){
+ ntmp2=appendd1(tmp2d1,tmp1d1[jj]);
+ }
+ }
+ ntmp2=appendd1(tmp2d1,Inf);
+ }
+ ntmp2--;
+ for(j=1; j<=ntmp2; j++){
+ Otherpartition[j]=tmp2d1[j];
+ }
+ Otherpartition[0]=ntmp2;
+ }
+ }
+ simplesort(parL);
+ parL[1]=1;
+ out[1]=parL[1];
+ out[0]=1; nout=1;
+ pointoncurve(parL[1],fig, Eps, p);
+ Partitionpt[0][0]=0;
+ npp=addptd2(Partitionpt, p);
+ for(i=1; i<=npar; i++){
+ pointoncurve(parL[i],fig, Eps, p);
+ dtmp=out[nout];
+ pointoncurve(dtmp,fig, Eps, q);
+ if(dist(2,p,q)>Eps1){
+ nout=appendd1(out,parL[i]);
+ npp=addptd2(Partitionpt,p);
+ }
+ }
+ if(out[nout]!=npt){
+ out[nout]=npt;
+ }
+ if(nout==1){
+ out[1]=1; out[2]=npt;
+ out[0]=2; nout=2;
+ }
+ return nout;
+}
+
+double funpthiddenQ(double u, double v, double pa[3]){
+ double Vec[3]={sin(THETA)*cos(PHI),sin(THETA)*sin(PHI),cos(THETA)};
+ double eps0=pow(10,-4.0)*(XMAX-XMIN)/10, pt[3], out;
+ surffun(u, v, pt);
+ if((fabs(Vec[1])>eps0)||(fabs(Vec[0])>eps0)){
+ out=(Vec[1]*(pt[0]-pa[0])-Vec[0]*(pt[1]-pa[1]));
+ }
+ else{
+ out=pt[0]-pa[0];
+ }
+ return out;
+}
+
+void makevaltable(double pta[3]){
+ double eps0=pow(10,-6.0), u, v, du, dv, p[3];
+ int i, j, nx=0, ny=0; ;
+ du=(Urng[1]-Urng[0])/Mdv;
+ dv=(Vrng[1]-Vrng[0])/Ndv;
+ for(j=0; j<=Ndv; j++){
+ v=Vrng[0]+j*dv;
+ for(i=0; i<=Mdv; i++){
+ u=Urng[0]+i*du;
+ Zval[j][i]=funpthiddenQ(u, v, pta);
+ }
+ }
+ for(i=0; i<=Mdv; i++){
+ Xval[i]=Urng[0]+i*du;
+ }
+ for(j=0; j<=Ndv; j++){
+ Yval[j]=Vrng[0]+j*dv;
+ }
+}
+
+int pthiddenQ(double pta[3], int uveq, double eps[2]){
+ int i, j, k, out, nqL, nsL, nptL, flg, nxt;
+ double Vec[3]={sin(THETA)*cos(PHI),sin(THETA)*sin(PHI),cos(THETA)};
+ double eps0, epspt, vec1[3], po[3]={0,0,0}, tmpd1, tmp1d1, tmp2d1, m1, m2;
+ double tmp3d1, tmp4d1, tmp5d1, tmp6d1, tmpd3[3], v1, v2, v3;
+ double tmpd2[2], p1[2], p2[2], ptuv[2], puv1[2], puv2[2];
+ double p1d3[3], p2d3[3], ptd3[3];
+ double ptL[DsizeM][6], sL[DsizeM][7], qL[DsizeM][2], pL[5][2], vL[5];
+// Out=1 : hidden
+// SL : List of segments near PtA+Vec
+ eps0=pow(10,-4.0)*(XMAX-XMIN)/10.0;
+ epspt=eps[0]*(XMAX-XMIN)/10.0;
+ out=0;
+ po[0]=0; po[1]=0; po[2]=0;
+ tmpd1=1/dist(3,Vec,po);
+ vec1[0]=tmpd1*Vec[0];
+ vec1[1]=tmpd1*Vec[1];
+ vec1[2]=tmpd1*Vec[2];
+ nptL=0;
+ makevaltable(pta);
+ nsL=0;
+ for(j=0; j<=Ndv-1; j++){
+ for(i=0; i<=Mdv-1; i++){
+ pL[0][0]=Xval[i]; pL[0][1]=Yval[j]; vL[0]=Zval[j][i];
+ pL[1][0]=Xval[i+1]; pL[1][1]=Yval[j]; vL[1]=Zval[j][i+1];
+ pL[2][0]=Xval[i+1]; pL[2][1]=Yval[j+1]; vL[2]=Zval[j+1][i+1];
+ pL[3][0]=Xval[i]; pL[3][1]=Yval[j+1]; vL[3]=Zval[j+1][i];
+ pL[4][0]=Xval[i]; pL[4][1]=Yval[j]; vL[4]=Zval[j][i];
+ qL[0][0]=0; nqL=0;
+ for(k=0; k<=3; k++){
+ p1[0]=pL[k][0]; p1[1]=pL[k][1];
+ p2[0]=pL[k+1][0]; p2[1]=pL[k+1][1];
+ m1=vL[k]; m2=vL[k+1];
+ if((m1>=eps0)&&(m2>=eps0)){
+ continue;
+ }
+ if((m1<=-eps0)&&(m2<=-eps0)){
+ continue;
+ }
+ if(fabs(m1)<eps0){
+ tmpd2[0]=p1[0]; tmpd2[1]=p1[1];
+ }
+ else if(fabs(m2)<eps0){
+ continue;
+ }
+ else{
+ tmpd2[0]=1/(m1-m2)*(-m2*p1[0]+m1*p2[0]);
+ tmpd2[1]=1/(m1-m2)*(-m2*p1[1]+m1*p2[1]);
+ }
+ nqL++;
+ qL[nqL][0]=tmpd2[0]; qL[nqL][1]=tmpd2[1];
+ }
+ if(nqL==2){
+ puv1[0]=qL[1][0]; puv1[1]=qL[1][1];
+ puv2[0]=qL[2][0]; puv2[1]=qL[2][1];
+ surffun(puv1[0],puv1[1],p1d3);
+ surffun(puv2[0],puv2[1],p2d3);
+ if(dist(2,p1d3,p2d3)<eps0){
+ continue;
+ }
+ tmp1d1=dist(3,p1d3,pta);
+ tmpd3[0]=p1d3[0]-pta[0];
+ tmpd3[1]=p1d3[1]-pta[1];
+ tmpd3[2]=p1d3[2]-pta[2];
+ tmp2d1=dotprod(3,tmpd3,vec1);
+ tmp3d1=sqrt(fabs(pow(tmp1d1,2.0)-pow(tmp2d1,2.0)));
+ tmp4d1=dist(3,p2d3, pta);
+ tmpd3[0]=p2d3[0]-pta[0];
+ tmpd3[1]=p2d3[1]-pta[1];
+ tmpd3[2]=p2d3[2]-pta[2];
+ tmp5d1=dotprod(3,tmpd3,vec1);
+ tmp6d1=sqrt(fabs(pow(tmp4d1,2.0)-pow(tmp5d1,2.0)));
+ if(tmp2d1<tmp5d1){
+ tmpd3[0]=p1d3[0]; tmpd3[1]=p1d3[1]; tmpd3[2]=p1d3[2];
+ p1d3[0]=p2d3[0]; p1d3[1]=p2d3[1]; p1d3[2]=p2d3[2];
+ p2d3[0]=tmpd3[0]; p2d3[1]=tmpd3[1]; p2d3[2]=tmpd3[2];
+ tmpd1=tmp2d1; tmp2d1=tmp5d1; tmp5d1=tmpd1;
+ tmpd1=tmp3d1; tmp3d1=tmp6d1; tmp6d1=tmpd1;
+ }
+ if((tmp3d1<eps[1]*epspt)&&(tmp6d1<eps[1]*epspt)){
+ if(tmp2d1>-eps0){
+ if(tmp5d1<-eps0){
+ nsL++;
+ sL[nsL][0]=p1d3[0]; sL[nsL][1]=p1d3[1]; sL[nsL][2]=p1d3[2];
+ sL[nsL][3]=p2d3[0]; sL[nsL][4]=p2d3[1]; sL[nsL][5]=p2d3[2];
+ sL[nsL][6]=-1;
+ }
+ else{
+ nsL++;
+ sL[nsL][0]=p1d3[0]; sL[nsL][1]=p1d3[1]; sL[nsL][2]=p1d3[2];
+ sL[nsL][3]=p2d3[0]; sL[nsL][4]=p2d3[1]; sL[nsL][5]=p2d3[2];
+ sL[nsL][6]=1;
+ }
+ }
+ }
+ v1=vec1[0]; v2=vec1[1]; v3=vec1[2];
+ if(fabs(v1)>eps0){
+ m1=pta[2]+v3/v1*(p1d3[0]-pta[0])-p1d3[2];
+ m2=pta[2]+v3/v1*(p2d3[0]-pta[0])-p2d3[2];
+ }
+ else if(fabs(v2)>eps0){
+ m1=pta[2]+v3/v2*(p1d3[1]-pta[1])-p1d3[2];
+ m2=pta[2]+v3/v2*(p2d3[1]-pta[1])-p2d3[2];
+ }
+ else{
+ m1=pta[1]-p1d3[1];
+ m2=pta[1]-p2d3[1];
+ }
+ if(m1*m2>=0){
+ if(((m1>eps0)&&(m2>eps0))||((m1<-eps0)&&(m2<-eps0))){
+ continue;
+ }
+ if(fabs(m1)<=eps0){
+ ptd3[0]=p1d3[0]; ptd3[1]=p1d3[1]; ptd3[2]=p1d3[2];
+ ptuv[0]=puv1[0]; ptuv[1]=puv1[1];
+ }
+ else{
+ ptd3[0]=p2d3[0]; ptd3[1]=p2d3[1]; ptd3[2]=p2d3[2];
+ ptuv[0]=puv2[0]; ptuv[1]=puv2[1];
+ }
+ }
+ else{
+ ptd3[0]=1/(m1-m2)*(-m2*p1d3[0]+m1*p2d3[0]);
+ ptd3[1]=1/(m1-m2)*(-m2*p1d3[1]+m1*p2d3[1]);
+ ptd3[2]=1/(m1-m2)*(-m2*p1d3[2]+m1*p2d3[2]);
+ ptuv[0]=1/(m1-m2)*(-m2*puv1[0]+m1*puv2[1]);
+ }
+ tmpd3[0]=ptd3[0]-pta[0];
+ tmpd3[1]=ptd3[1]-pta[1];
+ tmpd3[2]=ptd3[2]-pta[2];
+ tmp1d1=dotprod(3,tmpd3,vec1);
+ tmp2d1=fabs(tmp1d1);
+ tmpd3[0]=p1d3[0]-p2d3[0];
+ tmpd3[1]=p1d3[1]-p2d3[1];
+ tmpd3[2]=p1d3[2]-p2d3[2];
+ tmp3d1=dotprod(3,tmpd3,vec1);
+ tmp4d1=dist(3,p1d3,p2d3);
+ tmp6d1=tmp3d1/tmp4d1;
+ if(tmp1d1>eps0){
+ if(fabs(tmp6d1)>0.75){
+ nptL++;
+ ptL[nptL][0]=ptd3[0]; ptL[nptL][1]=ptd3[1]; ptL[nptL][2]=ptd3[2];
+ ptL[nptL][3]=p2d3[0]; ptL[nptL][4]=p2d3[1]; ptL[nptL][5]=p2d3[2];
+ continue;
+ }
+ if(tmp2d1>epspt){
+ return 1;
+ }
+ if(tmp2d1<2*epspt){
+ continue;
+ }
+ }
+ }
+ }
+ }
+ if(nptL==0){
+ return 0;
+ }
+ for(i=1; i<=nsL; i++){
+ p2d3[0]=sL[i][3]; p2d3[1]=sL[i][4]; p2d3[2]=sL[i][5];
+ flg=0;
+ for(j=1; j<=nsL; j++){
+ p1d3[0]=sL[j][0]; p1d3[1]=sL[j][1]; p1d3[2]=sL[j][2];
+ if(dist(3,p1d3,p2d3)<eps0){
+ sL[i][6]=j;
+ flg=1;
+ break;
+ }
+ }
+ if((flg==0)&&(sL[i][6]>0)){
+ sL[i][6]=-2;
+ }
+ }
+ for(i=1; i<=nptL; i++){
+ p2d3[0]=ptL[i][3]; p2d3[1]=ptL[i][4]; p2d3[2]=ptL[i][5];
+ flg=0;
+ for(j=1; j<=nsL; j++){
+ p1d3[0]=sL[j][0]; p1d3[1]=sL[j][1]; p1d3[2]=sL[j][2];
+ if(dist(3,p1d3,p2d3)<eps0){
+ flg=1;
+ break;
+ }
+ }
+ if(flg==0){
+ ptd3[0]=ptL[i][0]; ptd3[1]=ptL[i][1]; ptd3[2]=ptL[i][2];
+ tmpd1=dist(3,p2d3,ptd3);
+ tmpd3[0]=p2d3[0]-ptd3[0];
+ tmpd3[1]=p2d3[1]-ptd3[1];
+ tmpd3[2]=p2d3[2]-ptd3[2];
+ tmp1d1=fabs(dotprod(3,tmpd3,vec1));
+ tmp2d1=sqrt(fabs(pow(tmpd1,2.0)-pow(tmp1d1,2.0)));
+ tmp3d1=tmp2d1*dist(3,ptd3,pta)/tmpd1;
+ if(tmp3d1>epspt/5){
+ return 1;
+ }
+ else{
+ continue;
+ }
+ }
+ nxt=sL[j][6];
+ while(nxt>0){
+ ptd3[0]=sL[nxt][3]; ptd3[1]=sL[nxt][4]; ptd3[2]=sL[nxt][5];
+ nxt=sL[nxt][6];
+ }
+ if(nxt==-2){
+ return 1;
+ }
+ else{
+ out=0;
+ }
+ }
+ return out;
+}
+
+int nohiddenpara2(double paL[], double fk[][3], int uveq, double figkL[][3]){
+ double eps0=pow(10,-5.0), s, p1[2], p2[2], q[2],tmpd1, tmpd2[2], epstmp[2];
+ double fh[DsizeM][2], pta[3], ptap[2], vec[3];
+ double figL[DsizeM][2], tmpmd2[DsizeM][2], tmpmd3[DsizeM][3];
+ double tmp1d2[2], tmp2d2[2], tmp3d2[2], tmpd3[3],tmpd4[4];
+ double pd2[2], qd2[2], pd3[3], qd3[3], sp, sq, tp, tq, dtmp, dtmp1, dtmp2;
+ int ncusp=floor(Cusppt[0][0]+0.5), seL[DsizeM], npaL=floor(paL[0]+0.5);
+ int i, n, nfh, nfk, nfigL, nfigkL, nhidden, cspflg, nseL=0, ntmp, flg, tmpi1[DsizeM];
+ nfk=length3(fk);
+ nfh=projpara(fk, fh);
+ pull2(1,fh,p1);
+ pull2(nfh,fh,p2);
+ cspflg=1;
+ for(i=1; i<=ncusp; i++){
+ pull2(i, Cusppt, tmpd2);
+ if(dist(2,tmpd2,p1)<eps0){
+ if(cspflg==1){
+ cspflg=2;
+ }
+ else if(cspflg==3){
+ cspflg=6;
+ }
+ continue;
+ }
+ if(dist(2,tmpd2,p2)<eps0){
+ if(cspflg==1){
+ cspflg=3;
+ }
+ else if(cspflg==2){
+ cspflg=6;
+ }
+ continue;
+ }
+ }
+ seL[0]=0; nseL=0;
+ for(n=1; n<=npaL-1; n++){
+ s=(paL[n]+paL[n+1])/2.0;
+ ntmp=invparapt(s,fh,fk, pta);
+ parapt(pta,ptap);
+ epstmp[0]=Eps1; epstmp[1]=Eps3;
+ if((n==1)&&(cspflg % 2==0)){
+ pull2(1,fh,p1);
+ dtmp=fmin(Eps1*dist(2,ptap, p1),Eps1);
+ epstmp[0]=dtmp; epstmp[1]=Eps3;
+ }
+ if((n==npaL-1)&&(cspflg % 3==0)){
+ pull2(nfh,fh,p1);
+ dtmp=fmin(Eps1*dist(2, ptap, p1), Eps1);
+ epstmp[0]=dtmp; epstmp[1]=Eps3;
+ }
+ flg=pthiddenQ(pta, uveq, epstmp);
+ if(flg==0){
+ nseL=appendi1(seL,n);
+ }
+ }
+ figL[0][0]=0; nfigL=0;
+ figkL[0][0]=0; nfigkL=0;
+ for(i=1; i<=nseL; i++){
+ pointoncurve(paL[seL[i]], fh, Eps, tmp1d2);
+ pointoncurve(paL[seL[i]+1], fh, Eps, tmp2d2);
+ if(i==1){
+ copyd(0,1,tmp1d2,pd2);
+ sp=paL[seL[i]];
+ copyd(0,1,tmp2d2,qd2);
+ sq=paL[seL[i]+1];
+ }
+ else{
+ if(memberi(seL[i]-1,seL)==1){
+ copyd(0,1,tmp2d2,qd2);
+ sq=paL[seL[i]+1];
+ }
+ else{
+ ntmp=partcrv(sp,sq,fh,tmpmd2);
+ nfigL=appendd2(2,1,ntmp,tmpmd2,figL);
+ tp=invparapt(sp,fh,fk, tmpd3);
+ tq=invparapt(sq,fh,fk,tmpd3);
+ ntmp=partcrv3(tp,tq,fk,tmpmd3);
+ nfigkL=appendd3(2,1,ntmp,tmpmd3,figkL);
+ copyd(0,1,tmp1d2,pd2);
+ sp=paL[seL[i]];
+ copyd(0,1,tmp2d2,qd2);
+ sq=paL[seL[i]+1];
+ }
+ }
+ }
+ if(nseL>0){
+ if(dist(2,pd2,qd2)>Eps1){
+ nearestptpt(pd2,fh,tmpd4);
+ dtmp1=tmpd4[2];
+ nearestptpt(qd2,fh,tmpd4);
+ dtmp2=tmpd4[2];
+ ntmp=partcrv(dtmp1,dtmp2,fh,tmpmd2);
+ nfigL=appendd2(2,1,ntmp,tmpmd2,figL);
+ tp=invparapt(sp,fh,fk,tmpd3);
+ tq=invparapt(sq,fh,fk,tmpd3);
+ ntmp=partcrv3(tp,tq,fk,tmpmd3);
+ nfigkL=appendd3(2,1,ntmp, tmpmd3, figkL);
+ }
+ else{
+ nfigL=appendd2(2,1,nfh, fh, figL);
+ nfigkL=appendd3(2,1,nfk,fk,figkL);
+ }
+ }
+ tmpi1[0]=0; ntmp=0;
+ for(i=1; i<=npaL-1; i++){
+ if(memberi(i,seL)==0){
+ ntmp=appendi1(tmpi1,i);
+ }
+ }
+ copyi(0,ntmp,tmpi1,seL);
+ seL[0]=ntmp; nseL=ntmp;
+ Hiddendata[0][0]=0; nhidden=0;
+ for(i=1; i<=nseL; i++){
+ dtmp=paL[seL[i]];
+ pointoncurve(dtmp,fh,Eps,tmp1d2);
+ dtmp=paL[seL[i]+1];
+ pointoncurve(dtmp,fh,Eps, tmp2d2);
+ if(i==1){
+ copyd(0,1,tmp1d2,pd2);
+ sp=paL[seL[i]];
+ copyd(0,1,tmp2d2,qd2);
+ sq=paL[seL[i]+1];
+ }
+ else{
+ if(memberi(seL[i]-1,seL)==1){
+ copyd(0,1,tmp2d2,qd2);
+ sq=paL[seL[i]+1];
+ }
+ else{
+ tp=invparapt(sp,fh,fk,tmpd3);
+ tq=invparapt(sq,fh,fk,tmpd3);
+ ntmp=partcrv3(tp,tq,fk,tmpmd3);
+ nhidden=appendd3(2,1,ntmp,tmpmd3,Hiddendata);
+ copyd(0,1,tmp1d2,pd2);
+ sp=paL[seL[i]];
+ copyd(0,1,tmp2d2,qd2);
+ sq=paL[seL[i]+1];
+ }
+ }
+ }
+ if(nseL>0){
+ if(dist(2,pd2,qd2)>Eps1){
+ tp=invparapt(sp,fh,fk,tmpd3);
+ tq=invparapt(sq,fh,fk,tmpd3);
+ ntmp=partcrv3(tp,tq,fk,tmpmd3);
+ nhidden=appendd3(2,1,ntmp,tmpmd3,Hiddendata);
+ }
+ else{
+ nhidden=appendd3(2,1,nfk,fk,Hiddendata);
+ }
+ }
+ return nfigkL;
+}
+
+int borderparadata(double fkL[][3], double fsL[][3]){
+ double ekL[DsizeL][3], fall[DsizeL][2], fbdxy[DsizeL][2];
+ double tmpd3[DsizeM][3], tmpd2[DsizeM][2], p[2], p3[3];
+ double figkL[DsizeM][3], du, dv;
+ int i, j, nall, nekL, nfsL, nfkL=length3(fkL), nfall, nfbdxy;
+ int ndin, din[DsizeS][2], ndin2,din2[DsizeM][2];
+ int ntmp, ntmpd3,ntmpd2, npar=0, nfigkL;
+ double par[DsizeM];
+ du=(Urng[1]-Urng[0])/Mdv;
+ dv=(Vrng[1]-Vrng[0])/Ndv;
+ fsL[0][0]=0;
+ ekL[0][0]=0; nekL=0;
+ if(DrawE==1){
+ tmpd2[0][0]=0; nall=0;
+ for(j=0; j<=Ndv; j++){
+ nall=add2(tmpd2, Urng[1], Vrng[0]+j*dv);
+ }
+ nall=surfcurve(2, tmpd2,tmpd3);
+ nekL=appendd3(2,1,nall,tmpd3,ekL);
+ }
+ if(DrawN==1){
+ tmpd2[0][0]=0; nall=0;
+ for(j=0; j<=Mdv; j++){
+ nall=add2(tmpd2, Urng[0]+j*du, Vrng[1]);
+ }
+ nall=surfcurve(2, tmpd2,tmpd3);
+ nekL=appendd3(2,1,nall,tmpd3,ekL);
+ }
+ if(DrawW==1){
+ tmpd2[0][0]=0; nall=0;
+ for(j=0; j<=Ndv; j++){
+ nall=add2(tmpd2, Urng[0], Vrng[0]+j*dv);
+ }
+ nall=surfcurve(2, tmpd2,tmpd3);
+ nekL=appendd3(2,1,nall,tmpd3,ekL);
+ }
+ if(DrawS==1){
+ tmpd2[0][0]=0; nall=0;
+ for(j=0; j<=Mdv; j++){
+ nall=add2(tmpd2, Urng[0]+j*du, Vrng[0]);
+ }
+ nall=surfcurve(2, tmpd2,tmpd3);
+ nekL=appendd3(2,1,nall,tmpd3,ekL);
+ }
+ if(nekL>0){
+ nfkL=appendd3(2,1,nekL,ekL,fkL);
+ }
+ nfall=projpara(fkL,fall);
+ nfbdxy=makexybdy(fbdxy);
+ Otherpartition[0]=0;
+ ndin=dataindexd2(2,fall,din);
+ Borderpt[0][0]=0;
+ for(i=1; i<=ndin-1; i++){
+ Otherpartition[i]=Inf; Otherpartition[0]++;
+ }
+ Borderhiddendata[0][0]=0;
+ ndin=dataindexd2(2,fall,din);
+ ndin2=dataindexd3(2,fkL,din2);
+ for(i=1; i<= ndin2; i++){
+ tmpd3[0][0]=0;
+ ntmpd3=appendd3(0,din2[i][0],din2[i][1],fkL,tmpd3);
+ ntmpd2=projpara(tmpd3,tmpd2);
+ npar=partitionseg(tmpd2,fall, 1,par);
+ if(npar>2){
+ ntmp=npar-1;
+ tmpd2[0][0]=0; ntmpd2=0;
+ for(j=2; j<=ntmp; j++){
+ pull2(j,Partitionpt,p);
+ ntmpd2=addptd2(tmpd2, p);
+ }
+ ntmp=appendd2(0, 1,ntmpd2,tmpd2,Borderpt);
+ }
+ tmpd3[0][0]=0;
+ for(j=din2[i][0]; j<=din2[i][1]; j++){
+ pull3(j,fkL,p3);
+ ntmpd3=addptd3(tmpd3,p3);
+ }
+ nfigkL=nohiddenpara2(par,tmpd3,1, figkL);
+ if(nfigkL>0){
+ nfsL=appendd3(2,1,nfigkL,figkL, fsL);
+ }
+ ntmp=length3(Hiddendata);
+ if(ntmp>0){
+ appendd3(2,1,ntmp,Hiddendata,Borderhiddendata);
+ }
+ }
+ return nfsL;
+}
+
+int sfbdparadata(double outd3[][3]){
+ double pdata[DsizeL][2], pdatad3[DsizeL][3];
+ int nall, n;
+ int cusp[DsizeM]; // remove?
+ evlptablepara();
+ nall=implicitplot(pdata);
+ nall=cuspsplitpara(pdata, pdatad3);
+ n=length2(Cuspsplitpt);
+ Cusppt[0][0]=0;
+ nall=appendd2(0, 1,n,Cuspsplitpt,Cusppt);
+ nall= borderparadata(pdatad3, outd3);
+ push3(Inf,3,0,outd3);
+ nall=appendd3(0,1,length3(Borderhiddendata),Borderhiddendata,outd3);
+ push3(Inf,3,0,outd3);
+ return nall;
+}
+
+void makevaltablemeet(double pa[3], double vec[3], double eps0){
+ double u, v, du, dv, pt[3];
+ int i, j;
+ du=(Urng[1]-Urng[0])/Mdv;
+ dv=(Vrng[1]-Vrng[0])/Ndv;
+ for(j=0; j<=Ndv; j++){
+ v=Vrng[0]+j*dv;
+ for(i=0; i<=Mdv; i++){
+ u=Urng[0]+i*du;
+ surffun(u, v, pt);
+ if((fabs(vec[1])>eps0)||(fabs(vec[0])>eps0)){
+ Zval[j][i]=(vec[1]*(pt[0]-pa[0])-vec[0]*(pt[1]-pa[1]));
+ }
+ else{
+ Zval[j][i]=pt[0]-pa[0];
+ }
+ }
+ }
+ for(i=0; i<=Mdv; i++){
+ Xval[i]=Urng[0]+i*du;
+ }
+ for(j=0; j<=Ndv; j++){
+ Yval[j]=Vrng[0]+j*dv;
+ }
+}
+
+int meetpoints(double pta[3], double ptb[3], double eps, double ptL[][3]){
+ double eps0=pow(10,-4.0), vec[3], out[DsizeM], pL[5][2], vL[5];
+ double qL[DsizeM][2], p1d2[2], p2d2[2], tmpd2[2], puv1d2[2], puv2d2[2];
+ double m1,m2, p1d3[3], p2d3[3], v1, v2, v3, ptd3[3], ptuvd2[2], tmp1d1;
+ double po[3]={0,0,0}, tmpmd1[DsizeM], tmp1d3[3];
+ int nout, nptL, ntmp, nqL, i, j, k;
+ vec[0]=ptb[0]-pta[0]; vec[1]=ptb[1]-pta[1]; vec[2]=ptb[2]-pta[2];
+ out[0]=0; nout=0;
+ ptL[0][0]=0; nptL=0;
+ makevaltablemeet(pta,vec,eps0);
+ for(j=0; j<=Ndv-2; j++){
+ for(i=0; i<=Mdv-2; i++){
+ pL[0][0]=Xval[i]; pL[0][1]=Yval[j]; vL[0]=Zval[j][i];
+ pL[1][0]=Xval[i+1]; pL[1][1]=Yval[j]; vL[1]=Zval[j][i+1];
+ pL[2][0]=Xval[i+1]; pL[2][1]=Yval[j+1]; vL[2]=Zval[j+1][i+1];
+ pL[3][0]=Xval[i]; pL[3][1]=Yval[j+1]; vL[3]=Zval[j+1][i];
+ pL[4][0]=Xval[i]; pL[4][1]=Yval[j]; vL[4]=Zval[j][i];
+ qL[0][0]=0; nqL=0;
+ for(k=0; k<=3; k++){
+ pull2(k,pL,p1d2);
+ pull2(k+1,pL,p2d2);
+ m1=vL[k]; m2=vL[k+1];
+ if((m1>=eps0)&&(m2>=eps0)){
+ continue;
+ }
+ if((m1<=-eps0)&&(m2<=-eps0)){
+ continue;
+ }
+ if(fabs(m1)<eps0){
+ copyd(0,1,p1d2,tmpd2);
+ }
+ else if(fabs(m2)<eps0){
+ continue;
+ }
+ else{
+ tmpd2[0]=1/(m1-m2)*(-m2*p1d2[0]+m1*p2d2[0]);
+ tmpd2[1]=1/(m1-m2)*(-m2*p1d2[1]+m1*p2d2[1]);
+ }
+ nqL=addptd2(qL,tmpd2);
+ }
+ if(nqL==2){
+ pull2(1, qL, puv1d2);
+ pull2(2, qL, puv2d2);
+ surffun(puv1d2[0], puv1d2[1], p1d3);
+ surffun(puv2d2[0], puv2d2[1], p2d3);
+ v1=vec[0]; v2=vec[1]; v3=vec[2];
+ if(fabs(v1)>eps0){
+ m1=pta[2]+v3/v1*(p1d3[0]-pta[0])-p1d3[2];
+ m2=pta[2]+v3/v1*(p2d3[0]-pta[0])-p2d3[2];
+ }
+ else if(fabs(v2)>eps0){
+ m1=pta[2]+v3/v2*(p1d3[1]-pta[1])-p1d3[2];
+ m2=pta[2]+v3/v2*(p2d3[1]-pta[1])-p2d3[2];
+ }
+ else{
+ m1=pta[1]-p1d3[1];
+ m2=pta[1]-p2d3[1];
+ }
+ if(m1*m2>=-eps0){
+ if(((m1>eps0)&&(m2>eps0)) || ((m1<-eps0)&&(m2<-eps0))){
+ continue;
+ }
+ if(fabs(m1)<=eps0){
+ copyd(0,2,p1d3,ptd3);
+ copyd(0,1,puv1d2,ptuvd2);
+ }
+ else{
+ copyd(0,2,p2d3,ptd3);
+ copyd(0,1,puv2d2,ptuvd2);
+ }
+ }
+ else{
+ ptd3[0]=1/(m1-m2)*(-m2*p1d3[0]+m1*p2d3[0]);
+ ptd3[1]=1/(m1-m2)*(-m2*p1d3[1]+m1*p2d3[1]);
+ ptd3[2]=1/(m1-m2)*(-m2*p1d3[2]+m1*p2d3[2]);
+ }
+ tmp1d3[0]=ptd3[0]-pta[0]; tmp1d3[1]=ptd3[1]-pta[1];
+ tmp1d3[2]=ptd3[2]-pta[2];
+ tmp1d1=dotprod(3,tmp1d3,vec);
+ tmp1d1=tmp1d1/pow(dist(3,vec,po),2.0);
+ if((tmp1d1>-eps0)&&(tmp1d1<1+eps0)){
+ nout=appendd1(out,tmp1d1);
+ }
+ }
+ }
+ }
+ if(nout>>0){
+ simplesort(out);
+ tmpmd1[1]=out[1]; ntmp=1;
+ for(i=2; i<=nout; i++){
+ tmp1d3[0]=(out[i]-tmpmd1[ntmp])*vec[0];
+ tmp1d3[1]=(out[i]-tmpmd1[ntmp])*vec[1];
+ tmp1d3[2]=(out[i]-tmpmd1[ntmp])*vec[2];
+ tmp1d1=dist(3,tmp1d3,po);
+ if(tmp1d1>eps){
+ ntmp=appendd1(tmpmd1,out[i]);
+ }
+ }
+ nout=ntmp;
+ copyd(0,ntmp,tmpmd1,out);
+ for(i=1; i<=nout; i++){
+ tmp1d3[0]=pta[0]+out[i]*vec[0];
+ tmp1d3[1]=pta[1]+out[i]*vec[1];
+ tmp1d3[2]=pta[2]+out[i]*vec[2];
+ nptL=addptd3(ptL,tmp1d3);
+ }
+ }
+ return nptL;
+}
+
+int crvsfparadata(double fkL[][3], double fbdkL[][3], int sepflg, double out[][3]){
+ double fbdy[DsizeL][2], fk[DsizeM][3],fkp[DsizeM][3], outh[DsizeL][3];
+ double fh[DsizeM][2], parL[DsizeM], tmpmd3[DsizeM][3];
+ double ptL[DsizeM][3], tmpd2[2], tmpd3[3], tmp1d1, tmp2d1, dt;
+ double po[2]={0,0}, epsd2[2]={Eps1,Eps3}, pa[3], pb[3];
+ int nbor=length3(Borderhiddendata), nfkL,nfbdkL, nfbdy, nfk, nall;
+ int ncshidden, npar, ndin, din[DsizeM][2], ndin2,din2[DsizeS][2];
+ int nn, i, j, k, n, nptL, nout;
+ nfkL=length3(fkL);
+ nfbdy=projpara(fbdkL,fbdy);
+ out[0][0]=0;
+ outh[0][0]=0;
+ ndin=dataindexd3(2,fkL,din);
+ for(nn=1; nn<=ndin; nn++){
+ fkp[0][0]=0;
+ nfk=appendd3(0,din[nn][0],din[nn][1],fkL,fkp);
+ n=fmax(1,floor((fmax(Mdv,Ndv)+1)/(nfk-1)+0.5)); //17.06.16
+ dt=1.0/n;
+ fk[0][0]=0;
+ for(i=1; i<nfk; i++){
+ for(j=0; j<n; j++){
+ tmpd3[0]=fkp[i][0]+(fkp[i+1][0]-fkp[i][0])*j*dt;
+ tmpd3[1]=fkp[i][1]+(fkp[i+1][1]-fkp[i][1])*j*dt;
+ tmpd3[2]=fkp[i][2]+(fkp[i+1][2]-fkp[i][2])*j*dt;
+ addptd3(fk,tmpd3);
+ }
+ }
+ nfk=appendd3(0,nfk,nfk,fkp,fk);
+ nall=projpara(fk,fh);
+ npar=partitionseg(fh, fbdy,1, parL);
+ if(sepflg>=0){
+ for(i=1; i<=nfk-1; i++){
+ pull3(i,fk,pa);
+ pull3(i+1,fk,pb);
+ nptL=meetpoints(pa,pb, Eps2,ptL);
+ for(j=1; j<=nptL; j++){
+ pull3(j,ptL,tmpd3);
+ parapt(tmpd3,tmpd2);
+ tmp1d1=paramoncurve(tmpd2,i,fh);
+ tmp2d1=Inf;
+ for(k=1; k<=npar; k++){
+ tmp2d1=fmin(tmp2d1,fabs(parL[k]-tmp1d1));
+ }
+ tmpd3[0]=pb[0]-pa[0]; tmpd3[1]=pb[1]-pa[1];
+ tmpd3[2]=pb[2]-pa[2];
+ if(tmp2d1*dist(3,tmpd3,po)>Eps1){
+ npar=appendd1(parL,tmp1d1);
+ }
+ }
+ simplesort(parL);
+ }
+ }
+ nohiddenpara2(parL,fk,1, tmpmd3);
+ appendd3(2,1,length3(tmpmd3),tmpmd3,out);
+ appendd3(2,1, length3(Hiddendata),Hiddendata,outh);
+ }
+ push3(Inf,3,0,out); //17.06.17
+ nout=appendd3(0,1,length3(outh),outh,out);
+ push3(Inf,3,0,out); //17.06.17
+ return nout;
+}
+
+int wireparadata(double bdyk[][3], double udv[], double vdv[], int num,
+ double fsL[][3]){
+ double fbdy[DsizeL][2], udiv[DsizeM], vdiv[DsizeM], fbdxy[DsizeM][2];
+ double fs[DsizeL][3], u, v, d, pdata[DsizeM][3], fkL[DsizeM][3];
+ double fsLh[DsizeLL][3];
+ double tmpmd2[DsizeM][2], fk[DsizeM][3], par[DsizeM], p[2];
+ int nfbdy, nd, i, j, k, n, nu, nv, nfbdxy, nfsL, npdata, nfkL, nfk, npar,ntmp;
+ int nwire, ndin, din[DsizeM][2], nfs, ndin2, din2[DsizeM][2];
+ nfbdy=projpara(bdyk, fbdy);
+ Wirept[0][0]=0;
+ udiv[0]=0; nu=0;
+ vdiv[0]=0; nv=0;
+ n=floor(udv[0]+0.5);
+ if(n==-1){
+ nd=floor(udv[1]+0.5);
+ d=(Urng[1]-Urng[0])/(nd+1);
+ for(i=1; i<=nd; i++){
+ u=Urng[0]+i*d;
+ nu=appendd1(udiv,u);
+ }
+ }
+ else{
+ for(i=1; i<=n; i++){
+ nu=appendd1(udiv,udv[i]);
+ }
+ }
+ n=floor(vdv[0]+0.5);
+ if(n==-1){
+ nd=floor(vdv[1]+0.5);
+ d=(Vrng[1]-Vrng[0])/(nd+1);
+ for(i=1; i<=nd; i++){
+ v=Vrng[0]+i*d;
+ nv=appendd1(vdiv,v);
+ }
+ }
+ else{
+ for(i=1; i<=n; i++){
+ nv=appendd1(vdiv,vdv[i]);
+ }
+ }
+ nfbdxy=makexybdy(fbdxy);
+ Wirept[0][0]=0;
+ fsL[0][0]=0; nfsL=0;
+ fsLh[0][0]=0;
+ for(i=1; i<=nu; i++){
+ u=udiv[i];
+ d=(Vrng[1]-Vrng[0])/(num*Ndv);
+ tmpmd2[0][0]=0; ntmp=0;
+ for(j=1;j<=(num*Ndv)+1; j++){
+ v=Vrng[0]+(j-1)*d;
+ p[0]=u; p[1]=v;
+ ntmp=addptd2(tmpmd2,p);
+ }
+ nfkL=cuspsplitpara(tmpmd2, fkL);
+ ndin=dataindexd3(2,fkL,din);
+ for(j=1; j<=ndin; j++){
+ fk[0][0]=0;
+ nfk=appendd3(0, din[j][0], din[j][1], fkL,fk);
+ ntmp=projpara(fk,tmpmd2);
+ npar=partitionseg(tmpmd2, fbdy, 1, par);
+ ntmp=length2(Partitionpt);
+ if(ntmp>2){
+ for(k=2; k<=ntmp; k++){
+ pull2(k, Partitionpt, p);
+ nwire=addptd3(Wirept,p);
+ }
+ }
+ nfs=nohiddenpara2(par,fk,1, fs);
+ n=length3(Hiddendata);
+ ntmp=appendd3(2,1,n, Hiddendata,fsLh);
+ nfsL=appendd3(2,1,nfs,fs,fsL);
+ }
+ }
+ for(i=1; i<= nv; i++){
+ v=vdiv[i];
+ d=(Urng[1]-Urng[0])/(num*Mdv);
+ tmpmd2[0][0]=0; ntmp=0;
+ for(j=1;j<=(num*Mdv)+1; j++){
+ u=Urng[0]+(j-1)*d;
+ p[0]=u; p[1]=v;
+ ntmp=addptd2(tmpmd2,p);
+ }
+ nfkL=cuspsplitpara(tmpmd2, fkL);
+ ndin=dataindexd3(2,fkL,din);
+ for(j=1; j<=ndin; j++){
+ fk[0][0]=0;
+ nfk=appendd3(0, din[j][0], din[j][1], fkL,fk);
+ ntmp=projpara(fk,tmpmd2);
+ npar=partitionseg(tmpmd2, fbdy, 1, par);
+ ntmp=length2(Partitionpt);
+ if(ntmp>2){
+ for(k=2; k<=ntmp; k++){
+ pull2(k, Partitionpt, p);
+ nwire=addptd3(Wirept,p);
+ }
+ }
+ nohiddenpara2(par,fk,1, fs);
+ appendd3(2,1,length3(Hiddendata), Hiddendata,fsLh);
+ appendd3(2,1,length3(fs),fs,fsL);
+ }
+ }
+ push3(Inf,3,0,fsL);
+ nfsL=appendd3(0,1,length3(fsLh),fsLh,fsL);
+ push3(Inf,3,0,fsL);
+ return nfsL;
+}
+
+/*
+double cutfun(int ch, double u, double v){
+ double p[3],val ;
+ surffun(u,v,p);
+ val=p[0]+p[1]-0.5;
+ return val;
+}
+*/
+
+void makevaltablecut(int ch){
+ double eps0=pow(10,-6.0), u, v, du, dv;
+ int i, j, nx=0, ny=0; ;
+ du=(Urng[1]-Urng[0])/Mdv;
+ dv=(Vrng[1]-Vrng[0])/Ndv;
+ for(j=0; j<=Ndv; j++){
+ v=Vrng[0]+j*dv;
+ for(i=0; i<=Mdv; i++){
+ u=Urng[0]+i*du;
+ Zval[j][i]=cutfun(ch, u,v);
+ }
+ }
+ for(i=0; i<=Mdv; i++){
+ Xval[i]=Urng[0]+i*du;
+ }
+ for(j=0; j<=Ndv; j++){
+ Yval[j]=Vrng[0]+j*dv;
+ }
+}
+
+int sfcutdata(int ch, double ekL[][3]){
+ double cutuvL[DsizeL][2], out1[DsizeM][2], out2[DsizeM][3], pt[3];
+ int i, j, nall, ndin, din[DsizeM][2], nekL,nout1,nout2;
+ makevaltablecut(ch);
+ nall=implicitplot(cutuvL);
+ ekL[0][0]=0; nekL=0;
+ ndin=dataindexd2(2,cutuvL,din);
+ for(i=1; i<=ndin; i++){
+ out1[0][0]=0;
+ nout1=appendd2(2,din[i][0],din[i][1],cutuvL,out1);
+ out2[0][0]=0;
+ for(j=1; j<=nout1; j++){
+ surffun(out1[j][0], out1[j][1], pt);
+ nout2=addptd3(out2,pt);
+ }
+ nekL=appendd3(2,1,nout2,out2,ekL);
+ }
+ return nekL;
+}
+
+int crv3onsfparadata(double fk[][3], double fbdyd3[][3], double out[][3]){
+ double fbdy[DsizeL][2], fh[DsizeL][2], tmpmd2[DsizeL][2], par[DsizeM];
+ int n, nall, nfbdy, nfbdxy, npar, nout;
+ out[0][0]=0;
+ nfbdy=projpara(fbdyd3,fbdy);
+// nall=ospline3(2,fk,2,fk1);
+ projpara(fk,fh);
+ partitionseg(fh,fbdy, 1, par);
+ nohiddenpara2(par,fk, 1,out);
+ push3(Inf,3,0,out);
+ nall=appendd3(0,1,length3(Hiddendata),Hiddendata,out);
+ push3(Inf,3,0,out); //17.06.16
+ return nall;
+}
+
+int projcoordcurve(double curve[][3], double out[][3]){
+ double SP=sin(PHI), CP=cos(PHI), ST=sin(THETA), CT=cos(THETA);
+ double pt[3], xz, yz, zz;
+ int i, n, nall;
+ out[0][0]=0;
+ n=length3(curve);
+ for(i=1; i<=n; i++){
+ pull3(i, curve, pt);
+ if(pt[0]>Inf-1){
+ xz=pt[0]; yz=pt[1]; zz=pt[2];
+ }
+ else{
+ xz=-pt[0]*SP+pt[1]*CP;
+ yz=-pt[0]*CP*CT-pt[1]*SP*CT+pt[2]*ST;
+ zz=pt[0]*CP*ST+pt[1]*SP*ST+pt[2]*CT;
+ }
+ nall=push3(xz,yz,zz,out);
+ }
+ return nall;
+}
+
+int kukannozoku(double jokyo[2], double kukanL[][2], double res[][2]){
+ double t1, t2, tmpd2[2], ku[2];
+ int i, j, ii, nn, flg, nres;
+ nn=length2(kukanL);
+ t1=jokyo[0];
+ t2=jokyo[1];
+ pull2(1,kukanL,tmpd2);
+ t1=fmax(t1,tmpd2[0]);
+ pull2(nn,kukanL,tmpd2);
+ t2=fmin(t2,tmpd2[1]);
+ res[0][0]=0; nres=0;
+ flg=0;
+ for(ii=1; ii<=nn; ii++){
+ pull2(ii,kukanL,ku);
+ if(flg==0){
+ if(ku[1]<t1){
+ nres=addptd2(res,ku);
+ }
+ else{
+ flg=1;
+ if(ku[0]<t1-Eps){
+ tmpd2[0]=ku[0]; tmpd2[1]=t1;
+ nres=addptd2(res,tmpd2);
+ }
+ if(ku[1]>t2+Eps){
+ tmpd2[0]=t2; tmpd2[1]=ku[1];
+ nres=addptd2(res,tmpd2);
+ }
+ }
+ }
+ else if(flg==1){
+ if(ku[1]<t2){
+ continue;
+ }
+ else{
+ flg=2;
+ if(ku[0]<t2-Eps){
+ ku[0]=t2;
+ }
+ nres=addptd2(res,ku);
+ }
+ }
+ else{
+ nres=addptd2(res,ku);
+ }
+ }
+ return nres;
+}
+
+int skeletondata3(double data[][3], double r00,
+ double eps1, double eps2, double allres[][3]){
+ double objL[DsizeLL][3], pltL[DsizeLL][3];
+ double clipL[DsizeL][5];
+ double pts1[DsizeL][2],koc[DsizeM][4], koc2[DsizeM][4], kukanL[DsizeL][2];
+ double r0, t1, t2, z1, z2, tt, rr, origin[2], te, hh, ku[2], za, zb, ds[DsizeM],dmin;
+ double pt[2], pta[2], ptb[2], ptq[2];
+ double ptL[DsizeL][3], ptL2[DsizeL][2], res2[DsizeL][2], allres2[DsizeL][2];
+ double obj[DsizeL][3], plt[DsizeL][3];
+ double objp[DsizeL][3], pltp[DsizeL][3];
+ double obj2d[DsizeL][2], plt2d[DsizeL][2];
+ double tmpd1, tmp2d1, tmp3d1, tmp1d2[2], tmp2d2[2],tmpd3[3];
+ double tmpmd2[DsizeL][2], tmpmd3[DsizeL][3], tmpd4[4], tmp1d4[4];
+ int j, ii, jj, nobj, nplt, nall, din1[DsizeM][2], din2[DsizeM][2];
+ int nkoc, nkoc2, nn,nn1,nn2, nclipL, flg, ntmp;
+ char str1[100], str2[100];
+ objL[0][0]=0; pltL[0][0]=0;
+ dataindexd3(3,data,din1);
+ appendd3(0, din1[1][0],din1[1][1],data,objL);
+ appendd3(0, din1[2][0],din1[2][1],data,pltL);
+ allres[0][0]=0;
+ allres2[0][0]=0;
+ dataindexd3(2,objL,din1);
+ dataindexd3(2,pltL,din2);
+ for(nobj=1; nobj<=length2i(din1); nobj++){
+ tmpmd3[0][0]=0;
+ ntmp=appendd3(2,din1[nobj][0],din1[nobj][1],objL,tmpmd3);
+ nn=ceil((fmax(Mdv,Ndv)*2-1)/(ntmp-1));
+ increasept3(tmpmd3,nn,obj);
+ appendd3(0,ntmp,ntmp,tmpmd3,obj);
+ projcoordcurve(obj,objp);
+ obj2d[0][0]=0;
+ for(j=1; j<=length3(objp); j++){
+ push2(objp[j][0],objp[j][1],obj2d);
+ }
+ clipL[0][0]=0; nclipL=0;
+ for(nplt=1; nplt<=length2i(din2); nplt++){
+ tmpmd3[0][0]=0;
+ ntmp=appendd3(2,din2[nplt][0],din2[nplt][1],pltL,tmpmd3);
+ nn=ceil((fmax(Mdv,Ndv)*2-1)/(ntmp-1));
+ increasept3(tmpmd3,nn,plt);
+ appendd3(0,ntmp,ntmp,tmpmd3,plt);
+ projcoordcurve(plt,pltp);
+ plt2d[0][0]=0;
+ for(j=1; j<=length3(pltp); j++){
+ push2(pltp[j][0],pltp[j][1],plt2d);
+ }
+ nkoc2=intersectcrvsPp(obj2d,plt2d,eps1,eps2,koc2);
+ if(nkoc2>0){
+ koc[0][0]=0; nkoc=0;
+ pull2(1,plt2d,pta);
+ pull2(length2(plt2d),plt2d,ptb);
+ for(j=1; j<=nkoc2; j++){
+ pt[0]=koc2[j][0]; pt[1]=koc2[j][1];
+ nearestptpt(pt, plt2d, tmpd4);
+ koc2[j][3]=tmpd4[2];
+ pt[0]=tmpd4[0]; pt[1]=tmpd4[1];
+ nearestptpt(pt, obj2d, tmpd4);
+ koc2[j][0]=tmpd4[0]; koc2[j][1]=tmpd4[1];
+ koc2[j][2]=tmpd4[2];
+ ds[j]=tmpd4[3];
+ }
+ pull4(1,koc2,tmp1d4);
+ dmin=ds[1];
+ for(j=2; j<=nkoc2; j++){
+ if(fabs(koc2[j][2]-tmp1d4[2])<4){
+ if(ds[j]<dmin){
+ pull4(j,koc2,tmp1d4);
+ dmin=ds[j];
+ }
+ }
+ else{
+ addptd4(koc,tmp1d4);
+ pull4(j,koc2,tmp1d4);
+ dmin=ds[j];
+ }
+ }
+ nkoc=addptd4(koc,tmp1d4);
+/*
+ if(tmpd4[3]<2*eps1){
+ if((dist(2,pta,pt)<eps2)&&(tmpd4[2]<0.1*length2(plt2d))){
+ continue;
+ }
+ if((dist(2,ptb,pt)<eps2)&&(tmpd4[2]>0.9*length2(plt2d))){
+ continue;
+ }
+ pull4(j,koc2,tmpd4);
+ nkoc=addptd4(koc,tmpd4);
+ }
+ }
+*/
+ for(jj=1; jj<=nkoc; jj++){
+ pt[0]=koc[jj][0]; pt[1]=koc[jj][1];
+ pta[0]=plt2d[1][0]; pta[1]=plt2d[1][1];
+ ptb[0]=plt2d[length2(plt2d)][0]; ptb[1]=plt2d[length2(plt2d)][1];
+ if((dist(2,pt,pta)<eps2)&&(koc[jj][3]<0.3*length2(plt2d))){
+ continue;
+ }
+ if((dist(2,pt,ptb)<eps2)&&(koc[jj][3]>0.7*length2(plt2d))){
+ continue;
+ }
+ nn1=floor(koc[jj][2]);
+ nn2=koc[jj][3];
+ pta[0]=objp[nn1][0]; pta[1]=objp[nn1][1];
+ za=objp[nn1][2];
+ ptb[0]=objp[nn1+1][0]; ptb[1]=objp[nn1+1][1];
+ zb=objp[nn1+1][2];
+ if(dist(2,pta,ptb)<eps1){
+ continue;
+ }
+ t1=dist(2,pta,pt)/dist(2,pta,ptb);
+ z1=(1-t1)*za+t1*zb;
+ pta[0]=pltp[nn2][0]; pta[1]=pltp[nn2][1];
+ za=tmpmd3[nn2][2];
+ ptb[0]=pltp[nn2+1][0]; ptb[1]=pltp[nn2+1][1];
+ zb=tmpmd3[nn2+1][2];
+ if(dist(2,pta,ptb)<Eps){
+ continue;
+ }
+ t2=dist(2,pta,pt)/dist(2,pta,ptb);
+ z2=(1-t2)*za+t2*zb;
+ if(z1<z2-eps1){
+ if(nclipL==0){
+ tmpd1=1;
+ }
+ }
+ else{
+ tmpd1=Inf;
+ for(j=1; j<=nclipL; j++){
+ tmp2d1=pow(clipL[j][0]-pt[0],2.0);
+ tmp2d1=tmp2d1+pow(clipL[j][1]-pt[1],2.0);
+ tmpd1=fmin(tmpd1,tmp2d1);
+ }
+ }
+ if(tmpd1>pow(Eps,2.0)){
+ pts1[0][0]=0;
+ pointoncurve(nn1,obj2d,Eps,tmp1d2);
+ addptd2(pts1,tmp1d2);
+ pointoncurve(nn1+1,obj2d,Eps,tmp1d2);
+ addptd2(pts1,tmp1d2);
+ tmp1d2[0]=pts1[2][0]-pts1[1][0];
+ tmp1d2[1]=pts1[2][1]-pts1[1][1];
+ tmp2d2[0]=ptb[0]-pta[0];
+ tmp2d2[1]=ptb[1]-pta[1];
+ tmp3d1=dotprod(2,tmp1d2,tmp2d2);
+ origin[0]=0; origin[1]=0;
+ tmp3d1=tmp3d1/dist(2,tmp1d2,origin)/dist(2,tmp2d2,origin);
+ tmpd1=1-0.5*pow(tmp3d1,2.0);
+ r0=0.075*r00;
+ nclipL=push5(pt[0],pt[1], nn1,t1,r0/tmpd1, clipL);
+ }
+ }
+ }
+ }
+ kukanL[0][0]=0;
+ te=length3(obj);
+ push2(1.0,te, kukanL);
+ for(ii=1; ii<=nclipL; ii++){
+ pt[0]=clipL[ii][0]; pt[1]=clipL[ii][1];
+ nn=clipL[ii][2];
+ tt=nn+clipL[ii][3];
+ rr=clipL[ii][4];
+ flg=0;
+ for(jj=nn; jj>=1; jj--){
+ pointoncurve(jj,obj2d,Eps,ptq);
+ if(dist(2,pt,ptq)<rr){
+ continue;
+ }
+ flg=jj;
+ break;
+ }
+ if(flg==0){
+ t1=1;
+ }
+ else{
+ t1=flg; t2=tt;
+ hh=t2-t1;
+ for(j=1; j<=10; j++){
+ hh=hh*0.5;
+ pointoncurve(t1+hh,obj2d,Eps,ptq);
+ if(dist(2,pt,ptq)<rr){
+ t2=t2-hh;
+ }
+ else{
+ t1=t1+hh;
+ }
+ }
+ }
+ ku[0]=t1;
+ flg=0;
+ for(jj=nn+1; jj<=te; jj++){
+ pointoncurve(jj,obj2d,Eps,ptq);
+ if(dist(2,pt,ptq)<rr){
+ continue;
+ }
+ flg=jj;
+ break;
+ }
+ if(flg==0){
+ t2=te;
+ }
+ else{
+ t1=tt; t2=flg;
+ hh=t2-t1;
+ for(j=1; j<=10; j++){
+ hh=hh*0.5;
+ pointoncurve(t1+hh,obj2d,Eps,ptq);
+ if(dist(2,pt,ptq)<rr){
+ t1=t1+hh;
+ }
+ else{
+ t2=t2-hh;
+ }
+ }
+ }
+ ku[1]=t2;
+ ntmp=kukannozoku(ku,kukanL,tmpmd2);
+ kukanL[0][0]=0;
+ appendd2(0,1,ntmp,tmpmd2,kukanL);
+ }
+ for(jj=1; jj<=length2(kukanL); jj++){
+ tmp1d2[0]=kukanL[jj][0]; tmp1d2[1]=kukanL[jj][1];
+ t1=kukanL[jj][0]; nn1=floor(t1);
+ t2=kukanL[jj][1]; nn2=floor(t2);
+ ptL2[0][0]=0;
+ ptL[0][0]=0;
+ if(t1-nn1<1-Eps){
+ pointoncurve(t1,obj2d,Eps,tmp1d2);
+ addptd2(ptL2,tmp1d2);
+ invparapt(t1, obj2d, obj, tmpd3);
+ addptd3(ptL,tmpd3);
+ }
+ for(j=nn1+1; j<=nn2; j++){
+ pointoncurve(j,obj2d,Eps,tmp1d2);
+ addptd2(ptL2,tmp1d2);
+ invparapt(j, obj2d, obj, tmpd3);
+ addptd3(ptL,tmpd3);
+ }
+ if(t2-nn2>Eps){
+ pointoncurve(t2,obj2d,Eps,tmp1d2);
+ addptd2(ptL2,tmp1d2);
+ invparapt(t2, obj2d, obj, tmpd3);
+ addptd3(ptL,tmpd3);
+ }
+ if(length2(ptL2)>1){
+ appendd2(2,1,length2(ptL2),ptL2,allres2);
+ appendd3(2,1,length3(ptL),ptL,allres);
+ }
+ }
+ }
+ return length3(allres);
+}
+
+/*
+void writesfbd(const char *var, const char *fname, const char *fnameh,double sf[][3]){
+ sfbdparadata(sf);
+ output3(var, "", fname,2,sf);
+ output3(var, "h", fnameh,2,Borderhiddendata);
+}
+
+void writecrv(const char *var, const char *fname, const char *fnameh,
+ double crv[][3],double sf[][3]){
+ crvsfparadata(crv, sf, 1,Crvdata);
+ output3(var, "", fname,2,Crvdata);
+ output3(var, "h", fnameh,2,Crvsfhiddendata);
+}
+
+void writewire(const char *var, const char *fname, const char *fnameh,
+ double sf[][3], int num, double udv[], double vdv[]){
+ wireparadata(sf, num, udv,vdv, Wiredata);
+ output3(var, "", fname,2,Wiredata);
+ output3(var, "h", fnameh,2,Hiddenwiredata);
+}
+
+void writesfcut(const char *var, const char *fname, const char *fnameh,
+ double crv[][3], double sf[][3]){
+ sfcutdata(crv);
+ crv3onsfparadata(crv, sf, Crvonsfdata);
+ output3(var, "", fname,2,Crvonsfdata);
+ output3(var, "h", fnameh,2,Crv3onsfhiddendata);
+}
+
+void writecrvonsf(const char *var, const char *fname, const char *fnameh,
+ double crv[][3],double sf[][3]){
+ crv3onsfparadata(crv, sf, Crvonsfdata);
+ output3(var, "", fname,2,Crvonsfdata);
+ output3(var, "h", fnameh,2,Crv3onsfhiddendata);
+}
+*/
+
+
diff --git a/texmf-dist/scripts/ketcindy/ketlibC/surflibhead.h b/texmf-dist/scripts/ketcindy/ketlibC/surflibhead.h
new file mode 100644
index 00000000..49d2ed4c
--- /dev/null
+++ b/texmf-dist/scripts/ketcindy/ketlibC/surflibhead.h
@@ -0,0 +1,49 @@
+double Xval[DsizeS], Yval[DsizeS], Zval[DsizeS][DsizeS];
+
+double Implicitdata[DsizeL][2];
+double Cuspsplitpt[DsizeL][2];
+double Cusppt[DsizeM][2];
+double Otherpartition [DsizeM];
+double Partitionpt[DsizeM][2];
+double Cuspdata[DsizeM];
+double Wirept[DsizeM][3];
+double Hiddendata[DsizeL][3];
+double Borderpt[DsizeM][2];
+double Borderhiddendata[DsizeL][3];
+double Surf[DsizeL][3];
+double Crvdata[DsizeL][3];
+double Wiredata[DsizeLL][3];
+
+int output3(const char *var, const char *fname, int level, double out[][3]);
+int output3h(const char *var, const char *varh, const char *fname, double out[][3]);
+int writedataC(const char *fname, double out[][3]);
+int readdataC(const char *fname, double data[][3]);
+void parapt(double pt3[3],double pt2[2]);
+int projpara(double p3[][3], double p2[][2]);
+double invparapt(double ph, double fh[][2], double fk[][3],double out[3]);
+int surfcurve(int level, double crv[][2], double pdata[][3]);
+int xyzax3data(double x0, double x1, double y0, double y1, double z0, double z1,
+ double out[][3]);
+void evlptablepara(void);
+int implicitplot(double out[][2]);
+int cuspsplitpara(double pdata[][2], double outkL[][3]);
+int makexybdy(double ehL[][2]);
+int partitionseg(double fig[][2],double gL[][2], int ns, double out[]);
+void makevaltablepth(double pta[3]);
+int pthiddenQ(double pta[3], int uveq, double eps[2]);
+int nohiddenpara2(double paL[], double fk[][3], int uveq, double figkL[][3]);
+int borderparadata(double fkL[][3], double fsL[][3]);
+int sfbdparadata(double outd3[][3]);
+void makevaltablemeet(double pa[3], double vec[3], double eps0);
+int meetpoints(double pta[3], double ptb[3], double eps, double ptL[][3]);
+int crvsfparadata(double fkL[][3], double fbdkL[][3], int sepflg, double out[][3]);
+int sfcutdata(int ch, double ekL[][3]);
+int crv3onsfparadata(double fk[][3], double fbdyd3[][3], double out[][3]);
+int wireparadata(double bdyk[][3], double udv[], double vdv[], int num,
+ double fsL[][3]);
+int projcoordcurve(double curve[][3], double out[][3]);
+int kukannozoku(double jokyo[2], double kukanL[][2], double res[][2]);
+int skeletondata3(double data[][3], double r00, double eps1, double eps2,
+ double allres[][3]);
+
+double cutfun(int ch,double u, double v);