/// <summary>
/// 获取一个向量的unit 法向量，该法向量位于向量右侧,向量不能为零向量
/// </summary>
/// <param name="vtr"></param>
public static OxyzPointF GetNormal(OxyzPointF vtr)
{
double iDX = vtr._X * vtr._X;
double iDY = vtr._Y * vtr._Y;
double dDistance = Math.Sqrt(iDX + iDY);
double dx = 0d;
double dy = 0d;
OxyzPointF p1 = new OxyzPointF(0f, 0f, 0f);
OxyzPointF p2 = new OxyzPointF(0f, 0f, 0f);
if (vtr._Y != 0)
{
dx = vtr._Y / dDistance;
dy = dx * vtr._X / vtr._Y;
p1 = new OxyzPointF((float)dx, (float)dy);
p2 = new OxyzPointF((float)-dx, (float)-dy);
}
else if (vtr._X != 0)
{
dy = vtr._X / dDistance;
dx = dy * vtr._Y / vtr._X;
p1 = new OxyzPointF((float)dx, (float)dy);
p2 = new OxyzPointF((float)-dx, (float)-dy);
}
if (VectorTool.GetVectorPos(p1, new OxyzPointF(vtr._X, vtr._Y)) == -1)
{
return(new OxyzPointF(p1._X, -p1._Y));
}
return(new OxyzPointF(p2._X, -p2._Y));
}
/// <summary>
/// 判定角度并且输出角度的正弦和余弦值，315-45 为0度 45-135度变为90度,135-225 为180度 225-315度变为270度，
/// </summary>
public static SinCos GetSinCos(OxyzPointF mpBaseVector, OxyzPointF mpVector)
{
//由于0.707小于根号2的一半所以45度变为90度
double dCosineValue = VectorTool.GetCosine(mpBaseVector, mpVector);
//-45 180 +45度的左开右闭闭区间
if (-1.001 <= dCosineValue && dCosineValue < -0.708) //-根号2的是是1.414 其一半 是0.707
{
return(new SinCos(0, -1)); //cosine 180 是-1；
}
int irtlPos = VectorTool.GetVectorPos(mpBaseVector, mpVector);
if (-0.708 <= dCosineValue && dCosineValue < 0.708)
{ //判断y位于基向量的上方还是下方
if (irtlPos < -0.1) //-45 270 +45度
{
return(new SinCos(-1, 0)); //270
}
if (irtlPos > 0.1) // -45 90 +45度
{
return(new SinCos(1, 0)); //90
}
if (-0.1 < irtlPos && irtlPos < 0.1)
{
return(new SinCos(1, 0));
}
else//iPos==0 当前角度下 这是不可能出现的
{
throw new Exception("不可能出现的值");
}
}
//这之间的有可能是零度，有可能是360度
if (0.708 <= dCosineValue && dCosineValue <= 1.001)
{
//315度到44度之间全部当作0度处理
return(new SinCos(0, 1));
}
throw new Exception("不可能没有捕获所有的角度值");
}