FTC机器人设置Encoder驱动100Ticks后持续运行故障排查

核心问题1：电机初始化错误 #

你在初始化left和right变量时，连续两次赋值导致只有单个电机被绑定，另外两个电机完全没被调用：

left = hardwareMap.get(DcMotor.class, "frontLeftMotor");
left = hardwareMap.get(DcMotor.class, "backLeftMotor"); // 覆盖了前一行的frontLeftMotor

right = hardwareMap.get(DcMotor.class, "frontRightMotor");
right = hardwareMap.get(DcMotor.class, "backRightMotor"); // 覆盖了前一行的frontRightMotor

这会导致机器人仅两个电机工作，编码器反馈也只来自这两个电机，逻辑上的左右电机组未建立，直接引发运动失控。

核心问题2：RUN_TO_POSITION模式设置顺序错误 #

FTC电机控制逻辑中，必须先设置电机模式为RUN_USING_ENCODER，再设置目标位置，最后切换到RUN_TO_POSITION，否则目标位置可能无法生效。

修复后的完整代码 #

package org.firstinspires.ftc.teamcode.drive.auto;

import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.hardware.DcMotor;
import com.qualcomm.robotcore.hardware.DcMotorSimple;

@Autonomous(name="encoderAutoRB", group="Autonomous")
public class encoderAutoRB extends LinearOpMode {

    // 单独定义四个电机，避免变量覆盖
    private DcMotor frontLeft;
    private DcMotor backLeft;
    private DcMotor frontRight;
    private DcMotor backRight;

    private int leftTargetTotal;
    private int rightTargetTotal;

    @Override
    public void runOpMode() {
        // 初始化所有四个电机
        frontLeft = hardwareMap.get(DcMotor.class, "frontLeftMotor");
        backLeft = hardwareMap.get(DcMotor.class, "backLeftMotor");
        frontRight = hardwareMap.get(DcMotor.class, "frontRightMotor");
        backRight = hardwareMap.get(DcMotor.class, "backRightMotor");

        // 重置所有电机编码器
        frontLeft.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
        backLeft.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
        frontRight.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
        backRight.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);

        // 设置右电机反转（根据硬件配置调整）
        frontRight.setDirection(DcMotorSimple.Direction.REVERSE);
        backRight.setDirection(DcMotorSimple.Direction.REVERSE);

        // 初始目标位置设为0
        leftTargetTotal = 0;
        rightTargetTotal = 0;

        waitForStart();

        move(100, 100, 0.5);
    }

    private void move(int leftTarget, int rightTarget, double speed) {
        leftTargetTotal += leftTarget;
        rightTargetTotal += rightTarget;

        // 先切换到RUN_USING_ENCODER模式
        frontLeft.setMode(DcMotor.RunMode.RUN_USING_ENCODER);
        backLeft.setMode(DcMotor.RunMode.RUN_USING_ENCODER);
        frontRight.setMode(DcMotor.RunMode.RUN_USING_ENCODER);
        backRight.setMode(DcMotor.RunMode.RUN_USING_ENCODER);

        // 设置所有电机的目标位置
        frontLeft.setTargetPosition(leftTargetTotal);
        backLeft.setTargetPosition(leftTargetTotal);
        frontRight.setTargetPosition(rightTargetTotal);
        backRight.setTargetPosition(rightTargetTotal);

        // 切换到RUN_TO_POSITION模式
        frontLeft.setMode(DcMotor.RunMode.RUN_TO_POSITION);
        backLeft.setMode(DcMotor.RunMode.RUN_TO_POSITION);
        frontRight.setMode(DcMotor.RunMode.RUN_TO_POSITION);
        backRight.setMode(DcMotor.RunMode.RUN_TO_POSITION);

        // 设置电机功率
        frontLeft.setPower(speed);
        backLeft.setPower(speed);
        frontRight.setPower(speed);
        backRight.setPower(speed);

        // 等待所有电机到达目标位置
        while (opModeIsActive() && 
               frontLeft.isBusy() && backLeft.isBusy() && 
               frontRight.isBusy() && backRight.isBusy()) {
            idle();
        }

        // 到达位置后停止电机
        frontLeft.setPower(0);
        backLeft.setPower(0);
        frontRight.setPower(0);
        backRight.setPower(0);
    }
}

额外优化说明 #

• 增加了到达目标位置后自动停电机的逻辑，避免空转
• 单独定义每个电机，确保所有电机参与运动和编码器反馈
• 严格遵循FTC电机模式设置顺序，确保目标位置被正确识别

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