FLL_65266_LEGO_DYNAMICS/pynamics
1
0
Fork 0
forked from Arcmyx/pynamics
Code Pull Requests Activity

Update diagnostics/MotorDiagnostics.py

Browse Source
This commit is contained in:
Atharv Nagavarapu
2026-01-09 00:01:01 +00:00
parent 53402545c8
commit 6de3ebda08
1 changed files with 2 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

5
diagnostics/MotorDiagnostics.py
View File

@@ -4,7 +4,6 @@ import umath
class MotorDiagnostics: class MotorDiagnostics:
def __init__(self, hub, motorclass): def __init__(self, hub, motorclass):
self.testmotor = None self.testmotor = None
self.motorclass = motorclass
self.port_map = { self.port_map = {
"A": Port.A, "A": Port.A,
"B": Port.B, "B": Port.B,
@@ -13,7 +12,7 @@ class MotorDiagnostics:
"E": Port.E, "E": Port.E,
"F": Port.F, "F": Port.F,
} }
self.motorclass = motorclass
def stdev(self, vals): def stdev(self, vals):
DATA = vals DATA = vals
if len(DATA) < 2: if len(DATA) < 2:
@@ -37,7 +36,7 @@ class MotorDiagnostics:
STABILITY = max(0, 100 - (stdev_speed / desired) * 100) STABILITY = max(0, 100 - (stdev_speed / desired) * 100)
# Normalize load: map 10 to 20 as baseline (around 0%), 200 as max (around 100%) # Normalize load: map 10 to 20 as baseline (around 0%), 200 as max (around 100%)
BASELINE = 15 # midpoint of idle range BASELINE = 10 # midpoint of idle range
MAX_OBSERVED = 200 # heavy load/stall MAX_OBSERVED = 200 # heavy load/stall
NORMALIZED_LOAD = max(0, avg_load - BASELINE) NORMALIZED_LOAD = max(0, avg_load - BASELINE)
LOAD_PCT = min(100, (NORMALIZED_LOAD / (MAX_OBSERVED - BASELINE)) * 100) LOAD_PCT = min(100, (NORMALIZED_LOAD / (MAX_OBSERVED - BASELINE)) * 100)