clear all
close all
clc

    load('AccelData_StartWithZeroSpeed.mat')
    
    Ax = hv_Ax.Data;
    Ay = hv_Ay.Data;
    Az = hv_Az.Data;
    t = 0.05;
    ActualSpeed = hv_speed.Data;

    % Assuming intial velocity is zero
    
    Vx(1) = 0 + Ax(1)*t;
    Vy(1) = 0 + Ay(1)*t;
    Vz(1) = 0 + Az(1)*t;
    for i = 2:length(Ax)
        Vx(i) = Vx(i-1) + (Ax(i)+Ax(i-1))*t*0.5;
        Vy(i) = Vy(i-1) + (Ay(i)+Ay(i-1))*t*0.5;
        Vz(i) = Vz(i-1) + (Az(i)+Az(i-1))*t*0.5;

    end

    
    V1 = sqrt(Vx.*Vx + Vy.*Vy);
    plot(Vx,'k');
    hold on
    plot(ActualSpeed,'r');
    hold off