Open access peer-reviewed chapter

Safe Adaptive Trajectory Tracking Control of Robot for Human-Robot Interaction Using Barrier Function Transformation

Written By

Iman Salehi, Ghananeel Rotithor and Ashwin Dani

Submitted: 28 September 2020 Reviewed: 15 March 2021 Published: 22 April 2021

DOI: 10.5772/intechopen.97255

From the Edited Volume

Collaborative and Humanoid Robots

Edited by Jesús Hamilton Ortiz and Ramana Kumar Vinjamuri

Chapter metrics overview

415 Chapter Downloads

View Full Metrics

Abstract

In this chapter, safety methods in human-robot (HR) interaction/collaboration are presented. Ensuring the safety of humans, objects, or even the robot itself in the robot’s operating environment is one of the crucial aspects of collaborative robotics. Since there are limited ways of controlling the behavior of humans, e.g., by placing physical barriers, shaping the behavior of the robot is a feasible option. The chapter discusses current methods of placing barriers for human safety in an industrial setting and novel methods of placing virtual barriers by designing robot controllers using barrier transformation. The concepts of barrier functions (BFs), control barrier functions (CBFs), and barrier transformations are reviewed. The barrier transformation concept is used to design an adaptive trajectory tracking controller for the robot such that the robot does not cross the virtual barriers. The designed controller is tested in simulations. Future directions of safety technology in human-robot collaboration are presented.

Keywords

  • Safety
  • Barrier Transformation
  • Trajectory Tracking Control
  • Human-robot collaboration
  • Safe adaptive control

1. Introduction

In many robotics and other engineering applications, maintaining system states within a prescribed bound is essential to satisfy the system safety property. For example, in a manufacturing collaborative robotics context, it is crucial for the robot to satisfy requirements, such as trajectory boundedness and to safely carry out its operations [1, 2, 3]. In medical robotics context, when a robot is interacting with a person, the person undergoing surgery cannot move so the robot must stay within virtual barriers in 3D space so that it does not harm the person. See [4] for an example cobot architecture. A review of recent methods for safe human-robot (HR) interaction methods is presented in [5].

In this chapter, safety in the context of HR collaboration is defined such that the robot does not cross over a prescribed physical space where humans or other robots are operating or the robot does not cross joint or the task space limits when the robot is collaborating with the person. The violation of constraints can lead to severe degradation of the robot’s performance, unsafe behavior, and sometimes failure of the robot’s components. In collaborative robotics applications such as collaborative manipulation [6], collaborative construction [7], teleoperations [8, 9], for human-in-the-loop control applications [10], or distributed multi-robot control applications [11, 12, 13], restricting the motion of the robot to a constrained configuration or task space is essential. Safe HR collaboration/interaction is also important for introducing robot factory co-workers in manufacturing automation [14, 15], developing robotic assistants for astronauts [5], for assistive robotics [16, 17, 18, 19, 20].

The literature related to the control of the robot in HR interaction focuses on designing impedance control laws [16, 21, 22, 23] or admittance control laws [23, 24] for adapting the interaction forces exerted by the human on the robot, when the robot is physically interacting with the human. In [24], an admittance controller is designed which takes inputs from human actions to achieve safer HR interaction. In [25], a physical human-robot interaction in the context of bikebot is presented. In [21], a an adaptive impedance controller for HR interaction is developed that is based on the NN model of the human intention. In [26], a controller is developed for human robot handover interaction based on dynamic movement primitives. In these examples, the human is physically interacting with the robot.

Other studies in the literature address the problem of robot/autonomous system control to avoid running into humans by modeling them as obstacles [27, 28, 29]. Most of these studies view the problem as a collision avoidance problem and solve the collision avoidance using potential field approach [30]. These control actions are purely reactionary in nature [31]. To achieve pro-activeness, studies in literature have designed controllers and motion planners that incorporate the probabilistic information about the possible intentions of human actions [32, 33, 34]. When humans and robots collaborate, inference of the person’s intentions or robot’s intentions improves the overall performance of the collaborative task [35]. Many studies in the literature have focused on designing scheduling and planning algorithms. In [36], a stochastic trajectory optimizer for motion planning is used for planning robot arm motion based on human intentions. In [37], scheduling, planning and control algorithms are presented that adapt to the changing preferences of a human co-worker, while providing strong guarantees for synchronization and timing of activities. In [38], new hierarchical planners based on Hierarchical Goal Networks are developed for assembly planning in human-robot team.

In the context of control architecture design for human-in-the-loop systems, adaptive controllers are presented using the inner-outer loop control structure in [10]. Stability studies of human-in-the-loop telerobotics with time-delay is presented in [39]. However, these studies do not explicitly consider safety aspects of the human-in-the-loop systems. Providing safety guarantees on the learned controller of machine/robot is typically achieved by adjusting the reference command using a pre-filter called a reference governor [40, 41] or by using optimal control under uncertainty in a differential game setting.

For keeping the robot state bounded in a prescribed bound saturated controllers can be used [42, 43]. Barrier function (BF) is a commonly used approach to certify the forward invariance of a closed set with respect to a system model, which can be used to examine the system’s safety property [44, 45]. There are two candidates to construct BFs, namely, Reciprocal BFs and Zeroing BFs. The Reciprocal BFs can be of inverse-type and logarithmic-type. Extensions of BFs to controlled systems called as control Barrier Functions (CBF) have also been developed in the literature [46, 47]. Applications of BFs or CBFs in many autonomous robotic systems, such as robot manipulators, autonomous vehicles, and walking robots, are shown in [48, 49, 50]. In [47, 49, 51], BFs were successfully applied to dynamical systems where ensuring safety conditions are critical. In [51], time-varying BFs and CBFs for avoiding moving and static obstacles are derived, and their application to flying quadcopter is shown which avoids unsafe obstacle regions. Robustness properties of the CBFs are studied in [46], which shows that if a perturbation (or model error) makes it impossible to satisfy the invariance condition for a reciprocal barrier function, then the solution of the model must cease to exist because the control input becomes unbounded. For the Zeroing CBFs, Input-to-State stability (ISS) result holds in the presence of model uncertainties. A concept of exponential BFs and CBFs is introduced in [52]. The method of CBFs is extended to position-based constraints with relative degree 2 in [53] to address the safety constraints for systems with a higher relative degree. Furthermore, a backstepping based design method to design CBFs with a higher relative degree is also introduced. However, achieving a backstepping-based CBF design for systems with a higher relative degree is challenging. In [52], a concept of exponential CBFs is introduced that can handle state-dependent constraints for systems with a higher relative degree. In [54], a safety aware RL framework using BFs is proposed.

Barrier Lyapunov function (BLF) is another method that is used for the control of nonlinear systems when the outputs and states have upper and lower bound constraints (cf. [55, 56]). The BLF is constructed such that its value grows to infinity whenever its argument approaches the bounds. In [55, 57], an adaptive controller is developed using BLF defined over the output tracking error for single-input and single-output (SISO) nonlinear systems in a strict-feedback form. The controller works when the constraints are either constant or time-varying output constraints. An extension to output tracking with partial state constraints is developed in [58]. Using a similar BLF, in [59], an adaptive neural network with full-state feedback control that uses a Moore-Penrose pseudoinverse term in the control law design is developed for an uncertain robot dynamics with output constraints, and the signals of the closed-loop systems are proven to be semi-global uniformly ultimately bounded (SGUUB). In [54, 60], a BLF method that uses reinforcement learning (RL) is developed for a state regulation problem of a SISO nonlinear systems in the Brunovsky form with full-state and control input constraints.

Designing safe controllers using learning-based control methods are also presented in the literature. For example, in [61], a safe, online, model-free approach to path planning with Q-learning is discussed. A general safety framework for learning-based control using reachability analysis is presented in [62]. In [63], a receding horizon safe path planning approach using mixed integer linear programming (MILP) is presented. Safe trajectory generation for autonomous operation of spacecraft using convex optimization formulation is proposed in [64]. When the region is non-convex, successive convexification can be performed [65]. A detailed survey and tutorial of L1 adaptive control architecture for safety critical systems is presented in [66].

In this chapter, barrier function transformation, presented in [67], is used to design a safe adaptive trajectory tracking controller for the robot using Euler–Lagrange (EL) system. The safe adaptive trajectory tracking control architecture of a robot system presented in this chapter is shown in Figure 1. Full state constraints are used while designing the torque control law. A gradient parameter update law is designed along with projection laws to keep the parameter estimates bounded. A Lyapunov-based stability analysis is presented which concludes semi-global uniformly ultimately bounded tracking result. Simulations studies are conducted using 2-link robot such that the tracking controller does not cross the bounds placed on the joint angles of the robot leading to a desired end-effector motion within a certain bounds. In addition to the control design and its testing in simulation, the chapter presents a review of standard techniques of designing safe robot controllers using BFs and CBFs, followed by a review of Barrier transformations which is used to design adaptive robot controller of EL robot system in this chapter. Future directions of the method and its applicability to safety in collaborative robotics are discussed.

Figure 1.

A block diagram that illustrates the control flow in a robotic system. The architecture constitutes of two main loops. The inner-loop represents an equivalent unconstrained Euler–Lagrange (EL)-dynamics used to design an adaptive controller. The outer-loop contains the constrained EL-dynamics and a controller that defines the desired joint motions at each time step.

Rest of the chapter is organized as follows. A review of BFs and CBFs and Barrier transformations is presented. Barrier transformation is then used to design adaptive robot controller of EL robot system in this chapter. A design and analysis of the safe adaptive trajectory tracking controller is then discussed. Simulation results of the designed controller on a 2-link EL robot system model are presented. Future directions of robot control design for safe human-robot collaboration are provided at the end.

Advertisement

2. Review of barrier functions and control barrier functions

In this section, a brief review of BF and CBF are presented.

2.1 Barrier functions

Consider a continuous nonlinear dynamical system of the form

ẋ=fx,E1

where f:RnRn is a locally Lipschitz continuous nonlinear function and xtXRn is the state of the system. A set SRn is called (forward) invariant with respect to (1) if for any initial condition x0xt0S implies that xtS, tR [68]. BFs define a forward invariant safe region, where the solutions of a dynamical system in this region remain in the region for all time [46, 47, 69].

2.1.1 Constructing the barrier functions

Given a closed set SRn, its interior and its boundary are defined as follows

S=xRn:hx0,E2
S=xRn:hx=0,E3
IntS=xRn:hx>0,E4

where h:RnR is a continuously differentiable function.

Definition 1.[47, Definition 1] Given the continuous system(1), the closed setSdefined by(2)(4), and continuously differentiable functionh:RnR, a real-valued functionb:IntSRthat is differentiable with respect to its argument is said to be a reciprocal BF, if there exist classKfunctionsη1, η2, η3such that for allxIntS

1η1hxbx1η2hx,E5
bxxfxη3hx.E6

Candidate reciprocal BFs are inverse-type and logarithmic-type BFs given by bx=1hx and bx=loghx1+hx, respectively [47]. Note that the candidate is unbounded on the set boundary, i.e., bx as xS.

2.2 Control barrier functions

BFs are essential means to verify invariance of a set but they cannot be used in its direct form to design a controller [47]. In other words, to make sure that the set IntS is forward invariant under the dynamics of the system (1), a controller that guarantees the invariance of the set is required. Similar on how Lyapunov functions are extended to control Lyapunov functions [70], the concept of BFs can be extended to the case of control systems through the use of CBFs. Given the following nonlinear affine control system

