Reorganization: added the display sources files to this repository

Author: casainho

display/3D_print_enclosure/assembly.FCStd

@@ -0,0 +1,28 @@
+import digitalio
+
+class Buttons(object):
+    def __init__(self, power_pin, up_pin, down_pin):
+
+        self._power = digitalio.DigitalInOut(power_pin)
+        self._power.direction = digitalio.Direction.INPUT
+        self._power.pull = digitalio.Pull.UP
+
+        self._up = digitalio.DigitalInOut(up_pin)
+        self._up.direction = digitalio.Direction.INPUT
+        self._up.pull = digitalio.Pull.UP
+
+        self._down = digitalio.DigitalInOut(down_pin)
+        self._down.direction = digitalio.Direction.INPUT
+        self._down.pull = digitalio.Pull.UP
+
+    @property
+    def power(self):
+        return not self._power.value
+
+    @property
+    def up(self):
+        return not self._up.value
+
+    @property
+    def down(self):
+        return not self._down.value

display/3D_print_enclosure/base.FCStd

@@ -0,0 +1,33 @@
+import busio
+import displayio
+import adafruit_displayio_sh1106
+
+class Display(object):
+    def __init__(self, spi_clk_pin, spi_mosi_pin, chip_select_pin, command_pin, reset_pin, spi_clock_frequency):
+
+        displayio.release_displays()
+
+        spi = busio.SPI(
+            spi_clk_pin, # CLK pin
+            spi_mosi_pin, # MOSI pin
+            None) # MISO pin, not need to drive this display
+
+        display_bus = displayio.FourWire(
+            spi,
+            command = command_pin,
+            reset = reset_pin,
+            chip_select = chip_select_pin, # not used but for some reason there is an error if chip_select is None
+            baudrate = spi_clock_frequency)
+
+        WIDTH = 132
+        HEIGHT = 64
+        BORDER = 0
+
+        self._display = adafruit_displayio_sh1106.SH1106(display_bus, width = WIDTH, height = HEIGHT)
+
+        # set the display to vertical mode
+        self._display.rotation = 90
+
+    @property
+    def display(self):
+        return self._display

display/3D_print_enclosure/cover.FCStd

