- #1
- 11
- 0
I have a three link revolute manipulator at the origin. I know all the link lengths. The joint angle for the third link is coupled to the second such that Theta3 = k*Theta2. I want to determine the joint angles (thetas) of the manipulator given that the third link should lie on a line an angle Alpha from the x - axis at a known position.
I believe the solution should be unique but I can't seem to wrap my hands around an equation that proves it.
To summarize:
Knowns:
Link lengths: L1, L2, L3
Angle of line: Alpha = Theta1 + Theta2 + Theta3 = Theta1 + Theta2(1+k)
And it's position
Coupling function: Theta3 = Theta2 * k
Unknowns
Theta1, Theta2, Theta3
Joint positions, X1,Y1, X2, Y2, X3, Y3
I tried assuming I knew one of the joint end positions, i.e X2, Y2, because my intuition tells me there's got to be only one solution. Then maybe I could find another set of equations and somehow cut it out. Here's my work so far:
By law of cosines:
X2^2 + Y2^2 = L1^2 + L2^2 - 2L1L2cos(beta)
where beta is 180 - Theta2 (see diagram)
beta = acos((L1^2 + L2^2 - (X2^2 + Y2^2)) / (2L1L2))
Theta2 = 180 - beta
Theta3 = (180 - beta) * k
Theta1 = alpha - Theta2 - Theta3
But now I'm stuck because I can't come up with another good set of equations to remove X2 and Y2 since I don't actually know them. Any insight or advice would be great.
Thanks!
I believe the solution should be unique but I can't seem to wrap my hands around an equation that proves it.
To summarize:
Knowns:
Link lengths: L1, L2, L3
Angle of line: Alpha = Theta1 + Theta2 + Theta3 = Theta1 + Theta2(1+k)
And it's position
Coupling function: Theta3 = Theta2 * k
Unknowns
Theta1, Theta2, Theta3
Joint positions, X1,Y1, X2, Y2, X3, Y3
I tried assuming I knew one of the joint end positions, i.e X2, Y2, because my intuition tells me there's got to be only one solution. Then maybe I could find another set of equations and somehow cut it out. Here's my work so far:
By law of cosines:
X2^2 + Y2^2 = L1^2 + L2^2 - 2L1L2cos(beta)
where beta is 180 - Theta2 (see diagram)
beta = acos((L1^2 + L2^2 - (X2^2 + Y2^2)) / (2L1L2))
Theta2 = 180 - beta
Theta3 = (180 - beta) * k
Theta1 = alpha - Theta2 - Theta3
But now I'm stuck because I can't come up with another good set of equations to remove X2 and Y2 since I don't actually know them. Any insight or advice would be great.
Thanks!
Attachments
Last edited: