Files
dragonpilot/tools/zookeeper/power_monitor.py
Adeeb Shihadeh 6757e235f9 little zookeeper fixes (#24861)
* little zookeeper fixes

* bump that up
2022-06-14 20:38:25 -07:00

31 lines
751 B
Python
Executable File

#!/usr/bin/env python3
import sys
import time
from common.realtime import Ratekeeper
from common.filter_simple import FirstOrderFilter
from tools.zookeeper import Zookeeper
if __name__ == "__main__":
z = Zookeeper()
z.set_device_power(True)
z.set_device_ignition(False)
duration = None
if len(sys.argv) > 1:
duration = int(sys.argv[1])
rate = 123
rk = Ratekeeper(rate, print_delay_threshold=None)
fltr = FirstOrderFilter(0, 5, 1. / rate, initialized=False)
try:
start_time = time.monotonic()
while duration is None or time.monotonic() - start_time < duration:
fltr.update(z.read_power())
if rk.frame % rate == 0:
print(f"{fltr.x:.2f} W")
rk.keep_time()
except KeyboardInterrupt:
pass