Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- ma = Motor(Port.A)
- mb = Motor(Port.B)
- mc = Motor(Port.C)
- gyro = GyroSensor(Port.S1)
- flag = 1
- # Функция, проезда по квадрату при помощи гироскопа
- def square_gyro1():
- for i in range(4):
- ma.run(480)
- mb.run(480)
- wait(2000)
- ma.stop()
- mb.stop()
- gyro.reset_angle(0)
- while gyro.angle() < 90:
- ma.run(300)
- # Функция, проезда по квадрату при помощи гироскопа, альтернативная
- def square_gyro2():
- for i in range(4):
- ma.run_time(480,2000,wait=False)
- mb.run_time(480,2000)
- gyro.reset_angle(0)
- while gyro.angle() < 90:
- ma.run(300)
- # функция проезда прямо на указанное расстояние
- def forward(n):
- s = n/17.6 # в оборотах
- s = s * 360 # в градусах
- ma.run_angle(300,s,wait=False)
- mb.run_angle(300,s)
- # функция поворота на указанный угол
- def rotate(angle, dist):
- c = dist * 2 * 3.14 #длинна окружности
- s = int(c* angle / 17.6) #градусов надо провернуть
- ma.run_angle(200,s)
- # проезд по квадрату, со стороной 30 см
- for i in range(4):
- forward(30)
- rotate(90,15)
- # функция закрытия/открытия клешни
- def clap():
- mc.run_angle(100,180*flag)
- flag = -flag
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement