Homec4science
Diffusion MSM (master) Browse

msm/ShoulderModel_HHT/show_the_results.m
73754adfee53master

Last Change
Raw File

show_the_results.m
View Options

function IDDATA = show_the_results(IDDATA, FDDATA)
%{
Function for ploting the results
--------------------------------------------------------------------------
Syntax :
FDDATA = show_the_results(IDDATA, FDDATA);
--------------------------------------------------------------------------
File Description :
--------------------------------------------------------------------------
%}
% saving the forward dynamic results in a proper way for plotting aimes
for j = 1:12
for i=1:size(IDDATA.t,2)-1
if lt(j,7) % generalized coordinates
IDDATA.Coordinate_Evolution(j,i) = FDDATA(i).y(j,end);
else % generalized velocities
IDDATA.Coordinate_Evolution_D(j-6,i) = FDDATA(i).y(j,end);
end
end
end
% Show the resulted motion and its derivatives
figure
subplot(2,2,1);
p1 = plot(IDDATA.t(1:size(IDDATA.t,2)-1),...
(180/pi)*IDDATA.ImposedMotion([1,4,7],1:size(IDDATA.t,2)-1),...
IDDATA.t(1:size(IDDATA.t,2)-1),...
(180/pi)*IDDATA.Coordinate_Evolution(1:3,1:size(IDDATA.t,2)-1),...
'--','linewidth', 1);
p1(1).Color = 'r';p1(2).Color = 'g';p1(3).Color = 'b';
p1(4).Color = 'r';p1(5).Color = 'g';p1(6).Color = 'b';
grid on;
title('The imposed and integrated motions, angles',...
'fontsize', 8, ...
'fontweight', 'bold', ...
'fontname', 'sansserif');
xlabel('time [s]','fontsize',10,'fontweight','bold');
ylabel('angle [Deg]','fontsize',10,'fontweight','bold');
Motion1 = legend('imp.\psi','imp.\theta','imp.\phi',...
'int.\psi','int.\theta','int.\phi',...
'Location','best');
set(Motion1,'FontSize',10);
subplot(2,2,2);
p2 = plot(IDDATA.t(1:size(IDDATA.t,2)-1),...
(180/pi)*IDDATA.ImposedMotion([2,5,8],1:size(IDDATA.t,2)-1),...
IDDATA.t(1:size(IDDATA.t,2)-1),...
(180/pi)*IDDATA.Coordinate_Evolution_D(1:3,1:size(IDDATA.t,2)-1),...
'--','linewidth', 1);;
p2(1).Color = 'r';p2(2).Color = 'g';p2(3).Color = 'b';
p2(4).Color = 'r';p2(5).Color = 'g';p2(6).Color = 'b';
grid on;
title('The imposed and integrated motions, velocities',...
'fontsize', 8, ...
'fontweight', 'bold', ...
'fontname', 'sansserif');
xlabel('time [s]','fontsize',10,'fontweight','bold');
ylabel('angle [Deg/s]','fontsize',10,'fontweight','bold');
Motion2 = legend('imp. d\psi','imp. d\theta','imp. d\phi',...
'int. d\psi','int. d\theta','int. d\phi',...
'Location','best');
set(Motion2,'FontSize',10);
subplot(2,2,3);
p1 = plot(IDDATA.t(1:size(IDDATA.t,2)-1),...
1e3*IDDATA.Coordinate_Evolution(4:6,1:size(IDDATA.t,2)-1),...
'linewidth', 1);
p1(1).Color = 'r';p1(2).Color = 'g';p1(3).Color = 'b';
grid on;
title('Humeral head tranlations, displacements[mm]',...
'fontsize', 8, ...
'fontweight', 'bold', ...
'fontname', 'sansserif');
xlabel('time [s]','fontsize',10,'fontweight','bold');
ylabel('displacement [mm]','fontsize',10,'fontweight','bold');
Motion3 = legend('pos-ant','inf-sup','lat-med','Location','best');
set(Motion3,'FontSize',10);
subplot(2,2,4);
p1 = plot(IDDATA.t(1:size(IDDATA.t,2)-1),...
1e3*IDDATA.Coordinate_Evolution_D(4:6,1:size(IDDATA.t,2)-1),...
'linewidth', 1);
p1(1).Color = 'r';p1(2).Color = 'g';p1(3).Color = 'b';
grid on;
title('Humeral head tranlations, velocities [mm/s]',...
'fontsize', 8, ...
'fontweight', 'bold', ...
'fontname', 'sansserif');
xlabel('time [s]','fontsize',10,'fontweight','bold');
ylabel('velocity [mm/s]','fontsize',10,'fontweight','bold');
Motion4 = legend('pos-ant','inf-sup','lat-med','Location','best');
set(Motion4,'FontSize',10);
return
c4science · Help