ẋ=fx+gxu,E7

with f and g locally Lipschitz, xXRn, and uRm is the set of admissible input, in cases where the solutions of (7) do not stay in an invariant set S, a CBF can be specified that will assure the solutions to remain inside the invariant set.

2.2.1 Constructing the control barrier functions

In order to find a suitable CBF, the constraint on the system state x is encoded in a smooth constraint function hx. A value hx>0 indicates adherence, whereas hx<0 indicates a violation. The set of admissible state X0 is defined by

X0=xRn:hx>0E8
X0=xRn:hx=0E9

A Reciprocal CBF b:IntXoR is a non-negative function, if there exist class K functions η1,η2, and η3 such that for all xIntX0,

1η1hxbx1η2hxE10
infuRmLfbx+Lgbxuη2hx0.E11

where Lfbx is the Lie-Derivative bxxfx along the vector field fx and Lgbx is the Lie-Derivative bxxgx along the vector field gx. Hence for the system in (7), any locally Lipschitz controller u:X0Rm that is selected form (11) assures the closed-set X0Rn is forward invariant.

Advertisement

3. Review of barrier transformation

In this section, review of barrier function transformation is presented. Consider the following logarithmic barrier function BzaA:RR defined on an open interval aA:

BzaAlnAaaxAx,zaA.E12

where a and A are two constants satisfying a<A. The barrier function in (12) takes finite value when its arguments are within the region aA and approaches to infinity as its arguments reach the boundary of the region, i.e., limza,ABzaA=±.

Due to the monotonic characteristic of the natural logarithm the inverse of the barrier function (12) exists within the range of its definition, and it is given by

B1yaA=aAey2ey2Aey2aey2,yRE13

with the derivative defined as

dB1yaAdy=Aa2aA2a2ey2aA+A2ey.E14
Advertisement

4. Adaptive control of a robot system with full-state constraints

When a robot moves in a constrained space, it is crucial for the robot to satisfy requirements, such as the joint trajectories’ boundedness, to safely carry out its operations within a prescribed bound. This section presents an adaptive safe tracking control design method that learns the parameters of an uncertain Euler–Lagrange (EL) system in an online manner using a gradient adaptive learning law. The controller is designed to track joint angles and joint velocities of the robot arm such that the bounds on the joint angles and joint velocities are maintained.

4.1 Euler-Lagrange dynamics for robot arm

Consider the Euler–Lagrange (EL) dynamics

Mqq¨+Cqq̇q̇+Grq=τ,E15

where MqRd×d denotes a generalized inertia matrix, Cqq̇Rd×d denotes a generalized centripetal-Coriolis matrix, GrqRd denotes a generalized gravity vector, τ=τ1τdTRd represents the generalized input control vector, and qt,q̇t,q¨tRd denote the link position, velocity, and acceleration vectors, respectively. The subsequent development is based on the assumption that all the states are observed, and that Mq, Cqq̇, and Grq, are unknown. The following properties, found in [71, 72], are also exploited in the subsequent development.

Property 1. The inertia matrix is positive definite, and satisfies the following inequality for any arbitrary vector ξRd:

m1ξ2ξTMqξm2ξ2,E16

where m1 and m2 are positive constants, and represents the Euclidean norm.

Remark 1. Since Mq is a symmetric positive definite matrix, it can be shown that M1q is also a positive definite matrix, and its 2-norm is upper and lower bounded with known constants, i.e., m¯M1qm¯.

Property 2. The EL-dynamics in (15) are linearly parametrizable as follows

Yqq̇q¨θ=Mqq¨+Cqq̇q̇+Grq,E17

where Y:Rd×Rd×RdRd×m is the regression matrix, and θRn is the set of the unknown parameters.

Property 3. The norm of the centripetal-Coriolis can be upper bounded in the following manner:

Cqq̇C¯q̇,E18

where C¯R denotes known positive bounding constant, and denotes the induced infinity-norm of a matrix.

4.2 State space system model and control design

Let x=x1x2TXR2d, where x1=qRd, x2=q̇Rd, and the EL-dynamics in (15) can be written as follows

ẋ1=x2,ẋ2=fx+gxτ,E19

where f:R2dRd, g:R2dRd×d are locally Lipschitz continuous nonlinear functions, fx=M1x1Cx1x2x2Grx1, and gx=M1x1. With some algebraic manipulations, the EL-dynamics can be written into d separate first and second order dynamics:

ẋ1,j=x2,j,E20
ẋ2,j=fjx+gjxτ,j=1,,dE21

where fj:R2dR, gj:R2dR1×d are nonlinear continuously differentiable functions. Using the BF transformation (12), the system in (20)(21) can be transformed into a constrained state Φ=ϕ1ϕ2TR2d, where ϕ1=φ1,1φ1,dT and ϕ2=φ2,1φ2,dT are the constrained joint position and velocity vectors, respectively, as follows:

φi,j=Bxi,jδi,jΔi,j,i=1,2andj=1,,dE22
xi,j=B1φi,jδi,jΔi,j,i=1,2andj=1,,dE23

where B1φi,jδi,jΔi,j can be obtained using (13) and δi,j, Δi,j are lower and upper bounds on state, respectively. Using the chain rule of differentiation, i.e., dxi,jdt=xi,jφi,jdφi,jdt, where xi,jφi,j can be obtained using (14), and some algebraic manipulations result in the transformed state φi,j, and it is given by

φ̇1,j=K1,jφ1,jB1φ2,jδ2,jΔ2,j=F1,jφ1,jφ2,j,j=1,,d,E24
φ̇2,j=K2,jφ2,jfjx+gjxu=F2,jΦ+G2,jΦτ,j=1,,d,E25

where

