Homec4science
Diffusion MSM (command_line) Browse

msm/ShoulderModel_rTSA/INITIALISATION_Dataset/MAIN_INITIALISATION_build_data_kinematics.m
07fe7aaf51b9command_line

Last Change
Raw File

MAIN_INITIALISATION_build_data_kinematics.m
View Options

function KEDATA = MAIN_INITIALISATION_build_data_kinematics(REDATA, BLDATA)
% Function to initialise the kinematics dataset
%--------------------------------------------------------------------------
% Syntax :
% KEDATA = MAIN_INITIALISATION_build_data_kinematics(REDATA, BLDATA)
%--------------------------------------------------------------------------
%{
File Description:
This function
defines the initial joint angles for all the joints using
MAIN_TOOL_geometry_functions and saves them into
KEDATA.Initial_Joint_Angles.
based on the initial joint angles it sets the initial values
for the minimal coordinates and saves them into
KEDATA.Initial_Minimal_Cordinate
it receives the final values for the minimal coordinates
defined by the user and saves them into
KEDATA.Final_Minimal_Cordinate. This is a main shortcoming
of using the minimal coordinates. To be more
precise we need to use optimization here. But if we use
optimization, what would be the edge of minimal coordinates
over the optimization based approach to plan the motion.
finally we give all the above mentioned data to the function
named KINEMATICS_TOOL_build_motion and it constructs the
evaluation of the joint Euler angles, evaluation of the minimal
coordinates, and the evaluation of the bony landmarks. In other
word, it constructs the motion.
(KEDATA.Joint_Angle_Evolution, KEDATA.Coordinate_Evolution.M1,
KEDATA.Point_Evolution)
%}
%--------------------------------------------------------------------------
% Initialiase the Output
KEDATA = [];
% Get the Initial Joint Angles
JEA0 = MAIN_TOOL_geometry_functions('Get Euler Angles From Initial Rotation Matrices', BLDATA);
% Initial Joint Angles
KEDATA.Initial_Joint_Angles = JEA0;
%--------------------------------------------------------------------------
% The First Initial Minimal Coordinate: Clavicual Axial Rotation
%--------------------------------------------------------------------------
KEDATA.Initial_Minimal_Coordinate(1,1) = JEA0(1);
%--------------------------------------------------------------------------
% Second & Third Initial Minimal Coordinates: AI parametric coordinates
%--------------------------------------------------------------------------
% The position of AI, with respect to the ellipsoid centre is :
% AIx = Ax sin(M3) cos(M2)
% AIy = Ay sin(M3) sin(M2)
% AIz = Az cos(M3)
AIx = BLDATA.Initial_Points.AI(1) - REDATA.Centre(1);
AIy = BLDATA.Initial_Points.AI(2) - REDATA.Centre(2);
AIz = BLDATA.Initial_Points.AI(3) - REDATA.Centre(3);
Ax = REDATA.AIaxes(1);
Ay = REDATA.AIaxes(2);
Az = REDATA.AIaxes(3);
KEDATA.Initial_Minimal_Coordinate(3,1) = acos(AIz/Az);
KEDATA.Initial_Minimal_Coordinate(2,1) = atan2(AIy*Ax,AIx*Ay);
%--------------------------------------------------------------------------
% The Fourth Initial Minimal Coordinates: TS intersection Coordinate
%--------------------------------------------------------------------------
mu0 = KINEMATICS_TOOL_get_TS_intersect_coordinate(REDATA, BLDATA);
KEDATA.Initial_Minimal_Coordinate(4,1) = mu0;
%--------------------------------------------------------------------------
% The Fifth to Seventh Initial Minimal Coordinates: Glenohumeral Joint Angles
%--------------------------------------------------------------------------
% These values are inintialised a bit differently
KEDATA.Initial_Minimal_Coordinate(5,1) = JEA0(7);%0; %JEA0(7); No internal/external rotation
KEDATA.Initial_Minimal_Coordinate(6,1) = JEA0(8);%-1*pi/180; %JEA0(8);
KEDATA.Initial_Minimal_Coordinate(7,1) = JEA0(9);%30*pi/180; %JEA0(9); Lies on the scapular plane.
%--------------------------------------------------------------------------
% The Eighth and Nineth Initial Minimal Coordinates: Humeroulnar and Radiulnar Joint Angles
%--------------------------------------------------------------------------
% These values might be inintialized a bit differently
KEDATA.Initial_Minimal_Coordinate(8,1) = JEA0(10);%0*pi/180; %JEA0(8);
KEDATA.Initial_Minimal_Coordinate(9,1) = JEA0(11);%0*pi/180; %JEA0(9);
%--------------------------------------------------------------------------
% Set the final values
%--------------------------------------------------------------------------
% Set the Final Values (these values were obtained from initial testing,
% they are not necessarily the best)
KEDATA.Final_Minimal_Coordinate(1,1) = 30*pi/180;
KEDATA.Final_Minimal_Coordinate(2,1) = -30*pi/180;
KEDATA.Final_Minimal_Coordinate(3,1) = 91*pi/180;
KEDATA.Final_Minimal_Coordinate(4,1) = KEDATA.Initial_Minimal_Coordinate(4,1)+0.07;
KEDATA.Final_Minimal_Coordinate(5,1) = 0*pi/180;
KEDATA.Final_Minimal_Coordinate(6,1) = -140*pi/180;
KEDATA.Final_Minimal_Coordinate(7,1) = 30*pi/180;
KEDATA.Final_Minimal_Coordinate(8,1) = JEA0(10);%0*pi/180;
KEDATA.Final_Minimal_Coordinate(9,1) = JEA0(11);%0*pi/180;
% Set the polynomial orders
KEDATA.Order = 5*ones(1,9);
% Set the Derivative Conditions
KEDATA.DerCond = zeros(9,8);
% Number of way points
KEDATA.NbPoints = 100;
%--------------------------------------------------------------------------
% Build an initial motion
%--------------------------------------------------------------------------
% This function will set the following elements of KEDATA
% KEDATA.Joint_Angle_Evolution
% KEDATA.Coordinate_Evolution.M1
% KEDATA.Coordinate_Evolution.M2
% KEDATA.Coordinate_Evolution.M3
% KEDATA.Coordinate_Evolution.M4
% KEDATA.Coordinate_Evolution.M5
% KEDATA.Coordinate_Evolution.M6
% KEDATA.Coordinate_Evolution.M7
% KEDATA.Coordinate_Evolution.M8
% KEDATA.Coordinate_Evolution.M9
% KEDATA.Point_Evolution.IJ
% KEDATA.Point_Evolution.PX
% KEDATA.Point_Evolution.T8
% KEDATA.Point_Evolution.C7
% KEDATA.Point_Evolution.SC
% KEDATA.Point_Evolution.AC
% KEDATA.Point_Evolution.AA
% KEDATA.Point_Evolution.TS
% KEDATA.Point_Evolution.AI
% KEDATA.Point_Evolution.GH
% KEDATA.Point_Evolution.HU
% KEDATA.Point_Evolution.EL
% KEDATA.Point_Evolution.EM
% KEDATA.Point_Evolution.CP
% KEDATA.Point_Evolution.US
% KEDATA.Point_Evolution.RS
KEDATA = KINEMATICS_TOOL_build_motion(KEDATA, BLDATA, REDATA);
return;
c4science · Help