When used on a busy can bus on Linux/socketcan we had overruns as soo…

pyvit/dispatch.py

@@ -26,6 +26,22 @@ def __init__(self, device, single_process = False):
         self._running = False
         self._single_process = single_process
 
+        #
+        # Will only operate on filters if the underlying can hardware supports 
+        # filtering.
+        #
+        if hasattr(device, 'apply_filters'):
+            self._filter_list = []
+        else:
+            self._filter_list = None
+
+    def add_filter(self, id, mask):
+        if self._filter_list != None:
+            self._filter_list.append((id,mask))
+
+        if self._device.running:
+            self._device.apply_filters(self._filter_list)
+
     def add_receiver(self, rx_queue):
         if self.is_running:
             raise Exception('dispatcher must be stopped to add receiver')
@@ -53,6 +69,9 @@ def start(self):
         if self.is_running:
             raise Exception('dispatcher already running')
 
+        if self._filter_list:
+            self._device.apply_filters(self._filter_list)
+
         self._device.start()
         self._tx_queue = Queue()
 
@@ -78,6 +97,16 @@ def stop(self):
         self._device.stop()
         self._running = False
 
+        #
+        # Clear any data from current queues
+        #
+        for q in self._rx_queues:
+            while not q.empty():
+                q.get()
+        while not self._tx_queue.empty():
+                q.get()
+
+
     @property
     def is_running(self):
         return self._running

pyvit/hw/socketcan.py

@@ -6,6 +6,7 @@
 
 
 class SocketCanDev:
+
     def __init__(self, ndev):
         self.running = False
 
@@ -25,6 +26,23 @@ def start(self):
     def stop(self):
         pass
 
+    def apply_filters(self, filter_list):
+        #
+        # The can_filter struct looks like
+        # struct can_filter{
+        #       uint32_t id;
+        #       uint32_t mask;
+        # };
+        # the *optval is an array of the above structures.  The size of the array 
+        # cannot exceed 512 entries.
+        #
+        encodedArray = b""
+        for (fid, mask) in filter_list:
+            entry = struct.pack('<LL', fid, mask)
+            encodedArray += entry
+
+        self.socket.setsockopt(socket.SOL_CAN_RAW, socket.CAN_RAW_FILTER, encodedArray)
+
     def recv(self):
         assert self.running, 'device not running'
         frame_format = "=IB3xBBBBBBBB"

pyvit/proto/uds.py

@@ -1448,6 +1448,8 @@ def __init__(self, dispatcher=False, tx_arb_id=0x7E0, rx_arb_id=0x7E8, extended_
             self.transport_layer = IsotpNormalAddressing(dispatcher, tx_arb_id)
             self.transport_layer.rx_arb_id = rx_arb_id
 
+        dispatcher.add_filter(id=rx_arb_id, mask=0x7ff)
+
     def request(self, service, timeout=0.5):
         self.transport_layer.send(service.encode())
         if self.transport_layer.N_TAtype == N_TAtype.physical: