使用摇杆按钮与Flag控制伺服夹爪：Flag无法更新故障排查

我用摇杆按钮和Flag控制带伺服电机的夹爪，按钮点击能被检测到，但Flag始终无法更新。通过0.1秒间隔对比按钮状态，状态变化时Flag本该递增却没生效，试过声明全局Flag也没用，求解决办法。

原代码 #

def gripperLogic(flag): 
    flag = (flag + 1 ) % 4 #here flag should increase
    if flag == 1 and clenchAngle<minAngle:
        while flag==1:
            for i in range(clenchAngle,maxAngle+1):
                servo.position(index=0,degrees=i)
                flagcalc()
                if(flag!=1):
                    break
            if(flag!=1):
                    break
        print("\nServo is gripping the object") #servowrite to be written here
    elif flag == 2 and clenchAngle <= minAngle:
        print("\nServo has gripped the object") #servowrite to be written here
    elif flag == 3 and clenchAngle >= minAngle and clenchAngle < maxAngle:
        while flag==3:
            for i in range(clenchAngle,minAngle - 1 ,-1):
                servo.position(index=0,degrees=i)
                flagcalc()
                if(flag!=3):
                    break
            if(flag!=3):
                    break
        print("\nServo is releasing the object") #servowrite to be written here
    elif flag == 0 and clenchAngle <= maxAngle and clenchAngle > minAngle:
        print("\nServo has now released the object") #servowrite to be written here
    return flag
def flagcalc():
    flag=0
    grptmp = grip.value()
    reltmp = release.value()
    print("\n Gripper state " +str(grptmp) + "releaser state " + str(reltmp))
    utime.sleep(0.1)
    grpcmp = grip.value()
    relcmp = release.value()
    if grptmp != grpcmp or relcmp != reltmp:
            flag = gripperLogic(flag)     

def main():
    while True:
        flag=0
        grptmp = grip.value()
        reltmp = release.value()
        print("\n Gripper state " +str(grptmp) + " releaser state " + str(reltmp) + " flag " + str(flag))
        utime.sleep(0.1)
        grpcmp = grip.value()
        relcmp = release.value()
        
        if grptmp != grpcmp or relcmp != reltmp:
            flag = gripperLogic(flag)     
            
        
if __name__ == "__main__":
    main()

核心问题 #

1. 主循环每次重置Flag：main()的while循环里每次都执行flag=0，直接覆盖了所有之前的修改，导致状态无法保留。
2. 递归调用导致状态混乱：gripperLogic调用flagcalc，flagcalc又调用gripperLogic，形成嵌套递归，Flag的更新无法正确传递回主循环。
3. 局部变量作用域问题：flagcalc()里的flag是局部变量，调用gripperLogic后返回的值无法传递到主循环中。
4. 角度判断逻辑错误：原代码中clenchAngle < minAngle这类条件不符合夹紧/松开的实际逻辑，应该和maxAngle做对比。

修复后的代码 #

import utime

# 请根据实际硬件初始化以下对象和变量
# grip = 摇杆夹紧按钮的GPIO对象
# release = 摇杆松开按钮的GPIO对象
# servo = 伺服电机控制对象
# clenchAngle = 当前夹爪角度，初始值请根据实际设置
# minAngle = 夹爪松开的最小角度
# maxAngle = 夹爪夹紧的最大角度

def gripperLogic(current_flag): 
    # 递增Flag并取模4，实现循环切换
    new_flag = (current_flag + 1) % 4
    
    if new_flag == 1 and clenchAngle < maxAngle:
        # 执行夹紧动作
        for i in range(clenchAngle, maxAngle + 1):
            servo.position(index=0, degrees=i)
            clenchAngle = i  # 更新当前角度
            utime.sleep(0.01)  # 给伺服电机预留响应时间
            # 检测按钮状态，允许中途打断
            if grip.value() != 0 or release.value() != 0:
                break
        print("Servo is gripping the object")
    
    elif new_flag == 2:
        print("Servo has gripped the object")
    
    elif new_flag == 3 and clenchAngle > minAngle:
        # 执行松开动作
        for i in range(clenchAngle, minAngle - 1, -1):
            servo.position(index=0, degrees=i)
            clenchAngle = i  # 更新当前角度
            utime.sleep(0.01)
            if grip.value() != 0 or release.value() != 0:
                break
        print("Servo is releasing the object")
    
    elif new_flag == 0:
        print("Servo has now released the object")
    
    return new_flag

def is_button_pressed():
    # 检测按钮状态变化（消抖）
    initial_grip = grip.value()
    initial_release = release.value()
    utime.sleep(0.1)
    return grip.value() != initial_grip or release.value() != initial_release

def main():
    flag = 0  # Flag初始化放在循环外，保留状态
    while True:
        print(f"Gripper state: {grip.value()} | Release state: {release.value()} | Flag: {flag}")
        if is_button_pressed():
            flag = gripperLogic(flag)
        utime.sleep(0.1)
        
if __name__ == "__main__":
    main()

关键修复说明 #

• Flag持久化：把flag的初始化移到main()的while循环外，避免每次循环重置为0，确保状态能被保留。
• 移除递归调用：取消gripperLogic和flagcalc的嵌套调用，按钮检测统一放在主循环中，逻辑更清晰，避免状态丢失。
• 更新角度变量：在伺服运动时同步更新clenchAngle，确保后续的状态判断准确。
• 修正角度判断条件：将夹紧/松开的触发条件改为和maxAngle/minAngle的合理对比，符合实际运动逻辑。
• 简化按钮检测：抽离按钮检测为独立函数，主逻辑更简洁。

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