В этом примере показано, как анимировать ориентацию колеблющегося устройства.

Загрузите rpy_9axis.mat. Данные в rpy_9axis.mat зарегистрированный акселерометр, гироскоп, и данные о датчике магнитометра из устройства, колеблющегося в тангаже (вокруг оси Y), затем отклоняются от курса (вокруг оси z), затем прокручиваются (вокруг оси X). Ось X устройства указывала на юг, когда зарегистрировано.

ld = load('rpy_9axis.mat')

ld = struct with fields:
            Fs: 200
    sensorData: [1x1 struct]

Установите частоту дискретизации. Извлеките данные о гироскопе и акселерометр. Установитесь коэффициент децимации на 2. Используйте fuse создать косвенный фильтр cочетания датчиков Кальмана из данных.

accel = ld.sensorData.Acceleration;
gyro = ld.sensorData.AngularVelocity;    
Fs  = ld.Fs;
decim = 2;
fuse = imufilter('SampleRate',Fs,'DecimationFactor',decim);

Получите информацию о положении объединенных данных.

pose = fuse(accel,gyro);

Создайте театральный график. Добавьте в театральный график плоттер ориентации с 'DisplayName' установите на 'Fused Data' и 'LocalAxesLength' установите на 2.

tp = theaterPlot('XLimit',[-2 2],'YLimit',[-2 2],'ZLimit',[-2 2]);
op = orientationPlotter(tp,'DisplayName','Fused Data',...
    'LocalAxesLength',2);

Цикл через информацию о положении, чтобы анимировать изменяющуюся ориентацию.

for i=1:numel(pose)
    plotOrientation(op, pose(i))
    drawnow
end