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

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

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

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

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

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


led.off()
左轮 = motor.smart_motor(1, direction=False)
左轮.set_soft_break(True)
右轮 = motor.smart_motor(2, direction=True)
右轮.set_soft_break(True)
直行(2.7)
马达停止(1)
后转直角()
马达停止(1)
后退(3)
马达停止(1)
for count in range(2):
    buzzer.play_tone(440, 50)
    time.sleep(0.5)
    buzzer.stop()
    time.sleep(0.5)
led.on()