Académique Documents
Professionnel Documents
Culture Documents
Abstract:
Introduction:
We note that our robot-arm may reach M through bowing shoulder Q1, elbow Q2 and
wrist Q3 and rotating shoulder-base Q0. Q4 has no positioning influence. It only allows
the claws to grab at a better angle. So strictly speaking we have only 4 DOFs. With a
closer look we notice that the points M, O1, O2, O3, always are situated in the same
plane, when Q0 is rotating.
Thus every point may be fixed by looking at Q0 and the two-dimension coordinates of
the M in the rotating plane P.
In most of the cases points are initially defined and entered by Cartesian coordinates in
what is so called the world coordinate-system. In a first step these world-coordinates have
to be transformed to those coordinates in the (O1, O2, O3) plane and a certain unique
value of Q0. With the observation that by rotating Q0, the y-coordinates are the same in
the world-system and in P, the x-coordinate in
P is deduced by Pythagoras theorem.
Figure 3: view from above
Defining a point M(x, y) in a plane with rotations of three segments is obviously possible,
but presents some important ambiguity. In fact there are infinite possibilities in
determining M in terms of (Q1, Q2, Q3). This gives the robot a lot of freedom, but also
the necessity of choice, which is the second step to operate.
There are many ways to deduce Q1, Q2 and Q3 from M(x, y). The following section
describes one of the simplest.
Geometrical Solution
Figure 5: Geometrical Solution
Given the robot-arm with lengths a, b and c; given the point M(x, y); given the circle with
center O1 and radius a.
We arbitrarily fix the radius r2 of the circle with center M respecting the restrictions that
at least one intersection of both circles exist and that r2<=b+c. We choose one of the
intersections as point O2. The point O3 may be fixed through the intersection(s) of the
circle with center M and radius c and the circle with center O2 and radius b.
This geometrical approach graphically gives us the three points O1, O2 and O3 as circle
intersections. The angles Q1, Q2 and Q3 may be easily deduced.
Materials to be used: