Test python for encoder
This commit is contained in:
ZodiusInfuser
parent
15978e5ddc
commit
e3c3692e31
|
|
@ -3,6 +3,7 @@ from pimoroni_i2c import PimoroniI2C
|
|||
from breakout_ioexpander import BreakoutIOExpander
|
||||
from adafruit_is31fl3731 import IS31FL3731
|
||||
import sys
|
||||
from machine import I2C, Pin
|
||||
|
||||
PINS_BREAKOUT_GARDEN = {"sda": 4, "scl": 5}
|
||||
PINS_PICO_EXPLORER = {"sda": 20, "scl": 21}
|
||||
|
|
@ -18,8 +19,15 @@ ENC_TERM_B = 12
|
|||
|
||||
ENC_CHANNEL = 1
|
||||
|
||||
i2c = PimoroniI2C(**PINS_BREAKOUT_GARDEN)
|
||||
ioe = BreakoutIOExpander(i2c, address=0x18)
|
||||
#i2c = PimoroniI2C(**PINS_BREAKOUT_GARDEN)
|
||||
i2c = I2C(0, sda=Pin(4), scl=Pin(5))
|
||||
ioe = BreakoutIOExpander(i2c, address=0x18)#, interrupt=3)
|
||||
ioe.enable_interrupt_out(pin_swap=True)
|
||||
#ioe.set_address(0x13)
|
||||
|
||||
#2c.writeto(0x18, bytearray([0xF9, 0x06]))
|
||||
#i2c.writeto(0x18, bytearray([0x00, 0b11000000]))
|
||||
#i2c.writeto(0x18, bytearray([0x01, 0b00110001]))
|
||||
|
||||
ioe.set_mode(s1_pin, BreakoutIOExpander.PIN_IN_PU)
|
||||
ioe.set_mode(s2_pin, BreakoutIOExpander.PIN_IN_PU)
|
||||
|
|
@ -30,9 +38,18 @@ ioe.set_mode(s5_pin, BreakoutIOExpander.PIN_IN_PU)
|
|||
ioe.setup_rotary_encoder(ENC_CHANNEL, ENC_TERM_A, ENC_TERM_B, 6, count_microsteps=True)
|
||||
#ioe.set_mode(ENC_TERM_A, BreakoutIOExpander.PIN_IN_PU)
|
||||
#ioe.set_mode(ENC_TERM_B, BreakoutIOExpander.PIN_IN_PU)
|
||||
ioe.set_pin_interrupt(s1_pin, True)
|
||||
ioe.set_pin_interrupt(s2_pin, True)
|
||||
ioe.set_pin_interrupt(s3_pin, True)
|
||||
ioe.set_pin_interrupt(s4_pin, True)
|
||||
ioe.set_pin_interrupt(s5_pin, True)
|
||||
|
||||
display = IS31FL3731(i2c, address=0x77)
|
||||
#display.fill(10)
|
||||
display2 = IS31FL3731(i2c, address=0x77-3)
|
||||
display.fill(10)
|
||||
display2.fill(10)
|
||||
|
||||
time.sleep(1)
|
||||
|
||||
mapping = ((128, 32, 48),
|
||||
(129, 33, 49),
|
||||
|
|
@ -106,6 +123,14 @@ last_count = -1
|
|||
last_enc_a = False
|
||||
last_enc_b = False
|
||||
|
||||
toggler = False
|
||||
|
||||
import sys
|
||||
from machine import Pin
|
||||
p15 = Pin(15, Pin.OUT)
|
||||
p15.value(True)
|
||||
|
||||
last_sp = 0
|
||||
|
||||
while True:
|
||||
s1 = bool(ioe.input(s1_pin))
|
||||
|
|
@ -148,24 +173,45 @@ while True:
|
|||
print("Right (S5) has been pressed")
|
||||
last_s5 = s5
|
||||
|
||||
count = ioe.read_rotary_encoder(ENC_CHANNEL) // 2
|
||||
if ioe.get_interrupt_flag():
|
||||
ioe.clear_interrupt_flag()
|
||||
|
||||
count = ioe.read_rotary_encoder(ENC_CHANNEL) // 2
|
||||
if count != last_count:
|
||||
if count - last_count > 0:
|
||||
print("Clockwise, Count = ", count)
|
||||
else:
|
||||
print("Counter Clockwise, Count = ", count)
|
||||
|
||||
if count == 0 and (last_count > 1 or last_count < -1):
|
||||
p15.value(False)
|
||||
#sys.exit()
|
||||
|
||||
last_single = mapping[last_count % 24]
|
||||
display.pixel(last_single[0], 0, 0)
|
||||
display.pixel(last_single[1], 0, 0)
|
||||
display.pixel(last_single[2], 0, 0)
|
||||
display2.pixel(last_single[0], 0, 0)
|
||||
display2.pixel(last_single[1], 0, 0)
|
||||
display2.pixel(last_single[2], 0, 0)
|
||||
single = mapping[count % 24]
|
||||
r, g, b = hsv_to_rgb(count / 24, 1.0, 1.0)
|
||||
display.pixel(single[0], 0, int(255 * r))
|
||||
display.pixel(single[1], 0, int(255 * g))
|
||||
display.pixel(single[2], 0, int(255 * b))
|
||||
display2.pixel(single[0], 0, int(255 * r))
|
||||
display2.pixel(single[1], 0, int(255 * g))
|
||||
display2.pixel(single[2], 0, int(255 * b))
|
||||
last_count = count
|
||||
|
||||
|
||||
i2c.writeto(0x13, bytearray([0x41]))
|
||||
sp = i2c.readfrom(0x13, 1)
|
||||
if sp != last_sp:
|
||||
print("SP =", sp)
|
||||
last_sp = sp
|
||||
|
||||
|
||||
'''
|
||||
enc_a = bool(ioe.input(ENC_TERM_A))
|
||||
enc_b = bool(ioe.input(ENC_TERM_B))
|
||||
|
|
@ -185,4 +231,4 @@ while True:
|
|||
last_enc_b = enc_b
|
||||
'''
|
||||
|
||||
time.sleep(0.005)
|
||||
#time.sleep(0.001)
|
||||
|
|
@ -0,0 +1,69 @@
|
|||
import time
|
||||
from pimoroni_i2c import PimoroniI2C
|
||||
from breakout_ioexpander import BreakoutIOExpander
|
||||
from adafruit_is31fl3731 import IS31FL3731
|
||||
import sys
|
||||
from machine import I2C, Pin
|
||||
|
||||
PINS_BREAKOUT_GARDEN = {"sda": 4, "scl": 5}
|
||||
PINS_PICO_EXPLORER = {"sda": 20, "scl": 21}
|
||||
|
||||
ENC_TERM_A = 3
|
||||
ENC_TERM_B = 12
|
||||
|
||||
ENC_CHANNEL = 1
|
||||
|
||||
#i2c = PimoroniI2C(**PINS_BREAKOUT_GARDEN)
|
||||
i2c = I2C(0, sda=Pin(4), scl=Pin(5))
|
||||
ioe = BreakoutIOExpander(i2c, address=0x18)
|
||||
|
||||
ioe.setup_rotary_encoder(ENC_CHANNEL, ENC_TERM_A, ENC_TERM_B, 6, count_microsteps=True)
|
||||
#ioe.set_mode(ENC_TERM_A, BreakoutIOExpander.PIN_IN_PU)
|
||||
#ioe.set_mode(ENC_TERM_B, BreakoutIOExpander.PIN_IN_PU)
|
||||
|
||||
last_count = -1
|
||||
|
||||
last_enc_a = False
|
||||
last_enc_b = False
|
||||
|
||||
import sys
|
||||
from machine import Pin
|
||||
p15 = Pin(15, Pin.OUT)
|
||||
p15.value(True)
|
||||
|
||||
last_sp = 0
|
||||
|
||||
while True:
|
||||
count = ioe.read_rotary_encoder(ENC_CHANNEL) // 2
|
||||
if count != last_count:
|
||||
if count - last_count > 0:
|
||||
print("Clockwise, Count = ", count)
|
||||
else:
|
||||
print("Counter Clockwise, Count = ", count)
|
||||
|
||||
if count == 0 and (last_count > 1 or last_count < -1):
|
||||
p15.value(False)
|
||||
#sys.exit()
|
||||
|
||||
last_count = count
|
||||
|
||||
'''
|
||||
enc_a = bool(ioe.input(ENC_TERM_A))
|
||||
enc_b = bool(ioe.input(ENC_TERM_B))
|
||||
|
||||
if enc_a is not last_enc_a:
|
||||
if enc_a:
|
||||
print("ENC A high")
|
||||
else:
|
||||
print("ENC A low")
|
||||
last_enc_a = enc_a
|
||||
|
||||
if enc_b is not last_enc_b:
|
||||
if enc_b:
|
||||
print("ENC B high")
|
||||
else:
|
||||
print("ENC B low")
|
||||
last_enc_b = enc_b
|
||||
'''
|
||||
|
||||
#time.sleep(0.001)
|
||||
|
|
@ -0,0 +1,456 @@
|
|||
import time
|
||||
from pimoroni_i2c import PimoroniI2C
|
||||
from breakout_ioexpander import BreakoutIOExpander
|
||||
from adafruit_is31fl3731 import IS31FL3731
|
||||
import sys
|
||||
from machine import I2C, Pin
|
||||
|
||||
PINS_BREAKOUT_GARDEN = {"sda": 4, "scl": 5}
|
||||
PINS_PICO_EXPLORER = {"sda": 20, "scl": 21}
|
||||
|
||||
ENC_TERM_A = 1
|
||||
ENC_TERM_B = 3
|
||||
|
||||
ENC_CHANNEL = 1
|
||||
|
||||
#i2c = PimoroniI2C(**PINS_BREAKOUT_GARDEN)
|
||||
i2c = I2C(0, sda=Pin(4), scl=Pin(5))
|
||||
#ioe = BreakoutIOExpander(i2c, address=0x18)
|
||||
|
||||
NUM_PINS=20
|
||||
|
||||
I2C_ADDR = 0x16
|
||||
CHIP_ID = 0x510E
|
||||
CHIP_VERSION = 2
|
||||
|
||||
REG_CHIP_ID_L = 0xfa
|
||||
REG_CHIP_ID_H = 0xfb
|
||||
REG_VERSION = 0xfc
|
||||
|
||||
# Rotary encoder
|
||||
REG_ENC_EN = 0x04
|
||||
BIT_ENC_EN_1 = 0
|
||||
BIT_ENC_MICROSTEP_1 = 1
|
||||
BIT_ENC_EN_2 = 2
|
||||
BIT_ENC_MICROSTEP_2 = 3
|
||||
BIT_ENC_EN_3 = 4
|
||||
BIT_ENC_MICROSTEP_3 = 5
|
||||
BIT_ENC_EN_4 = 6
|
||||
BIT_ENC_MICROSTEP_4 = 7
|
||||
|
||||
REG_ENC_1_CFG = 0x05
|
||||
REG_ENC_1_COUNT = 0x06
|
||||
REG_ENC_2_CFG = 0x07
|
||||
REG_ENC_2_COUNT = 0x08
|
||||
REG_ENC_3_CFG = 0x09
|
||||
REG_ENC_3_COUNT = 0x0A
|
||||
REG_ENC_4_CFG = 0x0B
|
||||
REG_ENC_4_COUNT = 0x0C
|
||||
|
||||
# Cap touch
|
||||
REG_CAPTOUCH_EN = 0x0D
|
||||
REG_CAPTOUCH_CFG = 0x0E
|
||||
REG_CAPTOUCH_0 = 0x0F # First of 8 bytes from 15-22
|
||||
|
||||
# Switch counters
|
||||
REG_SWITCH_EN_P0 = 0x17
|
||||
REG_SWITCH_EN_P1 = 0x18
|
||||
REG_SWITCH_P00 = 0x19 # First of 8 bytes from 25-40
|
||||
REG_SWITCH_P10 = 0x21 # First of 8 bytes from 33-49
|
||||
|
||||
REG_USER_FLASH = 0xD0
|
||||
REG_FLASH_PAGE = 0xF0
|
||||
REG_DEBUG = 0xF8
|
||||
|
||||
REG_P0 = 0x40 # Bit addressing
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
REG_RWKL = 0x46
|
||||
REG_TCON = 0x48
|
||||
REG_TMOD = 0x49
|
||||
REG_TL0 = 0x4a
|
||||
REG_TL1 = 0x4b
|
||||
REG_TH0 = 0x4c
|
||||
REG_TH1 = 0x4d
|
||||
REG_CKCON = 0x4e
|
||||
REG_WKCON = 0x4f
|
||||
REG_P1 = 0x50 # Bit addressing
|
||||
|
||||
REG_CAPCON0 = 0x52
|
||||
REG_CAPCON1 = 0x53
|
||||
REG_CAPCON2 = 0x54
|
||||
REG_CKDIV = 0x55
|
||||
REG_CKSWT = 0x56 # TA protected
|
||||
REG_CKEN = 0x57 # TA protected
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
REG_P2 = 0x60 # Bit addressing
|
||||
REG_AUXR1 = 0x62
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
REG_WDCON = 0x6a # TA protected
|
||||
|
||||
REG_P3M1 = 0x6c
|
||||
REG_P3M2 = 0x6d
|
||||
REG_P3 = 0x70 # Bit addressing
|
||||
REG_P0M1 = 0x71
|
||||
REG_P0M2 = 0x72
|
||||
REG_P1M1 = 0x73
|
||||
REG_P1M2 = 0x74
|
||||
REG_ADCRL = 0x82
|
||||
REG_ADCRH = 0x83
|
||||
REG_T3CON = 0x84
|
||||
REG_RL3 = 0x85
|
||||
REG_RH3 = 0x86
|
||||
REG_T2CON = 0x88
|
||||
REG_T2MOD = 0x89
|
||||
REG_RCMP2L = 0x8a
|
||||
REG_RCMP2H = 0x8b
|
||||
REG_TL2 = 0x8c
|
||||
REG_TH2 = 0x8d
|
||||
REG_ADCMPL = 0x8e
|
||||
REG_ADCMPH = 0x8f
|
||||
REG_PWM0PH = 0x91
|
||||
REG_PWM0C0H = 0x92
|
||||
REG_PWM0C1H = 0x93
|
||||
REG_PWM0C2H = 0x94
|
||||
REG_PWM0C3H = 0x95
|
||||
REG_PNP = 0x96
|
||||
REG_PWM0FBD = 0x97
|
||||
REG_PWM0CON0 = 0x98
|
||||
REG_PWM0PL = 0x99
|
||||
REG_PWM0C0L = 0x9a
|
||||
REG_PWM0C1L = 0x9b
|
||||
REG_PWM0C2L = 0x9c
|
||||
REG_PWM0C3L = 0x9d
|
||||
REG_PIOCON0 = 0x9e
|
||||
REG_PWM0CON1 = 0x9f
|
||||
REG_ADCCON1 = 0xa1
|
||||
REG_ADCCON2 = 0xa2
|
||||
REG_ADCDLY = 0xa3
|
||||
REG_C0L = 0xa4
|
||||
REG_C0H = 0xa5
|
||||
REG_C1L = 0xa6
|
||||
REG_C1H = 0xa7
|
||||
REG_ADCCON0 = 0xa8
|
||||
REG_C2L = 0xad
|
||||
REG_C2H = 0xae
|
||||
REG_CAPCON3 = 0xb1
|
||||
REG_CAPCON4 = 0xb2
|
||||
REG_SPCR = 0xb3
|
||||
REG_SPSR = 0xb4
|
||||
REG_SPDR = 0xb5
|
||||
REG_AINDIDS0 = 0xb6
|
||||
REG_PWM0DTEN = 0xb9 # TA protected
|
||||
REG_PWM0DTCNT = 0xba # TA protected
|
||||
REG_PWM0MEN = 0xbb
|
||||
REG_PWM0MD = 0xbc
|
||||
REG_P3S = 0x41
|
||||
REG_P3SR = 0x42
|
||||
REG_P0S = 0x43
|
||||
REG_P0SR = 0x44
|
||||
REG_P1S = 0x45
|
||||
REG_P1SR = 0x47
|
||||
REG_PWM0C4H = 0x51
|
||||
REG_PWM0C5H = 0x58
|
||||
REG_PIOCON1 = 0x59
|
||||
REG_PWM0C4L = 0x5a
|
||||
REG_PWM0C5L = 0x5b
|
||||
REG_SPCR2 = 0x5c
|
||||
REG_ADCBAL = 0x5d
|
||||
REG_ADCBAH = 0x5e
|
||||
REG_ADCCON3 = 0x5f
|
||||
REG_P2M1 = 0x61
|
||||
REG_P2M2 = 0x63
|
||||
REG_P2SR = 0x64
|
||||
REG_P2S = 0x65
|
||||
REG_ADCSN = 0x66
|
||||
REG_ADCCN = 0x67
|
||||
REG_ADCSR = 0x68
|
||||
REG_P0UP = 0x69
|
||||
REG_P1UP = 0x6b
|
||||
REG_P2UP = 0x6e
|
||||
REG_P3UP = 0x6f
|
||||
REG_RWKH = 0x75
|
||||
REG_AINDIDS1 = 0x76
|
||||
REG_P0DW = 0x77
|
||||
REG_P1DW = 0x78
|
||||
REG_P2DW = 0x79
|
||||
REG_P3DW = 0x7a
|
||||
REG_AUXR4 = 0x7b
|
||||
REG_AUXR5 = 0x7c
|
||||
REG_AUXR7 = 0x7d
|
||||
REG_AUXR8 = 0x7e
|
||||
REG_PWM1PH = 0x7f
|
||||
REG_PWM1C0H = 0x80
|
||||
REG_PWM1C1H = 0x81
|
||||
REG_PWM1MD = 0x87
|
||||
REG_PWM1MEN = 0x90
|
||||
REG_PWM1PL = 0xa0
|
||||
REG_PWM1C0L = 0xa9
|
||||
REG_PWM1C1L = 0xaa
|
||||
REG_PWM1CON0 = 0xab
|
||||
REG_PWM1CON1 = 0xac
|
||||
REG_PIOCON2 = 0xaf
|
||||
REG_PWM2PH = 0xb0
|
||||
REG_PWM2C0H = 0xb7
|
||||
REG_PWM2C1H = 0xb8
|
||||
REG_PWM2MD = 0xbd
|
||||
REG_PWM2MEN = 0xbe
|
||||
REG_PWM2PL = 0xbf
|
||||
REG_PWM2C0L = 0xc0
|
||||
REG_PWM2C1L = 0xc1
|
||||
REG_PWM2CON0 = 0xc2
|
||||
REG_PWM2CON1 = 0xc3
|
||||
REG_PWM3PH = 0xc4
|
||||
REG_PWM3C0H = 0xc5
|
||||
REG_PWM3C1H = 0xc6
|
||||
REG_PWM3MD = 0xc7
|
||||
REG_PWM3MEN = 0xc8
|
||||
REG_PWM3PL = 0xc9
|
||||
REG_PWM3C0L = 0xca
|
||||
REG_PWM3C1L = 0xcb
|
||||
REG_PWM3CON0 = 0xcc
|
||||
REG_PWM3CON1 = 0xcd
|
||||
|
||||
REG_INT = 0xf9
|
||||
MASK_INT_TRIG = 0x1
|
||||
MASK_INT_OUT = 0x2
|
||||
BIT_INT_TRIGD = 0
|
||||
BIT_INT_OUT_EN = 1
|
||||
BIT_INT_PIN_SWAP = 2 # 0 = P1.3, 1 = P0.0
|
||||
|
||||
REG_INT_MASK_P0 = 0x00
|
||||
REG_INT_MASK_P1 = 0x01
|
||||
REG_INT_MASK_P2 = 0x02
|
||||
REG_INT_MASK_P3 = 0x03
|
||||
|
||||
|
||||
REG_VERSION = 0xfc
|
||||
REG_ADDR = 0xfd
|
||||
|
||||
REG_CTRL = 0xfe # 0 = Sleep, 1 = Reset, 2 = Read Flash, 3 = Write Flash, 4 = Addr Unlock
|
||||
MASK_CTRL_SLEEP = 0x1
|
||||
MASK_CTRL_RESET = 0x2
|
||||
MASK_CTRL_FREAD = 0x4
|
||||
MASK_CTRL_FWRITE = 0x8
|
||||
MASK_CTRL_ADDRWR = 0x10
|
||||
|
||||
# Special mode registers, use a bit-addressing scheme to avoid
|
||||
# writing the *whole* port and smashing the i2c pins
|
||||
BIT_ADDRESSED_REGS = [REG_P0, REG_P1, REG_P2, REG_P3]
|
||||
|
||||
reg_m1 = (REG_P0M1, REG_P1M1, -1, REG_P3M1)
|
||||
reg_m2 = (REG_P0M2, REG_P1M2, -1, REG_P3M2)
|
||||
reg_p = (REG_P0, REG_P1, -1, REG_P3)
|
||||
reg_ps = (REG_P0S, REG_P1S, REG_P2S, REG_P3S)
|
||||
|
||||
adc_ports = ((0, 4), (0, 5), (0, 6))
|
||||
|
||||
PIN_MODE_IO = 0b00000 # General IO mode, IE: not ADC or PWM
|
||||
PIN_MODE_QB = 0b00000 # Output, Quasi-Bidirectional mode
|
||||
PIN_MODE_PP = 0b00001 # Output, Push-Pull mode
|
||||
PIN_MODE_IN = 0b00010 # Input-only (high-impedance)
|
||||
PIN_MODE_PU = 0b10000 # Input (with pull-up)
|
||||
PIN_MODE_OD = 0b00011 # Output, Open-Drain mode
|
||||
PIN_MODE_PWM = 0b00101 # PWM, Output, Push-Pull mode
|
||||
PIN_MODE_ADC = 0b01010 # ADC, Input-only (high-impedance)
|
||||
|
||||
def read_reg(reg):
|
||||
i2c.writeto(0x16, bytearray([reg]))
|
||||
return i2c.readfrom(0x16, 1)[0]
|
||||
|
||||
def write_reg(reg, val):
|
||||
i2c.writeto(0x16, bytearray([reg, val]))
|
||||
|
||||
def set_bits(reg, bits):
|
||||
"""Set the specified bits (using a mask) in a register."""
|
||||
if reg in BIT_ADDRESSED_REGS:
|
||||
for bit in range(8):
|
||||
if bits & (1 << bit):
|
||||
write_reg(reg, 0b1000 | (bit & 0b111))
|
||||
else:
|
||||
value = read_reg(reg)
|
||||
time.sleep(0.001)
|
||||
write_reg(reg, value | bits)
|
||||
|
||||
def set_bit(reg, bit):
|
||||
"""Set the specified bit (nth position from right) in a register."""
|
||||
set_bits(reg, (1 << bit))
|
||||
|
||||
def clr_bits(reg, bits):
|
||||
"""Clear the specified bits (using a mask) in a register."""
|
||||
if reg in BIT_ADDRESSED_REGS:
|
||||
for bit in range(8):
|
||||
if bits & (1 << bit):
|
||||
write_reg(reg, 0b0000 | (bit & 0b111))
|
||||
else:
|
||||
value = read_reg(reg)
|
||||
time.sleep(0.001)
|
||||
write_reg(reg, value & ~bits)
|
||||
|
||||
def clr_bit(reg, bit):
|
||||
"""Clear the specified bit (nth position from right) in a register."""
|
||||
clr_bits(reg, (1 << bit))
|
||||
|
||||
def change_bit(reg, bit, state):
|
||||
"""Toggle one register bit on/off."""
|
||||
if state:
|
||||
set_bit(reg, bit)
|
||||
else:
|
||||
clr_bit(reg, bit)
|
||||
|
||||
def set_mode(pin, mode, schmitt_trigger, invert=False):
|
||||
if pin < 1 or pin > NUM_PINS:
|
||||
printf("ValueError: Pin should be in range 1-14.\n");
|
||||
return;
|
||||
|
||||
io_pin = adc_ports[pin - 1]
|
||||
|
||||
gpio_mode = mode & 0b11;
|
||||
io_type = (mode >> 2) & 0b11;
|
||||
initial_state = mode >> 4;
|
||||
|
||||
pm1 = read_reg(reg_m1[io_pin[0]]);
|
||||
pm2 = read_reg(reg_m2[io_pin[0]]);
|
||||
|
||||
# Clear the pm1 and pm2 bits
|
||||
pm1 &= 255 - (1 << io_pin[1]);
|
||||
pm2 &= 255 - (1 << io_pin[1]);
|
||||
|
||||
# Set the new pm1 and pm2 bits according to our gpio_mode
|
||||
pm1 |= (gpio_mode >> 1) << io_pin[1];
|
||||
pm2 |= (gpio_mode & 0b1) << io_pin[1];
|
||||
|
||||
write_reg(reg_m1[io_pin[0]], pm1)
|
||||
write_reg(reg_m2[io_pin[0]], pm2)
|
||||
|
||||
# Set up Schmitt trigger mode on inputs
|
||||
if mode == PIN_MODE_PU:
|
||||
change_bit(reg_ps[io_pin[0]], io_pin[1], schmitt_trigger)
|
||||
|
||||
# 5th bit of mode encodes default output pin state
|
||||
#write_reg(reg_p[io_pin[0]], (initial_state << 3) | io_pin[1])
|
||||
|
||||
def output(pin, value):
|
||||
if pin < 1 or pin > NUM_PINS:
|
||||
raise ValueError("Pin should be in range 1-14.")
|
||||
|
||||
io_pin = adc_ports[pin - 1]
|
||||
|
||||
if value == False:
|
||||
clr_bit(reg_p[io_pin[0]], io_pin[1])
|
||||
elif value == True:
|
||||
set_bit(reg_p[io_pin[0]], io_pin[1])
|
||||
|
||||
def setup_rotary_encoder(channel, pin_a, pin_b, pin_c, count_microsteps):
|
||||
channel -= 1;
|
||||
set_mode(pin_a, PIN_MODE_PU, True);
|
||||
set_mode(pin_b, PIN_MODE_PU, True);
|
||||
|
||||
if pin_c != 0:
|
||||
set_mode(pin_c, PIN_MODE_OD, False)
|
||||
output(pin_c, 0)
|
||||
|
||||
write_reg(0x06, pin_a | (pin_b << 4))
|
||||
change_bit(REG_ENC_EN, (channel * 2) + 1, count_microsteps)
|
||||
set_bit(REG_ENC_EN, channel * 2)
|
||||
|
||||
# Reset internal encoder count to zero
|
||||
write_reg(0x06, 0x00);
|
||||
|
||||
"""
|
||||
read_reg(0xFB)
|
||||
read_reg(0xFA)
|
||||
|
||||
read_reg(0x9E)
|
||||
write_reg(0x9E, 0x00)
|
||||
read_reg(0x73)
|
||||
read_reg(0x74)
|
||||
write_reg(0x73, 0x88)
|
||||
write_reg(0x74, 0x02)
|
||||
read_reg(0xC4)
|
||||
write_reg(0xC4, 0x04)
|
||||
write_reg(0x50, 0x0A)
|
||||
read_reg(0xC9)
|
||||
write_reg(0xC9, 0x00)
|
||||
read_reg(0x71)
|
||||
read_reg(0x72)
|
||||
write_reg(0x71, 0x03)
|
||||
write_reg(0x72, 0x1A)
|
||||
read_reg(0xC2)
|
||||
write_reg(0xC2, 0x20)
|
||||
#write_reg(0x40, 0x0D)
|
||||
time.sleep(0.01)
|
||||
|
||||
read_reg(0x9E)
|
||||
write_reg(0x9E, 0x00)
|
||||
|
||||
read_reg(0x71)
|
||||
read_reg(0x72)
|
||||
write_reg(0x71, 0x03)
|
||||
write_reg(0x72, 0x1A)
|
||||
#write_reg(0x40, 0x01)
|
||||
#write_reg(0x40, 0x01)
|
||||
|
||||
write_reg(0x05, 0xC3)
|
||||
read_reg(0x04)
|
||||
#write_reg(0x04, 0x03)
|
||||
read_reg(0x04)
|
||||
#write_reg(0x04, 0x03)
|
||||
write_reg(0x06, 0x00)
|
||||
"""
|
||||
|
||||
setup_rotary_encoder(ENC_CHANNEL, ENC_TERM_A, ENC_TERM_B, 0, count_microsteps=True)
|
||||
|
||||
|
||||
last_count = -1
|
||||
|
||||
last_enc_a = False
|
||||
last_enc_b = False
|
||||
|
||||
toggler = False
|
||||
|
||||
import sys
|
||||
from machine import Pin
|
||||
p15 = Pin(15, Pin.OUT)
|
||||
p15.value(True)
|
||||
|
||||
last_sp = 0
|
||||
|
||||
while True:
|
||||
count = read_reg(0x06) // 2
|
||||
#count = ioe.read_rotary_encoder(ENC_CHANNEL) // 2
|
||||
if count != last_count:
|
||||
if count - last_count > 0:
|
||||
print("Clockwise, Count = ", count)
|
||||
else:
|
||||
print("Counter Clockwise, Count = ", count)
|
||||
|
||||
if count == 0 and (last_count > 1 or last_count < -1):
|
||||
p15.value(False)
|
||||
#sys.exit()
|
||||
|
||||
last_count = count
|
||||
|
||||
#i2c.writeto(0x18, bytearray([0x41]))
|
||||
#sp = i2c.readfrom(0x18, 1)
|
||||
|
||||
#if sp != last_sp:
|
||||
# print("SP =", sp)
|
||||
#last_sp = sp
|
||||
|
||||
#time.sleep(0.001)
|
||||
Loading…
Reference in New Issue