→ jatj:plot(alpha, 'd-'); 06/20 12:09
噓 jatj:也不回報收到了或公不工作... 06/22 23:54
→ jatj:射後不理嘛 06/22 23:54
→ maygood:樓上抱歉~~這幾天在忙~沒有上來看結果~感謝您的回覆 06/23 20:50
我在寫動作分析的角度問題時
我寫了以下的程式
但是plot出來的線不連續
請問是哪裡出問題
跪求高人指點
感激!!!!!!!
len=length(D_Lanklem(:,1));
for i=1:len
Shank_COM(i,:)=Ram(i,:)+0.567.*(Rkm(i,:)-Ram(i,:));
Foot_COM(i,:)=(D_Rtoe(i,:)+0.5.*(D_Rheel(i,:)-D_Rtoe(i,:)));
%% shank coordinate system
Z_shank(i,:)=(Rkm(i,:)-Ram(i,:))./(norm(Rkm(i,:)-Ram(i,:)));
X_shank(i,:)=cross(-VS(i,:),c(i,:))./norm(cross(-VS(i,:),c(i,:)));
Y_shank(i,:)=cross(Z_shank(i,:), X_shank(i,:));
R_shank(i*3-2:i*3,:)=[X_shank(i,:)' Y_shank(i,:)' Z_shank(i,:)'];
%% foot coordinate system
Z_foot(i,:)=(D_Rtoe(i,:)-Ram(i,:))./norm(D_Rtoe(i,:)-Ram(i,:)); % toe和ankle中點連線
X_foot(i,:)=cross(-Z_foot(i,:),e(i,:))./norm(cross(-Z_foot(i,:),e(i,:)));
Y_foot(i,:)=cross(Z_foot(i,:), X_foot(i,:));
R_foot(i*3-2:i*3,:)=[X_foot(i,:)' Y_foot(i,:)' Z_foot(i,:)'];
%% 計算角度
R_ankle(i*3-2:i*3,:)=R_shank(i*3-2:i*3,:)'*R_foot(i*3-2:i*3,:);
Beda(i,:)=asind(-R_ankle(i*3-1,3));
A=Beda(i,:);
alpha(i,:)=180/pi*atan2((R_ankle(i*3-2,3)/cos(A)),(R_ankle(i*3-1,3)/cos(A)));
gama(i,:)=180/pi*atan2((R_ankle(i*3-1,1)/cos(A)),(R_ankle(i*3-1,2)/cos(A)));
angle_ankle(i,:)=[alpha(i,:) Beda(i,:) gama(i,:)];
a=angle_ankle(i,:);
%% plot
subplot(2,2,1),plot(alpha,'d');
subplot(2,2,2),plot(Beda,'o');
subplot(2,2,3),plot(gama,'x');
end
--
※ 發信站: 批踢踢實業坊(ptt.cc)
◆ From: 163.15.154.17