2021-07-19 07:43:25 +00:00
|
|
|
# encoder_portable.py
|
|
|
|
|
2017-07-07 06:00:56 +00:00
|
|
|
# Encoder Support: this version should be portable between MicroPython platforms
|
2021-07-19 07:43:25 +00:00
|
|
|
# Thanks to Evan Widloski for the adaptation to use the machine module
|
|
|
|
|
|
|
|
# Copyright (c) 2017-2021 Peter Hinch
|
|
|
|
# Released under the MIT License (MIT) - see LICENSE file
|
2017-07-07 06:00:56 +00:00
|
|
|
|
|
|
|
from machine import Pin
|
|
|
|
|
2021-07-19 07:43:25 +00:00
|
|
|
class Encoder:
|
2021-10-07 22:57:33 +00:00
|
|
|
def __init__(self, pin_a, pin_b, scale=1):
|
2017-07-07 06:00:56 +00:00
|
|
|
self.scale = scale
|
|
|
|
self.forward = True
|
2021-10-07 22:57:33 +00:00
|
|
|
self.pin_a = pin_a
|
|
|
|
self.pin_b = pin_b
|
2017-07-07 06:00:56 +00:00
|
|
|
self._pos = 0
|
2021-07-19 07:43:25 +00:00
|
|
|
try:
|
2021-10-07 22:57:33 +00:00
|
|
|
self.a_interrupt = pin_a.irq(trigger=Pin.IRQ_RISING | Pin.IRQ_FALLING, handler=self.a_callback, hard=True)
|
|
|
|
self.b_interrupt = pin_b.irq(trigger=Pin.IRQ_RISING | Pin.IRQ_FALLING, handler=self.b_callback, hard=True)
|
2021-07-19 07:43:25 +00:00
|
|
|
except TypeError:
|
2021-10-07 22:57:33 +00:00
|
|
|
self.a_interrupt = pin_a.irq(trigger=Pin.IRQ_RISING | Pin.IRQ_FALLING, handler=self.a_callback)
|
|
|
|
self.b_interrupt = pin_b.irq(trigger=Pin.IRQ_RISING | Pin.IRQ_FALLING, handler=self.b_callback)
|
2017-07-07 06:00:56 +00:00
|
|
|
|
2021-07-19 07:43:25 +00:00
|
|
|
def x_callback(self, pin):
|
2021-10-07 22:57:33 +00:00
|
|
|
self.forward = pin() ^ self.pin_b()
|
2017-07-07 06:00:56 +00:00
|
|
|
self._pos += 1 if self.forward else -1
|
|
|
|
|
2021-07-19 07:43:25 +00:00
|
|
|
def y_callback(self, pin):
|
2021-10-07 22:57:33 +00:00
|
|
|
self.forward = self.pin_a() ^ pin() ^ 1
|
2017-07-07 06:00:56 +00:00
|
|
|
self._pos += 1 if self.forward else -1
|
|
|
|
|
2021-07-19 07:43:25 +00:00
|
|
|
def position(self, value=None):
|
|
|
|
if value is not None:
|
|
|
|
self._pos = value // self.scale
|
2017-07-07 06:00:56 +00:00
|
|
|
return self._pos * self.scale
|