def _add_msg(self, m): '''add a new message''' type = m.get_type() self.messages[type] = m if not type in self.counts: self.counts[type] = 0 else: self.counts[type] += 1 if not type in self.counts_since_gps: self.counts_since_gps[type] = 0 else: self.counts_since_gps[type] += 1 if type == 'TIME' and 'StartTime' in m._fieldnames: self.px4_timebase = m.StartTime * 1.0e-6 self.px4_timestamps = True if type == 'GPS': self._adjust_time_base(m) if type == 'MODE': if isinstance(m.Mode, str): self.flightmode = m.Mode.upper() elif 'ModeNum' in m._fieldnames: self.flightmode = mavutil.mode_string_apm(m.ModeNum) else: self.flightmode = mavutil.mode_string_acm(m.Mode) self._set_time(m)
def _add_msg(self, m): '''add a new message''' type = m.get_type() self.messages[type] = m if not type in self.counts: self.counts[type] = 0 else: self.counts[type] += 1 if not type in self.counts_since_gps: self.counts_since_gps[type] = 0 else: self.counts_since_gps[type] += 1 if type == 'TIME' and 'StartTime' in m._fieldnames: self.px4_timebase = m.StartTime * 1.0e-6 self.px4_timestamps = True if type == 'GPS': self._adjust_time_base(m) if type == 'MODE': if isinstance(m.Mode, str): self.flightmode = m.Mode.upper() elif 'ModeNum' in m._fieldnames: self.flightmode = mavutil.mode_string_apm(m.ModeNum) else: self.flightmode = mavutil.mode_string_acm(m.Mode) if type == 'STAT': if 'MainState' in m._fieldnames: self.flightmode = mavutil.mode_string_px4(m.MainState) else: self.flightmode = "UNKNOWN" if type == 'PARM' and getattr(m, 'Name', None) is not None: self.params[m.Name] = m.Value self._set_time(m)
def _add_msg(self, m): """add a new message""" type = m.get_type() self.messages[type] = m if not type in self.counts: self.counts[type] = 0 else: self.counts[type] += 1 if not type in self.counts_since_gps: self.counts_since_gps[type] = 0 else: self.counts_since_gps[type] += 1 if type == "TIME" and "StartTime" in m._fieldnames: self.px4_timebase = m.StartTime * 1.0e-6 self.px4_timestamps = True if type == "GPS": self._adjust_time_base(m) if type == "MODE": if isinstance(m.Mode, str): self.flightmode = m.Mode.upper() elif "ModeNum" in m._fieldnames: self.flightmode = mavutil.mode_string_apm(m.ModeNum) else: self.flightmode = mavutil.mode_string_acm(m.Mode) self._set_time(m)
def _add_msg(self, m): '''add a new message''' type = m.get_type() self.messages[type] = m if not type in self.counts: self.counts[type] = 0 else: self.counts[type] += 1 if not type in self.counts_since_gps: self.counts_since_gps[type] = 0 else: self.counts_since_gps[type] += 1 if type == 'GPS': self._adjust_time_base(m) if type == 'MODE': if isinstance(m.Mode, str): self.flightmode = m.Mode.upper() else: self.flightmode = mavutil.mode_string_apm(m.ModeNum) self._set_time(m)