Professional Documents
Culture Documents
Cira 2007 382906
Cira 2007 382906
Cira 2007 382906
2
Computational Intelligence in Robotics and Automation
Jacksonville, FL, USA, June 20-23, 2007
Abstract—This paper provides a minimum time algorithm to robot and object arrival time curves to obtain the optimal
intercept an object on the conveyor belt by robotic manipulator. solution. However, we made several distinctive contributions
The goal is that the robot is able to intercept objects on a in this paper as described below. First is that we considered
conveyor line moving at a given speed in minimum time. In the exhaustive cases where robot travel time functions are
order to formulate the problem, we introduce the robot and
object arrival time functions, and conclude that the optimal
dependent upon initial positions of robotic end-effectors.
point occurs at the intersection of these two functions. The Second contribution is that when we calculate robot travel
search algorithm for finding the intersection point between the time, we employed a trapezoidal velocity profile which is
robot and object arrival time functions are also presented to used in many industrial robots currently in use. Thus, we
find the optimal point in real-time. believe that robot travel time we obtained is more practical
and readily implemented to any commercially available
robots. Third contribution we made is that we presented a
I. INTRODUCTION
fast converging search algorithm so that real time application
The problem of catching a moving object on conveyor belt is more feasible in many cases.
by robotics manipulators is somewhat similar to ones of This paper is organized as follows. In Section 2, problem
hitting the baseball or table tennis ball with specially statement and object interception modes are presented. In
equipped robotic end-effector or hitting the incoming missile Section 3, the robot and object arrival time functions are
by an interceptor. There have been numerous studies on detailed for various cases. The real-time search algorithm to
catching the moving objects by robotic manipulators. We find the intersection point between two monotonic curves is
may categorize these studies to tackle this problem into three shown in Section 4. Conclusion is given in the last section.
approaches.
First approach is to employ vision processing to track the II. CONVEYOR SYSTEM WITH MANIPULATORS
moving object. Employing vision processing such as optical Figure 1 shows a typical robotic assembly line with a
flow, they track the motion of object and this information is conveyor system where objects are supplied in continuous
supplied to robot to handle the object. [1, 2, 3, 4] Second fashion to be handled by the robotic manipulator. This
approach is to employ prediction, planning, and system consists of a fixed CCD camera, a 6 DOF robot AT-2
execution(PPE) methodology. In PPE approach, the object by Samsung Electronics, and a host computer for vision
motion is predicted, and then robot motion is planned and processing. We assume that the conveyor belt moves at a
executed to intercept the object.[5, 6, 7, 8, 9] Third approach fixed speed, and a vision camera is installed at the beginning
is to employ navigation and guidance theory which has been of the conveyor line.
applied to track free-flying missiles.[10, 11, 12] Off-line
time-optimal algorithms to find the intersection point
employing traditional robotic time-optimal algorithms[13, 14,
15] has been also reported by various researchers.[16, 17, 18,
19] Their approach is different from above mentioned three
approaches in that they find the optimal solution in off-line.
In this paper, our goal is to find the minimum-time
rendezvous point to catch moving object, employing PPE
approach in real time. The approach shown in this paper is
similar to the one used in Croft. et. al.[9] in that we employed
The purpose of this paper is to search the optimal While robot arrival time curve, t r (x) , is generally not known
grasping point on which robot catches the object moving on in advance, we may obtain it when we are given specific point
the conveyor belt in minimum time. In order to grasp the on by employing a velocity profile curve. The object arrival
object in minimum time, we first need to identify the time, t o (x) , in conveyor belt system has rather simple form
candidate points on the conveyor belt and decide the optimal
as below since it usually maintains constant velocity.
point from these candidate points on which required grasping
time is minimal. We may classify the interception modes into
three cases, according to the rendezvous conditions. As
shown in Figure 2(a), the robot meets the object right on time
to ( x) = c1 × x + c2 for c1 , c 2 Î Â (1)
in the optimal mode. In the waiting mode shown in Figure
2(b), the robot arrives earlier than the object and waits for the
object. In the tracking mode shown in Figure 2(c), the robot
arrives after the object passed and thus has to track the object,
maybe in faster speed. In this paper, we develop the
algorithm to search the optimal point where the robot and
object meet simultaneously. Since the optimal point lies on
the conveyor belt line of a straight line, this is basically one
dimensional search algorithm.
363
FrBT1.2
(c)
364
FrBT1.2
365
FrBT1.2
and go to Step 2. x ], [ x , ~ x ], or [ ~
* *
mk mk x , x ] in improved binary search
k k fk
Step 6. Since there is no unique intersection point in
algorithm. This obviously results in the reduction of search
[ xik , x f k ], stop here.
region and expedites the iteration process as long as optimal
solution exists in new narrower range.
In Algorithm 4.1, the value of d is given based on the In order to claim the assertion that the new search range
desired accuracy level as in Eq.(3). If this value is too small, was narrowed and there exists the optimal solution in the new
then more accurate intersection point can be achieved, but the range, we assume that an unique intersection point exists in
disadvantage will be an increased number of steps and [ x i , x m ] in Algorithm 4.1, without loss of generality, as
k k
resulting computation times. shown in Fig. 6. Since there exists an unique intersection
| to ( xmk ) - t r ( xmk ) | < d (3) point in [ x ik , x m k ], we know that
(5)
sign ( t r ( xm k ) - to ( xmk ) ) , then go to Step 7, else set
xik +1 = x mk , x f k +1 = ~
*
In the next iteration, xik +1 and x f can be decided using xk and go to Step 2.
k +1
Step 7. If ~
*
Algorithm 4.2, described below. Generally speaking, xk Î [ xmk , x f k ] and sign( tr ( ~xk * ) - to ( ~xk * ) ) =
improved algorithm achieves shorter iterations by selecting
sign( t r ( x f ) - to ( x f ) ) , then go to Step 8, else set
narrower search range than binary search algorithm at each k k
366
FrBT1.2
tr (x) REFERENCES
to ( xmk ) [1] R. Sharma, J. Y. Herve, and P. Cucka, "Dynamic robot manipulation using
visual tracking," Proc. of IEEE Int. Conf. Robotics and Automation, Nice,
France, pp. 1844-1849, 1992.
[2] P. K. Allen, A. Timcenko, B. Yoshimi, and P. Michelman, "Automated
tracking and grasping of a moving object with a robotic hand-eye system,"
IEEE Trans. Robotics and Automation, Vol.9, pp. 152-165, 1993.
tr ( x fk ) [3] N. P. Papanikolopoulos and P. K. Khosla, "Feature based robotic visual
t o ( xik ) tracking of 3-D translational motion" Proc of the 30th IEEE Conf Decision
x* x~k and Control, pp. 1877-1882, 1991.
*
xik xmk x fk
[4] N. P. Papanikolopoulos, P. K. Khosla, and T. Kanade, "Visual tracking of a
moving target by a camera mounted on a robot: a combination of control
and vision" IEEE Trans. Robotics and Automation, Vol.9 pp. 14-35,
1993.
Figure 6. Algorithm for searching optimal solution
[5] T. H. Park and B. H. Lee, "An approach to robot motion analysis and
planning for conveyor tracking," IEEE Trans Sys. Man Cybern., pp.378 –
384, 1992.
[6] E. A. Croft, R. G. Fenton, and B. Benhabib, "Time-optimal interception of
The algorithm terminates when the difference of the robot objects moving along topologically varying paths," Proc. IEEE Int. Conf.
arrival times and object arrival times is less than d , a Sys. Man Cybern., pp.4089 – 4094, 1995.
[7] E. A. Croft, R. G. Fenton, and B. Benhabib, "Time-optimal interception of
predefined value, as seen in Eq. (6). objects moving along predictable paths," Proc. IEEE Int. Symp. Assembly
| (t r ( ~
xk ) - t o ( ~
* *
xk )) | < d (6) and Task Plan., pp.419 – 425, 1995.
[8] D. Hujic, E. A. Croft, G. Zak, R. G. Fenton, J. K. Mills, and B. Benhabib,
“The robotic interception of moving objects in industrial setting: strategy
development and experiment” IEEE Trans Mechatronics, pp.225-239,
1998.
As discussed in binary search algorithm of Algorithm 4.1, [9] E. A. Croft, R. G. Fenton, and B. Benhabib, "Optimal rendezvous-point
the value of d , given in Eq. (6), is based on the desired selection for robotic interception of moving objects," IEEE Trans Sys. Man
Cybern. Part B, pp.192 – 204, 1998.
accuracy level as in Eq.(6). If this value is too small, then [10] M. Mehrandezh, N. M. Sela, R. G. Fenton, and B. Benhabib, "Robotic
more accurate intersection point can be achieved, but the interception of moving objects using ideal proportional navigation
guidance technique," Robotics and Autonomous Sys, pp.295 – 310, 1999.
disadvantage will be an increased number of steps and [11] M. Mehrandezh, N. M. Sela, R. G. Fenton, and B. Benhabib, "Robotic
resulting computation times. interception of moving objects using an augmented ideal proportional
navigation guidance technique," IEEE Trans Sys. Man Cybern. Part A,
Since improved binary search algorithm involves more pp.238 – 250, 2000.
steps per iteration, computation time will be longer. The [12] D. Chwa, J. Kang, J. Y. Choi, "Online trajectory planning of robot arms for
overall computation time, however, will be short as number interception of fast maneuvering object under torque and velocity
constraints," IEEE Trans Sys. Man Cybern. Part A, pp.831 – 843, 2005.
of iteration will be smaller in general. [13] K. Shin and N. D. McKay, "Selection of near-minimum-time geometric
paths for robotic manipulators", IEEE Trans Automatic Control, Vol.31
Issue.6 , pp. 501-511, 1986.
V. CONCLUSION [14] V. Rajan, "Minimum time trajectory planning", IEEE Int. Conf. Robotics
and Automation, pp.759-7645, 1985.
In this paper, we presented algorithms to find the [15] S. B. Moon and S. Ahmad, "Time-optimal trajectories for cooperative
minimum-time interception point on a conveyor belt to catch multi-manipulator systems”, IEEE Trans. Sys., Man, Cybern. Part B, pp.
343-353, April 1997.
the moving object in real-time. Employing binary search [16] S. Ma and M. Watanabe, "Minimum time path-tracking control of
algorithm, we successfully find the optimal rendezvous point, redundant manipulators," Proc. IEEE Int. Conf. Intellig. Robots and Sys.,
pp.27 – 32, 2000.
which is an intersection point between robot and object [17] M. Mehrandezh and K. Gupta, "Time-optimal rendezvous planning for
arrival time curves. We also presented an improved binary pick-and-place task sharing,” Proc. IEEE Int.Conf. Robotics and Autom.,
search algorithm to find this intersection point in real-time. pp.2703 – 2708, 2000.
[18] K. Kondak, S. Binner, G. Hommel, and M. Neumann, "Time optimal
The improved binary search algorithm shows a better manipulator control for sensor guided grasping of moving objects," Proc.
performance in terms of computation time and accuracy. IEEE Int. Conf. Intellig. Robots and Sys., pp.1912 – 1917, 2001.
[19] A. Efrat, H. H. Gonzalez-Banos, S. G. Kobourov, and L. Palanniappan,
Though simulation results are omitted due to the page
"Optimal strategies to track and capture a predictable target," Proc. IEEE
limitation, it will be provided in the future. Int. Conf. Robotics and Autom., pp.3789 – 3796, 2003.
367