retropilot
/
openpilot
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

add low pass filter on cpu temp (#1305)

albatross
Willem Melching 2020-04-01 15:58:40 -07:00 committed by GitHub
parent 30d4d64b4c
commit b497a01417
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
2 changed files with 9 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
common/filter_simple.py
View File

@ -6,5 +6,4 @@ class FirstOrderFilter():
def update(self, x): def update(self, x):
self.x = (1. - self.k) * self.x + self.k * x self.x = (1. - self.k) * self.x + self.k * x
return self.x

10
selfdrive/thermald/thermald.py
View File

@ -25,6 +25,7 @@ ThermalStatus = log.ThermalData.ThermalStatus
NetworkType = log.ThermalData.NetworkType NetworkType = log.ThermalData.NetworkType
NetworkStrength = log.ThermalData.NetworkStrength NetworkStrength = log.ThermalData.NetworkStrength
CURRENT_TAU = 15. # 15s time constant CURRENT_TAU = 15. # 15s time constant
CPU_TEMP_TAU = 5. # 5s time constant
DAYS_NO_CONNECTIVITY_MAX = 7 # do not allow to engage after a week without internet DAYS_NO_CONNECTIVITY_MAX = 7 # do not allow to engage after a week without internet
DAYS_NO_CONNECTIVITY_PROMPT = 4 # send an offroad prompt after 4 days with no internet DAYS_NO_CONNECTIVITY_PROMPT = 4 # send an offroad prompt after 4 days with no internet
@ -173,6 +174,7 @@ def thermald_thread():
network_strength = NetworkStrength.unknown network_strength = NetworkStrength.unknown
current_filter = FirstOrderFilter(0., CURRENT_TAU, DT_TRML) current_filter = FirstOrderFilter(0., CURRENT_TAU, DT_TRML)
cpu_temp_filter = FirstOrderFilter(0., CPU_TEMP_TAU, DT_TRML)
health_prev = None health_prev = None
fw_version_match_prev = True fw_version_match_prev = True
current_connectivity_alert = None current_connectivity_alert = None
@ -230,8 +232,12 @@ def thermald_thread():
current_filter.update(msg.thermal.batteryCurrent / 1e6) current_filter.update(msg.thermal.batteryCurrent / 1e6)
# TODO: add car battery voltage check # TODO: add car battery voltage check
max_cpu_temp = max(msg.thermal.cpu0, msg.thermal.cpu1, max_cpu_temp = cpu_temp_filter.update(
msg.thermal.cpu2, msg.thermal.cpu3) / 10.0 max(msg.thermal.cpu0,
msg.thermal.cpu1,
msg.thermal.cpu2,
msg.thermal.cpu3) / 10.0)
max_comp_temp = max(max_cpu_temp, msg.thermal.mem / 10., msg.thermal.gpu / 10.) max_comp_temp = max(max_cpu_temp, msg.thermal.mem / 10., msg.thermal.gpu / 10.)
bat_temp = msg.thermal.bat / 1000. bat_temp = msg.thermal.bat / 1000.