Homec4science
Diffusion ShoulderDB_ImportSegmentMeasureAnalyze (master) Browse

R8218/ShoulderCase/PointBaseCoodinateSystem.m
749c537bb20emaster

Last Change
Raw File

PointBaseCoodinateSystem.m
View Options

classdef PointBaseCoodinateSystem < handle
properties
oldCoordSys
origin
xAxis
yAxis
zAxis
end
methods
function obj = PointBaseCoodinateSystem()
obj.oldCoordSys = CoordinateSystem();
% obj.origin = [0 0 0];
% obj.xAxis = [1 0 0];
% obj.yAxis = [0 1 0];
% obj.zAxis = [0 0 1];
end
function setNewCoordSys(obj,scapula)
scapula.planeGen;
syms x y z
equ1 = scapula.InferoSuperior.plane.normal(1,1)*(x-scapula.InferoSuperior.plane.point...
(1,1))+scapula.InferoSuperior.plane.normal(1,2)*(y-scapula.InferoSuperior.plane.point...
(1,2))+scapula.InferoSuperior.plane.normal(1,3)*(z-scapula.InferoSuperior.plane.point(1,3))==0;
equ2 = scapula.AntoriorSuperior.plane.normal(1,1)...
*(x-scapula.AntoriorSuperior.plane.point(1,1))+scapula.AntoriorSuperior.plane.normal(1,2)...
*(y-scapula.AntoriorSuperior.plane.point(1,2))+scapula.AntoriorSuperior.plane.normal(1,3)...
*(z-scapula.AntoriorSuperior.plane.point(1,3))==0;
equ3 = scapula.PosteriorSuperior.plane.normal(1,1)*(x-scapula.PosteriorSuperior.plane.point(1,1))...
+scapula.PosteriorSuperior.plane.normal(1,2)*(y-scapula.PosteriorSuperior.plane.point(1,2))...
+scapula.PosteriorSuperior.plane.normal(1,3)*(z-scapula.PosteriorSuperior.plane.point(1,3))==0;
intersection12 = solve([equ1,equ2]);
intersection13 = solve([equ1,equ3]);
intersection23 = solve([equ2,equ3]);
xInter12 = sym2poly(intersection12.x);
yInter12 = sym2poly(intersection12.y);
p1l1 = [xInter12(2); yInter12(2) ;0];
p2l1 = [xInter12(1)+xInter12(2); yInter12(1)+yInter12(2) ;1];
dir1=(p2l1-p1l1)/norm(p2l1-p1l1);
xInter13 = sym2poly(intersection13.x);
yInter13 = sym2poly(intersection13.y);
p1l2 = [xInter13(2); yInter13(2) ;0];
p2l2 = [xInter13(1)+xInter13(2); yInter13(1)+yInter13(2) ;1];
dir2=(p2l2-p1l2)/norm(p2l2-p1l2);
xInter23 = sym2poly(intersection23.x);
yInter23 = sym2poly(intersection23.y);
p1l3 = [xInter23(2); yInter23(2) ;0];
p2l3 = [xInter23(1)+xInter23(2); yInter23(1)+yInter23(2) ;1];
dir3 = (p2l3-p1l3)/norm(p2l3-p1l3);
pointOnIntersect12 = [p1l1';p1l2'];
pointOnIntersect3 = [p1l3';p2l3'];
SG = scapula.spinoGlenoidNotch;
SGl1=p1l1 + dot((SG' - p1l1),dir1)*dir1;
SGl2=p1l2 + dot((SG' - p1l2),dir2)*dir2;
SGl3=p1l3 + dot((SG' - p1l3),dir3)*dir3;
projected = project2Plane(pointOnIntersect3,scapula.InferoSuperior.plane.normal...
,scapula.InferoSuperior.plane.point,size(pointOnIntersect3,1));
dir3New = (projected(2,:)-projected(1,:))/norm(projected(2,:)-projected(1,:));
meanSGonZaxis = mean([SGl1';SGl2';SGl3']);
%Direction of axes
obj.zAxis = mean([dir1';dir2';dir3New]);
obj.xAxis = scapula.InferoSuperior.plane.normal;
obj.yAxis = cross(obj.xAxis,obj.zAxis);
obj.origin = meanSGonZaxis +dot((SG - meanSGonZaxis),obj.zAxis)*obj.zAxis;
%obj.origin = project2line(SG',meanSGonZaxis',obj.zAxis);
end
function projectedPoint = project2line(pointOut,pointIn,dir)
projectedPoint = pointOut + dot((pointOut-pointIn),dir)*dir;
end
function plot(obj,scapula)
hold on
s=80;
scatter3(obj.origin(1,1),obj.origin(1,2),obj.origin(1,3),s,'MarkerEdgeColor','r','LineWidth',4);
zAxisPoints = [obj.origin+60*obj.zAxis;obj.origin-180*obj.zAxis];
xAxisPoints = [obj.origin-50*obj.xAxis;obj.origin+50*obj.xAxis];
yAxisPoints = [obj.origin+50*obj.yAxis;obj.origin-50*obj.yAxis];
plot3(xAxisPoints(:,1),xAxisPoints(:,2),xAxisPoints(:,3),'b','LineWidth',5);
plot3(yAxisPoints(:,1),yAxisPoints(:,2),yAxisPoints(:,3),'g','LineWidth',5);
plot3(zAxisPoints(:,1),zAxisPoints(:,2),zAxisPoints(:,3),'k','LineWidth',5);
scapula.InferoSuperior.plane.plot(80);
end
end
end
c4science · Help