Vex V5 C++ GPS传感器：定点导航X轴完成后转Y轴的实现方法

你可以在X轴移动逻辑完成后，直接添加Y轴的转向与移动代码，让机器人在到达X目标位置后自动切换到Y轴任务。以下是修改后的完整代码：

void driveTo (int xPos, int yPos) {
  printPos();
  
  // 处理X轴移动
  if(xPos > GPS14.xPosition(mm)){
    Drivetrain.turnToHeading(90, degrees);
    // 添加误差阈值，避免GPS精度问题导致反复启停
    while (GPS14.xPosition(mm) < xPos - 5) {
      Drivetrain.drive(forward);
    }
    Drivetrain.stop();
  } else if(xPos < GPS14.xPosition(mm)){
    Drivetrain.turnToHeading(-90, degrees);
    while (GPS14.xPosition(mm) > xPos + 5) {
      Drivetrain.drive(forward);
    }
    Drivetrain.stop();
  }
  // X轴完成后，处理Y轴移动
  if(yPos > GPS14.yPosition(mm)){
    Drivetrain.turnToHeading(0, degrees);
    while (GPS14.yPosition(mm) < yPos - 5) {
      Drivetrain.drive(forward);
    }
    Drivetrain.stop();
  } else if(yPos < GPS14.yPosition(mm)){
    Drivetrain.turnToHeading(180, degrees);
    while (GPS14.yPosition(mm) > yPos + 5) {
      Drivetrain.drive(forward);
    }
    Drivetrain.stop();
  }
}

int main() {
  driveTo (0, 0);
}

关键修改说明： #

• 调整X轴判断逻辑：直接比较当前X坐标与目标X坐标的大小，避免目标为0时无操作的冗余判断
• 添加误差阈值（5mm）：因为GPS传感器存在精度误差，直接用等于判断会导致机器人频繁启停，设置小范围的阈值可以让移动更稳定
• 新增Y轴处理流程：在X轴移动完成后，根据目标Y坐标的正负转向对应航向（0度为Y正方向，180度为Y负方向），然后执行移动直到到达目标范围
• 逻辑顺序：严格按照先X后Y的顺序执行，X轴任务完成后才会进入Y轴处理，自然实现“停止X轴判断转向Y轴”的需求

内容的提问来源于stack exchange，提问作者Akelly12341241234