Time-Robust Path Planning with Piece-Wise Linear Trajectory for Signal Temporal Logic Specifications

Nhan-Khanh Le,Erfaun Noorani,Sandra Hirche,John Baras
2024-03-16
Abstract:Real-world scenarios are characterized by timing uncertainties, e.g., delays, and disturbances. Algorithms with temporal robustness are crucial in guaranteeing the successful execution of tasks and missions in such scenarios. We study time-robust path planning for synthesizing robots' trajectories that adhere to spatial-temporal specifications expressed in Signal Temporal Logic (STL). In contrast to prior approaches that rely on {discretize}d trajectories with fixed time steps, we leverage Piece-Wise Linear (PWL) signals for the synthesis. PWL signals represent a trajectory through a sequence of time-stamped waypoints. This allows us to encode the STL formula into a Mixed-Integer Linear Program (MILP) with fewer variables. This reduction is more pronounced for specifications with a long planning horizon. To that end, we define time-robustness for PWL signals. Subsequently, we propose quantitative semantics for PWL signals according to the recursive syntax of STL and prove their soundness. We then propose an encoding strategy to transform our semantics into a MILP. Our simulations showcase the soundness and the performance of our algorithm.
Systems and Control
What problem does this paper attempt to address?
This paper investigates how to plan the path of a robot in real-world scenarios with uncertain time existence to satisfy signal temporal logic (STL) based spatiotemporal specifications. STL is a logic language that can express system spatiotemporal behaviors clearly. In contrast to previous methods, this paper proposes using piecewise linear (PWL) signals to synthesize paths instead of discrete trajectories with fixed time steps. PWL signals represent trajectories through a sequence of waypoints with timestamps, which reduces the number of variables and complexity of the problem. The main contributions of this paper include: 1. Defining the time robustness of PWL signals and proposing the corresponding quantified semantics to demonstrate its correctness. This allows evaluating time slack directly with fewer waypoints, i.e., the satisfaction level of the trajectory with respect to the specification. 2. Introducing a hierarchical time robust formal synthesis problem aimed at generating waypoints that not only satisfy the specification but also maximize time robustness. 3. Designing an encoding strategy that converts the above semantics into mixed-integer linear programming (MILP) to directly solve the time robust path planning problem. 4. Demonstrating the effectiveness and performance of the algorithm through simulations. In short, the goal of this paper is to address the path planning problem for robots in environments with uncertainties such as delays, early starts, or interferences during execution, ensuring that they can perform tasks according to STL specifications with spatiotemporal constraints. By using PWL signals, this method improves robustness to time uncertainty and is more efficient in handling long-term planning problems.