Robotics-2018/main.py at master · CosmoV/Robotics-2018 · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
import pyb
import time
import us016
import tcs34725
import vl53l0x
from machine import Pin, I2C

PWMA = Pin('X1', Pin.OUT)
AIN2 = Pin('X2', Pin.OUT)
AIN1 = Pin('X3', Pin.OUT)
STBY = Pin('X4', Pin.OUT)
BIN1 = Pin('X5', Pin.OUT)
BIN2 = Pin('X6', Pin.OUT)
PWMB = Pin('X7', Pin.OUT)

STBY.on()
AIN1.on()
AIN2.off()

# i2c = I2C(scl=Pin('Y9', Pin.OUT), sda=Pin('Y10', Pin.OUT), freq=400000)
# laser_sensor = vl53l0x.VL53L0X(i2c, 0x29)
# laser_sensor.start_continuous(0)
#
# rgb_sensor = tcs34725.TCS34725(i2c)
# us_sensor = us016.US016(pyb.Pin.board.X3, pyb.Pin.board.X4, 3, 3)
#
# rgb_sensor.active(True)
# rgb_sensor.gain(60)
#
# while True:
#     print(tcs34725.html_rgb(sensor.read(True)))
#     print(us_sensor.distance())
#     print(laser_sensor.read_range_continuous_mm())