同一坐标系中,由任意两点计算旋转角度.

同一坐标系中,由任意两点计算旋转角度.

 

double  CCarNaviView::CalculateRotateAngle(CPoint pntBegin,CPoint pntNext)
{
    CPoint pntFirst(pntBegin);
    CPoint pntSecond(pntNext);

    
double dRotateAngle = atan2(fabs(pntBegin.x-pntNext.x),fabs(pntBegin.y-pntNext.y));
 
    
//如果下一点的横坐标大于前一点(在第一和第四象限)
    if (pntNext.x>=pntFirst.x)
    
{
        
//在第一象限(0<=dRotateAngle<=90)
        if (pntNext.y>=pntFirst.y)
        
{
            
//不做任何处理
            dRotateAngle=dRotateAngle;
        }

        
else
        
{
            dRotateAngle
=PI-dRotateAngle;
        }

    }

    
else//(在第二和第三象限)
    {
        
//第二象限
        if (pntNext.y>=pntFirst.y)
        
{
            dRotateAngle
=2*PI-dRotateAngle;
        }

        
else//第三象限
        {
            dRotateAngle
=PI+dRotateAngle;
        }

    }

    dRotateAngle 
= dRotateAngle * 180 / PI;
    
return dRotateAngle;
}

你可能感兴趣的:(同一坐标系中,由任意两点计算旋转角度.)