坐标

yy1717

2020-04-03 7ad5b81283c39e66ba2ca84314e283f277fc77e0

 lib/src/main/cpp/test_items/stop_and_start.cpp

@@ -90,7 +90,7 @@
    {
        double dis2 = DistanceOfTire2Edge(map, car);

        MA_SendDistance(-1, dis2);
        MA_SendDistance(DistanceOf(map->point[8], map->point[7]) - dis2, dis2);
    }

    if (prevMoveDirect != moveDirect) {
@@ -262,7 +262,13 @@
    // 全车都需不在地图中
    bool ret = false;

    Polygon carBody;
    Polygon carBody, map2;
    PointF vPoint = Calc3Point(map->point[8], map->point[0], DistanceOf(map->point[8], map->point[7]), 'R');

    map2.num = 4;
    map2.point = (PointF *)malloc(map2.num * sizeof(PointF));

    MakePolygon(&map2, {vPoint, map->point[0], map->point[7], map->point[8]});

    carBody.num = car->bodyNum;
    carBody.point = (PointF *)malloc(carBody.num * sizeof(PointF));
@@ -270,11 +276,11 @@
        carBody.point[i] = car->carXY[car->body[i]];
    }

    if (IntersectionOf(&carBody, map) == GM_None) {
    if (IntersectionOf(&carBody, &map2) == GM_None) {
        ret = true;
    }

    free(carBody.point);

    free(map2.point);
    return ret;
}