diff --git a/receiver/decode_sbf.py b/receiver/decode_sbf.py index f15972f..c6a5f8d 100644 --- a/receiver/decode_sbf.py +++ b/receiver/decode_sbf.py @@ -665,14 +665,13 @@ def decode(self, buff, len_, sys=[], prn=[]): msg = bytearray(32) for i in range(8): d = st.unpack_from('L', msg, i*4, d) k += 4 - self.fh_galinav.write("\n") # GALRawINAV is missing tail bit (6) of even page + # add 6 bits offset for odd page msg_ = bytearray(30) - msg_[0:15] = msg[0:15] + msg_[0:15] = msg[0:15] # even page k = 114 for i in range(15): d = bs.unpack_from('u8', bytes(msg), k)[0] @@ -680,6 +679,10 @@ def decode(self, buff, len_, sys=[], prn=[]): k += 8 msg_ = bytes(msg_) + for i in range(30): + self.fh_galinav.write("{:08x}".format(msg_[i])) + self.fh_galinav.write("\n") + eph = self.rn.decode_gal_inav(self.week, self.tow, sat, 2, msg_) if self.mode_galinav == 0 and eph is not None: