坐标

yy1717

2020-11-24 6e0f29b08a040d14576d7053c1206a8439936570

 lib/src/main/cpp/test_common/Geometry.cpp

@@ -358,6 +358,19 @@
    return deg;
}

double DeltaYaw(double yaw1, double yaw2)
{
    double deltaAng;

    if (fabs(yaw1 - yaw2) > 180.0) {
        deltaAng = 360.0 - fabs(yaw1 - yaw2);
    } else {
        deltaAng = fabs(yaw1 - yaw2);
    }

    return deltaAng;
}

/**********************************************************
 * base 和 dest的第二点重合时形成的夹角
 * @param base