Feedback Motion Prediction for Safe Unicycle Robot Navigation

As a simple and robust mobile robot base, differential drive robots that can be modelled as a kinematic unicycle find significant applications in logistics and service robotics in both industrial and domestic settings. Safe robot navigation around obstacles is an essential skill for such unicycle robots to perform diverse useful tasks in complex cluttered environments, especially around people and other robots. Fast and accurate safety assessment plays a key role in reactive and safe robot motion design. In this paper, as a more accurate and still simple alternative to the standard circular Lyapunov level sets, we introduce novel conic feedback motion prediction methods for bounding the close-loop motion trajectory of the kinematic unicycle robot model under a standard unicycle motion control approach. We present an application of unicycle feedback motion prediction for safe robot navigation around obstacles using reference governors, where the safety of a unicycle robot is continuously monitored based on the predicted future robot motion. We investigate the role of motion prediction on robot behaviour in numerical simulations and conclude that fast and accurate feedback motion prediction is key for fast, reactive, and safe robot navigation around obstacles.Comment: 11 pages, 5 figures, extended version of a paper submitted to a conference publicatio

Optimization-based methods for real-time generation of safe motions in mobile robots

Having robots operating in unstructured and dynamically changing environments is a challenging task that requires advanced motion generation approaches that are able to perform in real-time while maintaining the robot and environment safety. The progress in the field of numerical optimization, as well as the development of tailored algorithms, made Nonlinear Model Predictive Control (NMPC) an appealing candidate for real-time motion generation. By considering the robot model as prediction model and through appropriate constraints on the robot states and control inputs, NMPC can enforce safety to the resulting motion in a straightforward way. This thesis addresses the problem of real-time generation of safe motions for mobile robots and mobile manipulators. The different structure of the considered robots introduces different safety risks during the robot motion and so the motion generation problem for each robot is addressed in separate parts of this thesis. In the first part, the problem of motion generation for mobile robots navigating in environments populated by static and/or moving obstacles is considered. For the generation of the desired motion, real-time NMPC is used. We argue that, in order to tackle the risk of collision with the environment, traditional distance-based approaches are incapable of maintaining the robot safety when the NMPC uses relatively short prediction horizons. Instead, we propose two NMPC approaches that employ two alternative collision avoidance constraints. The first proposed NMPC approach is applied to a scenario of safe robot navigation in a human crowd. The NMPC serves as a motion generation module in a safe motion generation framework, complete with a crowd prediction module. The considered collision avoidance constraint is built upon an appropriate Control Barrier Function (CBF). The second NMPC approach is applied to a scenario of robot navigation among moving obstacles, where the dynamics of the considered robot are significant. The proposed collision avoidance constraint is built upon the notion of avoidable collision state, which considers not only the robot-obstacle distance but also their velocity as well as the robot actuation capabilities. The simulation results indicate that both methods are effective and able to maintain the robot safety even in cases where their purely distance-based counterparts fail. The second part of the thesis addresses the problem of safe motion generation for mobile manipulators, called to execute tasks that may require aggressive motions. Here, in addition to the risk of collision with its environment, the robot, consisting of multiple articulated bodies, is also susceptible to self-collisions. Moreover, fast motions can always result to loss of balance. To solve the problem, we propose a real-time NMPC scheme that uses the robot full dynamics, in order to enforce kinodynamic feasibility, while it also considers appropriate collision and self-collision avoidance constraints. To maintain the robot balance we enforce a constraint that restricts the feasible set of robot motions to those generating non-negative moments around the edges of the support polygon. This balance constraint, inherently nonlinear, is linearized using the NMPC solution of the previous iteration. In this way, we facilitate the solution of the NMPC in real-time, without compromising the robot safety. Although the proposed NMPC is effective when applied to MM with low degrees of freedom, when the robot becomes more complex the use of its full dynamic model as a prediction model in an NMPC can lead to unacceptably large computational times that are not compatible with the real-time requirement. However, the use of a simplified model of the robot in an NMPC can compromise the robot safety. For this reason, we propose an optimization-based controller equipped with balance constraints as well as CBF-based collision avoidance constraints. The proposed controller can serve as an intermediate between a motion generation module that does not consider the robot full dynamics and the robot itself in order to ensure that the resulting motion will be at least safe. Simulation results indicate the effectiveness of the proposed method

Assistive Planning in Complex, Dynamic Environments: a Probabilistic Approach

We explore the probabilistic foundations of shared control in complex dynamic environments. In order to do this, we formulate shared control as a random process and describe the joint distribution that governs its behavior. For tractability, we model the relationships between the operator, autonomy, and crowd as an undirected graphical model. Further, we introduce an interaction function between the operator and the robot, that we call "agreeability"; in combination with the methods developed in~\cite{trautman-ijrr-2015}, we extend a cooperative collision avoidance autonomy to shared control. We therefore quantify the notion of simultaneously optimizing over agreeability (between the operator and autonomy), and safety and efficiency in crowded environments. We show that for a particular form of interaction function between the autonomy and the operator, linear blending is recovered exactly. Additionally, to recover linear blending, unimodal restrictions must be placed on the models describing the operator and the autonomy. In turn, these restrictions raise questions about the flexibility and applicability of the linear blending framework. Additionally, we present an extension of linear blending called "operator biased linear trajectory blending" (which formalizes some recent approaches in linear blending such as~\cite{dragan-ijrr-2013}) and show that not only is this also a restrictive special case of our probabilistic approach, but more importantly, is statistically unsound, and thus, mathematically, unsuitable for implementation. Instead, we suggest a statistically principled approach that guarantees data is used in a consistent manner, and show how this alternative approach converges to the full probabilistic framework. We conclude by proving that, in general, linear blending is suboptimal with respect to the joint metric of agreeability, safety, and efficiency

Collision Detection and Reaction: A Contribution to Safe Physical Human-Robot Interaction

In the framework of physical Human-Robot Interaction (pHRI), methodologies and experimental tests are presented for the problem of detecting and reacting to collisions between a robot manipulator and a human being. Using a lightweight robot that was especially designed for interactive and cooperative tasks, we show how reactive control strategies can significantly contribute to ensuring safety to the human during physical interaction. Several collision tests were carried out, illustrating the feasibility and effectiveness of the proposed approach. While a subjective “safety” feeling is experienced by users when being able to naturally stop the robot in autonomous motion, a quantitative analysis of different reaction strategies was lacking. In order to compare these strategies on an objective basis, a mechanical verification platform has been built. The proposed collision detection and reactions methods prove to work very reliably and are effective in reducing contact forces far below any level which is dangerous to humans. Evaluations of impacts between robot and human arm or chest up to a maximum robot velocity of 2.7 m/s are presented