X-Git-Url: http://git.droids-corp.org/?a=blobdiff_plain;f=qtosd%2Fserialfpv.py;h=f089d1c69b36abe13d1d01e1694c4a432697b356;hb=f92b62a5354dcfe189a31d76d4004006354bf16b;hp=6153a3da0ad7ff087f75807c37f73307a8bbf35b;hpb=844bf63c7f0b676932a04c3e3c7060abf90faea4;p=fpv.git diff --git a/qtosd/serialfpv.py b/qtosd/serialfpv.py index 6153a3d..f089d1c 100644 --- a/qtosd/serialfpv.py +++ b/qtosd/serialfpv.py @@ -49,7 +49,7 @@ class SerialFPV(): self.prev_reftime = None self.data = "" - def update(self): + def update_state(self): # read from file/serial while len(self.data) < 16384: data = self.f.read(1024) @@ -75,7 +75,7 @@ class SerialFPV(): "\| magnet %s %s %s " % (FLOAT, FLOAT, FLOAT) + "\| angles %s %s %s"% (FLOAT, FLOAT, FLOAT), l) if m: - cur_time = float(m.groups()[0]) / 20. + cur_time = float(m.groups()[0]) / 1000. # first time, init prev_time and prev_reftime if self.realtime == False and self.prev_time == None: self.prev_time = cur_time @@ -88,7 +88,6 @@ class SerialFPV(): break roll, pitch, yaw = ( map(lambda x: float(x), m.groups()[10:13])) - print roll, pitch, yaw self.roll = math.degrees(roll) + 180. self.pitch = math.degrees(pitch) self.yaw = math.degrees(yaw)