Использование затвора камеры для запуска MPU6050 на Raspberry Pi

Question

Я подключил DSLR к RPi с помощью GPIO; и MPU6050 для RPi с использованием I2C. Я пытаюсь записать данные гироскопа и акселерометра в маленьком временном окне (обычно менее 50 мс), когда нажимаю кнопку спуска затвора камеры. Моя желаемая частота дискретизации находится где-то между 500 Гц и 1000 Гц. И я использую FIFO для временного хранения данных датчика.

В настоящее время проблема заключается в том, что код иногда приводит к избыточным выборкам (большое смещение по сравнению с теоретическим значением). Например, когда я установил 500 Гц на 100 мс - я ожидал 50 сэмплов, но оказалось 62 сэмпла. У меня нет этой проблемы, если запустить MPU6050 без синхронизации камеры.

Кроме того, я запутался, что это

Status = mpu6050.readStatus()
if (Status & 0x10) == 0x10 :
    print "Overrun Error! Quitting.\n"

за?

Буду очень признателен, если кто-нибудь сможет помочь. Спасибо!

Код Python:

import datetime
import MPU6050
import math
import time
import numpy
import RPi.GPIO as GPIO
import time
import sys
GPIO.setmode(GPIO.BCM)
TargetSampleTime= 20 #int(sys.argv[1])
TargetRate= 500 #float(sys.argv[2])
GPIO.setup(24,GPIO.IN,pull_up_down=GPIO.PUD_DOWN)

mpu6050 = MPU6050.MPU6050()
mpu6050.setup()
mpu6050.setGResolution(2)
mpu6050.setSampleRate(TargetRate)
mpu6050.enableFifo(False)
time.sleep(0.01)

print "Capturing in {0} ms at {1} samples/sec".format(TargetSampleTime, mpu6050.SampleRate)

mpu6050.resetFifo()
mpu6050.enableFifo(True)
time.sleep(0.01)

Values = []
Total = 0

def my_callback(channel):
      print "Rising edge detected on 24"
      GPIO.remove_event_detect(24)
      GPIO.cleanup()
      a = datetime.datetime.now()
      # read MPU6050 from FIFO
      while True:
       Values.extend(mpu6050.readDataFromFifo())
       b = datetime.datetime.now()
       dt = int((b-a).microseconds/1000)
       if dt >= TargetSampleTime:
           break;
      b = datetime.datetime.now()
      Total = len(Values)/14
      print "Capture in {0} ms".format((b-a).microseconds/1000)
      print "Captured {0} samples".format(Total)
      if Total > 0:
       Status = mpu6050.readStatus()
       if (Status & 0x10) == 0x10 :
        print "Overrun Error! Quitting.\n"
        quit()
       # writing IMU data to txt
       print "Saving RawData.txt  file."  
       FO = open("RawData.txt","w")
       FO.write("GT\tGx\tGy\tGz\tTemperature\tGyrox\tGyroy\tGyroz\n")
       fftdata = []
       for loop in range (Total):
        SimpleSample = Values[loop*14 : loop*14+14]
        I = mpu6050.convertData(SimpleSample)
        CurrentForce = math.sqrt( (I.Gx * I.Gx) + (I.Gy * I.Gy) +(I.Gz * I.Gz))
        fftdata.append(CurrentForce)
        FO.write("{0:6.3f}\t{1:6.3f}\t{2:6.3f}\t{3:6.3f}\t".format(CurrentForce, I.Gx , I.Gy, I.Gz))
        FO.write("{0:5.1f}\t{1:6.3f}\t{2:6.3f}\t{3:6.3f}\n".format(I.Temperature,I.Gyrox,I.Gyroy,I.Gyroz))

       FO.close()
      quit()
# detect shutter button press
GPIO.add_event_detect(24, GPIO.RISING, callback=my_callback, bouncetime=100)
raw_input("Listening...")

Answer 1

Решил это с помощью SPI вместо I2C. Теперь я могу получать данные со стабильной частотой дискретизации 2000 Гц.