team17code

% Team 17
% Lance Marttinen, Jordan Horan, Kyle Tolman
% Simulation Code
% November 5, 2014


clear
clc

% Ask user which data to use
df=1;%input('Which rider would you like? ');
front_area=.53;%input('Frontal Area of ORV: ');%----.53
vfront_area=.67;%input('Frontal Area of FSHPV: ');%----.67
while df<1||df>10
    clear;
    clc;
    df=input('Please try again with a number between 1 and 10:  ');
end
% Load data, set to vectors
[lat,lon,elev,dist,hr,vel,mass]=course_vector(df);

vmass=mass+(51.4/2.2);

% Set vec_size to be size of data
vec_size=size(lon,1);

% Difference in distance
for i=1:vec_size-1;
     dif_dist(i,1)=(dist(i+1)-dist(i));
end

% Find average velocity
for i=1:vec_size-1;
    VA(i,1)=(vel(i+1)+vel(i))/2;
    if VA(i)<=0
        VA(i)=.1;
    end
end

for i=1:vec_size-1;
    dV(i,1)=(vel(i+1)-vel(i));
end

% Find dt
for i=1:vec_size-1;
     dt(i,1)=dif_dist(i)/VA(i);
    if dt(i)<=0
        dt(i)=.1;
    end
end

% Find acceleration
for i=1:vec_size-1;
     accel(i,1)=dV(i)/dt(i);
end

% Find elevation difference
for i=1:vec_size-1;
     de(i,1)=(elev(i+1)-elev(i));
end

% Find total distance
tot_dist=dist(vec_size);

% Set total elevation gain variable
tot_elev_gain=0;
pos_count=0; %--------------------------------Is this needed?
% Find elevation gain
for i=1:vec_size-1;
    if de(i)>0;
        tot_elev_gain=tot_elev_gain+de(i);
        pos_count=pos_count+1;
    end
end

% Slope vector
for i=1:vec_size-1;
    if dif_dist(i)<=0;
        dif_dist(i)=1;
    end
    slope_vec(i,1)=atand(de(i)/dif_dist(i));
end

% Plot longitude, latitude, and elevation

%plot3(lon,lat,elev);%-----------------------------Re-add this
%xlabel('longitude');
%ylabel('latitude');
%zlabel('elevation');
%title('figure 1');

%figure;
%plot(dt,VA);
%xlabel('Velocity');
%ylabel('Distance');
%title('figure 2');

% Average up angle
avg_up_ang=atand(tot_elev_gain/tot_dist);

% Print distance and elevation to user
fprintf('\nThe total distance is %6.2f m and the total elevation is %6.2f m\n\n',tot_dist,tot_elev_gain)

% Set gravity variable
g=9.81;

% Slope resistance
for i=1:vec_size-1;
    f_slope(i,1)=mass*g*sind(slope_vec(i));
end

%Set coefficient of rolling friction variable
c_f=.008;

% Rolling Resistance
for i=1:vec_size-1;
    f_roll(i,1)=c_f*mass*g*cosd(slope_vec(i));
end

% Set bump power loss variable
p_b=100;

% Bump resistance
for i=1:vec_size-1;
    f_bump(i,1)=p_b/VA(i);
end

% Set drag force variables
air_density=1.256;
drag=1;

% Air Resistance
for i=1:vec_size-1;
    f_air(i,1)=.5*air_density*front_area*drag*(VA(i))^2;
end

% Force of rider
for i=1:vec_size-1;
    f_rider(i,1)=mass*accel(i)+f_air(i)+f_roll(i)+f_bump(i)+f_slope(i);
end

% Power of rider
for i=1:vec_size-1;
    p_rider(i,1)=f_rider(i)*VA(i);
end

%---------------------------------------------------------In class exercise
over6=0;
over9=0;
under4=0;

for i=1:vec_size;
    if vel(i)>6;
        over6=over6+1;
        if vel(i)>9;
            over9=over9+1;
        end
    elseif vel(i)<4;
        under4=under4+1;
    end
end

%--------------------------------------------------End of in class exercise

tot_time=sum(dt)/60;
fprintf('It took the rider %6.2f minutes to complete the course. \n',tot_time);

for i=1:vec_size-1;
    if p_rider(i)>=0
    pos_prider(i,1)=p_rider(i);
    end
    if p_rider(i)<0
        pos_prider(i,1)=0;
    end
end

over0=0;

for i=1:vec_size-1;
    if pos_prider(i)>0
        over0=over0+1;
    end
end

PPA=(sum(pos_prider))/(over0);















VPR=PPA+1;
loopcounter=0;


while VPR>=PPA

    loopcounter=loopcounter+1;
    vover0=0;

    for i=1:vec_size-1;
        dt(i,1)=dt(i)*1.02;
        accel(i,1)=dV(i)/dt(i);
        vf_slope(i,1)=vmass*g*sind(slope_vec(i));
        vf_roll(i,1)=c_f*vmass*g*cosd(slope_vec(i));
        vf_air(i,1)=.5*air_density*vfront_area*drag*(VA(i))^2;
        f_driver(i,1)=vmass*accel(i)+vf_air(i)+vf_roll(i)+f_bump(i)+vf_slope(i);
        p_driver(i,1)=f_driver(i)*VA(i);
         if p_driver(i)>=0
            pos_pdriver(i,1)=p_driver(i);
        end
        if p_driver(i)<0
            pos_pdriver(i,1)=0;
        end



         if pos_pdriver(i)>0
            vover0=vover0+1;
         end
    end

VPR=(sum(pos_pdriver))/(vover0);

end

loopcounter