+ def put_ann(self, ss, es, ann_class, value):
+ self.put(ss, es, self.out_ann, [ann_class, value])
+
+ def process_bit(self, sync, bit_ss, bit_es, bit_value):
+ self.put_ann(bit_ss, bit_es, ann_bit, ['%d' % bit_value])
+ self.bits.append((bit_ss, bit_es, bit_value))
+
+ if sync == 0:
+ if len(self.bits) < 20:
+ self.put_ann(self.bits[0][0], bit_es, ann_warning, ['Not enough data bits'])
+ self.reset()
+ return
+
+ # Bit structure:
+ # 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19
+ # T --------------- 18-bit pos ----------------- PARITY or
+ # -TYPE-- ------------ 16-bit pos -------------- PARITY or
+ # -TYPE-- -8-bit command -8-bit parameter value- PARITY
+
+ # Calculate parity, excluding the parity bit itself
+ parity = 0
+ for ss, es, value in self.bits[:-1]:
+ parity ^= value
+
+ par_ss, par_es, par_value = self.bits[19]
+ parity_even = 0
+ parity_odd = 0
+ if (par_value == parity):
+ parity_even = 1
+ else:
+ parity_odd = 1
+
+ type_1_value = self.bits[0][2]
+ type_3_value = (self.bits[0][2] << 2) | (self.bits[1][2] << 1) | self.bits[2][2]
+
+ # Determine frame type
+ type = frame_type_none
+ parity_status = ['X', 'Unknown']
+ type_ss = self.bits[0][0]
+ type_es = self.bits[2][1]
+
+ ### 18-bit position
+ if (type_1_value == 1) and (parity_odd == 1):
+ type = frame_type_18bit_pos
+ type_es = self.bits[0][1]
+ self.put_ann(self.bits[0][0], bit_es, ann_warning, ['Careful: 18-bit position frames with wrong parity and command frames with wrong parity cannot be identified'])
+ ### 16-bit position
+ elif (type_3_value == 1):
+ type = frame_type_16bit_pos
+ if (parity_even == 1):
+ parity_status = ['OK']
+ else:
+ parity_status = ['NOK']
+ self.put_ann(self.bits[0][0], bit_es, ann_warning, ['Parity error', 'PE'])
+ ### Command
+ elif (type_3_value == 7) and (parity_even == 1):
+ type = frame_type_command
+ self.put_ann(self.bits[0][0], bit_es, ann_warning, ['Careful: 18-bit position frames with wrong parity and command frames with wrong parity cannot be identified'])
+ ### Other
+ else:
+ self.put_ann(self.bits[0][0], bit_es, ann_warning, ['Error', 'Unknown command or parity error'])
+ self.reset()
+ return
+
+ # Output command and parity annotations
+ if (type == frame_type_16bit_pos):
+ self.put_ann(type_ss, type_es, ann_type, ['16 bit Position Frame', '16 bit Pos', 'Pos', 'P'])
+ if (type == frame_type_18bit_pos):
+ self.put_ann(type_ss, type_es, ann_type, ['18 bit Position Frame', '18 bit Pos', 'Pos', 'P'])
+ if (type == frame_type_command):
+ self.put_ann(type_ss, type_es, ann_type, ['Command Frame', 'Command', 'C'])
+
+ self.put_ann(par_ss, par_es, ann_parity, parity_status)
+
+ # Output value
+ if (type == frame_type_16bit_pos) or (type == frame_type_18bit_pos):
+ pos = 0
+
+ if (type == frame_type_16bit_pos):
+ count = 15
+ for ss, es, value in self.bits[3:19]:
+ pos |= value << count
+ count -= 1
+ pos = pos if pos < 32768 else pos - 65536
+ else:
+ count = 17
+ for ss, es, value in self.bits[3:19]:
+ pos |= value << count
+ count -= 1
+ pos = pos if pos < 131072 else pos - 262144
+
+ self.put_ann(type_es, par_ss, ann_pos, ['%d' % pos])
+
+ if (type == frame_type_command):
+ count = 7
+ cmd = 0
+ cmd_es = 0
+ for ss, es, value in self.bits[3:11]:
+ cmd |= value << count
+ count -= 1
+ cmd_es = es
+ self.put_ann(type_es, cmd_es, ann_command, ['Command 0x%X' % cmd, 'Cmd 0x%X' % cmd, '0x%X' % cmd])
+
+ count = 7
+ param = 0
+ for ss, es, value in self.bits[11:19]:
+ param |= value << count
+ count -= 1
+ self.put_ann(cmd_es, par_ss, ann_parameter, ['Parameter 0x%X / %d' % (param, param), '0x%X / %d' % (param, param),'0x%X' % param])
+
+ self.reset()