/// <summary>
/// 求p围绕pCenter旋转angle后的坐标值
/// </summary>
/// <param name="p">需要旋转的坐标</param>
/// <param name="pCenter">围绕的坐标</param>
/// <param name="angle">旋转角度,大于0逆时针,小于0顺时针</param>
/// <returns></returns>
private static Point calcNewPoint(Point p, Point pCenter, float angle)
{
// calc arc
float l = (float)((angle * Math.PI) / 180);
//sin/cos value
float cosv = (float)Math.Cos(l);
float sinv = (float)Math.Sin(l);
// calc new point
float newX = (float)((p.X - pCenter.X) * cosv - (p.Y - pCenter.Y) * sinv + pCenter.X);
float newY = (float)((p.X - pCenter.X) * sinv + (p.Y - pCenter.Y) * cosv + pCenter.Y);
return new Point((int)newX, (int)newY);
}
public double GetAngle(MapPoint pntFirst, MapPoint pntNext)
{
double dRotateAngle = Math.Atan2(Math.Abs(pntFirst.X - pntNext.X), Math.Abs(pntFirst.Y - pntNext.Y));
if (pntNext.X >= pntFirst.X)
{
if (pntNext.Y >= pntFirst.Y)
{
}
else
{
dRotateAngle = Math.PI - dRotateAngle;
}
}
else {
if (pntNext.Y >= pntFirst.Y)
{
dRotateAngle = 2 * Math.PI - dRotateAngle;
}
else {
dRotateAngle = Math.PI + dRotateAngle;
}
}
dRotateAngle = dRotateAngle * 180 / Math.PI;
return dRotateAngle;
}