X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=decoders%2Fstepper_motor%2Fpd.py;h=b6ff9b105960c0a269de6818970f7a6cb8ac2fc2;hb=991c44f33a55733610f6d9da1efbcc5bf1074dee;hp=8a1c2e11eca5b7cf89bb64854b9e55d0c674506f;hpb=92b7b49f6964f57a7d6fc4473645c993cfa4ba52;p=libsigrokdecode.git diff --git a/decoders/stepper_motor/pd.py b/decoders/stepper_motor/pd.py index 8a1c2e1..b6ff9b1 100644 --- a/decoders/stepper_motor/pd.py +++ b/decoders/stepper_motor/pd.py @@ -24,7 +24,7 @@ class SamplerateError(Exception): pass class Decoder(srd.Decoder): - api_version = 2 + api_version = 3 id = 'stepper_motor' name = 'Stepper motor' longname = 'Stepper motor position / speed' @@ -52,7 +52,7 @@ class Decoder(srd.Decoder): def __init__(self): self.oldstep = None - self.prev_step_ss = None + self.ss_prev_step = None self.pos = 0 self.prev_speed = None self.prev_pos = None @@ -70,28 +70,26 @@ class Decoder(srd.Decoder): self.unit = 'mm' def step(self, ss, direction): - if self.prev_step_ss is not None: - delta = ss - self.prev_step_ss + if self.ss_prev_step is not None: + delta = ss - self.ss_prev_step speed = self.samplerate / delta / self.scale speed_txt = self.format % speed pos_txt = self.format % (self.pos / self.scale) - self.put(self.prev_step_ss, ss, self.out_ann, + self.put(self.ss_prev_step, ss, self.out_ann, [0, [speed_txt + ' ' + self.unit + '/s', speed_txt]]) - self.put(self.prev_step_ss, ss, self.out_ann, + self.put(self.ss_prev_step, ss, self.out_ann, [1, [pos_txt + ' ' + self.unit, pos_txt]]) self.pos += (1 if direction else -1) - self.prev_step_ss = ss + self.ss_prev_step = ss def metadata(self, key, value): if key == srd.SRD_CONF_SAMPLERATE: self.samplerate = value - def decode(self, ss, es, data): + def decode(self): if not self.samplerate: raise SamplerateError('Cannot decode without samplerate.') - - for (self.samplenum, (step, direction)) in data: - if step == 1 and self.oldstep == 0: - self.step(self.samplenum, direction) - self.oldstep = step + while True: + step, direction = self.wait({0: 'r'}) + self.step(self.samplenum, direction)