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;
}