def stepper_init(ADDRESS = 0x23, MOTOR_ID = 1): # ID 1 / 2
motor = SM28BYJ48(i2c, ADDRESS, MOTOR_ID)
# turn right 90 deg
motor.turn_degree(90, 0)
# turn left 90 deg
motor.turn_degree(90, 1)
return motor
This is simple usage of 28BYJ-48 step motor on ULN2803 driver via PFC8574 I2C expander
Set your expander address and motor id in constants
"""
from machine import Pin, I2C
from lib.sm28byj48 import SM28BYJ48
from utils.pinout import set_pinout
pinout = set_pinout()
#PCF address = 33 #33-0x21/35-0x23
ADDRESS = 0x21
# motor id 1 or 2
MOTOR_ID1 = 1
MOTOR_ID2 = 2
i2c_sda = Pin(pinout.I2C_SDA_PIN, Pin.IN, Pin.PULL_UP)
i2c_scl = Pin(pinout.I2C_SCL_PIN, Pin.OUT, Pin.PULL_UP)
i2c = I2C(scl=i2c_scl, sda=i2c_sda,
freq=100000) # 100kHz as Expander is slow :(
motor1 = SM28BYJ48(i2c, ADDRESS, MOTOR_ID1)
while True:
# turn right 180 deg
motor1.turn_degree(90 * 2)
# turn left 180 deg
motor1.turn_degree(90 * 2, 1)
def octopus_demo():
print()
#global notInitServo
notInitServo = True
global oled
global fet
###beep(pwm0,500,100) # start beep
#tim.init(period=1000, mode=Timer.ONE_SHOT, callback=lambda t:print("test timer - thread delay"))
#tim.init(period=2000, mode=Timer.PERIODIC, callback=lambda t:print(2))
printOctopus()
print("Hello, this is basic octopusLAB example")
print(" (Press Ctrl+C to abort | CTRL+D to soft reboot)")
print()
time.sleep_us(10) # sleep for 10 microseconds
led.blink(500)
time.sleep_ms(300) # 1s
start = time.ticks_ms()
run = True
while run:
sel = mainMenu()
piezzo.beep(1000, 50)
if sel == "a":
print("analog input test: ")
pin_an = Pin(pinout.ANALOG_PIN, Pin.IN)
adc = machine.ADC(pin_an)
an = adc.read()
print("RAW: " + str(an))
# TODO improve mapping formula, doc: https://docs.espressif.com/projects/esp-idf/en/latest/api-reference/peripherals/adc.html
print("volts: {0:.2f} V".format(an / 4096 * 10.74), 20, 50)
if sel == "b":
count = 5
for _ in range(count):
piezzo.beep(500, 100)
led.blink(500)
if sel == "bt":
butt1 = Pin(pinout.BUTT1_PIN, Pin.IN, Pin.PULL_UP)
butt2 = Pin(pinout.BUTT2_PIN, Pin.IN, Pin.PULL_UP)
butt3 = Pin(pinout.BUTT3_PIN, Pin.IN, Pin.PULL_UP)
count = 10
for _ in range(count):
print("b1-" + str(butt1.value())),
print("b2-" + str(butt2.value())),
print("b3-" + str(butt3.value()))
piezzo.beep(500, 100)
led.blink(500)
if sel == "c":
clt()
printOctopus()
if sel == "f":
print("file info /dir/ls:") #
print(os.listdir())
print("> lib: " + str(os.listdir("lib")))
print("> util: " + str(os.listdir("util")))
print("> pinouts: " + str(os.listdir("pinouts")))
i2c_scann()
if sel == "i":
print("System info:")
print("> octopus() ver: " + ver)
from util.sys_info import sys_info
sys_info()
if sel == "m":
time.sleep_ms(500)
from util.buzzer.melody import mario
piezzo.play_melody(mario)
piezzo.nosound()
if sel == "r1": RGBtest()
if sel == "r8":
np = rgb_init(8)
Rainbow()
if sel == "r80":
NUMBER_LED = 8
np = rgb_init(NUMBER_LED)
for i in range(NUMBER_LED):
np[i] = (1, 0, 0)
time.sleep_ms(1) # REVIEW:
np.write()
if sel == "s":
from util.setup import setup
setup()
if sel == "t":
print("temperature >")
from lib.temperature import TemperatureSensor
ts = TemperatureSensor(pinout.ONE_WIRE_PIN)
temp = ts.read_temp()
# print to console
print(temp)
if sel == "w":
w_connect()
if sel == "wr1":
w_connect()
np = rgb_init(1)
import urequests
import json
url1 = "http://octopuslab.cz/api/ws.json"
print(url1)
r1 = urequests.post(url1)
j = json.loads(r1.text)
time.sleep_ms(2000)
print(j["r"])
np[0] = (j["r"], j["g"], j["b"]) #R
np.write()
if sel == "q":
print("machine.reset() and Exit")
time.sleep_ms(1000)
machine.reset()
run = False
if sel == "d":
printOctopus()
print(">>> Display test submenu")
print('=' * 30)
print("--- [od] --- oled display test")
print("--- [os] --- oled 3segment")
print("--- [oi] --- oled display image")
print("--- [m7] --- max display 8x7-segm")
print("--- [m8] --- max display 8x8-matrix")
print("--- [sd] --- serial display")
print("-+- [nd] -+- Nextion display")
print("-+- [id] -+- ink display")
print('=' * 30)
sel_d = input("select: ")
if sel_d == "od":
print("oled display test >")
oled_intit()
oled.fill(1)
oled.show()
time.sleep_ms(300)
oled.fill(0) # reset display
oled.show()
# write text on x, y
oled.text('OLED test', 25, 10)
oled.text(get_hhmm(":", rtc), 45, 29) #time HH:MM
oled.hline(0, 50, 128, 1)
oled.text("octopusLAB 2018", 5, 55) #time HH:MM
oled.show()
time.sleep_ms(1000)
if sel_d == "os":
print("oled segment test >")
oled_intit()
#from util.display_segment import * #???
for num in range(10):
threeDigits(oled, 20 + num, True, True)
time.sleep_ms(50)
if sel_d == "oi":
print("oled image test >")
oled_intit()
import framebuf
IMAGE_WIDTH = 63
IMAGE_HEIGHT = 63
with open('assets/octopus_image.pbm', 'rb') as f:
f.readline() # Magic number
f.readline() # Creator comment
f.readline() # Dimensions
data = bytearray(f.read())
fbuf = framebuf.FrameBuffer(data, IMAGE_WIDTH,
IMAGE_HEIGHT,
framebuf.MONO_HLSB)
# To display just blit it to the display's framebuffer (note you need to invert, since ON pixels are dark on a normal screen, light on OLED).
oled.invert(1)
oled.blit(fbuf, 0, 0)
oled.text("Octopus", 66, 6)
oled.text("Lab", 82, 16)
oled.text("Micro", 74, 35)
oled.text("Python", 70, 45)
oled.show()
if sel_d == "m7":
from lib.max7219_8digit import Display
#spi = SPI(-1, baudrate=100000, polarity=1, phase=0, sck=Pin(14), mosi=Pin(13), miso=Pin(2))
#ss = Pin(15, Pin.OUT)
d7 = Display(spi, ss)
d7.write_to_buffer('12345678')
d7.display()
if sel_d == "m8":
from lib.max7219 import Matrix8x8
d8 = Matrix8x8(spi, ss, 1) #1/4
#print("SPI device already in use")
count = 6
for i in range(count):
d8.fill(0)
d8.text(str(i), 0, 0, 1)
d8.show()
print(i)
time.sleep_ms(500)
d8.fill(0)
d8.show()
if sel_d == "sd":
from machine import UART
uart = UART(2, 9600) #UART2 > #U2TXD(SERVO1/PWM1_PIN)
uart.write('C') #test quick clear display
uart.write('W7') #change color
uart.write('h30') #horizontal line
uart.write('h230') #horizontal line
uart.write('R0')
uart.write('W2') #color
uart.write('QoctopusLAB - UART2 test*')
time.sleep_ms(100)
uart.write('R2')
uart.write('W1') #color
uart.write('QESP32 & ROBOTboard*')
time.sleep_ms(100)
uart.write('R5')
uart.write('W2') #color
num = 9
for i in range(num):
uart.write('Q')
uart.write(str(num - i - 1))
uart.write('*')
time.sleep_ms(500)
if sel == "r":
printOctopus()
print()
print('=' * 30)
print(">>> Boards special test")
print('.' * 30)
print(" Robot board")
print("--- [dc] --- dc motor test")
print("--- [se] --- servo")
print("--- [sm] --- step motor")
print('.' * 30)
print(" IoT board")
print("--- [re] --- relay test")
print("--- [fa] --- pwm fan test")
print("--- [li] --- led fade in")
print("--- [lo] --- led fade out")
print("--- [lp] --- led pulse")
print('=' * 30)
sel_r = input("select: ")
if sel_r == "dc":
print("dc motor test >")
a1 = Pin(pinout.MOTOR_1A, Pin.OUT)
a2 = Pin(pinout.MOTOR_2A, Pin.OUT)
a12 = Pin(pinout.MOTOR_12EN, Pin.OUT)
a3 = Pin(pinout.MOTOR_3A, Pin.OUT)
a4 = Pin(pinout.MOTOR_4A, Pin.OUT)
a34 = Pin(pinout.MOTOR_34EN, Pin.OUT)
a34.value(0)
a12.value(1)
print("a12:10")
a1.value(1)
a2.value(0)
time.sleep_ms(3000)
print("a12:01")
a1.value(0)
a2.value(1)
time.sleep_ms(3000)
a12.value(0)
a34.value(1)
print("a34:01")
a3.value(0)
a4.value(1)
time.sleep_ms(3000)
print("a12:10")
a3.value(1)
a4.value(0)
time.sleep_ms(3000)
a34.value(0)
if sel_r == "se":
print("servo1 test >")
#pwm_center = int(pinout.SERVO_MIN + (pinout.SERVO_MAX-pinout.SERVO_MIN)/2)
pwm_center = 60
#if notInitServo:
print("init-servo:")
pin_servo1 = Pin(pinout.PWM1_PIN, Pin.OUT)
servo1 = PWM(pin_servo1, freq=50, duty=pwm_center)
print("OK")
time.sleep_ms(1500)
#notInitServo = False
time.sleep_ms(1500)
servo1.duty(SERVO_MAX)
time.sleep_ms(1500)
servo1.duty(SERVO_MIN)
time.sleep_ms(1500)
print("degree45")
set_degree(servo1, 45)
if sel_r == "sm":
from lib.sm28byj48 import SM28BYJ48
#PCF address = 35 #33-0x21/35-0x23
ADDRESS = 0x23
# motor id 1 or 2
MOTOR_ID1 = 1
#MOTOR_ID2 = 2
i2c_sda = Pin(pinout.I2C_SDA_PIN, Pin.IN, Pin.PULL_UP)
i2c_scl = Pin(pinout.I2C_SCL_PIN, Pin.OUT, Pin.PULL_UP)
i2c = machine.I2C(scl=i2c_scl, sda=i2c_sda,
freq=100000) # 100kHz as Expander is slow :(
motor1 = SM28BYJ48(i2c, ADDRESS, MOTOR_ID1)
# turn right 90 deg
motor1.turn_degree(90)
# turn left 90 deg
motor1.turn_degree(90, 1)
if sel_r == "re":
print("relay test >")
rel = Pin(pinout.RELAY_PIN, Pin.OUT)
rel.value(1)
time.sleep_ms(3000)
rel.value(0)
if sel_r == "li":
if not fet:
fet = Pin(pinout.MFET_PIN, Pin.OUT)
print("led - pwm fade in - test >")
#lf = PWM(Pin(pinout.MFET_PIN))
#lf.duty(0)
#lf.freq(5000)
#time.sleep_ms(1000)
#for i in range(100):
# lf.duty(i*10)
# time.sleep_ms(20)
fade_in(fet, 500, 5)
if sel_r == "lo":
if not fet:
fet = Pin(pinout.MFET_PIN, Pin.OUT)
print("led - pwm fade out - test >")
#lf = PWM(Pin(pinout.MFET_PIN))
#lf.duty(1000)
#lf.freq(5000)
#time.sleep_ms(1000)
#for i in range(100):
# lf.duty(1000-i*10)
# time.sleep_ms(20)
fade_out(fet, 500, 5)
if sel_r == "lp":
lf = PWM(Pin(pinout.MFET_PIN))
for i in range(5):
pulse(lf, 200)
if sel == "p":
printOctopus()
print()
print(">>> Projects submenu")
print('=' * 30)
print("--- [1] --- temporary")
print("--- [2] --- todo")
print("--- [3] --- ")
print('=' * 30)
sel_p = input("select: ")
if sel_p == "1":
print("project 1 >")
delta = time.ticks_diff(time.ticks_ms(), start) # compute time difference
print("> delta time: " + str(delta))
piezzo.beep(2000, 50)
print("all OK, press CTRL+D to soft reboot")
led.blink(50)