Design and Implementation of Stewart Platform
Design and Implementation of Stewart Platform
ABSTRACT
From the time it was proposed, there had been no interest to this
mechanism for about 15 years until Hunt stated the advantages of using
parallel manipulators. After 1983 researchers acknowledged its high load
capacity and precise positioning capabilities, and started to make detailed
analysis of the structure. Today's popular parallel manipulator known as
Stewart Platform reached its generalized form which consists of six linear
actuators that are connected to the base with spherical or universal joints
and to the moving platform with spherical joints [4]. From 1980's onward,
Stewart Platform, gained popularity mainly because of the advantages
offered by parallel manipulators over the serial ones [3].
Figure 1.4. The first flight simulator based on an octahedral hexapod in
mid 1960s (courtesy of Klaus Cappel)
Parallel manipulators have been used since 1980's when high load carrying and
precise positioning capability is needed. Since the time it was proposed, it has
been used as a flight simulator. Besides, a wide variety of applications have
benefited from this design. A few of the industries using Stewart Platform
design include aerospace and defense, automotive, transportation, machine tool
technology, and recently the platform is used in medical applications for its
precise positioning capability.
OBJECTIVE
▪ Repeatability of ±0.5 µm
History
Applications
Z
Accurac
y
Angular < 1°
Positional 2° 0.25 in
0.25 in
19
The mechanical properties were set to allow the robot to
fit comfortably on a desk surface, and be moved by one
person. The specified range of motion demonstrates that
the Stewart Platform can properly utilize each of its six
degrees of freedom. The robot is not being used for
tooling or processing applications, and does not need to
be extremely accurate; it must be accurate enough to
pass visual observation by the user.
CHAPTER 2
LITERATURE SURVEY
Forward Kinematics
20
The most challenging problem concerning the Stewart problem has
been the forward kinematics analysis since late 1980's. The problem is to
determine the assembly configurations when base points, platform
geometry and link lengths are given. In other words, it is the problem of
solving the following kinematics relation
|| t + R* p – b ||2 = L 2
21
6i =
22
1 to 6
23
(2.1)
i i i
where bi
24
denotes the
25
ith
26
base point,
27
pi the
28
ith
29
platform point, R the rotation, t the
30
Li . Analytical solution for the general
31
mechanism [10-16]. A third approach converts the platform to an
equivalent serial mechanism, and the constraints on the joint angles are
utilized to derive the remaining equations for the forward kinematics [17-
20]. These approaches on specialized platforms enabled closed form
solutions for the simple 3-3 case and for more complicated 5-5 and 6-4
cases. Beside the coincident connection points, some researchers [21-23]
proposed the use of angular constraints between six pairs of points, lines,
and/or planes in the base and the moving platform to obtain the solution
of the problem in closed form.
Apart from the above-mentioned approaches, a decomposition
scheme was proposed by Nair and Maddocks [24] for the forward
kinematics problem. A linear dependent part and a nonlinear
independent part were suggested. Faugere and Lazard
[25] classified all the m - n cases according to the combinations of
connection points,
Numerical Schemes
32
to obtain all the real solutions [28-30]. In order to find all the real roots,
Innocenti and Parenti-Castelli [31] used the analytical result of the 5-5
case by a unidimensional search over the value of the removed fictitious
leg length to obtain a numerical solution for the 5-5 case. Dasgupta and
Mruthyunjaya suggested an efficient 3 dimensional search and
verification algorithm based on pure geometric constraints [32].
Although numerical methods have computational advantages and
can be utilized to find the real solutions, they are not useful to predict
total number of the roots in the complex domain. Raghavan [33] was able
to find all distinct solutions in a complex domain by tracking 960 paths
which suggest the upper bound for the number of configurations for the
Stewart Platform to be 40.
33
Analytical Methods for General 6-6 Case
34
Other Approaches
35
motion of hip-attachment points onto their subspaces enables conversion
of the underlying direct kinematics to a linear algebraic system to resolve
the ambiguity. The linearization procedure, a polar least square estimate,
leads to a fast computation. Implementation of neural networks by Geng
and Haynes [46] constitutes yet another research effort for the forward
kinematics problem.
Dynamic Analysis
36
dynamic equations for the Stewart Platform through the pure Newton–
Euler approach. Nguyen and Pooran [49] and Lebret et al.
[50] developed Lagrange equations of motion, and the latter gave some
insight into the structure and properties of these equations. Lee and Geng
[51] studied the dynamics of a flexible Stewart Platform manipulator
using Lagrange formulation assuming platform to be rigid. The dynamic
formulation was established by a combination of screw theory with the
principle of virtual work by Gallardo et al [52].
Principle of virtual work formulation is based on the computation of
the energy of the whole system with the adoption of a generalized
coordinate framework [52]. To simplify this approach, theory of screws,
which is a way to express velocities and forces in three dimensional
space, combining both rotational and translational parts, was used.
37
Wang and Gosselin [53] and Tsai [47] also used the principle of virtual
work to perform the dynamic analysis of the spatial six DOF parallel
manipulators with prismatic actuators.
Koekebakker et al. [54] provided the dynamic formulation of the
Stewart Platform through Kane's method. As Liu et al. [55] mentioned,
Kane's equation analyses the dynamics of a multibody system with N
bodies using the relation
F+F* =0
38
(2.2)
39
equations to avoid the difficulties mentioned earlier. Accounting for the
parallel configuration of the Stewart Platform, and combining the
advantages of both Newton–Euler method and Lagrange formulation, the
explicit compact closed-form dynamic equations of Stewart Platform can
be derived in the task space [58].
40
Flexure Joints
41
between flexure mechanisms and conventional joints is the consideration
of kinematics stability and the design issue.
Wei et al. [62] stated that the flexure hinges have a lot of advantages
compared to the others such as ball joints or universal ones. Because of
the fact that they are manufactured monolithically, they are very
compact in structurally. Besides, they have a lot of advantages like
having no backlash, no friction, no lubrication and no error due to
lubrication. However, they have a limited range of motion as they have
to flex without sustaining any plastic deformation at the joints.
42
Figure 2.1. Wide range flexure-hinge based parallel manipulator
43
Closed-form equations are formulated to characterize their compliance
both for the active rotation and all other in and out-of-plane motions.
To sum up, Gui-Min et al. [63] represented the compliance model of
the right circular hybrid flexure hinges. The close-form solutions were
provided to characterize the flexibility and precision of rotation. The
precision model with stress considerations were verified with the finite
element analysis. Their results show that the most suitable solutions for
large displacements and high accuracy are reached with the right circular
hybrid flexure hinges (Figure 2.2) rather than the right circular ones and
corner filleted hinges.
44
Figure 2.2. Right circular hybrid flexure hinge
45
Figure 2.3. Flexure hinges' configurations with their
compliant/sensitive axis
46
Apart from these, Paros and Weisbord [64] presented two-axis
circular flexure hinges which are designed in serial configuration.
47
Design of Symmetric Conic-Section Flexure Hinges Based on
Closed-form Compliance Equations
The most widely used formulation for flexure hinge design was
proposed by Lobontiu et al. [69]. They derived closed form equations of
compliance for conic section (circular, elliptic, parabolic and hyperbolic)
flexure hinges.
48
Figure 2.5. Conic section flexure hinges
49
excluded from the workspace in order to improve the performance.
There has been ongoing research to find the singularities of Stewart
Platform, and many different solutions have been proposed.
When Hunt stated the advantages of such parallel manipulators in
1978, he also mentioned a singular configuration when the moving plate
rotates about a line intersected by all six legs [71]. In 1986, Fitcher [72]
found another singular configuration which occurs when the moving
plate is kept parallel to the base, and rotated 90 degrees about z-axis. In
1988, Merlet [73] used Grassmann Geometry to find
50
possible singular configurations. He found other possible singular
configurations in addition to the ones stated by Hunt and Fichter. All of
these approaches use geometric information; however, it is hard to
provide a unified relation this way. Singular configurations can be found
case by case if a modified or new Stewart Platform is designed. A
singularity equation is needed to create a unified relation [74]. In 1993,
Sefrioui and Gosselin [75] derived an analytic expression of the
singularity loci for a planar three DOF parallel manipulator. Until 1996
there had not been a deep study on the analytic expression of singular
configurations in six DOF parallel manipulators. In 1996, St-Onge and
Gosselin [76] derived an analytic equation directly from the property of
the determinant, which is a fourth-degree polynomial of the position
variables.
In addition to the research on the singular configurations,
characteristics of the singular configurations have been studied [74]. In
1990, Gosselin and Angeles [77] classified the singularities of the closed-
loop kinematics chain mechanisms into three categories in general form.
In 1991, Ma and Angeles [78] suggested another classification of the
singular configurations, and derived conditions for the architecture
singularity.
Other studies on singularity includes the work by Kim et al. [74]
who used extra sensors on Stewart Platform to reduce the complexity of
the position kinematics problem, and to find singular configurations. In
1999, they used extra sensors to simplify velocity equation as it was
done in the forward position kinematics case, and derived the singularity
equation directly from the velocity equation. Singular configurations can
also be found by forming the Jacobian symbolically. If determinant of
the Jacobian is set equaled to zero, singular configurations can be
extracted from this equation. However, since each Jacobian element is
51
quite complicated, Su et al. [79] proposed a simple singularity analysis
for Stewart Platform using Genetic Algorithm (GA). In this method, the
square of the determinant of Jacobian matrix is selected as the object
function, and the minimal value of the objective function is found in the
trajectory workspace using GA. If the minimum of this objective
function is zero, then there are certain singularities. Otherwise, there is
no singularity position for that Stewart Platform.
52
Figure 2.6. Hunt's singular configuration (Legs' vectors cross the same line in
space)
53
CHAPTER 3
METHODOLOGY
54
2 More Images
We designed the platform using servo motors because they are easier to find
and cheaper than linear actuators. The range of motion is a bit more limited, but
we were designing for expressiveness and not so much for range.
55
- 1x RaspberryPi (with 5V/2A power supply)
- 6x Dynamixel AX-12A motors
- 1x UART circuit (with 12V/6A power supply)
- 1x aluminum base
- 1x plastic platform
- 12x M3 ball joints
- 6x threaded rods
- 6x servo brackets
- 6x servo horns
- lots of tiny screws
The servo brackets and horns came with the motors we bought, but we also
modeled them in case we needed replacement parts. Simpler acrylic pieces can
be used to hold whatever object you need on top of the platform, but since we
wanted to hold cellphones in an upright position, we ended up designing a
custom platform. STLs are attached here. The servo horns can also be cut from
1/8” acrylic or wood using a laser cutter.
Step 2: Testing
We tested our AX-12A library and motor driver circuit using one of the motors
attached to our platform. We quickly realized that the servos on the platform
can’t be driven independently of each other; in most cases, all six motors have
to move simultaneously in order to achieve a desired position or pose.
This is a video showing how all the motors are affected when we drive only one
motor up and down.
56
Step 3: Math: Papers
Unlike articulated robotic arms, the Stewart Platform’s inverse kinematics are
simpler than its forward kinematics. What this means is that it’s easier to
calculate the leg lengths and motor parameters given a desired position for the
platform, than to calculate where the platform is located for a given set of motor
parameters. This is fine; we really want the inverse kinematics anyway, and that
way we avoid solving a system of 18 non-linear equations with 40 possible
solutions.
Some of the papers that we found were not specific to servo-based Stewart
Platforms; they simply described the math based on desired leg lengths, and
sometimes assumed that linear actuators would be used. This is the case for
this MICS journal paper, which describes a very specific Stewart Platform and
focuses on its forward kinematics.
57
We also found two papers that were more specific for servos. This paper by
Filip Szufnarowski describes the inverse kinematic problem very nicely, but it
was this document by an unknown author from the Wokingham U3A Math
Group that had the most detail and cleanest notation. For example, this image
that labels all the relevant points of a Stewart Platform with their corresponding
coordinate system.
58
The inverse kinematics problem of a Stewart Platform can be broken up into
two stages:
(1) Given a desired position and orientation for the platform, how far is each
joint on the platform from its corresponding base joint,
and
(2) What servo angles, if any, put each platform joint in the positions calculated
in the previous step.
The first problem is easy to solve; once you have the appropriate points and
coordinate systems defined like in the above image, the distances between base
joints and platforms joints can be calculated with simple matrix operations for
rotation and translation.
Namely, the length of each leg is calculated using the li equation in the image
above. T is the translation vector between base coordinate system and platform
coordinate system (where you want the platform to move), bi and pi are the
locations of the joints in base and platform coordinate systems, respectively,
59
and PRB is a rotation matrix describing how you want the platform to rotate.
PRB is also described in detail in one of the images above.
60
The second part of the inverse kinematics problem is a little bit trickier. For
each servo, given a platform joint position P, relative to the base joint position
B, and fixed lengths for the servo horn a and support leg s, what is the servo
arm angle that satisfies the distance l calculated in the previous step.
Since l increases as you vary the servo arm angle from -90° to +90° (relative to
base plane), one way to solve for this angle is to do a binary search over the
angle values, and find the one that more closely satisfies all the distance
constraints. This is done on the code for this Stewart Platform.
But, the Wokingham U3A Math Group document actually steps through the
derivation of a closed-form expression for this angle, using some pretty sweet
geometry, algebra and trigonometry tricks.
61
The form of the equation for the angle is shown in one of the images above
(read the paper for the full derivation and definition of the variables).
We actually found a small bug in this part of the U3A document: instead of
using the p values for the platform joint positions in the platform coordinate
system, you have to use the q values, which are relative to the base coordinate
system.
We wrote a simple Stewart Platform simulator for our platform, to see the range
of movements that it will be able to achieve, and to double-check the math. The
code is in Processing, and is on github.
62
Once the math was verified, it wasn’t hard to extend the code to get real-time
communication going between the simulator and the platform. We used OSC to
send motor angle packets to the RaspberryPi controlling the platform, and a bit
of code to transform these angles into AX12-A motor commands. The code for
controlling the motors using the simulator is on github.
CHAPTER 4
BLOCK DIAGRAM
SWITCH
63
64
WORKING PRINCIPLE
In this project we are using to servo motor for motion control system. The
project is a productivity increasing feature in a factory. During the
manufacturing of this mechanism we had found many of intelligence that can be
given to it. We provide the basic functions like three motion. And the main
function, up down and rotation.
65
ADVANTAGES
5. Simple in construction
66
CONCLUSION
67
REFERENCES
1. Chung M., Malone E., Tolley M. T., Chepaitis A. J., Lipson H., (2008)
“Object Augmentation for the Visually Impaired Using RP”, Proceedings of the
19th Solid Freeform Fabrication Symposium, Austin TX, Aug 2008
4. Jongwon Kim, Chongwoo Park, Sun Joong Ryu, Jinwook Kim, Jae Chul
Hwang, Changbeom Park, Iurascu, C.C., “Design and analysis of a redundantly
actuated parallel mechanism for rapid machining” , IEEE Transactions on
Robotics and Automation, August 2001, Volume 17, Issue 4, p. 423-434.
7. Lipson, H., (2006) "A Relaxation Method for Simulating the Kinematics of
Compound Nonlinear Mechanisms", ASME Journal of Mechanical Design,
Volume 128, Issue 4
8. Malone E., Lipson H., (2007) “Fab@Home: The Personal Desktop Fabricator
Kit”, Rapid Prototyping Journal, Vol. 13, No. 4, pp.245-255
68
9. Masuda, T., “Specific Kinematic Changes in a Linear-Actuated Parallel
Mechanism According to Differences in Actuator Arrangement”, Proceedings
of the 2000 IEEE/RSJ Internal Conference on Intelligent Robots and Systems
11. Petko, M., Karpiel, G., “Mechatronic Design of a Parallel Manipulator for
Milling”, 2005 Proceedings IEEE/ASME International Conference on
Advanced Intelligent Mechatronics., p.759-764
12. Weiss, L. and Prinz, F., 1998, "Novel Applications and Implementations of
Shape Deposition Manufacturing,” Naval Research Reviews 1, Office of Naval
Research
69