Abstract
We consider the problem of planning the path of a vehicle, which we refer to as the actor, to traverse a threat field with minimum threat exposure. The threat field is an unknown, time-invariant, and strictly positive scalar field defined on a compact 2D spatial domain – the actor’s workspace. The threat field is estimated by a network of mobile sensors that can measure the threat field pointwise at their locations. All measurements are noisy. The objective is to determine a path for the actor to reach a desired goal with minimum risk, which is a measure sensitive not only to the threat exposure itself, but also to the uncertainty therein. A novelty of this problem setup is that the actor can communicate with the sensor network and request that the sensors position themselves such that the actor’s risk is minimized. Future applications of this problem setup include, for example, delivery (by an actor) of emergency supplies to a remote location that lies within/beyond a region afflicted by wildfire or atmospheric contaminants (the threat field). We formulate this problem on a grid defined on the actor’s workspace, which defines a topological graph \(\mathcal {G}\). The threat field is assumed to be finitely parameterized by coefficients of spatial basis functions. Least squares estimates of these parameters are constructed using measurements from the sensors and the actor. Whereas edge transitions in the graph \(\mathcal {G}\) are deterministic, the transition costs depend on the threat field estimates, and are deterministic but unknown. The actor and the sensors interact iteratively. At each iteration, Dijkstra’s algorithm is used to determine a minimum risk path in the graph \(\mathcal {G}\) for the actor. Next, a set of grid points “near” this path are identified as points of interest. Finally, the next set of sensor locations is determined to maximize the confidence of threat field estimates on these points of interest, the threat field estimate is accordingly updated, and the iteration repeats. We explore the effect of initial sensor placement on the convergence of the iterative planner-sensor as well as discuss convergence properties with respect to the relative number of parameters and sensors available.
Access this chapter
Tax calculation will be finalised at checkout
Purchases are for personal use only
Notes
- 1.
As quantified by the trace of the estimation error covariance matrix P.
References
N. Adurthi, P. Singla, Information driven optimal sensor control for efficient target localization and tracking, in Proceedings of the 2014 American Control Conference, Portland, 2014, pp. 610–615
R. Alterovitz, T. Siméon, K. Goldberg, The stochastic motion roadmap: a sampling framework for planning with markov motion uncertainty, in Proceedings of Robotics: Science and Systems (RSS), Atlanta, MA, USA, 2007
M. Athans, P.L. Falb, Optimal Control (Dover Publications Inc., Mineola, NY, USA, 2007)
D.P. Bertsekas, Dynamic Programming and Optimal Control (Athena Scientific, Belmont, 2000)
J.T. Betts, Survey of numerical methods for trajectory optimization. J. Guid. Control Dyn. 21(2), 193–204 (1998)
R.A. Brooks, T. Lozano-Pérez, A subdivision algorithm in configuration space for findpath with rotation. IEEE Trans. Syst. Man Cybern. SMC-15(2), 224–233 (1985)
A.E. Bryson, Y.C. Ho, Applied Optimal Control (Taylor & Francis, New York, 1975)
S. Chakravorty, R. Saha, Simultaneous planning localization and mapping: a hybrid Bayesian/frequentist approach, in Proceedings of the American Control Conference, 2008, pp. 1226–1231. https://doi.org/10.1109/ACC.2008.4586660
D. Cochran, A.O. Hero, Information-driven sensor planning: navigating a statistical manifold, in 2013 IEEE Global Conference on Signal and Information Processing, GlobalSIP 2013 – Proceedings, pp. 1049–1052. https://doi.org/10.1109/GlobalSIP.2013.6737074
R.V. Cowlagi, P. Tsiotras, Hierarchical motion planning with dynamical feasibility guarantees for mobile robotic vehicles. IEEE Trans. Robot. 28(2), 379–395 (2012)
M.A. Demetriou, D. Ucinski, State estimation of spatially distributed processes using mobile sensing agents, in American Control Conference (ACC), Jan 2011, San Francisco, CA, USA, pp. 1770–1776
M. Demetriou, N. Gatsonis, J. Court, Coupled controls-computational fluids approach for the estimation of the concentration from a moving gaseous source in a 2-d domain with a Lyapunov-guided sensing aerial vehicle. IEEE Trans. Control Syst. Technol. 22(3), 853–867 (2013). https://doi.org/10.1109/TCST.2013.2267623
N. Farmani, L. Sun, D. Pack, Optimal UAV sensor management and path planning for tracking. The ASME 2014 Dynamic System and Control Conferences, 2014, pp. 1–8. https://doi.org/10.1115/DSCC2014-6232
D. Garg, M. Patterson, W.W. Hager, A.V. Rao, D.A. Benson, G.T. Huntington, A unified framework for the numerical solution of optimal control problems using pseudospectral methods. Automatica 46, 1843–1851 (2010)
S. Karaman, E. Frazzoli, Sampling-based algorithms for optimal motion planning. Int. J. Robot. Res. 30(7), 846–894 (2011). https://doi.org/10.1177/0278364911406761
L.E. Kavraki, P. Švestka, J.C. Latombe, M.H. Overmars, Probabilistic roadmaps for path planning in high-dimensional configuration spaces. IEEE Trans. Robot. Autom. 12(4), 566–580 (1996)
A. Krause, A. Singh, C. Guestrin, Near-optimal sensor placements in gaussian processes: theory, efficient algorithms and empirical studies. J. Mach. Learn. Res. 9, 235–284 (2008). https://doi.org/10.1145/1102351.1102385
C. Kreucher, A.O. Hero, K. Kastella, A comparison of task driven and information driven sensor management for target tracking, in Proceedings of the 44th IEEE Conference on Decision and Control, and the European Control Conference, CDC-ECC’05, 2005, pp. 4004–4009. https://doi.org/10.1109/CDC.2005.1582788
H. Kurniawati, T. Bandyopadhyay, N.M. Patrikalakis, Global motion planning under uncertain motion, sensing, and environment map. Auton. Robot. 33(3), 255–272 (2012). https://doi.org/10.1007/s10514-012-9307-y
S.M. LaValle, J.J. Kuffner Jr., Randomized kinodynamic planning. Int. J. Robot. Res. 20(5), 378–400 (2001)
R. Lerner, E. Rivlin, I. Shimshoni, Landmark selection for task-oriented navigation. IEEE Trans. Robot. 23(3), 494–505 (2007). https://doi.org/10.1109/TRO.2007.895070
T. Lozano-Pérez, An algorithm for planning collision-free paths among polyhedral obstacles. Commun. ACM 22(10), 560–570 (1979)
R. Madankan, S. Pouget, P. Singla, M. Bursik, J. Dehn, M. Jones, A. Patra, M. Pavolonis, E.B. Pitman, T. Singh, P. Webley, Computation of probabilistic hazard maps and source parameter estimation for volcanic ash transport and dispersion. J. Comput. Phys. 271, 39–59 (2014)
S. Martinez, Distributed interpolation schemes for field estimation by mobile sensor networks. IEEE Trans. Control Syst. Technol. 18(2), 491–500 (2010). https://doi.org/10.1109/TCST.2009.2017028
S. Martinez, F. Bullo, Optimal sensor placement and motion coordination for target tracking. Automatica 42(4), 661–668 (2006). https://doi.org/10.1016/j.automatica.2005.12.018
N. Meuleau, C. Plaunt, D. Smith, T. Smith, A comparison of risk sensitive path planning methods for aircraft emergency landing, in ICAPS-09: Proceedings of the Workshop on Bridging the Gap Between Task And Motion Planning, Thessaloniki, Greece, 2009, pp. 71–80
B. Mu, L. Paull, M. Graham, J. How, J. Leonard, Two-stage focused inference for resource-constrained collision-free navigation. Proceedings of Robotics: Science and Systems, Rome, Italy, 2015. https://doi.org/10.15607/RSS.2015.XI.004
N.J. Nilsson, Artificial Intelligence: A New Synthesis (Morgan Kauffman Publishers Inc., San Francisco, 1998)
S.L. Padula, R.K. Kincaid, Optimization strategies actuator placement sensor and actuator placement. NASA Report, Apr 1999
R. Prentice, N. Roy, The belief roadmap: efficient planning in belief space by factoring the covariance. Int. J. Robot. Res. 28(11–12), 1448–1465 (2009)
R. Siegwart, I.R. Nourbakhsh, D. Scaramuzza, Introduction to autonomous mobile robots (MIT Press, Cambridge, 2011)
P. Skoglar, J. Nygards, M. Ulvklo, Concurrent path and sensor planning for a uav – towards an information based approach incorporating models of environment and sensor, in IEEE International Conference on Intelligent Robots and Systems, 2006, pp. 2436–2442. https://doi.org/10.1109/IROS.2006.281685
D. Ucinski, Sensor network scheduling for identification of spatially distributed processes, in Conference on Control and Fault-Tolerant Systems, SysTol’10 – Final Program and Book of Abstracts, vol. 20(3), 2010, pp. 493–504. https://doi.org/10.1109/SYSTOL.2010.5675945
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2018 Springer Nature Switzerland AG
About this chapter
Cite this chapter
Cooper, B.S., Cowlagi, R.V. (2018). Dynamic Sensor-Actor Interactions for Path-Planning in a Threat Field. In: Blasch, E., Ravela, S., Aved, A. (eds) Handbook of Dynamic Data Driven Applications Systems. Springer, Cham. https://doi.org/10.1007/978-3-319-95504-9_19
Download citation
DOI: https://doi.org/10.1007/978-3-319-95504-9_19
Published:
Publisher Name: Springer, Cham
Print ISBN: 978-3-319-95503-2
Online ISBN: 978-3-319-95504-9
eBook Packages: Computer ScienceComputer Science (R0)