Find Joint Angle for Animation

4 次查看(过去 30 天)
I have a stick figure animation and would like to display joint angles on the plot... I am having trouble calculating the joint angles...
The angles appear to flip (ex change from 170 degrees to 10 degrees) and at times all together wrong...
Here is an example of my code... based on code I found online...
u1(:,1)=M1(:,2); u1(:,2)=M2(:,2); u1(:,3)=M3(:,2);
v1(:,1)=M1(:,1); v1(:,2)=M2(:,1); v1(:,3)=M3(:,1);
for i=1:length(u1);
CosTheta1(i,1)= dot(u1(i,:),v1(i,:))/(norm(u1(i,:))*norm(v1(i,:)));
ThetaInDegrees1(i,1)=acos(CosTheta1(i,1))*180/pi;
end
M1 is point #1, M2 is point #2 & M3 is point #3. Column 1 is Y data & Column 2 is X data. u1 & v1 are 3x1908. For my current file 'i' is is 1908.
I want to find the angle <123 with the vertex at M2.
Why am I getting wrong values? How do I prevent flipping?
Thanks ~Dan

采纳的回答

Richard Brown
Richard Brown 2012-7-12
编辑:Richard Brown 2012-7-13
You are taking the dot products of the wrong vectors! You need to take the vectors emanating from M2. The following should do the trick
u1 = M1 - M2;
v1 = M3 - M2;
% Easiest to normalise first
u1 = bsxfun(@rdivide, u1, hypot(u1(:, 1), u1(:, 2)));
v1 = bsxfun(@rdivide, v1, hypot(v1(:, 1), v1(:, 2)));
% Can compute the angle in one vectorised hit
theta_deg = acos(dot(u1, v1, 2)) * 180/pi;
edit I initially wrote the code for the M's being transposed. Fixed now.
edit2 Missing parenthesis added in last line
  5 个评论
Daniel
Daniel 2012-7-12
I think I figured it out...
theta_deg = acos(dot(u1, v1, 2) * 180/pi;
should be...
theta_deg = acos(dot(u1, v1, 2)) * 180/pi;
Richard Brown
Richard Brown 2012-7-13
oops! I wrote the code without actually testing it

请先登录,再进行评论。

更多回答(0 个)

类别

Help CenterFile Exchange 中查找有关 Surface and Mesh Plots 的更多信息

Community Treasure Hunt

Find the treasures in MATLAB Central and discover how the community can help you!

Start Hunting!

Translated by