Precision agriculture offers the opportunity to automate routine or difficult tasks in orchards and vineyards, such as spraying or inspection, with Uncrewed Ground Vehicles (UGV). In this context, human operators should be kept in the closed-loop control of the robot for safety and reliability. This work is motivated by the challenges of effectively deploying human-robot shared control in the field. First, an asymptotically stable controller keeps the robot on the desired trajectory between rows of trees, whose distance is on the order of the robot’s width. Second, the robot must efficiently avoid static and moving obstacles on its path. Third, the control inputs must not exceed the actuator limits, which can degrade trajectory tracking performance, cause instability, or damage critical hardware. Finally, in real-life scenarios, user intervention is sometimes required to manage unpredictable situations. To overcome these challenges, we propose and deploy a shared controller that continuously and smoothly varies the ratio of human and automatic control inputs depending on the human’s intent, geometrically rescales trajectory inputs to maintain bounded control, and incorporates obstacle avoidance capabilities – all while preserving asymptotic stability of the closed-loop system. Additionally, we introduce a time re-scaling strategy that modifies trajectory evolution, ensuring target positions remain within a defined vicinity of the robot. The system performance was assessed in simulation and in 26 field trials inside an apple orchard using different obstacle configurations, weather, and terrain conditions, with a success rate of 100% and an average tracking error of 0.1 m.Note to Practitioners—The proposed shared control approach is developed for use with a differentially steered Uncrewed Ground Vehicle (UGV) with first order kinematic constraints and can be adapted to different indoor and outdoor scenarios. The environment in which the UGV is deployed should be mapped in advance to create a reference trajectory for the UGV to follow. If the location of obstacles is not known in advance, an obstacle detection and tracking system, as well as an online mapping system, must be developed. A simulated model of the UGV and the environment are useful for determining initial values of the shared control gains that can be further tuned when the physical platform is first deployed. In GPS-denied scenarios, a Simultaneous Localization and Mapping (SLAM) system must be implemented; a lidar-inertial based SLAM system is recommended. A force-reflexive joystick is ideal for sensitive human input. In addition, the communication between the UGV and the base station (where the human operator supervises the UGV and provides commands to it) should have minimal time delays, not exceeding typical human reaction time (ca. 0.25 s).