F2,jΦ=K2,jφ2,jfjB1φ1,1B1φ2,jE26
G2,jΦ=K2,jφ2,jgjB1φ1,1B1φ2,jE27

and Ki,jφi,φ=xi,φφi,j1, i=1,2 and j=1,,d. The constrained system in terms of Φ can be expressed in a compact form as follows

Φ̇=FΦ+GΦτ,E28

where F:R2dR2d and G:R2dR2d×d are given by

FΦ=F1,1φ1,1φ2,1F1,dφ1,dφ2,dF2,1ΦF2,dΦ,GΦ=0d×dG2,1ΦG2,dΦ.E29

Assumption 1. The function F:R2dR2d is locally Lipschitz continuous, and there exists a positive constant F¯ such that for ΦΨ, FΦ<F¯Φ, where ΨR2d is a compact set containing the origin. Moreover, the system is assumed to be controllable over Ψ with GΦ being locally Lipschitz and bounded in Ψ, i.e., GΦ<G¯, where G¯ is a positive scalar.

Following (28), the EL-dynamics can be represented in the constrained space as follows

MφpK21ϕ2ϕ̇2+CφpφvK11ϕ1ϕ2+Grφp=τ,E30

where

φp=B1φ1,1B1φ1,dT,E31
φv=B1φ2,1B1φ2,dT,E32

and

Kiϕi=Ki,1φi,100Ki,dφi,d,E33

with Ki,jφi,j=B1φi,jφi,j, i=1,2 and j=1,,d.

Assumption 2. The terms Kiϕi defined in (33) is positive definite, and its 2-norm is upper and lower bounded by known positive constants, i.e., k¯iKiϕik¯i, i=1,2.

Lemma 1. Given the term Kiϕi defined in (33) with

Ki,jφi,j=δi,j2eφi,j2δi,jΔi,j+Δi,j2eφi,jΔi,jδi,j2δi,jΔi,j2,i=1,2andj=1,,d,E34

the 2-norm of its inverse, Ki1ϕi, can be upper bounded by a positive constant κ¯i, i.e., Ki1ϕiκ¯i, i=1,2.

Proof: The 2-norm of Ki1ϕi=diagKi,11φi,1Ki,d1φi,d can be upper bounded because Ki,j1φi,j is bounded, that is

limφi,jΔi,jδi,j2δi,jΔi,j2δi,j2eφi,j2δi,jΔi,j+Δi,j2eφi,j=0,E35

which implies that 2-norm of Ki1φi can be upper bounded by a positive constant κ¯i.

Now, using Property 2, the EL-dynamics in (30) can be linearly parameterized, and it is given by

MK21ϕ̇2+CK11ϕ2+Gr=Y1φpφvϕ1ϕ2ϕ̇2θ,E36

where Y1:Rd×Rd×Rd×Rd×RdRd×n is the regression matrix. Note that in (36), and henceforth the parameter dependency of the elements in the EL-dynamics are dropped for brevity.

Lemma 2. Suppose that there exists a controller that tracks the desired trajectory for the system given in (30). Then, the same controller can also track the desired trajectory of the original system in (15) given that the initial state of the system x0=x0X.

Proof: See proof of ([55], Lemma 1)

Lemma 2 proves that if the initial state is within the prescribed bound, a control law can be designed for the full-state constrained system such that it satisfies the tracking objective of the original system.

4.2.1 Safe adaptive tracking control development

In this subsection, an adaptive control technique is used to identify the parameters of an uncertain system and track the desired joint position ϕ1dest:R+Rd and joint velocity ϕ2dest:R+Rd trajectories.

Assumption 3. The signals ϕ1des, ϕ2des, ϕ̇2des are uniformly continuous and bounded such that ϕ1desϕ¯1des, ϕ2desϕ¯2des, ϕ̇2desϕ̇¯2des, where ϕ¯1des, ϕ¯2des, and ϕ̇¯2des are known positive constants.

Consider the following tracking control input design

τ=M̂K21a+ĈK11v+ĜrβK2r,E37

where ^ denotes the parameter estimates and β is a positive scalar. Signals a, v, r are given by

a=ϕ̇2desΛϕ˜2,E38
v=ϕ2desΛϕ˜1,E39
r=ϕ˜2+Λϕ˜1,E40

where ϕ˜1ϕ1ϕ1des and ϕ˜2ϕ2ϕ2des are position and velocity tracking errors, respectively. ΛRd×d is a positive definite diagonal matrix, and its 2-norm is upper bounded by a known positive constant, i.e., ΛΛ¯.

In terms of the linear parameterization of the EL-dynamics, i.e., Property 2, the control input (37) can be rewritten as

τ=Y2φpφvK21ϕ2aK11ϕ1vθ̂βK2ϕ2r,E41

where Y2:Rd×Rd×Rd×RdRd×n is the regression matrix. Substituting (37) in the EL-dynamics (30) yields the following closed-loop error dynamics given by

MK21ṙ+CK11r+βK2r=Y2θ˜,E42

where θ˜=θ̂θ is the parameter estimation error. The parameter θ̂ update rule is given by

θ̂̇=projΓ1Y2TK2r,E43

where ΓRn×n is a diagonal and positive definite matrix, and proj is a standard projection operator that ensures the parameter estimates are bounded, i.e., θ¯θ̂θ¯ (for further details see [71]).

Remark 2. The parameter estimation error θ˜ is bounded and uniformly continuous since θ̂ evolves according to the update law in (43).

4.2.2 Lyapunov stability analysis

To facilitate the following development of the Lyapunov stability analysis, let ζ:0R2d+n denote the composite state vector, i.e., ζtrTtϕ1Ttθ˜TtT. Let λmin and λmax denote the minimum and maximum eigenvalues of its argument.