@@ -0,0 +1,160 @@
+import busio
+import struct
+
+class EBikeBoard(object):
+    """EBike_board"""
+    def __init__(self, uart_tx_pin, uart_rx_pin, ebike_data):
+        """EBike_board
+        :param ~microcontroller.Pin uart_tx_pin: UART TX pin that connects to display
+        :param ~microcontroller.Pin uart_tx_pin: UART RX pin that connects to display
+        """
+
+        # configure UART for communications with display
+        self._uart = busio.UART(uart_tx_pin, uart_rx_pin, baudrate=19200, timeout=0.005)
+
+        # init variables
+        self._read_and_unpack__state = 0
+        self._read_and_unpack__len = 0
+        self._read_and_unpack__cnt = 0
+        self._rx_package = RXPackage()
+        self._process_data__error_cnt = 0
+        self._ebike_data = ebike_data
+
+    # code taken from:
+    # https://github.com/LacobusVentura/MODBUS-CRC16
+    def _crc16(self, data):
+
+        table = [ 
+            0x0000, 0xC0C1, 0xC181, 0x0140, 0xC301, 0x03C0, 0x0280, 0xC241,
+            0xC601, 0x06C0, 0x0780, 0xC741, 0x0500, 0xC5C1, 0xC481, 0x0440,
+            0xCC01, 0x0CC0, 0x0D80, 0xCD41, 0x0F00, 0xCFC1, 0xCE81, 0x0E40,
+            0x0A00, 0xCAC1, 0xCB81, 0x0B40, 0xC901, 0x09C0, 0x0880, 0xC841,
+            0xD801, 0x18C0, 0x1980, 0xD941, 0x1B00, 0xDBC1, 0xDA81, 0x1A40,
+            0x1E00, 0xDEC1, 0xDF81, 0x1F40, 0xDD01, 0x1DC0, 0x1C80, 0xDC41,
+            0x1400, 0xD4C1, 0xD581, 0x1540, 0xD701, 0x17C0, 0x1680, 0xD641,
+            0xD201, 0x12C0, 0x1380, 0xD341, 0x1100, 0xD1C1, 0xD081, 0x1040,
+            0xF001, 0x30C0, 0x3180, 0xF141, 0x3300, 0xF3C1, 0xF281, 0x3240,
+            0x3600, 0xF6C1, 0xF781, 0x3740, 0xF501, 0x35C0, 0x3480, 0xF441,
+            0x3C00, 0xFCC1, 0xFD81, 0x3D40, 0xFF01, 0x3FC0, 0x3E80, 0xFE41,
+            0xFA01, 0x3AC0, 0x3B80, 0xFB41, 0x3900, 0xF9C1, 0xF881, 0x3840,
+            0x2800, 0xE8C1, 0xE981, 0x2940, 0xEB01, 0x2BC0, 0x2A80, 0xEA41,
+            0xEE01, 0x2EC0, 0x2F80, 0xEF41, 0x2D00, 0xEDC1, 0xEC81, 0x2C40,
+            0xE401, 0x24C0, 0x2580, 0xE541, 0x2700, 0xE7C1, 0xE681, 0x2640,
+            0x2200, 0xE2C1, 0xE381, 0x2340, 0xE101, 0x21C0, 0x2080, 0xE041,
+            0xA001, 0x60C0, 0x6180, 0xA141, 0x6300, 0xA3C1, 0xA281, 0x6240,
+            0x6600, 0xA6C1, 0xA781, 0x6740, 0xA501, 0x65C0, 0x6480, 0xA441,
+            0x6C00, 0xACC1, 0xAD81, 0x6D40, 0xAF01, 0x6FC0, 0x6E80, 0xAE41,
+            0xAA01, 0x6AC0, 0x6B80, 0xAB41, 0x6900, 0xA9C1, 0xA881, 0x6840,
+            0x7800, 0xB8C1, 0xB981, 0x7940, 0xBB01, 0x7BC0, 0x7A80, 0xBA41,
+            0xBE01, 0x7EC0, 0x7F80, 0xBF41, 0x7D00, 0xBDC1, 0xBC81, 0x7C40,
+            0xB401, 0x74C0, 0x7580, 0xB541, 0x7700, 0xB7C1, 0xB681, 0x7640,
+            0x7200, 0xB2C1, 0xB381, 0x7340, 0xB101, 0x71C0, 0x7080, 0xB041,
+            0x5000, 0x90C1, 0x9181, 0x5140, 0x9301, 0x53C0, 0x5280, 0x9241,
+            0x9601, 0x56C0, 0x5780, 0x9741, 0x5500, 0x95C1, 0x9481, 0x5440,
+            0x9C01, 0x5CC0, 0x5D80, 0x9D41, 0x5F00, 0x9FC1, 0x9E81, 0x5E40,
+            0x5A00, 0x9AC1, 0x9B81, 0x5B40, 0x9901, 0x59C0, 0x5880, 0x9841,
+            0x8801, 0x48C0, 0x4980, 0x8941, 0x4B00, 0x8BC1, 0x8A81, 0x4A40,
+            0x4E00, 0x8EC1, 0x8F81, 0x4F40, 0x8D01, 0x4DC0, 0x4C80, 0x8C41,
+            0x4400, 0x84C1, 0x8581, 0x4540, 0x8701, 0x47C0, 0x4680, 0x8641,
+            0x8201, 0x42C0, 0x4380, 0x8341, 0x4100, 0x81C1, 0x8081, 0x4040
+        ]
+
+        xor = 0
+        crc = 0xFFFF
+        for byte in data:
+            xor = (byte ^ crc) & 0xff
+            crc >>= 8
+            crc ^= table[xor]
+            crc &= 0xFFFF # important, crc must stay 16bits all the way through
+
+        return crc
+
+    def _read_and_unpack(self):
+        # only read next data bytes after we process the previous package
+        if self._rx_package.received == False:
+            rx_array = self._uart.read()
+            if rx_array is not None:
+                for data in rx_array:
+                    # find start byte
+                    if self._read_and_unpack__state == 0:
+                        if (data == 0x59):
+                            self._rx_package.data[0] = data
+                            self._read_and_unpack__state = 1
+                        else:
+                            self._read_and_unpack__state = 0
+
+                    # len byte
+                    elif self._read_and_unpack__state == 1:
+                        self._rx_package.data[1] = data
+                        self._read_and_unpack__len = data
+                        self._read_and_unpack__state = 2
+
+                    # rest of the package
+                    elif self._read_and_unpack__state == 2:
+                        self._rx_package.data[self._read_and_unpack__cnt  + 2] = data
+                        self._read_and_unpack__cnt += 1
+
+                        # end of the package
+                        if self._read_and_unpack__cnt >= self._read_and_unpack__len:
+                            
+                            # print(",".join(["0x{:02X}".format(i) for i in self._rx_package.data[0: self._read_and_unpack__len]]))
+
+                            # calculate the CRC
+                            crc = self._crc16(self._rx_package.data[0: self._read_and_unpack__len])
+                            # get the original CRC
+                            crc_original = struct.unpack_from('<H', self._rx_package.data, self._read_and_unpack__len)[0]
+                            
+                            # check if CRC is ok                    
+                            self._rx_package.received = True if crc == crc_original else False
+
+                            self._process_data__error_cnt = 0
+                            self._read_and_unpack__cnt = 0
+                            self._read_and_unpack__state = 0
+                        else:
+                            # keep increasing error counter
+                            self._process_data__error_cnt += 1
+
+    def _process_data(self):
+        if self._rx_package.received == True:
+            self._ebike_data.battery_voltage = struct.unpack_from('<H', self._rx_package.data, 2)[0] / 100.0
+            self._ebike_data.battery_current = self._rx_package.data[4] / 5.0
+            self._ebike_data.motor_power = struct.unpack_from('<H', self._rx_package.data, 5)[0]
+            self._ebike_data.vesc_temperature_x10 = struct.unpack_from('<H', self._rx_package.data, 7)[0]
+            self._ebike_data.motor_temperature_sensor_x10 = struct.unpack_from('<H', self._rx_package.data, 9)[0]
+            self._ebike_data.vesc_fault_code = self._rx_package.data[11]
+            self._ebike_data.brakes_are_active = self._rx_package.data[12]
+
+            self._rx_package.received = False # signal that next package can be processed
+                
+    def _send_data(self):
+        # start building the TX package
+        # start byte + len byte + [package type + xx data bytes] + CRC 2 bytes
+        # len = count([package type + xx data bytes] + CRC 2 bytes)
+        tx_array = bytearray(255)
+        tx_array[0] = 0x59
+        _len = 2 # start byte + len byte
+
+        tx_array[2] = int(self._ebike_data.assist_level)
+        _len += 1
+
+        # final building of the TX package
+        tx_array[1] = _len
+
+        # calculate the CRC
+        crc = self._crc16(tx_array[0: _len])
+        struct.pack_into('<H', tx_array, _len, crc) # CRC: 2 bytes
+
+        # send packet to UART
+        self._uart.write(tx_array[0: _len + 2])
+
+        # print(",".join(["0x{:02X}".format(i) for i in tx_array[0: _len + 2]]))
+
+    # read and process UART data
+    def process_data(self):
+        self._read_and_unpack()
+        self._process_data()
+        self._send_data()
+
+class RXPackage():
+    data = bytearray(255)
+    received = False

display/3D_print_enclosure/round.FCStd

@@ -0,0 +1,21 @@
+import time
+
+class EBike(object):
+
+    def __init__(self):
+        self.vesc_fault_code = 0
+        self.battery_voltage = 0
+        self.battery_current = 0
+        self.motor_power = 0
+        self.motor_current = 0
+        self.motor_speed_erpm = 0
+        self.previous_motor_current_target = True
+        self.brakes_are_active = False
+        self.torque_weight = 0
+        self.cadence = 0
+        self.ramp_last_time = time.monotonic_ns()
+        self.motor_current_target = 0
+        self.assist_level = 0
+        self.vesc_temperature_x10 = 0
+        self.motor_temperature_sensor_x10 = 0
+