[轉貼]最小二乘法直線擬合

http://blog.csdn.net/byxdaz/article/details/594414

class CFoldPoint

{

public:

  double x;double y;

}

typedef CTypedPtrList CFoldPointList;
typedef CDoubleArray CDoubleArray;

//最小二乘法直線擬合
BOOL CalculateLineKB(CFoldPointList *m_FoldList,double &k,double &b)
{
 //最小二乘法直線擬合
 //m_FoldList為關鍵點(x,y)的鏈表
 //擬合直線方程(Y=kX+b)

 if(m_FoldList==NULL)return FALSE;
 long lCount=m_FoldList->GetCount();
 if(lCount<2)return FALSE;
 CFoldPoint *pFold;
 double mX,mY,mXX,mXY,n;
 mX=mY=mXX=mXY=0;
 n=lCount;
 POSITION pos=m_FoldList->GetHeadPosition();
 while(pos != NULL)
 {
  pFold=m_FoldList->GetNext(pos);
  mX+=pFold->X;
  mY+=pFold->Y;
  mXX+=pFold->X*pFold->X;
  mXY+=pFold->X*pFold->Y;
 }
 if(mX*mX-mXX*n==0)return FALSE;
 k=(mY*mX-mXY*n)/(mX*mX-mXX*n);
 b=(mY-mX*k)/n;
 return TRUE;
}