Rescue missions in mountain environments are hardly achievable by standard legged robots—because of the high slopes—or by flying robots—because of limited payload capacity. We present a concept for a rope-aided climbing robot which can negotiate up-to-vertical slopes and carry heavy payloads. The robot is attached to the mountain through a rope, and it is equipped with a leg to push against the mountain and initiate jumping maneuvers. Between jumps, a hoist is used to wind/unwind the rope to move vertically and affect the lateral motion. This simple (yet effective) two-fold actuation allows the system to achieve high safety and energy efficiency. Indeed, the rope prevents the robot from falling while compensating for most of its weight, drastically reducing the effort required by the leg actuator. We also present an optimal control strategy to generate point-to-point trajectories overcoming an obstacle. We achieve fast computation time ($16\ m$long jump, showing the effectiveness of the proposed approach, and confirming the interest of our concept. Finally, we performed a reachability analysis showing that the region of achievable targets is strongly affected by the friction properties of the foot-wall contact.

Developing feasible body trajectories for legged systems on arbitrary terrains is a challenging task. In this paper, we present a paradigm that allows to design feasible Center of Mass (CoM) and body trajectories in an efficient manner. In our previous work [1], we introduced the notion of the 2D feasible region, where static balance and the satisfaction of joint torque limits were guaranteed, whenever the projection of the CoM lied inside the proposed admissible region. In this work we propose a general formulation of the improved feasible region that guarantees dynamic balance alongside the satisfaction of both joint-torque and kinematic limits in an efficient manner. To incorporate the feasibility of the kinematic limits, we introduce an algorithm that computes the reachable region of the CoM. Furthermore, we propose an efficient planning strategy that utilizes the improved feasible region to design feasible CoM and body orientation trajectories. Finally, we validate the capabilities of the improved feasible region and the effectiveness of the proposed planning strategy, using simulations and experiments on the 90 kg Hydraulically actuated Quadruped (HyQ) and the 21 kg Aliengo robots.

To traverse complex scenarios reliably a legged robot needs to move its base aided by the ground reaction forces, which can only be generated by the legs that are momentarily in contact with the ground. A proper selection of footholds is crucial for maintaining balance. In this paper, we propose a foothold evaluation criterion that considers the transition feasibility for both linear and angular dynamics to overcome complex scenarios. We devise convex and nonlinear formulations as a direct extension of [1] in a receding-horizon fashion to grant dynamic feasibility for future behaviours. The criterion is integrated with a Vision-based Foothold Adaptation (VFA) strategy that takes into account the robot kinematics, leg collisions and terrain morphology. We verify the validity of the selected footholds and the generated trajectories in simulation and experiments with the 90kg quadruped robot HyQ.

Simplified models are useful to increase the computational efficiency of a motion planning algorithm, but their lack of accuracy have to be managed. We propose two feasibility constraints to be included in a Single Rigid Body Dynamics-based trajectory optimizer in order to obtain robust motions in challenging terrain. The first one finds an approximate relationship between joint-torque limits and admissible contact forces, without requiring the joint positions. The second one proposes a leg model to prevent leg collision with the environment. Such constraints have been included in a simplified nonlinear non-convex trajectory optimization problem. We demonstrate the feasibility of the resulting motion plans both in simulation and on the Hydraulically actuated Quadruped (HyQ) robot, considering experiments on an irregular terrain.

Whole-Body Control (WBC) has emerged as an important framework in locomotion control for legged robots. However, most WBC frameworks fail to generalize beyond rigid terrains. Legged locomotion over soft terrain is difficult due to the presence of unmodeled contact dynamics that WBCs do not account for. This introduces uncertainty in locomotion and affects the stability and performance of the system. In this article, we propose a novel soft terrain adaptation algorithm called STANCE: Soft Terrain Adaptation and Compliance Estimation. STANCE consists of a WBC that exploits the knowledge of the terrain to generate an optimal solution that is contact consistent and an online terrain compliance estimator that provides the WBC with terrain knowledge. We validated STANCE both in simulation and experiment on the Hydraulically actuated Quadruped (HyQ) robot, and we compared it against the state-of-the-art WBC. We demonstrated the capabilities of STANCE with multiple terrains of different compliances, aggressive maneuvers, different forward velocities, and external disturbances. STANCE allowed HyQ to adapt online to terrains with different compliances (rigid and soft) without pretuning. HyQ was able to successfully deal with the transition between different terrains and showed the ability to differentiate between compliances under each foot.

Planning whole-body motions while taking into account the terrain conditions is a challenging problem for legged robots since the terrain model might produce many local minima. Our coupled planning method uses stochastic and derivatives-free search to plan both foothold locations and horizontal motions due to the local minima produced by the terrain model. It jointly optimizes body motion, step duration and foothold selection, and it models the terrain as a cost-map. Due to the novel attitude planning method, the horizontal motion plans can be applied to various terrain conditions. The attitude planner ensures the robot stability by imposing limits to the angular acceleration. Our whole-body controller tracks compliantly trunk motions while avoiding slippage, as well as kinematic and torque limits. Despite the use of a simplified model, which is restricted to flat terrain, our approach shows remarkable capability to deal with a wide range of noncoplanar terrains. The results are validated by experimental trials and comparative evaluations in a series of terrains of progressively increasing complexity.

In legged locomotion, the projection of the robot's Center of Mass (CoM) being inside the convex hull of the contact points is a commonly accepted sufficient condition to achieve static balancing. However, some of these configurations cannot be realized because the joint-torques required to sustain them would be above their limits (actuation limits). In this article, we rule out such configurations and define the feasible region, a revisited support region that guarantees both global static stability in the sense of tip-over and slippage avoidance and of existence of a set of joint-torques that are able to sustain the robot's body weight. We show that the feasible region can be employed for the online selection of feasible footholds and CoM trajectories to achieve statically stable locomotion on rough terrains, also in presence of load-intensive tasks. Key results of our approach include the efficiency in the computation of the feasible region using an Iterative Projection (IP) algorithm and the successful execution of hardware experiments on the HyQ robot, that was able to negotiate obstacles of moderate dimensions while carrying an extra 10-kg payload.

We present a trajectory optimization framework for legged locomotion on rough terrain. We jointly optimize the center of mass motion and the foothold locations, while considering terrain conditions. We use a terrain costmap to quantify the desirability of a foothold location. We increase the gait's adaptability to the terrain by optimizing the step phase duration and modulating the trunk attitude, resulting in motions with guaranteed stability. We show that the combination of parametric models, stochastic-based exploration and receding horizon planning allows us to handle the many local minima associated with different terrain conditions and walking patterns. This combination delivers robust motion plans without the need for warm-starting. Moreover, we use soft-constraints to allow for increased flexibility when searching in the cost landscape of our problem. We showcase the performance of our trajectory optimization framework on multiple terrain conditions and validate our method in realistic simulation scenarios and experimental trials on a hydraulic, torque controlled quadruped robot.

We propose a reactive locomotion strategy, called height reflex, that is useful to address big elevation changes in the terrain (e.g. when a quadruped robot has to step down from a high platform). In these cases the swing leg can lose mobility creating issues in the subsequent steps. The height reflex is a foot trajectory replanning strategy that redistributes the swing motion (in a smart way) to the stance legs to “lower” the whole trunk and to aid the foothold searching motion. To spread the motion we exploit a massless link model of the robot with virtual dampers at the joints, which is used to replan the feet trajectories. The proposed approach is able to incorporate kinematic limits, it is easy-to-tune, computationally efficient and suitable for real-time implementations. The reflex is implemented and experimentally evaluated on the 80 kg hydraulic quadruped HyQ. With our approach we were able to address high steps, up to 24 cm which is 30% of HyQ leg length and 53% of its retractable leg range.

The identification of inertial parameters is crucial to achieve high-performance model-based control of legged robots. The inertial parameters of the legs are typically not altered during expeditions and therefore are best identified offline. On the other hand, the trunk parameters depend on the modules mounted on the robot, like a motor to provide the hydraulic power, or different sets of cameras for perception. This motivates the use of recursive approaches to identify online mass and the position of the Center of Mass (CoM) of the robot trunk, when a payload change occurs. We propose two such approaches and analyze their robustness in simulation. Furthermore, experimental trials on our 80-kg quadruped robot HyQ show the applicability of our strategies during locomotion to cope with large payload changes that would otherwise severely compromise the balance of the robot.

Most animal and human locomotion behaviors for solving complex tasks involve dynamic motions and rich contact interaction. In fact, complex maneuvers need to consider dynamic movement and contact events at the same time. We present a hierarchical trajectory optimization approach for planning dynamic movements with unscheduled contact sequences. We compute whole-body motions that achieve goals that cannot be reached in a kinematic fashion. First, we find a feasible CoM motion according to the centroidal dynamics of the robot. Then, we refine the solution by applying the robot's full-dynamics model, where the feasible CoM trajectory is used as a warm-start point. To accomplish the unscheduled contact behavior, we use complementarity constraints to describe the contact model, i.e. environment geometry and non-sliding active contacts. Both optimization phases are posed as Mathematical Program with Complementarity Constraints (MPCC). Experimental trials demonstrate the performance of our planning approach in a set of challenging tasks.

A common disadvantage of multi-legged robots is that they often lack the manipulation capability. To overcome this limitation, an arm can be added to the body of the multi-legged robot, to perform manipulation tasks and provide assistance for locomotion. First, we proposed an attachment configuration of the arm for a multi-legged robot that provide a uniform workspace in front, below and above the base robot trunk. Second, an integrated control framework promises to keep the mobility and the balance of the mobile platform and provides precise manipulation capability of the arm incorporating a payload estimation scheme. Finally, we verify an integrated control framework with experimental results of a static and walking mobile platform while moving the arm.

We present a framework for dynamic quadrupedal locomotion over challenging terrain, where the choice of appropriate footholds is crucial for the success of the behaviour. We build a model of the environment on-line and on-board using an efficient occupancy grid representation. We use Any-time-Repairing A* (ARA*) to search over a tree of possible actions, choose a rough body path and select the locally-best footholds accordingly. We run a n-step lookahead optimization of the body trajectory using a dynamic stability metric, the Zero Moment Point (ZMP), that generates natural dynamic whole-body motions. A combination of floating-base inverse dynamics and virtual model control accurately executes the desired motions on an actively compliant system. Experimental trials show that this framework allows us to traverse terrains at nearly 6 times the speed of our previous work, evaluated over the same set of trials.

We present a framework for quadrupedal locomotion over highly challenging terrain where the choice of appropriate footholds is crucial for the success of the behaviour. We use a path planning approach which shares many similarities with the results of the DARPA Learning Locomotion challenge and extend it to allow more flexibility and increased robustness. During execution we incorporate an on-line force-based foothold adaptation mechanism that updates the planned motion according to the perceived state of the environment. This way we exploit the active compliance of our system to smoothly interact with the environment, even when this is inaccurately perceived or dynamically changing, and update the planned path on-the-fly. In tandem we use a virtual model controller that provides the feed-forward torques that allow increased accuracy together with highly compliant behaviour on an otherwise naturally very stiff robotic system. We leverage the full set of benefits that a high performance torque controlled quadruped robot can provide and demonstrate the flexibility and robustness of our approach on a set of experimental trials of increasing difficulty.

Legged robots have the potential to serve as versatile and useful autonomous robotic platforms for use in unstructured environments such as disaster sites. They need to be both capable of fast dynamic locomotion and precise movements. However, there is a lack of platforms with suitable mechanical properties and adequate controllers to advance the research in this direction. In this paper we are presenting results on the novel research platform HyQ, a torque controlled hydraulic quadruped robot. We identify the requirements for versatile robotic legged locomotion and show that HyQ is fulfilling most of these specifications. We show that HyQ is able to do both static and dynamic movements and is able to cope with the mechanical requirements of dynamic movements and locomotion, such as jumping and trotting. The required control, both on hydraulic level (force/torque control) and whole body level (rigid model based control) is discussed.

Robots are frequently modeled as rigid body systems, having torques as input to their dynamics. A high-performance low-level torque source allows us to control the robot/environment interaction and to straightforwardly take advantage of many model-based control techniques. In this paper, we define a general 1-DOF framework, using basic physical principles, to show that there exists an intrinsic velocity feedback in the generalized force dynamics, independently of the actuation technology. We illustrate this phenomena using three different systems: a generic spring-mass system, a hydraulic actuator, and an electric motor. This analogy helps to clarify important common aspects regarding torque/force control that can be useful when designing and controlling a robot. We demonstrate, using simulations and experimental data, that it is possible to compensate for the load motion influence and to increase the torque tracking capabilities.

This paper is focussed on the modelling and control of a hydraulically-driven biologically-inspired robotic leg. The study is part of a larger project aiming at the development of an autonomous quadruped robot (hyQ) for outdoor operations. The leg has two hydraulically-actuated degrees of freedom (DOF), the hip and knee joints. The actuation system is composed of proportional valves and asymmetric cylinders. After a brief description of the prototype leg, the paper shows the development of a comprehensive model of the leg where critical parameters have been experimentally identified. Subsequently the leg control design is presented. The core of this work is the experimental assessment of the pros and cons of single-input single-output (SISO) vs. multiple-input multiple-output (MIMO) and linear vs. nonlinear control algorithms in this application (the leg is a coupled multivariable system driven by nonlinear actuators). The control schemes developed are a conventional PID (linear SISO), a Linear Quadratic Regulator (LQR) controller (linear MIMO) and a Feedback Linearisation (FL) controller (nonlinear MIMO). LQR performs well at low frequency but its behaviour worsens at higher frequencies. FL produces the fastest response in simulation, but when implemented is sensitive to parameters uncertainty and needs to be properly modified to achieve equally good performance also in the practical implementation.

This paper deals with a comparative study on using water and air as actuation means for the control of a fluidic muscle (designed for air) and assesses the performance, particularly from a dynamic and energetic point of view. A medium with higher bulk modulus such as oil/water is believed to increase pressure and force bandwidths and reduce sensitivity to load variations, as is the case with conventional hydraulic stiff actuation systems. However in this application the inherent flexibility of the muscle plays a major role. Water has been chosen because of its non-flammability, environmental friendliness and the low solubility of air in it. The operating pressure range of the pneumatic muscle is 0-6 bar (typical range of a pneumatic system) that is well below typical operating pressures of hydraulic systems (typically over 100 bar). At such low pressures the dynamic behaviour of water is less predictable because of the higher likelihood of entrapped air in the water which physically occurs when operating at low pressures. This can majorly affect water bulk modulus and hence its dynamic performance. Therefore, the behaviour of the system in this unconventional pressure range for a liquid must be more thoroughly investigated. Theoretical and experimental analyses on a dedicated test rig have been carried out to assess these assumptions.