imuplotraw.m

function [ output_args ] = imuplot( imudata, imuidx )
%imuplot Plot one set of IMU data from a data set.
%   Pass in a set of IMU data that contains 1 or more
% sets of IMU data. Each set will be 7 columns, temp
% and then gx, gy, gz, ax, ay, az
% The index will pick which set to plot, starting at 0
% for the first set, 1 for the second, etc.

    [r,c] = size(imudata);
    numIMUs = int8((c-1)/9);
    if imuidx >= numIMUs
        error('imupot',sprintf('IMU index out of range: %s .',imuidx));
    end
    
    t = [0:0.01:(r-1)*0.01];
    
    myimu = double(imudata(:,imuidx*9+3:imuidx*9+9));
    
    myimu(:,1) = (35+(myimu(:,1)+13200)/280);
    for x=2:4
        % Gyro calculations
        myimu(:,x) = 250*(myimu(:,x)/2^15);
    end
    
    for x=5:7
        myimu(:,x) = 2*(myimu(:,x)/2^15);
    end
    
    fh = figure;
    subplot(7,1,1);
    plot(t,myimu(:,1));
    ylabel('Temp');

    for x=[2:4]
        subplot(7,1,x);
        plot(t,myimu(:,x));
        ylabel('gyro dps');
    end

    for x=[5:7]
        subplot(7,1,x);
        plot(t,myimu(:,x));
        ylabel('acc. G');
    end

end