I have worked on a variety of research topics, ranging from autonomous mobility to computer vision. Specifically, I worked on stochastic control and information (belief) space planning forr simultaneous localization and mapping for mobile robots, robot vision, and satellite-based navigation. Scroll below to watch videos, and download research publications from my prior research.

[Google Scholar Profile]

Autonomous Vision-based Navigation for Micro Aerial Vehicles: From May 2015 to December 2015 I was a co-op at Qualcomm Research Center in San Diego. I worked on full onboard vision-based autonomy for aerial robots. We demoed this system at CES 2016. This system implements full waypoint navigation, builds a map of an initially unknown world, and also assists the pilot in flying by not letting him/her collide with obstacles! Here is a video of a demo in the Qualcomm lab.

Motion Planning in Non-Gaussian Belief Spaces: While recent work has dealt with planning for Gaussian beliefs, for many cases, a multi-modal belief is a more accurate representation of the underlying belief. This is particularly true in environments with information symmetry that cause uncertain data associations which naturally lead to a multi-modal hypothesis on the state. Thus, a planner cannot simply base actions on the most-likely state. We propose an algorithm that uses a Receding Horizon Planning approach to plan actions that sequentially disambiguate the multi-modal belief to a uni-modal Gaussian and achieve tight localization on the true state, called a Multi-Modal Motion Planner (M3P).

Robust Real-time Replanning in Belief Space in Changing Environments:  We have devised a principled way of real-time replanning in belief space via realization of the rollout policy based on the FIRM framework. This video demonstrates the performance of the method on physical mobile robots over a long (about 25 minutes) and complex run. In this run, we investigate how such a real-time replanning method can generate a feedback plan that is robust to discrepancies between real models and computational models as well as robust to changes in the environment, failures in the sensory system, and large deviations from the nominal plan. We believe these framework lay the ground work for further advancing the theoretical POMDP framework toward practical applications, and achieving longterm autonomy in robotic systems.

Development of an Aerial Platform for Vision Based Simultaneous Localization and Mapping: Aerial vehicles need an accurate estimate of position and orientation for navigation. In a GPS denied setting, one needs to access other sensor information. A vision based real time Extended Kalman Filter based simultaneous localisation and mapping application was successfully implemented in C++ based on Andrew Davison’s MonoSlam. I successfully designed, developed and flight tested a quadrotor micro aerial vehicle equipped with onboard computer, laser range scanner and camera for mapping of unknown indoor environments. Implemented a 6 Degree of Freedom quadrotor model in MATLAB and designed a PID based controller. 

Satellite Based Precision Navigation for Commercial Aircrafts: I implemented a fully functioning model of GPS constellation in MATLAB; Simulated Dual- Frequency GPS receiver and demonstrated a positioning accuracy of 1-12 m for an aircraft in-flight. Demonstrated a new algorithm for carrier phase tracking using smoothed pseudorange measurements. Simulated a precision autolanding to determine positioning errors using carrier phase measurements; was able to meet FAA specified CAT-III accuracy requirements.

A list of recent and past publications and thesis. [Google Scholar Profile]


  • S. Agarwal, K.S. Parunandi, S. Chakravorty, “Robust Pose-Graph SLAM using Absolute Orientation Sensing“, accepted IEEE Robotics and Automation Letters 2019
  • A. Agha-mohammadi, S. Agarwal, S. Kim, S. Chakravorty and N. M. Amato, “SLAP: Simultaneous Localization and Planning Under Uncertainty via Dynamic Replanning in Belief Space,” in IEEE Transactions on Robotics, vol. 34, no. 5, pp. 1195-1214, Oct. 2018 [ieeexplore]
  • A. Agha-mohammadi, Saurav Agarwal, Suman Chakravorty, ” Periodc-node Sampling-Based Framework for Stochastic Motion Control of Small Aerial Vehicles,” ASME J. Dyn. Sys., Meas., Control 137(3), 031005 (Oct 21, 2014). [ASME-Journal]
  • S Agarwal and H B Hablani., “Automatic Aircraft Landing over Parabolic Trajectory using Precise GPS Measurements,” IJCA Proceedings on International Conference and workshop on Emerging Trends in Technology (ICWET) (7):38-45, 2011 (IJCA2011)


  • Saurav Agarwal, Vikram Shree and Suman Chakravorty, “RFM-SLAM: Exploiting Relative Feature Measurements to Separate Orientation and Position Estimation in SLAM“, In Proc. IEEE International Conference on Robotics and Automation (ICRA), Singapore, May 29 – June 13, 2017 [pdfarXiv:1609.05235]
  • Saurav Agarwal, Amirhossein Tamjidi and Suman Chakravorty, “Motion Planning for Active Data Association and Localization in Non-Gaussian Belief Spaces“, International Workshop on the Algorithmic Foundations of Robotics (WAFR) 2016, San Francisco, USA (M3P-WAFR2016arXiv, video)
  • A. Agha-mohammadi, Saurav Agarwal, Aditya Mahadevan, Suman Chakravorty, Daniel Tomkins, Jory Denny, Nancy Amato, “Robust Online Belief Space Planning in Changing Environments: Application to Physical Mobile Robots,” In Proc. IEEE Int. Conf. Robot. Autom. (ICRA), Hong Kong, China, May 2014. [ICRA-2014-pdf]
  • Kumar A., Agarwal S., Unhelkar V.V., Sharma A., & Hablani H.B., “A Study of GPS-INS Integration for Improved Autonomous Navigation of Aircrafts,” in Proceedings of International Conference on Navigation and Communication (NavCom – 2012), Hyderabad, India, December 2012 (NavCom_12)
  • Agarwal, S. & Hablani, H.B., “Precise Positioning Using GPS for CAT-III Aircraft Operations Using Smoothed Pseudorange Measurements,” International Conference and Workshop on Emerging Trends in Technology, February 25-26, 2011, Mumbai, India (ICWET2010)


  • Monocular Vision Based Indoor Simultaneous Localisation and Mapping for Quadrotor Platform, M.Sc Thesis, Cranfield University, UK. Download pdf -> Msc-Thesis
  • Micro Aerial Vehicle Simulation in Scilab for Hardware-in-the-Loop Testing, B.Tech Thesis, Indian Institute of Technology, Bombay. Download pdf -> B.Tech-Report-Part-I B.Tech-Report-Part-II