Theorem 1.1.The controller and parameter update laws defined in(41)and(43)ensure SGUUB tracking of the desired state trajectories, provided the following sufficient conditions,

γ1>21+γ5+γ7,γ3>21+γ5+γ6,E44

are satisfied, where

γ1=βm¯k¯22γ5=βλ¯k¯22m¯γ2=λmaxΛTΛα¯γ6=γ2+γ4ϕ¯2desγ3=γ1λminΛTΛγ7=α¯+γ4ϕ¯2desγ4=Λ¯α¯α¯=k¯2m¯C¯κ¯12E45

Proof: See details in [67].

Advertisement

5. Simulations

Simulation studies are conducted to verify and demonstrate the performance of the designed safe adaptive robot controller. The simulations are conducted using MacBook Pro running Intel i7 processor and 16 Gigabytes of memory and the controller and EL dynamic model is coded using MATLAB 2018a.

5.1 Safe tracking control of an uncertain EL-dynamics with full-state constraints using BF

In this section, the controller and adaptive laws developed in (37) and (43) are simulated for a two-link robot planar manipulator, with dynamics shown in (46), where c1, c2, c12 denote cosq1, cos(q2), and cosq1+q2 respectively, sin2 denotes sinq2, and g is the gravitational constant.

θ1+2θ2c2θ3+θ2c2θ3+θ2c2θ3Mqq¨1q¨2+θ2sin2q̇2θ2sin2q̇1+q̇2θ2sin2q̇10Cqq̇q̇1q̇2+θ4gc1+θ5gc12θ5gc12Grq=τ1τ2E46

The nominal values of the parameter vector θ=θ1θ2θ3θ4θ5T are

θ1=0.325kgm2θ3=0.217kgm2θ2=0.240kgm2θ4=2.4kgmθ5=1.0kgmE47

The desired trajectory is selected as

qd1=46e2tsint,qd2=43etcost.E48

The objective is to track the desired joint trajectory provided that the model parameters are unknown while the state Q=qq̇T satisfies the following constraints,

q14.4,4.1q̇110.2,4.2q27.1,4.2q̇24.2,4.93E49

To this end, the barrier function formulation presented in Section 3 is used along with the adaptive control developed in Section 4. The feedback and adaptation gains for the proposed controller are selected as β=14, Λ=diag2.01,2.01, and Γ=diag3030. The results of the simulation are shown in Figures 24. The joints position evolution q1t and q2t of a two degrees-of-freedom planar robot using an adaptive law with and without BF are shown in Figure 2. It can be observed from Figure 2 that when the adaptive law with BF is used, the estimated trajectories are blocked from crossing over the boundaries that are set for each of the joints. The position and velocity estimation errors are depicted in Figure 3. From Figures 2 and 3, it is clear that the tracking error asymptotically converges to zero, and, because the Lyapunov candidate does not contain any terms that are negative definite in θ˜, the parameter estimation does not converge but it does remain bounded. Boundedness of the parameter estimation errors can be seen in Figure 4.

Figure 2.

Evolution of the joint angles for the planar robot simulation using an adaptive law with and without BF.

Figure 3.

Evolution of the joint angle errors and joint velocity errors for the planar robot simulation using an adaptive law with BF.

Figure 4.

Evolution of the parameter estimation error for the planar robot simulation.

Advertisement

6. Conclusions and future directions

This chapter provides a perspective on problems wherein humans and robots work collaboratively with one another. Research in this field aims to relax the current workplace constraints, such as fences, virtual curtains often seen in manufacturing settings between humans and robots or velocity limits on collaborative robots. This chapter develops an efficient robot control methodology to create a safe working environment without sacrificing the efficiency of the robots. In the context of the chapter, safety is defined as a constrained behavior of a system, and robot effectiveness, as driving the actual behavior of the robot to the desired behavior. To this end, an online safe tracking controller for an uncertain Euler–Lagrange robotic system with is developed where the constraints are placed on all the states. A barrier function transform is used to transform the full-state constrained EL-dynamics into an equivalent unconstrained system with no prior knowledge of the system parameters. An adaptive controller is developed along with a gradient based adaptive parameter estimation law on the transformed system that tracks the desired trajectories of the original system. The controller guarantees that the robot trajectories remain inside a pre-specified safe region, tracking the desired trajectories and the parameter estimation errors remain bounded. The method can be utilized for applications wherein robots must operate in a confined space to reach an object for grasping or other manipulation tasks such as pick and place.

In future, the usefulness of barrier transformation to design a visual servo controller will be shown. Constrained VS approach can guarantee target features to remain within the camera field of view for the duration of the task. Some recent efforts in that direction can be found in [73]. Utilizing CBF for developing safe robot controllers by utilizing human actions and workspaces can be another avenue of future research for safe human-robot interaction.

Advertisement

Acknowledgments

The authors would like to thank Daniel Trombetta for discussions related to human-robot interaction application and control design.

