Obstacle Avoidance For Autonomous Mowing
Obstacle Avoidance For Autonomous Mowing
An International Journal
To cite this article: Ben C. Creed , Aaron Arsenault , Steven A. Velinsky & Ty A. Lasky (2012)
Obstacle Avoidance for Autonomous Mowing, Mechanics Based Design of Structures and
Machines, 40:3, 334-348, DOI: 10.1080/15397734.2012.685441
This paper discusses obstacle avoidance for autonomous mowing for application in
highway vegetation control. In recent work, a unique autonomous mower testbed
was developed to prove the efficacy of such an approach. The testbed has been
augmented with laser range finding to support obstacle detection. This paper presents
experimental results for reactive obstacle avoidance using the pure-pursuit geometric
control algorithm. The results show that the laser-based obstacle detection and
avoidance is effective for the mowing application.
INTRODUCTION
The California Department of Transportation (Caltrans) is responsible for the
sustained maintenance of over 24,000 km (15,000 miles) of highway and more than
93,000 ha (230,000 acres) of right-of-way (Caltrans, 1997). This includes vegetation
management, which makes up approximately 40% of Caltrans maintenance budget
(Teeter-Balin, 2004). Primary vegetation control needs include maintenance of
roadbed integrity, visibility, drainage, noxious weed control, aesthetic roadside
appearance, and fire protection (Caltrans, 1997). Mowing of medians and rights-of-
way is an important vegetation management practice for Caltrans, but it is labor-
intensive and requires expensive and specialized equipment.
Previous work presented the application environment and explored scenarios
and their effectiveness for autonomous mowing (Arsenault et al., 2010). A separate
paper investigated the performance, particularly mowing width consistency, of
the autonomous mower (Arsenault et al., 2011). The current work extends these
efforts by adding laser-based obstacle detection and avoidance. The performance
evaluation of a pure-pursuit geometric controller for reactive obstacle avoidance in
the context of mowing is presented.
334
OBSTACLE AVOIDANCE FOR AUTONOMOUS MOWING 335
Requirements
kinematic tracking control. The performance of the controller has been proven in
Zhang et al. (1997).
Tracking point velocity and platform angular velocity are
1 b 1
u= r + L rLe v = R rRe − L rLe = R rRe − L rLe (1)
2 R Re d d
Here, R and L are the right and left wheel speeds, d is track width, and b is
distance from baseline to body frame.
The control law is defined as
R t −1
ẋB t xB t − xA t
d = = Gp + Kp (2)
L t ẏB t yB t − yA t
d
where Kp = diagkx ky , kx > 0 ky > 0 is the gain matrix which defines the
exponential rate of convergence, and
− d 2br
sin t
+ cosr t d cos t
+ sinr t
Gp−1 = d sin t
Re Re 2br Re Re
(3)
2br
+ cos t
r
− d cos t
2br
+ sin t
r
Le Le Le Le
From (2), control input d = R t L tTd is determined (at 5 Hz) from the
reference path velocity in the X Y global coordinate frame and the x y error
offset of the testbed tracking point from the desired reference point, with desired
speed d then input to the motor control. This control law yields exponentially
convergent tracking with rate minkx ky , neglecting the motor control dynamics.
338 CREED ET AL.
As such, a vehicle can exactly track the x y position of a predefined reference path.
This solution does not yield independent control of the heading angle, and exact
orientation tracking occurs only when the reference path is a straight line (Zhang
et al., 1997). For automated mowing with long sections of straight cutting swaths,
independent orientation tracking is not necessary.
Sensor Selection
For an automated roadside mowing unit to supplement existing practices,
a cost-effective solution will yield a significant reduction in labor, material, and
equipment cost in comparison to the total investment, without accounting for the
gains from improved safety. Hardware and sensor technology usually dominate
overall system cost; thus, this paper’s goal is an effective but low-cost sensor and
hardware array.
An approach similar to that taken in Aono et al. (1998) was adopted.
Odometry from relative sensors (wheel shaft encoders) is fused with absolute GPS
(Global Positioning System) information to produce an accurate localization system.
Aono et al. (1998) found that dead reckoning and GPS measurements could be
fused to result in accuracy of about 0.2 m with a GPS accuracy of only 1.0 m. For
efficient mowing, final system accuracy of about 1 ft (0.3 m) or better is acceptable,
suggesting, based on Aono’s study (Aono et al., 1998), a GPS unit with accuracy
of roughly 1.5 m (60 in) or better. A low-cost (∼$1000) Crescent Vector OEM
board from Hemisphere GPS was selected. This unit provides reasonable accurate
global positioning data and excellent absolute heading information, using two
antennas separated with a known baseline, and uses WAAS corrections to yield
horizontal accuracy of less than 0.6 m (24 in), 95% of the time. This configuration
OBSTACLE AVOIDANCE FOR AUTONOMOUS MOWING 339
obstacle avoidance driven by the LIDAR sensor and feeding the pure-pursuit
tracker. Another key component is the EKF, which takes input from the robot’s
wheel sensors as well as a dual-antenna GPS and a gyro to generate the current
state estimate, as discussed in detail in Arsenault (2007) and Arsenault et al. (2011).
To provide obstacle sensing on the testbed, a SICK LMS291 2D laser scanner
has been implemented. The LMS291 is a Class 1 (eye-safe) 2D laser scanner with a
maximum scanning swath of 180? ( rad). The data gathered by the laser contains a
distance reading to the nearest object for each angular increment as small as (1/4)
(0.004 rad). Under ideal conditions, it has a range of approximately 80 m (262 ft).
L2A + 2yA b
RB = (4)
2xA + Kh p −
342 CREED ET AL.
where RB represents the radius of the circle traversed by baseline center point B,
LA is the look ahead distance to the goal point from the tracking point, xA and yA
represent the distance to the goal point in a coordinate frame fixed at tracking point
A with the y-axis aligned with the vehicle centerline, b is the distance between points
A and B, and p − denotes the heading error.
A large variety of collision avoidance algorithms exist, varying in method,
computational intensity, and sensor and vehicle requirements. The emphasis of
this work is on the application, and thus two existing reactive algorithms were
investigated and evaluated. These are summarized below for completeness.
Purely Reactive Collision Avoidance I: In the purely reactive collision avoidance
algorithm (Martinez et al., 1998), the equations that govern the behavior of the
vehicle are quite simple. Both the look-ahead distance and lateral error must be
known to utilize the pure-pursuit tracker. With reactive obstacle avoidance, the
look-ahead distance, L, is a dynamic value determined by the distance to the nearest
obstacle. The algorithm is composed of two layers. The first layer is responsible for
the basic pure-pursuit path tracking. A path is provided to the vehicle, and pure-
pursuit is repeatedly used to determine and track goal points that are L ahead of
the vehicle’s current position. Simultaneously, the laser rangefinder (LRF) performs
180 ( rad) sweeps in front of the vehicle. The shortest range and corresponding
orientation is returned. If the minimum distance is outside of a specified threshold,
no action is taken. If inside, the algorithm selects a new goal point by rotating the
detected obstacle point’s coordinates by 90 ( /2 rad) away from the obstacle.
Singapore Harbor Reactive Collision Avoidance: The second collision avoidance
algorithm is based on a reactive algorithm presented in Bandyophadyay et al.
(2010). This algorithm utilizes the entire data set returned by the LRF to
intelligently plan a path.
When a threatening object is detected by the LRF, a vehicle-bounding radius
is drawn around the points that define the left and right boundaries of the detected
obstacle. Next, tangent points are calculated that connect a line from the vehicle’s
current position to the endpoint circles. The distance from each tangent point to the
specified “goal point” is calculated, and the point with the shortest distance becomes
a sub-goal, and is used to determine the new heading of the vehicle. Once the vehicle
arrives at the sub-goal, it reorients back towards the original goal.
measure is called the “Mean Distance to Goal”, or “MGD” (Munoz et al., 2007).
This metric is useful for robots that follow a reference trajectory, and quantifies the
average error between the traversed path and the reference path. Small MGD values
correspond to a traversed path that is close to the desired trajectory.
“Security Metrics” address the vehicle’s distance to potential obstacles (Munoz
et al., 2007). The first security metric (SM1) presented in Munoz et al. (2007)
calculates the average of the distances between the vehicle and obstacles throughout
the entire mission. With autonomous mowing, minimizing this value helps ensure
that the vehicle remains near the obstacle. The minimum distance that the vehicle
maintains from the obstacle is also important and it can be extracted when
calculating SM1.
In addition to performance and security measures, smoothness measures
should be examined to help minimize energy and time requirements. The “Control
Effort” (Martinez et al., 1998) is defined as the average absolute value of the
curvature increments for all the control intervals. The control effort can be used as
a relative measurement between algorithms to help determine which path required
more energy for the vehicle to traverse.
The above measures, combined as a normalized weighted sum, provide a good
measure of the quality of the whole system. The weights were determined as listed
in Table 1, based on the importance of each measure for the specific mowing
application. Each algorithm was evaluated on the robot as it traversed around
obstacles in a test course. The score was then used to make the final selection for
the most effective algorithm.
The performance of each algorithm was evaluated based on two simple test
courses. The first course consisted of a single obstacle placed in the center of the
desired trajectory. This simple course was used to identify the basic behavior of
each algorithm, for clear comparison. The second course consisted of two obstacles
separated by a distance d. This course was utilized for a set of tests, each with a
different initial posture and various obstacle spacing distances. It was designed to
determine how the robot handled the presence of multiple obstacles.
For brevity, the quantitative analysis of only the single obstacle tests are
included herein; results for the multiple obstacle tests are in Creed (2011). The data
presented are based on an average of three trial runs.
For each algorithm, the relative quantitative measures are tabulated in
Table 2. Two figures are provided for the algorithms. The first illustrates both
desired and actual trajectory traversed as well as relevant LRF data points (Fig. 4).
Reactive Harbor
Figure 4 Reactive path and trajectory history (color figure available online).
The second plot illustrates path error as a function of time (Fig. 5), where the error
is quantified as the distance to the closest path point.
Both obstacle avoidance algorithms successfully guided the vehicle around the
circular obstacle. Each of them worked differently however, and the paths taken
Figure 5 Reactive algorithm error vs. time (color figure available online).
OBSTACLE AVOIDANCE FOR AUTONOMOUS MOWING 345
differ significantly. From Fig. 4, the Singapore Harbor algorithm guided the vehicle
to the left of the obstacle, and the reactive algorithm resulted in a much more
circular route. Traversal of a noncircular path would result in a larger control effort
(due to curvature variations) than the circular case. Neither algorithm resulted in
a collision with the obstacle, but both algorithms left and returned to the path
at different points. When returning to the path, the Singapore Harbor algorithm
produced considerably higher overshoot. Since both algorithms utilized the pure-
pursuit path-tracking algorithm with the same look-ahead distance, the overshoot
is likely an artifact of computational delays.
The error plots presented in Fig. 5 reveal that the harbor algorithm
consistently guided the vehicle further from the obstacle, even though the reaction
threshold distance was the same for both algorithms. The overshoot discussed from
Fig. 4 is also shown in the Fig. 5, peaking at approximately t = 45 sec. Based on
these results, the reactive algorithm was selected for final implementation.
The results showed that the robot successfully navigated autonomously around each
obstacle. In addition, the robot maintained path-tracking consistency similar to
results in Arsenault et al. (2011), which is essential for efficient and effective mowing.
While the state estimation and GT do show some variance, the essential point is
that consistent mowing width is maintained. Thus, the robot maintains its ability to
perform its primary task but has the added capability of obstacle avoidance.
CONCLUSION
This paper presented obstacle avoidance for an autonomous mower for
highway vegetation control. Reactive algorithms were evaluated based upon
quantitative performance measures. The selected algorithm was combined with
the pure-pursuit-tracking controller, which was successfully validated in a harsh
outdoor environment including obstacles. The performance measures, the control
architecture, and implementation approach were all tailored specifically for this
robotic application.
While highly promising, additional research is necessary before such a system
could be fully deployed into highway operations. First, due to the close proximity
of traffic, it is essential that a detailed failure mode analysis be performed. Second,
it is well known that highway maintenance and construction work is a distraction to
passing motorists. While the autonomous mowers will be moving at a relatively slow
speed, it is still necessary to assess and mitigate the impacts on driver distraction.
ACKNOWLEDGMENTS
The authors gratefully acknowledge the Division of Research and Innovation
of the California Department of Transportation for the support of this work
through the Advanced Highway Maintenance and Construction Technology
(AHMCT) Research Center at the University of California, Davis.
REFERENCES
Aono, T., Fujii, K., Hatsumoto, S., Kamiya, T. (1998). Positioning of Vehicle
on Undulating Ground Using GPS and Dead Reckoning. Presented at the IEEE
International Conference on Robotics and Automation, Leuven, Belgium, May
16–20.
Arsenault, A. (2007). Implementation and Validation of a Low Cost Sensor Array for
Autonomous Roadside Mowing. MS thesis, University of California, Davis.
Arsenault, A., Velinsky, S. A., Lasky, T. A. (2010). Autonomous mowing –
Improving efficiency and safety of roadside vegetation control. ASCE Journal of
Infrastructure Systems 16(3):206–215.
Arsenault, A., Velinsky, S. A., Lasky, T. A. (2011). A low-cost sensor array
and test platform for autonomous roadside mowing. IEEE/ASME Transactions
Mechatronics 16(3):592–597.
Asadi, E., Bozorg, M. (2009). A decentralized architecture for simultaneous
localization and mapping. IEEE/ASME Transactions Mechatronics 14(1):64–71.
OBSTACLE AVOIDANCE FOR AUTONOMOUS MOWING 347
Rezaei, S., Sengupta, R. (2007). Kalman filter based integration of DGPS and
vehicle sensors for localization. IEEE Transactions on Control System Technology
15(6):1080–1088.
Rizzoni, G. (2005). Principles and Applications of Electrical Engineering. New York:
McGraw-Hill.
Schworer, I. J. (2005). Navigation and control of an autonomous vehicle. MS thesis,
Virginia Polytechnic Institute and State University, Virginia.
Shair, S., Chandler, J. H., Gonzalez-Villela, V. J., Parkin, R. M., Jackson, M. R.
(2008). The use of aerial images and GPS for mobile robot waypoint navigation.
IEEE/ASME Transactions Mechatronics 13(6):692–699.
Stentz, A. T., Dima, C., Wellington, C., Herman, H., Stager, D. (2002). A system
for semi-autonomous tractor operations. Autonomous Robots 13(1):87–103.
Teeter-Balin, J. (2004). Feasibility of Alternative Vegetation Maintenance Control
Technologies. MS thesis, University of California, Davis.
Zhang, Y., Velinsky, S. A., Feng, X. (1997). On the tracking control of differentially
steered wheeled mobile robots. Transactions ASME, Journal of Dynamic Systems,
Measurements, and Control 119(3):455–461.