GCS转VCS

已知坐标系在GCS下的位置orgPoint以及相对于GCS实时的orgHeading

float x{static_cast<float>(tgtPoint.x - orgPoint.x) * cos(orgHeading) + static_cast<float>(tgtPoint.y - orgPoint.y) * sin(orgHeading)};
float y{static_cast<float>(tgtPoint.x - orgPoint.x) * (-sin(orgHeading)) + static_cast<float>(tgtPoint.y - orgPoint.y) * cos(orgHeading)};