-
Multi-Robot Relative Pose Estimation in SE(2) with Observability Analysis: A Comparison of Extended Kalman Filtering and Robust Pose Graph Optimization
Authors:
Kihoon Shin,
Hyunjae Sim,
Seungwon Nam,
Yonghee Kim,
Jae Hu,
Kwang-Ki K. Kim
Abstract:
In this study, we address multi-robot localization issues, with a specific focus on cooperative localization and observability analysis of relative pose estimation. Cooperative localization involves enhancing each robot's information through a communication network and message passing. If odometry data from a target robot can be transmitted to the ego robot, observability of their relative pose es…
▽ More
In this study, we address multi-robot localization issues, with a specific focus on cooperative localization and observability analysis of relative pose estimation. Cooperative localization involves enhancing each robot's information through a communication network and message passing. If odometry data from a target robot can be transmitted to the ego robot, observability of their relative pose estimation can be achieved through range-only or bearing-only measurements, provided both robots have non-zero linear velocities. In cases where odometry data from a target robot are not directly transmitted but estimated by the ego robot, both range and bearing measurements are necessary to ensure observability of relative pose estimation. For ROS/Gazebo simulations, we explore four sensing and communication structures. We compare extended Kalman filtering (EKF) and pose graph optimization (PGO) estimation using different robust loss functions (filtering and smoothing with varying batch sizes of sliding windows) in terms of estimation accuracy. In hardware experiments, two Turtlebot3 equipped with UWB modules are used for real-world inter-robot relative pose estimation, applying both EKF and PGO and comparing their performance.
△ Less
Submitted 4 February, 2024; v1 submitted 27 January, 2024;
originally announced January 2024.
-
Recent Advances in Path Integral Control for Trajectory Optimization: An Overview in Theoretical and Algorithmic Perspectives
Authors:
Muhammad Kazim,
JunGee Hong,
Min-Gyeom Kim,
Kwang-Ki K. Kim
Abstract:
This paper presents a tutorial overview of path integral (PI) control approaches for stochastic optimal control and trajectory optimization. We concisely summarize the theoretical development of path integral control to compute a solution for stochastic optimal control and provide algorithmic descriptions of the cross-entropy (CE) method, an open-loop controller using the receding horizon scheme k…
▽ More
This paper presents a tutorial overview of path integral (PI) control approaches for stochastic optimal control and trajectory optimization. We concisely summarize the theoretical development of path integral control to compute a solution for stochastic optimal control and provide algorithmic descriptions of the cross-entropy (CE) method, an open-loop controller using the receding horizon scheme known as the model predictive path integral (MPPI), and a parameterized state feedback controller based on the path integral control theory. We discuss policy search methods based on path integral control, efficient and stable sampling strategies, extensions to multi-agent decision-making, and MPPI for the trajectory optimization on manifolds. For tutorial demonstrations, some PI-based controllers are implemented in Python, MATLAB and ROS2/Gazebo simulations for trajectory optimization. The simulation frameworks and source codes are publicly available at https://github.com/INHA-Autonomous-Systems-Laboratory-ASL/An-Overview-on-Recent-Advances-in-Path-Integral-Control.
△ Less
Submitted 1 December, 2023; v1 submitted 21 September, 2023;
originally announced September 2023.
-
Einstein Structure of Squashed Four-Spheres
Authors:
Jeongwon Ho,
Kyung Kiu Kim,
Hyun Seok Yang
Abstract:
It is known that the moduli space of Einstein structures is an isolated point so that an Einstein structure has no infinitesimal Einstein deformations. We examine the rigidity of the Einstein structure by considering deformations of the round four-sphere $\mathbb{S}^4$. We show that any deformation of the round four-sphere $\mathbb{S}^4$ causes it to deviate from the Einstein structure, except tri…
▽ More
It is known that the moduli space of Einstein structures is an isolated point so that an Einstein structure has no infinitesimal Einstein deformations. We examine the rigidity of the Einstein structure by considering deformations of the round four-sphere $\mathbb{S}^4$. We show that any deformation of the round four-sphere $\mathbb{S}^4$ causes it to deviate from the Einstein structure, except trivial deformations at most only changing the size of the sphere.
△ Less
Submitted 14 September, 2023; v1 submitted 11 September, 2023;
originally announced September 2023.
-
MPPI-IPDDP: Hybrid Method of Collision-Free Smooth Trajectory Generation for Autonomous Robots
Authors:
Min-Gyeom Kim,
Kwang-Ki K. Kim
Abstract:
This study presents a hybrid trajectory optimization method that generates a collision-free smooth trajectory for autonomous mobile robots. The hybrid method combines sampling-based model predictive path integral (MPPI) control and gradient-based interior-point differential dynamic programming (IPDDP) exploiting their advantages of exploration and smoothing. The proposed method, called MPPI-IPDDP,…
▽ More
This study presents a hybrid trajectory optimization method that generates a collision-free smooth trajectory for autonomous mobile robots. The hybrid method combines sampling-based model predictive path integral (MPPI) control and gradient-based interior-point differential dynamic programming (IPDDP) exploiting their advantages of exploration and smoothing. The proposed method, called MPPI-IPDDP, consists of three steps. The first step generates a coarse trajectory by MPPI control, the second step constructs a collision-free convex corridor, and the third step smooths the coarse trajectory by IPDDP using the collision-free convex corridor computed in the second step. For demonstration, the proposed algorithm was applied to trajectory optimization for differential-driving wheeled mobile robots and point-mass quadrotors. A supplementary video of the simulations can be found at https://youtu.be/-oUAt5sd9Bk.
△ Less
Submitted 4 August, 2022;
originally announced August 2022.
-
Parameterized Energy-Optimal Regenerative Braking Strategy for Connected and Autonomous Electrified Vehicles: A Real-Time Dynamic Programming Approach
Authors:
Dohee Kim,
Jeong Soo Eo,
Kwang-Ki K. Kim
Abstract:
This paper presents a vehicle speed planning system called the energy-optimal deceleration planning system (EDPS), which aims to maximize energy recuperation of regenerative braking of connected and autonomous electrified vehicles. A recuperation energy-optimal speed profile is computed based on the impending deceleration requirements for turning or stop** at an intersection. This is computed to…
▽ More
This paper presents a vehicle speed planning system called the energy-optimal deceleration planning system (EDPS), which aims to maximize energy recuperation of regenerative braking of connected and autonomous electrified vehicles. A recuperation energy-optimal speed profile is computed based on the impending deceleration requirements for turning or stop** at an intersection. This is computed to maximize the regenerative braking energy while satisfying the physical limits of an electrified powertrain. In automated driving, the powertrain of an electrified vehicle can be directly controlled by the vehicle control unit such that it follows the computed optimal speed profile. To obtain smooth optimal deceleration speed profiles, optimal deceleration commands are determined by a parameterized polynomial-based deceleration model that is obtained by regression analyses with real vehicle driving test data. The parameters are dependent on preview information such as residual time and distance as well as target speed. The key design parameter is deceleration time, which determines the deceleration speed profile to satisfy the residual time and distance constraints as well as the target speed requirement. The bounds of deceleration commands corresponding to the physical limits of the powertrain are deduced from realistic deceleration test driving. The state constraints are dynamically updated by considering the anticipated road load and the deceleration preference. For validation and comparisons of the EDPS with different preview distances, driving simulation tests with a virtual road environment and vehicle-to-infrastructure connectivity are presented. It is shown that the longer preview distance in the EDPS, the more energy-recuperation. In comparison with driver-in-the-loop simulation tests, EDPS-based autonomous driving shows improvements in energy recuperation and reduction in trip time.
△ Less
Submitted 14 February, 2021;
originally announced February 2021.
-
Semidefinite Programming Approach to Gaussian Sequential Rate-Distortion Trade-offs
Authors:
Takashi Tanaka,
Kwang-Ki K. Kim,
Pablo A. Parrilo,
Sanjoy K. Mitter
Abstract:
Sequential rate-distortion (SRD) theory provides a framework for studying the fundamental trade-off between data-rate and data-quality in real-time communication systems. In this paper, we consider the SRD problem for multi-dimensional time-varying Gauss-Markov processes under mean-square distortion criteria. We first revisit the sensor-estimator separation principle, which asserts that considered…
▽ More
Sequential rate-distortion (SRD) theory provides a framework for studying the fundamental trade-off between data-rate and data-quality in real-time communication systems. In this paper, we consider the SRD problem for multi-dimensional time-varying Gauss-Markov processes under mean-square distortion criteria. We first revisit the sensor-estimator separation principle, which asserts that considered SRD problem is equivalent to a joint sensor and estimator design problem in which data-rate of the sensor output is minimized while the estimator's performance satisfies the distortion criteria. We then show that the optimal joint design can be performed by semidefinite programming. A semidefinite representation of the corresponding SRD function is obtained. Implications of the obtained result in the context of zero-delay source coding theory and applications to networked control theory are also discussed.
△ Less
Submitted 9 August, 2016; v1 submitted 27 November, 2014;
originally announced November 2014.