VTD 监视器航向角与 53-2017国标 航向角对齐

1.53-2017国标航向角定义

2.53-2017与VTD比较

图中车辆均以顺时针运行,且正北如图所示 。(VTD中没有方向定义,故自定义正北方向)

3.对齐

1.减去90度,0度对齐

2.乘以-1,符号对齐

3.分段对(-90,0)加上360度 (270,360)

PS:1,2两步并作 vtdh = 90 - vtdh;

/** * @brief 将VTDheading转换为53-2017标准*/
double headingConvertE(double vtdh)
{
  vtdh = 90 - vtdh; 
  if (vtdh < 0)
    return vtdh + 360;
  else
    return vtdh;
}

猜你喜欢

转载自blog.csdn.net/qq_41854291/article/details/106017397