如果机器人向左或向右转动，则从角度确定

Question

我正在尝试编写软件，以设计我的机器人的路线。我有两个向量，我试图确定他们相对于彼此的轮到什么（看图像）。我可以计算下面的角度，形式代码，但是不能确定机器人是想左转还是右转。我没有想法......有什么提示吗？

angle = acosf((vNewX*vOldX + vNewY*vOldY)/(NewVectorDistance*OldVectorDistance))*180.0/3.14159;

Answer 1

使用一个向量的atan2与另一个向量的atan2的差异。