mirror of
https://github.com/sunnypilot/sunnypilot.git
synced 2026-07-20 08:02:07 +08:00
Jason Wen
2f33f13f8b
version: sunnypilot v0.9.7.0 release date: 2024-08-11T04:16:15 master commit: c0df551c5bbd296a1e272c1878535dec14b4e7ad
19 lines
449 B
Python
19 lines
449 B
Python
class FirstOrderFilter:
|
|
# first order filter
|
|
def __init__(self, x0, rc, dt, initialized=True):
|
|
self.x = x0
|
|
self.dt = dt
|
|
self.update_alpha(rc)
|
|
self.initialized = initialized
|
|
|
|
def update_alpha(self, rc):
|
|
self.alpha = self.dt / (rc + self.dt)
|
|
|
|
def update(self, x):
|
|
if self.initialized:
|
|
self.x = (1. - self.alpha) * self.x + self.alpha * x
|
|
else:
|
|
self.initialized = True
|
|
self.x = x
|
|
return self.x
|