X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=decoders%2Fstepper_motor%2Fpd.py;h=52e3e635a4bea1185e8e2282bad2d8c901a3d9e1;hb=4539e9ca58966ce3c9cad4801b16c315e86ace01;hp=b3bb5bc73cabf14f1a12c9b7e22d71fa9b36a700;hpb=d2bcb32bc16eddffc9ec54b505c03028a2ec4160;p=libsigrokdecode.git diff --git a/decoders/stepper_motor/pd.py b/decoders/stepper_motor/pd.py index b3bb5bc..52e3e63 100644 --- a/decoders/stepper_motor/pd.py +++ b/decoders/stepper_motor/pd.py @@ -14,8 +14,7 @@ ## GNU General Public License for more details. ## ## You should have received a copy of the GNU General Public License -## along with this program; if not, write to the Free Software -## Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA +## along with this program; if not, see . ## import sigrokdecode as srd @@ -24,11 +23,11 @@ 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' - desc = 'Calculate absolute position and movement speed from step/dir signals.' + desc = 'Absolute position and movement speed from step/dir.' license = 'gplv2+' inputs = ['logic'] outputs = ['stepper_motor'] @@ -50,9 +49,9 @@ class Decoder(srd.Decoder): ('position', 'Position', (1,)), ) - def __init__(self, **kwargs): + 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 +69,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)