FTC电机执行Run to Position后持续运转无法停止，求排查方案

针对你遇到的电机执行Run to Position模式后不停转的问题，从代码和硬件层面排查以下关键点：

核心排查方向 #

• 编码器复位异常：代码中执行STOP_AND_RESET_ENCODER后，编码器可能未真正归零，导致目标位置计算偏差，电机永远认为未到达目标。可以在复位后加入遥测确认数值是否为0。
• 模式切换顺序问题：部分电机控制器对模式切换的顺序敏感，建议先设置目标位置，再切换到RUN_TO_POSITION模式，或在设置目标后重新确认模式。
• 未手动切断功率：虽然RUN_TO_POSITION理论上到达位置后会自动停转，但部分硬件可能存在延迟或误差，导致电机持续微调。循环结束后需手动设置setPower(0)。
• 电机方向与编码器计数不匹配：若电机方向反转但编码器计数方向未同步，电机可能向相反方向转动，永远无法到达目标位置。可手动转动电机，观察getCurrentPosition()的变化是否符合预期。
• 目标位置过小：100脉冲的目标位置对于高分辨率编码器（如NeveRest 40的1120脉冲/转）来说仅为极小角度，可能因硬件检测延迟导致isBusy()无法正确触发结束。建议先测试大目标位置（如1000）。

修改后的测试代码 #

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="EncoderTestOneThousand", group="Autonomous")
public class EncoderTestOneThousand extends LinearOpMode {
    private DcMotor main;
    private int mainPos;

    @Override
    public void runOpMode() {
        main = hardwareMap.get(DcMotor.class, "main");
        // 确保编码器完全复位归零
        main.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
        while (main.getCurrentPosition() != 0 && opModeIsActive()) {
            telemetry.addData("复位中", main.getCurrentPosition());
            telemetry.update();
        }
        main.setDirection(DcMotorSimple.Direction.REVERSE);
        main.setMode(DcMotor.RunMode.RUN_USING_ENCODER);
        mainPos = 0;
        telemetry.addData("就绪", "编码器已归零");
        telemetry.update();
        waitForStart();
        drive(1000, 0.5); // 先测试大目标位置
    }

    private void drive(int mainTarget, double speed) {
        mainPos += mainTarget;
        main.setTargetPosition(mainPos);
        main.setMode(DcMotor.RunMode.RUN_TO_POSITION);
        main.setPower(speed);
        
        // 实时输出状态，方便调试
        while (opModeIsActive() && main.isBusy()) {
            telemetry.addData("目标位置", mainPos);
            telemetry.addData("当前位置", main.getCurrentPosition());
            telemetry.addData("电机繁忙", main.isBusy());
            telemetry.update();
            idle();
        }
        
        // 手动停止电机，避免持续运转
        main.setPower(0);
        main.setMode(DcMotor.RunMode.RUN_USING_ENCODER);
    }
}

修改说明 #

1. 增加编码器复位确认循环，确保计数归零
2. 初始设置为RUN_USING_ENCODER模式，避免模式切换冲突
3. 加入遥测数据，实时观察目标位置、当前位置和电机状态
4. 循环结束后手动切断电机功率，并切换回常规编码器模式
5. 改用1000脉冲的目标位置，更容易验证电机是否能正常停转

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