from motorm import turn  #motorm是樹莓派連結馬達的模組
                         #其中turn這個函數是模組中的馬達運轉函數
# turn(LS,RS,T) # LS=左側輪子的速度; RS=右側輪子的速度; T=馬達運轉的時間秒數
S="""下面的程式中會分別讓自駕車執行下面幾個運轉的動作包括:
1.前轉2秒鐘 2.後退2秒鐘 3.左前行1秒鐘 4.右前行1秒鐘
5.定點左轉2秒鐘 6.定點右轉2秒鐘 7.倒退兩秒鐘\n"""
print(S)
input('按下Enter鍵開始測試馬達... ')
turn(0.3,0.3,2.0); #左輪速度=右輪速度=0.3 --> 直線行進2秒鐘
turn(0.0,0.0,0.5); #左輪速度=右輪速度=0.0 --> 停止0.5秒 
turn(-0.3,-0.3,2.0); #左輪速度=右輪速度=-0.3 --> 直線倒退行走2秒鐘
turn(0.0,0.0,0.5) 
turn(0.2,0.4,1.0); #左輪速度=0.2; 右輪速度=0.4 --> 向左偏轉前行1秒鐘
turn(0.0,0.0,0.5) 
turn(0.4,0.2,1.0); #左輪速度=0.4; 右輪速度=0.2 --> 向右偏轉前行1秒鐘
turn(0.0,0.0,0.5) 
turn(-0.4,0.4,2.0); #左輪速度=-0.4; 右輪速度=0.4 --> 車子在原地左轉2秒鐘
turn(0.0,0.0,0.5) 
turn(0.4,-0.4,2.0); #左輪速度=0.4; 右輪速度=-0.4 --> 車子在原地右轉2秒鐘
turn(0.0,0.0,0.5) 
turn(-0.3,-0.3,2.0); #左輪速度=右輪速度=-0.3 --> 直線倒退行走2秒鐘
print("馬達測試完成")