Polygonal Obstacle Avoidance Combining Model Predictive Control and Fuzzy Logic
In practice, navigation of mobile robots in confined environments is often done using a spatially discrete cost-map to represent obstacles. Path following is a typical use case for model predictive control (MPC), but formulating constraints for obstacle avoidance is challenging in this case. Typically the cost and constraints of an MPC problem are defined as closed-form functions and typical solvers work best with continuously differentiable functions. This is contrary to spatially discrete occupancy grid maps, in which a grid's value defines the cost associated with occupancy. This paper presents a way to overcome this compatibility issue by re-formulating occupancy grid maps to continuously differentiable functions to be embedded into the MPC scheme as constraints. Each obstacle is defined as a polygon -- an intersection of half-spaces. Any half-space is a linear inequality representing one edge of a polygon. Using AND and OR operators, the combined set of all obstacles and therefore the obstacle avoidance constraints can be described. The key contribution of this paper is the use of fuzzy logic to re-formulate such constraints that include logical operators as inequality constraints which are compatible with standard MPC formulation. The resulting MPC-based trajectory planner is successfully tested in simulation. This concept is also applicable outside of navigation tasks to implement logical or verbal constraints in MPC.
Code (0)
등록된 구현이 없습니다.
Similar Papers 제목 키워드 기반
GPU-Accelerated Polygonal Signed Distance Functions for Real-Time Collision Avoidance
Optimization-based local planning and control require high-rate collision-avoidance constraint evaluation over a prediction horizon. In obstacle-dense environments, where feasible space is limited and the constraints bec…
Computational EfficiencyCollision AvoidanceSimultaneous Lane-Keeping and Obstacle Avoidance by Combining Model Predictive Control and Control Barrier Functions
In this work, we combine {Model Predictive Control} (MPC) and Control Barrier Function (CBF) design {methods} to create a hierarchical control law for simultaneous lane-keeping (LK) and obstacle avoidance (OA): at the lo…
Model Predictive ControlGeometric Model Predictive Path Integral for Agile UAV Control with Online Collision Avoidance
In this letter, we introduce Geometric Model Predictive Path Integral (GMPPI), a sampling-based controller capable of tracking agile trajectories while avoiding obstacles. In each iteration, GMPPI generates a large numbe…
Collision AvoidanceSpline Trajectory Tracking and Obstacle Avoidance for Mobile Agents via Convex Optimization
We propose an output feedback control-based motion planning technique for agents to enable them to converge to a specified polynomial trajectory while imposing a set of safety constraints on our controller to avoid colli…
Motion PlanningTrajectory Planning with Model Predictive Control for Obstacle Avoidance Considering Prediction Uncertainty
This paper introduces a novel trajectory planner for autonomous robots, specifically designed to enhance navigation by incorporating dynamic obstacle avoidance within the Robot Operating System 2 (ROS2) and Navigation 2 …
Collision AvoidanceModel Predictive ControlNavigateTrajectory Planning