B样条曲线曲面和NURBS曲线曲面C语言算法源程序.doc

学习小结：前面学习了Bezier曲线，B样条基函数和B样条曲线的一些基础知识。掌握关键问题是一条B样条曲线间的多段曲线的光滑连接。因为现在是用多段Bezier曲线来描绘一条B样条曲线，所以问题变为两段Bezier曲线间光滑连接。两段Bezier曲线段（3次）B1和B2光滑连接的条件：
（1）.要求B1和B2有共同的连接点，即G0连续。
（2）.要求B1和B2在连接点处有成比例的一阶导数，即G1连续。由端点处的一阶导数,为实现G1连续，则有：
即：
这也表明，三点共线。如下图表示了一条3次B样条曲线的所有控制多边形：
(P1) P2
P3
P4 (P11) (P12)

P5 P10
P0 P6 P9
P7 P8
图5.3次B样条曲线和所有控制多边形
图5中，P0至P6为原始3次B样条曲线控制多边形顶点，P0至P12是计算后最终形成B样条曲线控制多边形顶点。

图6.双二次（2x2）B样条曲面

6.B样条曲线曲面和NURBS曲线曲面的C语言实现算法源程序

#ifndef _mynurbs_h
#ifndef _MYNURBS_H

#include "gl\gl.h"
#include "math.h"
//*-*-*-*-*-*-*-*-*-*-*-*-*-*-* B样条基函数计算部分 *-*-*-*-*-*-*-*-*-*-*-*-*-*
//确定参数u所在的节点区间下标
//n=m-p-1
//m为节点矢量U[]的最大下标
//p为B样条函数次数
int FindSource(int n,int p,float u,float U[])
{
int low,high,mid;

if(u==U[n+1])//特殊情况
return n;
//进行二分搜索
low=p;
high=n+1;
mid=(int)(low+high)/2;
while(uU[mid])
{
if(u=U[mid]&&u参数u所在的节点区间下标
void BasisFunction(int i,int p,float u,float U[],float N[])
{
int j,di,dp,k;
float tul,tur,left,right;
float tmpN[50][50];

for(k=0;k<=p;k++)
{
dp=0;
for(di=i+p-k;di>=i-k;di--)
{
if(u>=U[di]&&u dp+=1;
for(j=1;j
}
}
N[i-k]=tmpN[i-k][p];
}
}
//-----------------------------------------------------------------------
//计算基函数的1阶导数并保存在NP[]中
//i为参数u所在的节点区间下标
//p为B样条函数次数P>2
void DerBasisFunc(int i,int p,float u,float U[],float NP[])
{
int j,di,dp,k;
float tul,tur,left,right,saved,dl,dr;
float tmpN[50][50];

for(k=0;k<=p;k++)
{
dp=0;
for(di=i+p-k;di>=i-k;di--)
{
if(u>=U[di]&&u])/tul,dl=1/tul;
else
left=0,dl=0;
if(tur!=0)
right=(U[di+j+1]-u)/tur,dr=1/tur;
else
right=0,dr=0;
tmpN[di][j]=(left*tmpN[di][j-1]+right*tmpN[di+1][j-1]);
saved=p*(dl*tmpN[di][j-1]-dr*tmpN[di+1][j-1])/(p+p-1);
}
}
NP[i-k]=saved;
}
}
//*-*-*-*-*-*-*-*-*-*-*-*-*-* Bezier曲线曲面部分 *-*-*-*-*-*-*-*-*-*-*-*-*-*-*-*-*
//计算参数u的p次基函数值并存在BC[]中
void BernsteinFunc(int p,double t,float BC[])
{
for(int i=0;i<=p;i++)
{
if(i==0)
BC[0]=(float)pow(1-t,p);
if(i==p)
BC[p]=(float)pow(t,p);
if(i>0&&it,i)*(float)pow(1-t,p-i);
}
}
//获取p次Bezier曲线上的lines个点的值
void BezierPoint(int p,float px[],float py[],float pz[],int lines,float tmp[][3])
{
float BC[20];
int i,j;

for(j=0;j<=lines;j++)
{
double t=j/(float)lines;
BernsteinFunc(p,t,BC);
tmp[j][0]=tmp[j][1]=tmp[j][2]=0
for(i=0;i for(j=0;j<=lines;j++)
{
double t=j/(float)lines;
BernsteinFunc(p,t,BC);
x=y=z=w=0;
for(i=0;i[j][3]=w;
}
}
//-----------------------------------------------------------------------------------
//绘制p次的Bezier曲线
void Bezier(int p,float px[],float py[],float pz[],int lines)
{
float pt[100][3];
int j;

BezierPoint(p,px,py,pz,lines,pt);
for(j=1;j<=lines;j++)
{
glBegin(GL_LINES);
glVertex3f(pt[j-1][0],pt[j-1][1],pt[j-1][2]);
glVertex3f(pt[j][0],pt[j][1],pt[j][2]);
glEnd();
}
}
//------------------------------------------------------------------------------
//绘制p次的有理Bezier曲线
void NBezier(int p,float px[],float py[],float pz[],float w[],int lines)
{
float pt[100][4];
int j;

NBezierPoint(p,px,py,pz,w,lines,pt);
for(j=1;j<=lines;j++)
{
glBegin(GL_LINES);
glVertex3f(pt[j-1][0],pt[j-1][1],pt[j-1][2]);
glVertex3f(pt[j][0],pt[j][1],pt[j][2]);
glEnd();
}
}
//-------------------------------------------------
//计算双p次Bezier曲面上所有的点并保存在Pt[][][]中
//u和v分别为曲面(u,v)方向上的网格数
void BezierFacePoint(int p,int u,int v,float px[][4],float py[][4],float pz[][4],float pt[161][161][3])
{
float urx[11][161],ury[11][161],urz[11][161];
float tx[11],ty[11],tz[11],tmp[161][3];
int i,j,k;

for(j=0;jfor(k=0;k
//计算双p次有理Bezier曲面上所有的点并保存在Pt[][][]中
//u和v分别为曲面(u,v)方向上的网格数
void NuBezierFacePoint(int p,int u,int v,float px[][4],float py[][4],float pz[][4],float w[][4],float pt[161][161][3])
{
float urx[11][161],ury[11][161],urz[11][161],urw[11][161];
float tx[11],ty[11],tz[11],tw[11],tmp[161][4];
int i,j,k;

for(j=0;jrz[j][k]=tmp[k][2];
urw[j][k]=tmp[k][3];
}
}
for(i=0;i<=v;i++)
{
for(k=0;k[j][1]=tmp[j][1];
pt[i][j][2]=tmp[j][2];
}
}
}
//-*-*-*-*-*-*-*-*-*-*-*-*-*-*-*-* B样条曲线曲面部分 -*-*-*-*-*-*-*-*-*-*-*-*-*-*-
//计算样条曲线的1阶导矢（u所对应的所有点）保存在Der[]中
//n=m-p-1
//p为曲线的次数
void BSplineDer(int n,int p,float U[],float P[],float Der[])
{
float N[100],tmp;
int i,j;

fori=p+1;i<=n;i++)
{
DerBasisFunc(i,p,U[i],U,N);
tmp=0;
for(j=i;j>=i-p;j--)
tmp+=N[j]*P[j];
Der[i-p]=tmp;
}
}
//计算曲线上的点（u所对应的所有点）保存在Poi[]中
//n=m-p-1
//p为曲线的次数
void BSplinePoint(int n,int p,float U[],float P[],float Poi[])
{
float N[100],tmp;
int i,j;

for(i=p+1i<=n;i++)
{
BasisFunction(i,p,U[i],U,N);
tmp=0;
for(j=i;j>=i-p;j--)
tmp+=N[j]*P[j];
Poi[i-p]=tmp;
}
}
//计算3次样条曲线上的所有控制多边形保存在CP[]中
//m为节点矢量U[]的最大下标
void B3SplineControlPoint(int m,float U[],float P[],float CP[])
{
int n,k,i,cp,p;
float Poi[100],Der[100],add;

p=3;
nm-p-1;
BSplinePoint(n,p,U,P,Poi);
BSplineDer(n,p,U,P,Der);
cp=(n-p)*3+p;
for(i=0;i<2;i++)
{
CP[i]=P[i];
CP[cp-i]=P[n-i];
}
for(i=3;i
//m为节点矢量U[]的最大下标
void B2SplineControlPoint(int m,float U[],float P[],float CP[])
{
int n,k,tm,i,cp,p;
float Poi[100];

p=2;
n=m-p-1;
BSplinePoint(n,p,U,P,Poi);
cp=(n-p)*2+p;
for(i=0;i<2;i++)
CP[i]=P[i];
CP[cp]=P[n];
tm=2;
for(i=2;i]=Poi[k];
CP[i+1]=P[tm];
tm++;
}
}
//绘制3次B样条曲线
//m为节点矢量U[]的最大下标
void BSpline3L(int m,float U[],float px[],float py[],float pz[])
{
float pcx[100],pcy[100],pcz[100],drx[4],dry[4],drz[4];
int i,j,tmcp;

B3SplineControlPoint(m,U,px,pcx);
B3SplineControlPoint(m,U,py,pcy);
B3SplineControlPoint(m,U,pz,pcz);
/*
glColor3f(0.0f,0.0f,0.0f);
for(i=1;i<3*m-17;i++)
{
glBegin(GL_LINES);
glVertex3f(pcx[i-1],pcy[i-1],pcz[i-1]);
glVertex3f(pcx[i],pcy[i],pcz[i]);
glEnd();
}
glColor3f(1.0f,0.0f,0.0f);*/
tmcp=m-7;
for(i=0;i<=tmcp;i++)
{
for(j=i*3;jj++)
{
drx[j-i*3]=pcx[j];
dry[j-i*3]=pcy[j];
drz[j-i*3]=pcz[j];
}
Bezier(3,drx,dry,drz,20);
}
}
//绘制2次B样条曲线
//m为节点矢量U[]的最大下标
void BSpline2L(int m,float U[],float px[],float py[],float pz[])
{
float pcx[100],pcy[100],pcz[100],drx[3],dry[3],drz[3];
int i,j,tmcp;

B2SplineControlPoint(m,U,px,pcx);
B2SplineControlPoint(m,U,py,pcy);
B2SplineControlPoint(m,U,pz,pcz);
tmcp=m-5;
for(i=0;i<=tmcp;i++)
{
for(j=i*2;j曲面所有控制多边形顶点，并保存在pt[][][]中
//mu,mv分别为节点矢量U[],V[]的最大下标值
void BS3FaceControlPoint(int mu,float U[],int mv,float V[],float px[],float py[],float pz[],float pt[100][100][3])
{
int i,j,k,dp;
float tmx[50],tmy[50],tmz[50];
float tmpx[50][100],tmpy[50][100],tmpz[50][100];
float uvx[100][100],uvy[100][100],uvz[100][100];

for(i=0;i}
for(i=0;i<3*mu-17;i++)
{
for(j=0;jk][0]=uvx[i][k];
pt[i][k][1]=uvy[i][k];
pt[i][k][2]=uvz[i][k];
}
}
}
//计算双二次（2x2）B样条曲面所有控制多边形顶点，并保存在pt[][][]中
//mu,mv分别为节点矢量U[],V[]的最大下标值
void BS2FaceControlPoint(int mu,float U[],int mv,float V[],float px[],float py[],float pz[],float pt[100][100][3])
{
int i,j,k,dp;
float tmx[50],tmy[50],tmz[50];
float tmpx[50][100],tmpy[50][100],tmpz[50][100];
float uvx[100][100],uvy[100][100],uvz[100][100];

for(i=0;itmpx[i]);
B2SplineControlPoint(mu,U,tmy,tmpy[i]);
B2SplineControlPoint(mu,U,tmz,tmpz[i]);
}
for(i=0;i<2*mu-7;i++)
{
for(j=0;jV,tmy,uvy[i]);
B2SplineControlPoint(mv,V,tmz,uvz[i]);
for(k=0;k<2*mv-7;k++)
{
pt[i][k][0]=uvx[i][k];
pt[i][k][1]=uvy[i][k];
pt[i][k][2]=uvz[i][k];
}
}
}
//-------------------------------------------------------------------------------
//设置网格数
void SetGridCount(int dt,int tu,int tmk[])
{
int i,tm;

tm=tu%dt;
for(i=0;i网格数
//p为曲面的次数
void BSplineFace(int p,int nu,float U[],int uk,int mv,float V[],int vk,
float px[],float py[],float pz[],float bs[161][161][3])
{
int udk[20],vdk[20],i,j,k,l,hu,sv,du,dv;
float tp[100][100][3],td[161][161][3];
float tmx[4][4],tmy[4][4],tmz[4][4];

du=nu-2*p;
dv=mv2*p;
SetGridCount(du,uk,udk);
SetGridCount(dv,vk,vdk);
if(p==3)
BS3FaceControlPoint(nu,U,mv,V,px,py,pz,tp);
if(p==2)
BS2FaceControlPoint(nu,U,mv,V,px,py,pz,tp);
for(i=0;i
{
tmx[j-i*p][l-k*p]=tp[l][j][0];
tmy[j-i*p][l-k*p]=tp[l][j][1];
tmz[j-i*p][l-k*p]=tp[l][j][2];
}
BezierFacePoint(p,udk[k],vdk[i],tmx,tmy,tmz,td);
for(sv=i*vdk[0];sv<=vdk[i]+i*vdk[0];sv++)
for(hu=k*udk[0];hu<=udk[k]+k*udk[0];hu++)
{
bs[sv][hu][0]=td[sv-i*vdk[0]][hu-k*udk[0]][0];
bs[sv][hu][1]=td[sv-i*vdk[0]][hu-k*udk[0]][1];
bs[sv][hu][2]=td[sv-i*vdk[0]][hu-k*udk[0]][2];
}
}
}
}
//-*-*-*-*-*-*-*-*-*-*-*-*-*-*-*-* Nurbs 样条曲线曲面部分 -*-*-*-*-*-*-*-*-*-*-*-*-*-*-
//计算Nurbs曲线上的点（u所对应的所有点）保存在Poi[]中
//n=m-p-1
//p为曲线的次数
void NurbsPoint(int n,int p,float U[],float P[],float W[],float Poi[])
{
float N[100],tmp,tmw;
int i,j;

for(i=p+1;i<=n;i++)
{
BasisFunction(i,p,U[i],U,N);
tmp=0;tmw=0;
for(j=i;j>=i-p;j--)
{
tmp+=N[j]*P[j]*W[j];
tmw+=N[j]*W[j];
}
Poi[i-p]=tmp/tmw;
}
}
//计算Nurbs曲线的1阶导矢（u所对应的所有点）保存在Der[]中
//n=m-p-1
//p为曲线的次数
void NurbsDer(int n,int p,float U[],float P[],float W[],float Der[])
{
float N[100],CP[100],NW[100],tmp,tw;
int i,j;

NurbsPoint(n,p,U,P,W,CP);
BSplinePoint(n,p,U,W,NW);
for(i=p+1;i<=n;i++)
{
DerBasisFunc(i,p,U[i],U,N);

tmp=0;tw=0;
for(j=i;j>=i-p;j--)
{
tmp+=N[j]*P[j]*W[j];
tw+=N[j]*W[j];
}
Der[i-p]=(tmp-tw*CP[i-p])/NW[i-p];
}
}
//计算3次Nurbs曲线上的所有控制多边形保存在CP[]中
//m为节点矢量U[]的最大下标
void Nurbs3ControlPoint(int m,float U[],float P[],float W[],float CP[])
{
int n,k,i,cp,p;
float Poi[100],Der[100],add;

p=3;
n=m-p-1;
NurbsPoint(n,p,U,P,W,Poi);
NurbsDer(n,p,U,P,W,Der);
cp=(n-p)*3+p;
for(i=0;i<2;i++)
{
CP[i]=P[i];
CP[cp-i]=P[n-i];
}
for(i=3;i算2次Nurbs曲线上的所有控制多边形保存在CP[]中
//m为节点矢量U[]的最大下标
void Nurbs2ControlPoint(int m,float U[],float P[],float W[],float CP[])
{
int n,k,tm,i,cp,p;
float Poi[100];

p=2;
n=m-p-1;
NurbsPoint(n,p,U,P,W,Poi);
cp=(n-p)*2+p;
for(i=0;i<2;i++)
CP[i]=P[i];
CP[cp]=P[n];
tm=2;
for(i=2;ii+=2)
{
k=(int)i/2;
CP[i]=Poi[k];
CP[i+1]=P[tm];
tm++;
}
}
//绘制3次Nurbs样条曲线
//m为节点矢量U[]的最大下标
void Nurbs3L(int m,float U[],float px[],float py[],float pz[],float W[])
{
float pcx[100],pcy[100],pcz[100],drx[4],dry[4],drz[4];
float pcw[100],drw[4];
int i,j,tmcp;

Nurbs3C