tmc: Simplify internal DUMP_TMC interface
Only the tmc2208 driver needs special read register translation logic. Rework the code so a default implementation is available for all the other drivers. Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
This commit is contained in:
@@ -189,7 +189,7 @@ class TMC2208:
|
||||
self.mcu_tmc = tmc_uart.MCU_TMC_uart(config, Registers, self.fields)
|
||||
# Register commands
|
||||
cmdhelper = tmc.TMCCommandHelper(config, self.mcu_tmc)
|
||||
cmdhelper.setup_register_dump(self.query_registers)
|
||||
cmdhelper.setup_register_dump(ReadRegisters, self.read_translate)
|
||||
# Setup basic register values
|
||||
self.fields.set_field("pdn_disable", True)
|
||||
self.fields.set_field("mstep_reg_select", True)
|
||||
@@ -215,17 +215,11 @@ class TMC2208:
|
||||
set_config_field(config, "pwm_autograd", True)
|
||||
set_config_field(config, "PWM_REG", 8)
|
||||
set_config_field(config, "PWM_LIM", 12)
|
||||
def query_registers(self, print_time=0.):
|
||||
out = []
|
||||
for reg_name in ReadRegisters:
|
||||
val = self.mcu_tmc.get_register(reg_name)
|
||||
# IOIN has different mappings depending on the driver type
|
||||
# (SEL_A field of IOIN reg)
|
||||
if reg_name == "IOIN":
|
||||
drv_type = self.fields.get_field("SEL_A", val)
|
||||
reg_name = "IOIN@TMC220x" if drv_type else "IOIN@TMC222x"
|
||||
out.append((reg_name, val))
|
||||
return out
|
||||
def read_translate(self, reg_name, val):
|
||||
if reg_name == "IOIN":
|
||||
drv_type = self.fields.get_field("SEL_A", val)
|
||||
reg_name = "IOIN@TMC220x" if drv_type else "IOIN@TMC222x"
|
||||
return reg_name, val
|
||||
|
||||
def load_config_prefix(config):
|
||||
return TMC2208(config)
|
||||
|
||||
Reference in New Issue
Block a user