- #1
RodriRego
- 3
- 0
Homework Statement
Hello. My colleague and I have been struggling with this assignment where we have to:
- Given the position and orientation of the end-effector of a robotic arm with 6 degrees of freedom get the joint angle values (inverse kinematics). The robotic arm in question is the SainSmart 6 DOFs robotic arm.
Homework Equations
Axis Position
1 - Geometric Approach (T03)
2 - Algebraic Approach (T36)[/B]
The angles 4, 5 and 6 would be obtained from this:
T06 = T03*T36
T36 = inverse(T03)*T06
T06 is known from the orientation and position of the end-effector (given info);
T03 would be obtained through the geometric approach.
The Attempt at a Solution
We managed to get expressions for the first 3 angles through a geometric approach and the law of cossines. However, to do so we assumed we knew the point at the tip after the 3rd joint. We know how to procede to get the other 3 angles, through an algebraic approach, however, to use that we need the transformation matrix from join 3 to 0 (T03), which would be fine if we actually knew the position of the point at the tip after the 3rd joint.
To sum up, we are struggling at joining the two approaches because of the assumptions made to achieve the geometric approach.