c – 我如何找到一个物体在航点之前或之后？

我希望它如何工作是我在赛道上的不同点制作航点,
然后我运行我的航路点检查以查看汽车是否超过了下一个航点(下一个“需要”过去),如果是,那么它会更新下一个航点,否则什么都没有.

我希望这将起作用的方式是,我制作一个从n到n 1的向量,然后在n处找到与第一个向量垂直的向量.然后我看看对象是在该向量的前面还是后面.
我找到了一个帮助我实现此功能的Gamedev.net forumpost：

void Engine::checkWaypoint(Vehicle* vehicle)
{
  btVector3 vector = waypoints[vehicle->nextWaypoint];
  // n
  btVector3 nextVector = waypoints[vehicle->nextWaypoint + 1];
  // n+1
  vector = nextVector - vector;
  // First vector
  btVector3 pos = btVector3(vehicle->position.X,vehicle->position.Y,vehicle->position.Z);

  float product = vector.dot(pos - waypoints[vehicle->nextWaypoint]);
  // positiv = before,negative = behind

  if(product < 0)
    vehicle->nextWaypoint += 1;
}

目前的错误是：

>更新下一个点而不是经过一个新点.
>当它到达终点并重置时,它会停止在第一个航路点上触发.

所以我的问题：

这是一个很好的方法吗？

我做得对吗？