References

  1. 1. S. Haddadin, Towards safe robots: approaching Asimov’s 1st law. Springer, 2013, vol. 90.
  2. 2. A. De Luca, A. Albu-Schaffer, S. Haddadin, and G. Hirzinger, “Collision detection and safe reaction with the dlr-iii lightweight manipulator arm,” in 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2006, pp. 1623–1630.
  3. 3. F. Flacco and A. De Luca, “Safe physical human-robot collaboration,” in IEEE/RSJ International Conference on Intelligent Robots and Systems, 2013, pp. 2072–2072.
  4. 4. M. A. Peshkin, J. E. Colgate, W. Wannasuphoprasit, C. A. Moore, R. B. Gillespie, and P. Akella, “Cobot architecture,” IEEE Transactions on Robotics and Automation, vol. 17, no. 4, pp. 377–390, 2001.
  5. 5. P. A. Lasota, T. Fong, J. A. Shah et al., A survey of methods for safe human-robot interaction. Now Publishers, 2017.
  6. 6. Y.-C. Peng, D. S. Carabis, and J. T. Wen, “Collaborative manipulation with multiple dual-arm robots under human guidance,” International Journal of Intelligent Robotics and Applications, vol. 2, no. 2, pp. 252–266, 2018.
  7. 7. H. Maske, M. Matthews, A. Axelrod, H. Mohamadipanah, G. Chowdhary, C. Crick, and P. Pagilla, “Collaborative goal and policy learning from human operators of construction co-robots,” in Neural Information Processing Systems (NIPS), 2014.
  8. 8. J. Braasch, R. J. Radke, J. Wen, M. Si, A. Cunningham, W. Keddy-Hector, and U. Sinha, “Audio/visual concepts for human/robot communication in immersive virtual environments,” The Journal of the Acoustical Society of America, vol. 135, no. 4, pp. 2169–2169, 2014.
  9. 9. T. Fong, C. Thorpe, and C. Baur, “Multi-robot remote driving with collaborative control,” IEEE Transactions on Industrial Electronics, vol. 50, no. 4, pp. 699–704, 2003.
  10. 10. T. Yucelen, Y. Yildiz, R. Sipahi, E. Yousefi, and N. Nguyen, “Stability limit of human-in-the-loop model reference adaptive control architectures,” International Journal of Control, vol. 91, no. 10, pp. 2314–2331, 2018.
  11. 11. D. Panagou, D. M. Stipanović, and P. G. Voulgaris, “Distributed coordination control for multi-robot networks using lyapunov-like barrier functions,” IEEE Transactions on Automatic Control, vol. 61, no. 3, pp. 617–632, 2015.
  12. 12. Z. Kan, A. P. Dani, J. M. Shea, and W. E. Dixon, “Network connectivity preserving formation stabilization and obstacle avoidance via a decentralized controller,” IEEE Transactions on Automatic Control, vol. 57, no. 7, pp. 1827–1832, 2012.
  13. 13. A. W. Farras, J. Yamauchi, T. Hatanaka, and M. Fujita, “Safe cooperative control of human-robotic network teaming with control barrier function,” in 2020 SICE International Symposium on Control Systems (SICE ISCS), 2020, pp. 33–39.
  14. 14. K. Hawkins, N. Vo, S. Bansal, and A. Bobick, “Probabilistic human action prediction and wait-sensitive planning for responsive humanrobot collaboration,” in Proceedings of the IEEE-RAS International Conference on Humanoid Robots, 2013, pp. 15–17.
  15. 15. P. A. Lasota, G. F. Rossano, and J. A. Shah, “Toward safe close-proximity human-robot interaction with standard industrial robots,” in IEEE International Conference on Automation Science and Engineering (CASE), 2014, pp. 339–344.
  16. 16. B. Alqaudi, H. Modares, I. Ranatunga, S. M. Tousif, F. L. Lewis, and D. O. Popa, “Model reference adaptive impedance control for physical human-robot interaction,” Control Theory and Technology, vol. 14, no. 1, pp. 68–82, 2016.
  17. 17. C.-S. Tsai, J.-S. Hu, and M. Tomizuka, “Ensuring safety in human-robot coexistence environment,” in IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2014, pp. 4191–4196.
  18. 18. D.-J. Kim, Z. Wang, N. Paperno, and A. Behal, “System design and implementation of UCF-MANUS – an intelligent assistive robotic manipulator,” IEEE/ASME transactions on mechatronics, vol. 19, no. 1, pp. 225–237, 2012.
  19. 19. F. Zhang and H. Huang, “Source selection for real-time user intent recognition toward volitional control of artificial legs,” IEEE journal of biomedical and health informatics, vol. 17, no. 5, pp. 907–914, 2012.
  20. 20. D. De Carli, E. Hohert, C. A. Parker, S. Zoghbi, S. Leonard, E. Croft, and A. Bicchi, “Measuring intent in human-robot cooperative manipulation,” in IEEE International Workshop on Haptic Audio visual Environments and Games. IEEE, 2009, pp. 159–163.
  21. 21. Y. Li and S. Ge, “Human-robot collaboration based on motion intention estimation,” IEEE/ASME Transactions on Mechatronics, vol. 19, no. 3, pp. 1007–1014, 2014.
  22. 22. C. Yang, G. Ganesh, S. Haddadin, S. Parusel, A. Albu-Schaeffer, and E. Burdet, “Human-like adaptation of force and impedance in stable and unstable interactions,” IEEE transactions on robotics, vol. 27, no. 5, pp. 918–930, 2011.
  23. 23. N. Hogan, “Impedance control: An approach to manipulation: Part I—Theory, part II—Implementation, part III—Applications,” Trans. ASME J. Dyn. Syst., Meas. Control, vol. 107, no. 1, pp. 1–24, 1985.
  24. 24. I. Ranatunga, F. L. Lewis, D. O. Popa, and S. M. Tousif, “Adaptive admittance control for human–robot interaction using model reference design and adaptive inverse filtering,” IEEE Transactions on Control Systems Technology, vol. 25, no. 1, pp. 278–285, 2016.
  25. 25. K. Chen, Y. Zhang, J. Yi, and T. Liu, “An integrated physical-learning model of physical human-robot interactions with application to pose estimation in bikebot riding,” The International Journal of Robotics Research, vol. 35, no. 12, pp. 1459–1476, 2016.
  26. 26. S. Calinon, I. Sardellitti, and D. G. Caldwell, “Learning-based control strategy for safe human-robot interaction exploiting task and robot redundancies,” in IEEE/RSJ International Conference on Intelligent Robots and Systems. IEEE, 2010, pp. 249–254.
  27. 27. G. Hoffman and C. Breazeal, “Effects of anticipatory perceptual simulation on practiced human-robot tasks,” Autonomous Robots, vol. 28, no. 4, pp. 403–423, 2010.
  28. 28. S. Ferguson, B. Luders, R. C. Grande, and J. P. How, “Real-time predictive modeling and robust avoidance of pedestrians with uncertain, changing intentions,” in Algorithmic Foundations of Robotics XI. Springer, 2015, pp. 161–177.
  29. 29. F. Flacco, T. Kroger, A. De Luca, and O. Khatib, “A depth space approach to human-robot collision avoidance,” in IEEE International Conference on Robotics and Automation, 2012, pp.338–345.
  30. 30. M. Geravand, F. Flacco, and A. De Luca, “Human-robot physical interaction and collaboration using an industrial robot with a closed control architecture,” in IEEE International Conference on Robotics and Automation, 2013, pp. 4000–4007.
  31. 31. O. Oshin, E. A. Bernal, B. M. Nair, J. Ding, R. Varma, R. W. Osborne, E. Tunstel, and F. Stramandinoli, “Coupling deep discriminative and generative models for reactive robot planning in human-robot collaboration,” in 2019 IEEE International Conference on Systems, Man and Cybernetics (SMC), 2019, pp. 1869–1874.
  32. 32. H. Ravichandar and A. P. Dani, “Human intention inference using expectation-maximization algorithm with online model learning,” IEEE Transactions on Automation Science and Engineering, vol. 14, no. 2, pp. 855–868, 2017.
  33. 33. H. C. Ravichandar, A. Kumar, and A. P. Dani, “Gaze and motion information fusion for human intention inference,” International Journal of Intelligent Robotics and Applications, vol. 2, no. 2, pp. 136–148, 2018.
  34. 34. A. P. Dani, I. Salehi, G. Rotithor, D. Trombetta, and H. Ravichandar, “Human-in-the-loop robot control for human-robot collaboration: Human intention estimation and safe trajectory tracking control for collaborative tasks,” IEEE Control Systems Magazine, vol. 40, no. 6, pp. 29–56, 2020.
  35. 35. C. Liu, J. B. Hamrick, J. F. Fisac, A. D. Dragan, J. K. Hedrick, S. S. Sastry, and T. L. Griffiths, “Goal inference improves objective and perceived performance in human-robot collaboration,” in International Conference on Autonomous Agents & Multiagent Systems. International Foundation for Autonomous Agents and Multiagent Systems, 2016, pp. 940–948.
  36. 36. J. Mainprice and D. Berenson, “Human-robot collaborative manipulation planning using early prediction of human motion,” in Intelligent Robots and Systems, 2013 IEEE/RSJ International Conference on. IEEE, 2013, pp. 299–306.
  37. 37. R. Wilcox, S. Nikolaidis, and J. Shah, “Optimization of temporal dynamics for adaptive human-robot interaction in assembly manufacturing,” Robotics, pp. 441–449, 2013.
  38. 38. V. Shivashankar, K. N. Kaipa, D. S. Nau, and S. K. Gupta, “Towards integrating hierarchical goal networks and motion planners to support planning for human-robot teams,” in AAAI Fall Symposium: Artificial Intelligence for Human-Robot Interaction, 2014, pp. 13–15.
  39. 39. E. Yousefi, Y. Yildiz, R. Sipahi, and T. Yucelen, “Stability analysis of a human-in-the-loop telerobotics system with two independent time-delays,” IFAC-PapersOnLine, vol. 50, no. 1, pp. 6519–6524, 2017.
  40. 40. I. Kolmanovsky, E. Garone, and S. Di Cairano, “Reference and command governors: A tutorial on their theory and automotive applications,” in American Control Conference. IEEE, 2014, pp. 226–241.
  41. 41. U. V. Kalabić, I. V. Kolmanovsky, and E. G. Gilbert, “Reduced order extended command governor,” Automatica, vol. 50, no. 5, pp. 1466–1472, 2014.
  42. 42. F. Flacco, A. De Luca, and O. Khatib, “Control of redundant robots under hard joint constraints: Saturation in the null space,” IEEE Transactions on Robotics, vol. 31, no. 3, pp. 637–654, 2015.
  43. 43. N. Fischer, A. Dani, N. Sharma, and W. E. Dixon, “Saturated control of an uncertain nonlinear system with input delay,” Automatica, vol. 49, no. 6, pp. 1741–1747, 2013.
  44. 44. F. Blanchini, “Set invariance in control,” Automatica, vol. 35, no. 11, pp. 1747–1767, 1999.
  45. 45. S. Prajna and A. Jadbabaie, “Safety verification of hybrid systems using barrier certificates,” in International Workshop on Hybrid Systems: Computation and Control, 2004, pp. 477–492.
  46. 46. X. Xu, P. Tabuada, J. W. Grizzle, and A. D. Ames, “Robustness of control barrier functions for safety critical control,” IFAC-PapersOnLine, vol. 48, no. 27, pp. 54–61, 2015.
  47. 47. A. D. Ames, X. Xu, J. W. Grizzle, and P. Tabuada, “Control barrier function based quadratic programs for safety critical systems,” IEEE Transactions on Automatic Control, vol. 62, no. 8, pp. 3861–3876, 2017.
  48. 48. F. Berkenkamp, R. Moriconi, A. P. Schoellig, and A. Krause, “Safe learning of regions of attraction for uncertain, nonlinear systems with gaussian processes,” in IEEE Conference on Decision and Control, 2016, pp. 4661–4666.
  49. 49. L. Wang, E. A. Theodorou, and M. Egerstedt, “Safe learning of quadrotor dynamics using barrier certificates,” in IEEE International Conference on Robotics and Automation. IEEE, 2018, pp. 2460–2465.
  50. 50. Q. Nguyen, A. Hereid, J. W. Grizzle, A. D. Ames, and K. Sreenath, “3d dynamic walking on stepping stones with control barrier functions,” in Decision and Control (CDC), 2016 IEEE 55th Conference on. IEEE, 2016, pp. 827–834.
  51. 51. G. Wu and K. Sreenath, “Safety-critical control of a planar quadrotor,” in American Control Conference (ACC), 2016. IEEE, 2016, pp. 2252–2258.
  52. 52. Q. Nguyen and K. Sreenath, “Exponential control barrier functions for enforcing high relative-degree safety-critical constraints,” in 2016 American Control Conference (ACC), 2016, pp. 322–328.
  53. 53. Q. Nguyen and K. Sreenath, “Safety-critical control for dynamical bipedal walking with precise footstep placement,” IFAC-PapersOnLine, vol. 48, no. 27, pp. 147–154, 2015.
  54. 54. Y. Yang, Y. Yin, W. He, K. G. Vamvoudakis, H. Modares, and D. C. Wunsch, “Safety-aware reinforcement learning framework with an actor-critic-barrier structure,” in American Control Conference, 2019, pp. 2352–2358.
  55. 55. K. P. Tee, S. S. Ge, and E. H. Tay, “Barrier lyapunov functions for the control of output-constrained nonlinear systems,” Automatica, vol. 45, no. 4, pp. 918–927, 2009.
  56. 56. K. B. Ngo, R. Mahony, and Z.-P. Jiang, “Integrator backstepping using barrier functions for systems with multiple state constraints,” in IEEE Conference on Decision and Control, 2005, pp. 8306–8312.
  57. 57. K. P. Tee, B. Ren, and S. S. Ge, “Control of nonlinear systems with time-varying output constraints,” Automatica, vol. 47, no. 11, pp. 2511–2516, 2011.
  58. 58. K. P. Tee and S. S. Ge, “Control of nonlinear systems with partial state constraints using a barrier lyapunov function,” International Journal of Control, vol. 84, no. 12, pp. 2008–2023, 2011.
  59. 59. W. He, Y. Chen, and Z. Yin, “Adaptive neural network control of an uncertain robot with full-state constraints,” IEEE Transactions on Cybernetics, vol. 46, no. 3, pp. 620–629, March 2016.
  60. 60. M. L. Greene, P. Deptula, S. Nivison, and W. E. Dixon, “Sparse learning-based approximate dynamic programming with barrier constraints,” IEEE Control Systems Letters, pp. 1–1, 2020.
  61. 61. G. P. Kontoudis and K. G. Vamvoudakis, “Kinodynamic motion planning with continuous-time q-learning: An online, model-free, and safe navigation framework,” IEEE Transactions on Neural Networks and Learning Systems, vol. 30, no. 12, pp. 3803–3817, 2019.
  62. 62. J. F. Fisac, A. K. Akametalu, M. N. Zeilinger, S. Kaynama, J. Gillula, and C. J. Tomlin, “A general safety framework for learning-based control in uncertain robotic systems,” IEEE Transactions on Automatic Control, vol. 64, no. 7, pp. 2737–2752, 2018.
  63. 63. T. Schouwenaars, J. How, and E. Feron, “Receding horizon path planning with implicit safety guarantees,” in Proceedings of the American Control Conference, 2004, pp. 5576–5581.
  64. 64. L. S. Breger and J. P. How, “Safe trajectories for autonomous rendezvous of spacecraft,” Journal of Guidance, Control, and Dynamics, vol. 31, no. 5, pp. 1478–1489, 2008.
  65. 65. Y. Mao, D. Dueri, M. Szmuk, and B. Açıkmeşe, “Successive 20 convexification of non-convex optimal control problems with state constraints,” in IFAC-PapersOnLine, 2017, pp. 4063–4069.
  66. 66. N. Hovakimyan, C. Cao, E. Kharisov, E. Xargay, and I. M. Gregory, “l1 adaptive control for safety-critical systems,” IEEE Control Systems Magazine, vol. 31, no. 5, pp. 54–104, 2011.
  67. 67. I. Salehi, G. Rotithor, D. Trombetta, and A. P. Dani, “Safe tracking control of an uncertain euler-lagrange system with full-state constraints using barrier functions,” in 59th IEEE Conference on Decision and Control (CDC). IEEE, 2020, pp. 3310–3315.
  68. 68. H. K. Khalil, Nonlinear Systems, 3rd ed. Prentice Hall, 2002.
  69. 69. S. Prajna, A. Jadbabaie, and G. J. Pappas, “Stochastic safety verification using barrier certificates,” in IEEE Conference on Decision and Control, vol. 1. IEEE, 2004, pp. 929–934.
  70. 70. E. D. Sontag, “A lyapunov-like characterization of asymptotic controllability,” SIAM Journal on Control and Optimization, vol. 21, no. 3, pp. 462–471, 1983.
  71. 71. W. E. Dixon, “Adaptive regulation of amplitude limited robot manipulators with uncertain kinematics and dynamics,” IEEE Transactions on Automatic Control, vol. 52, no. 3, pp. 488–493, 2007.
  72. 72. M. W. Spong, S. Hutchinson, and M. Vidyasagar, Robot modeling and control. Wiley New York, 2006, vol. 3.
  73. 73. R. Funada, M. Santos, J. Yamauchi, T. Hatanaka, M. Fujita, and M. Egerstedt, “Visual coverage control for teams of quadcopters via control barrier functions,” in 2019 International Conference on Robotics and Automation (ICRA), 2019, pp. 3010–3016.

Written By

Iman Salehi, Ghananeel Rotithor and Ashwin Dani

Submitted: 28 September 2020 Reviewed: 15 March 2021 Published: 22 April 2021