Professional Documents
Culture Documents
Timothy R. Vittor
Richard A. Willgoss
Tomonari Furukawa
University of New South Wales
Sydney, NSW 2052
Australia
tvittor@hotmail.com; r.willgoss@unsw.edu.au; t.furukawa@unsw.edu.au
1
serial N-link DOF reconfigurable manipulator. This made minimizing the motion of individual actuators to achieve
the modular reconfigurable robot advantageous in making either local optimization as in [Liegeois, 1977] or global
a system adaptable to different given tasks and unknown optimization as in [Chernousko, et al., 1994].
environment. NASA has produced manipulators for
inspection purposes with both redundancy and high 2 Modular Decentralized Control
dexterity [Marzwell and Slifko, 1995; Williams II and
Mayhew IV, 1997]. The major limitation of its design is As mentioned above, the means of describing mechanical
its inability to negotiate obstacles in unmapped manipulator systems can be portrayed in two methods as
environments and has sporadic end effecter motions, both shown in Figure 1.
of which are undesirable.
2.1 Centralized Method
The implementation of a reconfigurable modular
manipulator raises a further problem as to how the The centralized method, a top-down approach, regards the
manipulator relates to its newly acquired immediate motion of each actuator as determined by a central
environment. Researchers in multi-robot systems are processor. Stereo vision is used to determine x d , the 3-
n
currently addressing such issues, investigating the co-
operative multi-robot behavior to flock, disperse, dimensional displacement between the end effecter and
aggregate, forage, collectively explore environments and the goal. This error is transformed using inverse
follow trails [Arai et al., 2002]. Research in this field is kinematics to find the desired end effecter position
however, theoretical with little practical application relative to the manipulator’s base co-ordinate system.
[Jantapremjit et al., 2001].
1 −1 2 −1 n −1 −1 n −1 n
Current research in multi-robot systems has b
xd = 0 T 1 T ....n − 2 T n −1 T xd (1)
produced frameworks for team motion co-ordination as
well as novel communication methods for self-
where
reconfigurable robots [Shen et al., 2002]. This is known
as an Adaptive Distributed Control (ADC) protocol that
produces hormone like messages used to produce C yi S yi S xi S yi C xi 0
locomotion in dynamic reconfigurable environments. The 0 C xi − S xi 0
=
i −1
protocol is distributed and fault tolerant, allows for i −1 T (2)
collaborative behavior, asynchronous coordination and − S yi C yi S xi C yi C xi li
scalability. The limitation of the protocol is that only one
0 0 0 1
hormone can be acted on at a time and numerous rule
bases are required in each module for the various motions.
This method allows for an effective and novel means of
C xi = cos θ xi ( ) ( )
, C yi = cos θ yi
communication between connected modules. S xi = sin (θ ) xi
, S y2 = sin (θ ) yi
The field of robot applications to date has largely
been dominated by the requirements of high stability, high
speed and precise movement. As robot functions have
evolved from controlled stable applications to dynamic
uncontrolled environments, the desire to incorporate
redundancy to the above requirements has become
essential. Kinematic redundancy is favorable in robots as
it allows increased dexterity, versality and collision
avoidance capabilities. Though numerous applications
have been established where kinematic redundancy is
considered favorable, the kinematic control of such
systems remains a problem, with cross couplings between
actuated motions.
In this paper, the nature of redundant system
controllability is investigated, and whether it can be
improved through the exploitation of the mechanical
systems layout and decentralized control modeling. To
deal with the redundancy problem in manipulators, two
approaches, namely the centralized and decentralized
methods, have been dealt with. The first approach
imposes constraints on the system, thereby reducing Figure 2. Transformation between links
redundancy, but still for singularity to occur. This method
is commonly referred to as the “extended Jacobian The transformation shown in Figure 2 is used to
method” [Baillieul, 1985]. The second approach limits find the general 2 DOF co-ordinate transformation
redundancy by constraining the end effecter motion to a between successive links in this paper assuming rotation
prescribed path. Overall motion is achieved by about the x and y axes [Craig, 1989].
2
Figure 1. Redundant Manipulator Mechanical System Layouts
Using the above transformation, it is possible to motion of all links. This leads to limited information
produce a complete transformation matrix from the end storage. Information is not analyzed centrally to
link to the manipulator base. However, even though the contribute to system actions. Motion is determined by
inverse kinematics can be found by matrix inversion, it multiple processors working independently to achieve a
fails to provide an unique solution, there being a choice of goal. Whereas the centralized method can be viewed as
two. The centrally controlled system based on a function top-down, the decentralized is bottom-up.
f 1 (⋅) where n ≥ 2 links namely, Even though the links appear in series on the
physical layout, they operate independently of each other,
[θ x1 ,θ y1 ,....,θ xn ,θ yn ]
T
(
= f 1 b x d , l1 ,...., l n ) (3)
eliminating the central full reconstruction of the
manipulator kinematics within one controller. Further, it
removes the requirement of the central controller, as no
cannot determine the actions of redundant manipulators, reconstruction of information is required once distributed
as there are an infinity of solutions that can achieve a among the links.
given goal. The removal of the central processor coupled with
This has led to determining optimal paths whereby the uni-directional data flow along the arm allows for
multiple solutions are revised with anticipation of finding modularization of the system, as all data can now be
a single path through cost benefit functions. In centrally processed within the manipulator links. To achieve a
controlled systems, this method results in redundancy bottom-up approach in a system, each module must view
largely complicating a system’s controllability since the goal from an unique perspective, utilizing the system’s
singularities have to be bypassed for any given goal. redundancy and goal data flow modified by each link. The
Advantages of central system control allow for desired angular motions can be found for each link,
total control of the manipulator and can also be viewed as
action-based because the central processing unit
calculates all required motion of each actuator prior to
[θ xi , θ yi ]T
= f 2 (x )i
err i = n, n − 1, n − 2... (4)
3
If each link has an embedded microprocessor,
manipulator motion can be achieved through Mechanical Two DOF actuators Mechanical
decentralized control, with links acting independently to Flange Flange
achieve an overall goal.
A further characteristic of the method is the lack of
Input Output
a base reference in the system. This allows for the
Output Input
approach not to be limited by the number of links in the
manipulator. Modules can be added or removed from the
system without modification to system controllability. Figure 4. Link Schematic
4
600 600
500 500
400 400
) )
m 300 300
m
m
( m
(
Z 200 Z 200
100 100
0 0
500 500
600 600
400 400
0 200 0 200
0 0
-200 -200
-500 -400 -500 -400
Y (mm) -600 Y (mm) -600
X (mm) X (mm)
600 600
500 500
400 400
) )
m 300 300
m
m
( m
(
Z 200 Z 200
100 100
0 0
500 500
600 600
400 400
0 200 0 200
0 0
-200 -200
-500 -400 -500 -400
Y (mm) -600 Y (mm) -600
X (mm) X (mm)
In the simulation the length of each link is assumed representation of the motion observed. Figure 6(a) shows
to be constant, resulting in 12 DOF motion, where each that no overshoot exists during the final approach of the
link’s angles are known only to the link itself. goal.
A further characteristic, as observed in Figure 6(b),
4 Results is that the final approach by the end effecter to the goal is
eventually limited to the z-axis in the reference frame of
Figure 5 shows the goal (300,300,350) can be reached by the end effecter. This is favorable in that one normally
paths that look close to optimal, covering all the possible approaches an object in the z direction in order to
initial conditions in approaching the goal. In observing the manipulate it.
path generated, the common goal is reached from four Figure 7 shows that there is proportionately more
initial conditions in quadrant on the ground plane. Stable overshoot present in links when moving further from the
motion is observed in each of the links as well as the base. This can be observed in both x and y actuators,
overall end effecter motion. The control method appears though overshoot is more prominent around the y-axis.
to be both versatile and robust. Singularities are avoided if This is consistent with the transformation choice in the
the length of the deployed arm is greater than the distance simulation where rotation occurs around the y-axis
to the goal. If not, then the arm can be shown to point followed by the x-axis. Movement of the end effecter is
directly at the goal and measure the shortfall in distance. larger for equal movements of actuators in going from the
Attention was then turned to analyzing one end effecter to the base, leading to more
particular manipulator motion with the end effecter overcompensation as we move out from the base along
initially at (-600,0,0) keeping the same goal. Motion of the arm.
the end effecter relative to the base is shown in Figure The error profiles in Figure 7, as observed by each
6(a) and is composite, disguising the motion of each link, link include not only the motion of the individual link, but
demonstrating decentralized bottom-up control. In Figure also incorporate motion of the five other links. Figure 8
6(b), it can be noted that the end effecter appears to shows, that in attempting to reach the goal, there is a
overshoot the observed goal in all three axes when prominent directional change in the motion profile of
approaching the goal. This, however, is not a true links positioned further from the base. The overshoot in
5
Figure 7 can be clearly correlated with the relative link returning close to their original values. When viewing the
motion profiles. The changes in motor directions as overall motion in Figure 5 such motion is desirable in
observed in Figure 8 appear undesirable e.g. link 6 angles finding a smooth path to the goal.
-600 -1000
0 500 1000 1500 2000 2500 3000 3500 0 500 1000 1500 2000 2500 3000 3500
time (ms) time (ms)
Link 1 Angular Error Vs Time Link 2 Angular Error Vs Time Link 3 Angular Error Vs Time
150 150 150
Around Y-axis Around X-axis Around X-axis
Around X-axis Around Y-axis Around Y-axis
100 100 100
50 50 50
) ) )
g g g
e 0 e 0 e 0
d( d( d(
r r r
or or or
r r r
E E E
-50 -50 -50
Link 4 Angular Error Vs Time Link 5 Angular Error Vs Time Link 6 Angular Error Vs Time
200 200 200
Around X-axis Around X-axis Around X-axis
Around Y-axis Around Y-axis Around Y-axis
150 150 150
100 100
100
50 50
) 50 ) )
g g g
e e 0 e 0
d( d( d(
r r r
or 0 or or
r r r
E E -50 E -50
-50
-100 -100
-100 -150
-150
6
Link 1 Actuator Angle Vs Time Link 2 Actuator Angle Vs Time Link 3 Actuator Angle Vs Time
0 50 30
Around X-axis Around X-axis
-10 Around Y-axis Around Y-axis
40
20
-20
30
-30 10
) ) )
g g 20 g
e e e
d( d( d(
-40
el el el
g g 10 g 0
n n n
A -50 A A
r r r
ot ot ot
a a 0 a
ut ut ut
c -60 c c -10
A A A
-10
-70
-20
-80 -20
Around X-axis
Around Y-axis
-90 -30 -30
0 500 1000 1500 2000 2500 3000 3500 0 500 1000 1500 2000 2500 3000 3500 0 500 1000 1500 2000 2500 3000 3500
time (ms) time (ms) time (ms)
Link 4 Actuator Angle Vs Time Link 5 Actuator Angle Vs Time Link 6 Actuator Angle Vs Time
30 25 25
Around X-axis Around X-axis Around X-axis
25 Around Y-axis 20 Around Y-axis 20 Around Y-axis
20
15 15
15
10 10
) ) )
g g g
e 10 e e
d( d( d(
5 5
el el el
g 5 g g
n n n
A A 0 A 0
r r r
ot 0 ot ot
a a a
ut ut ut
c c -5 c -5
A -5 A A
-10 -10
-10
7
7 Future Work [Kelmar and Khosia, 1990] L. Kelmar, and P. Khosia,
“Automatic generation of forward and inverse
For the system demonstrated in this paper, time constants kinematics for a reconfigurable modular manipulator
on each module were the same. To further improve the system” Journal of Robotics Systems Vol.7 No.4, pp.
approach characteristics of the end effecter to the goal, 599-619, 1990.
changing these time constants in some optimal way will [Kondo and Ting, 1998] Naoshi Kondo, and K.C. Ting,
“Robotics for Bioproduction Systems” Published by
be considered. ASAE, The Society for Engineering in Agricultural,
Much scope exists for future work in the food, and biological systems, 1998.
optimization of decentralized control theory, as much in [Liegeois, 1977] A. Liegeois, “Automatic Supervisory
automated fruit picking application as in the broad field of Control of the Configuration and Behaviour of Multi-
redundant system control. body Mechanisms”, IEEE Trans. System, Man and
Work is currently being undertaken to construct a Cybernetics, Vol. SMC-7, pp. 868-871, 1977.
physical system with which to demonstrate the practical [Marzwell and Slifko, 1995] N.I. Marzwell, and A. Slifko,
application of decentralized control theory in fruit “Visual Inspection Planar Serpentine Manipulator”
picking. NASA’s Technology 2005 conference, Chicago, IL.,
October, 1995.
[Paredis et al., 1996] C.J.J. Paredis, H.B. Brown, P.K.
References Khosla, “A Rapidly Deployable Manipulator System”
IEEE International Conference on Robotics and
[Arai et al., 2002] Tamio Arai, Enrico Pagello, and Lynne
Automation, Minneapolis, Minnesota, April, 1996.
E. Parker, “Editorial: Advances in Multi-Robot [Pl'a et al., 1993] F. Pl'a, F. Juste, and F. Ferri, “Feature
Systems” IEEE Transactions on Robotics and
extraction of spherical objects in image analysis: an
Automation, 18(5), pp. 665-661, October, 2002. application to robotic citrus harvesting” Computers and
[Baillieul, 1985] J. Baillieul, “Kinematic Programming Electronics in Agriculture, 8:57-72, 1993.
alternatives for redundant manipulators” Proc. IEEE [Rabatel, 1988] G. Rabatel, “A vision system for Magali,
Int. Conf. Robotics and Automation, pp. 722-728, the fruit picking robot” Paper 88293, AGENG88, Int.
March, 1985. Conf. Agricultural Engineering, Paris, 1988.
[Chernousko, et al., 1994] Felix L. Chernousko, Nikolai [Recce et al., 1996] M. Recce, J. Taylor, A. Plebe, and G.
N. Bolotnik, and Valery G. Gradetsky, “Manipulation Tropiano, “Vision and Neural control for an orange
Robots: Dynamics, Control and Optimization” CRC harvesting robot” International Workshop on Neural
Press, Florida, USA, pp.170-210, 1994. Networks for Identification, Control, Robotics and
[Craig, 1989] J.J. Craig, “Introduction to Robotics: Signal/Image Processing, Venice, Italy, IEEE
Mechanics and Control” Addison-Wesley Publishing Computer Soc. Press, pp. 467-484, 1996.
Co., Inc., Reading, MA, 1989. [Sarig, 1993] Y. Sarig, “Robotics of Fruit Harvesting: A
[Gieling et al., 1995] Th.H. Gieling, Eldert J. Van Henten, State-of-the-art Review” Journal of Agricultural
E.A. Van Os, O. Sakaue, and A.T.M. Hendrix, Engineering Research, 54, pp. 265-280, 1993.
“Conditions, demands and technology for automatic
[Schmitz et. al. 1989] D. Schmitz, P. Khosia, R. Hoffman,
harvesting of fruit vegetables” Acta Horticulture 440: and T. Kanade, “CHIMERA: A real-time programming
360-365, 1995.
environment for manipulator control”, Proc. IEEE Int.
[Hayashi et al., 2000] Shigehiko Hayashi, Katsunobu Conf. Robotics and Automation, Vol.2, pp. 846-852,
Ganno, and Yukitsugu Ishii, “Visual feedback guidance
1989.
of manipulator for eggplant harvesting using fuzzy [Shen et al., 2002] Wei-Min Shen, Behnam Salemi, and
logic” J.SHITA, 12(2), pp. 83-92, 2000.
Peter Will, “Hormone-Inspired Adaptive
[Hayashi et al., 2002] Shigehiko Hayashi, Katsunobu Communication and Distributed Control for CONRO
Ganno, Yukitsugu Ishii, and Itsuo Tanaka, “Robotic
Self-Reconfigurable Robots” IEEE Transactions on
Harvesting System for Eggplant” JARQ 36(3), pp. 163- Robotics and Automation, 18(5), October, 2002.
168, 2002.
[Tillet, 1993] N.D. Tillet, “Robotic Manipulators in
[Henten et al., 2002] Eldert J. Van Henten, Bart A.J. Van horticulture: a review” Journal of agricultural
Tuijl, Jochen Hemming, Jan G. Kornet, and Jan
engineering research 55: pp. 88-105, 1993.
Bontsema, “CUPID – An Autonomous Cucumber [Vittor et al., 2004] Timothy R. Vittor, Richard A
Picking Device” Proceedings of Mechatronics,
Willgoss, and Tomonari Furukawa, “Modular
University of Twente, June, 2002. Decentralized Control of Reconfigurable Redundant
[Jantapremjit et al., 2001] P. Jantapremjit, and D. Austin,
Manipulator Systems” Proc. IEEE Int. Conf. Robotics
“Design of a modular Self-Reconfigurable Robot” and Automation, (to be submitted).
Australian Conference on Robotics and Automation,
[Williams II and Mayhew IV, 1997] Robert L. William II,
Sydney, November, 2001. and James B. Mayhew IV, “Obstacle-Free Control Of
[Kelmar and Khosia, 1988] L. Kelmar, and P. Khosia,
The Hyper-Redundant Nasa Inspection Manipulator”
“Automatic generation of kinematics for a Proc. of the Fifth National Conf. on Applied Mechanics
reconfigurable modular manipulator system” Proc. and Robotics, October 12-15, 1997.
IEEE Int. Conf. Robotics and Automation,
Philadelphia, USA, 1988.