Mittwertbildung des Speedsensors
Der Speedsesnor braucht ein gleitenden Mittelwert wegen sensorscheibe. Dies muss im Treiber selbst implementiert werden. Nutzt die Queue von FreeRTOS und eine Summe um die zeiten zu mitteln. Elemet aus Queeue popen -> von summe abziehen -> neues Element zur summe hinzufügen -> neues Elemet zur in Queeue hinzufügen.