aboutsummaryrefslogtreecommitdiffstats
path: root/System/Pendulum/encoder.py
diff options
context:
space:
mode:
authorMatt Strapp <matt@mattstrapp.net>2022-02-18 12:41:51 -0600
committerMatt Strapp <matt@mattstrapp.net>2022-02-18 12:41:51 -0600
commit1337de59b712c30c447b2b45de9ec54ecd6d8ea4 (patch)
tree6c0fc73eeee869bd01392a849fc547a2552cb919 /System/Pendulum/encoder.py
parentChange git repo to organization repos (diff)
downloadee4511w-1337de59b712c30c447b2b45de9ec54ecd6d8ea4.tar
ee4511w-1337de59b712c30c447b2b45de9ec54ecd6d8ea4.tar.gz
ee4511w-1337de59b712c30c447b2b45de9ec54ecd6d8ea4.tar.bz2
ee4511w-1337de59b712c30c447b2b45de9ec54ecd6d8ea4.tar.lz
ee4511w-1337de59b712c30c447b2b45de9ec54ecd6d8ea4.tar.xz
ee4511w-1337de59b712c30c447b2b45de9ec54ecd6d8ea4.tar.zst
ee4511w-1337de59b712c30c447b2b45de9ec54ecd6d8ea4.zip
Hopefully get the system able to be packaged
Signed-off-by: Matt Strapp <matt@mattstrapp.net>
Diffstat (limited to 'System/Pendulum/encoder.py')
-rw-r--r--System/Pendulum/encoder.py77
1 files changed, 77 insertions, 0 deletions
diff --git a/System/Pendulum/encoder.py b/System/Pendulum/encoder.py
new file mode 100644
index 0000000..ece7fd1
--- /dev/null
+++ b/System/Pendulum/encoder.py
@@ -0,0 +1,77 @@
+# Import required modules
+import RPi.GPIO as GPIO
+import time
+import math
+
+# Constants: parameters that the caller cannot modify
+# Delay: Minimum delay necessary after pull pin low to read input
+delay = 0.0000005
+
+# Encoder Class
+# This controls the motor at the given IO
+class Encoder:
+ def __init__(self, clk_pin, cs_pin, data_pin):
+ # Set the board IO (just in case it hasn't been done yet)
+ GPIO.setmode(GPIO.BCM)
+ # Setup class varaiable
+ self.offset = 0
+ self.clk_pin = clk_pin
+ self.cs_pin = cs_pin
+ self.data_pin = data_pin
+ # Setup the IO
+ try:
+ GPIO.setup(self.clk_pin, GPIO.OUT)
+ GPIO.setup(self.cs_pin, GPIO.OUT)
+ GPIO.setup(self.data_pin, GPIO.IN)
+ # Setup the CS and CLK to be high
+ GPIO.output(PIN_CLK, 1)
+ GPIO.output(PIN_CS, 1)
+ except:
+ # If this fails, it's likely because the IO has already been configured. The encoders share some pins. Ignore the failure
+ time.sleep(0.01) # Used just to have something in the exception catch
+ #print("ERROR. Unable to setup the configuration required")
+ # Wait some time to before reading
+ time.sleep(0.5)
+ def set_zero(self, offset = 0):
+ # Take current position as zero
+ pos = self.read_position('Raw')
+ self.offset = (self.read_position('Raw') + self.offset + offset) % 1024
+ def clockup(self):
+ GPIO.output(self.clk_pin, 1)
+ def clockdown(self):
+ GPIO.output(self.clk_pin, 0)
+ def read_position(self, format):
+ # Most of this is based of timing diagram of encoder
+ # Pull CS low to start reading
+ GPIO.output(self.cs_pin, 0)
+ # Delay necessary before reading is ready
+ time.sleep(delay*2)
+ data = 0
+ # Clockdown necessary before reading
+ self.clockdown()
+ # Go through 10 bits needed to read
+ for i in range(0, 10):
+ # Clock up to start reading one bit
+ self.clockup()
+ # Shift data left and insert input
+ data <<= 1
+ data |= GPIO.input(self.data_pin)
+ # Clock down after finish reading
+ self.clockdown()
+ # Pull CS high after finish reading
+ GPIO.output(self.cs_pin, 1)
+ # Format with offset, Max is 1024
+ data = (data - self.offset) % 1024
+ # Data is linearly mapped
+ if format=="Raw":
+ return data
+ elif format == "Degrees":
+ degrees = (data/1024.0) * 360.0
+ return degrees
+ elif format == "Radians":
+ radians = (data/1024.0) * (2.0*math.pi)
+ return radians
+ else:
+ print("ERROR. Invalid format (Raw, Degrees, Radians)")
+ return None
+