import time
import supply_voltage #导入它，开启电量指示呼吸灯功能
import motor

直行时间 = None
停止时间 = None
后退时间 = None

def 直行(直行时间):
    global 停止时间, 后退时间
    左轮.openloop_turn(50)
    右轮.openloop_turn(50)
    time.sleep(直行时间)

def 左转直角():
    global 直行时间, 停止时间, 后退时间
    左轮.openloop_turn((-50))
    右轮.openloop_turn(50)
    time.sleep(0.6)

def 右转直角():
    global 直行时间, 停止时间, 后退时间
    左轮.openloop_turn(50)
    右轮.openloop_turn((-50))
    time.sleep(0.6)

def 马达停止(停止时间):
    global 直行时间, 后退时间
    左轮.openloop_turn(0)
    右轮.openloop_turn(0)
    time.sleep(停止时间)

def 后退(后退时间):
    global 直行时间, 停止时间
    左轮.openloop_turn((-50))
    右轮.openloop_turn((-50))
    time.sleep(后退时间)


左轮 = motor.smart_motor(1, direction=False)
左轮.set_soft_break(True)
右轮 = motor.smart_motor(2, direction=True)
右轮.set_soft_break(True)
直行(1)
左转直角()
直行(2)
马达停止(1)
左转直角()
直行(0.5)
马达停止(1)
后退(0.5)
马达停止(1)
左转直角()
马达停止(1)
直行(1)
左转直角()
直行(0.5)
右转直角()
直行(0.5)
左转直角()
马达停止(1)