# An Extended Passive Motion Paradigm for Human-Like Posture and Movement Planning in Redundant Manipulators

^{1}Laboratory of Neuromotor Physiology, Fondazione Santa Lucia, Rome, Italy^{2}Synergy Lab, Robotics Research Centre, School of Mechanical and Aerospace Engineering, Nanyang Technological University, Singapore, Singapore

A major challenge in robotics and computational neuroscience is relative to the posture/movement problem in presence of kinematic redundancy. We recently addressed this issue using a principled approach which, in conjunction with nonlinear inverse optimization, allowed capturing postural strategies such as Donders' law. In this work, after presenting this general model specifying it as an extension of the Passive Motion Paradigm, we show how, once fitted to capture experimental postural strategies, the model is actually able to also predict movements. More specifically, the passive motion paradigm embeds two main intrinsic components: joint damping and joint stiffness. In previous work we showed that joint stiffness is responsible for static postures and, in this sense, its parameters are regressed to fit to experimental postural strategies. Here, we show how joint damping, in particular its anisotropy, directly affects task-space movements. Rather than using damping parameters to fit *a posteriori* task-space motions, we make the *a priori* hypothesis that damping is proportional to stiffness. This remarkably allows a postural-fitted model to also capture dynamic performance such as curvature and hysteresis of task-space trajectories during wrist pointing tasks, confirming and extending previous findings in literature.

## 1. Introduction

Recent trends in both industry and healthcare clearly show the need for robots to be able to cooperate and assist humans in specific tasks. In order to do so, not only our robots will need to be safe-by-design, incorporating for example compliant mechanisms (Haddadin et al., 2010; Vanderborght et al., 2013) and force/impedance control architectures (Ficuciello et al., 2015) (as opposed to the current rigid and position-controlled deployed in industry) but will also need to *behave* naturally. In other words, while working with a robot, human operators not only need to be safe at all times, but shall also feel comfortable. As an example, imagine a robotic assistant designed to hand-over tools to a human operator. It is quite important for the robot to assume *natural postures*, which carry non-verbal semantics very valuable to human operators (the same object can be passed in different ways, for different purposes). For this and other reasons, in the last decades, roboticists have started looking into human motor strategies as a source of inspiration for the formulation of bio-inspired postural/motion controllers (Khatib et al., 2004; Schaal and Schweighofer, 2005; Kim et al., 2011, 2013; Zanchettin et al., 2013).

Another characteristic of modern robots is that they are general-purpose (unlike, for example, a CNC machine) and often bear human-like functionalities, if not resemblance. In this paper we shall be mainly interested in robotic manipulators. Currently, many commercial robotic arms are made available (in single or bimanual configuration) with kinematic similarities to human arms (Smith and Rooks, 2006; Albu-Schaffer et al., 2008). One of the specific similarities lies in the degrees-of-freedom (DOF), typically 6–7 in current robotic manipulators, and the *kinematic redundancy* which comes with it when dealing with most of tasks. The coordination of redundant degrees-of-freedom is a central topic in both robotics and neuroscience and we are interested in two specific aspects: the *redundancy problem* (Bernstein, 1967) and the *posture/movement problem* (Ostry and Feldman, 2003). This issue was first addressed by the authors in a recent work (Tommasino and Campolo, 2017) where a principled approach was proposed to tackle these very issues with focus on capturing human-like postural strategies: static (or equilibrium) postures satisfying a given (static) task constraint. In this work, we shall specialize the computational model and extend our previous results to the problem of movement generation: given a desired task constraint, find human-like motions (and postures), both in task and joint space, that brings the current robot posture to the desired task-space target.

### The Robotics Approach to Kinematic Redundancy

Motions for robotic manipulators are typically planned in task-space as it is much easier and intuitive to define a trajectory for a robotic end-effector than for its multiple (and often) redundant joints. For example, if we want a robotic manipulator to reach for a given object we can easily program the robotic gripper to follow a desired task-space path **x**_{d} with a given task-space velocity **ẋ**_{d} rather than programming the trajectory of each individual joint. However, due to kinematic redundancy, mapping the desired task trajectory in joint space is challenging as infinite combinations of joints trajectories are possible for the same task-space trajectory. This issue has a very long history in robotics and it has been tackled by roboticists, either at the kinematic or at the force level, with a local optimization approach and the use of weighted pseudo-inverses of the Jacobian matrix of the robot manipulator (Klein and Huang, 1983; Nenchev, 1989; English and Maciejewski, 2000). For instance, a simple way to map a desired task trajectory **ẋ**_{d} in joint space is: ${\dot{q}}_{d}={J}_{W}^{\#}(\text{q}){\u1e8b}_{d}$, where ${J}_{W}^{\#}$ is any W-weighted generalized pseudo-inverse of the Jacobian matrix *J*. However, it was soon realized that such solution, although simple, very often results in non-holonomic, or non-repeatable joint trajectories, i.e., the robot equilibrium posture satisfying a given task-constraint is not unique but depends on the path that robot followed before reaching the desired task constraint (Klein and Huang, 1983; Mussa-Ivaldi and Hogan, 1991). This type of solution is problematic especially for cyclic task-space movements as non-repeatable joint motions can result in instability and/or violations of joint constraints. At the kinematic level, the problem of repeatability can be tackled by planning an additional joint trajectory (or null-space motion) ${\dot{q}}_{0}$ that does not interfere with the planned task-space motions **ẋ**: $\dot{q}={J}_{W}^{\#}(\text{q})\u1e8b+{N}_{W}(\text{q}){\dot{q}}_{0}$ where *N*_{W}(* q*) is the null-space projector operator associated to the weighting matrix

*W*(Klein and Huang, 1983; Nenchev, 1989; English and Maciejewski, 2000)

^{1}. While kinematic motion planning requires an

*execution*level to track the desired trajectory in joint space (such as computed torque control or PD control (Murray et al., 1994), weighted pseudo-inverses and null-space projectors can also be used to solve kinematic redundancy at the force/torque level: $\tau ={J}^{T}(\text{q})\text{F}+{N}_{W}^{T}{\nabla}_{\text{q}}h(\text{q})$, where

**τ**is the commanded joint torque,

*is a task-space force fields (Mistry and Schaal, 2015)*

**F**^{2}that drives the robotic end-effector along desired task constraints and ∇

_{q}

*h*(

*) is the gradient of a real or virtual potential fields that is mapped in the null-space of the Jacobian transpose matrix to achieve repeatable joint motions.*

**q**In the last decade, task-space control has been extensively used in robotics to generate human-like and/or adaptive robot behavior (Schaal and Schweighofer, 2005) either at the tasks-space level, in terms of adaptive trajectories (Peters and Schaal, 2007; Degallier and Ijspeert, 2010) and Cartesian impedance (Calinon et al., 2013), then at the joint space level in terms of null-space control and weighting matrix *W* (Khatib et al., 2004; Nakanishi et al., 2008; Dietrich et al., 2015).

### Kinematic Constraints and Computational Approaches to Human Motor Control

In neuroscience is still debated whether the human brain adopts a hierarchical approach to plan and control movements and whether the brain plans and control task-space and null-space motions independently (Jordan and Wolpert, 1999; Mussa-Ivaldi et al., 2011; Mistry and Schaal, 2015). The experimental evidence that unconstrained planar reaching movements features straight-line paths and bell-shaped velocity profiles led to the hypothesis that the human brain plans hand movement in task-space, by shifting the equilibrium position of the hand according to a minimum-jerk trajectory. This trajectory would then be tracked in joint space (hence at a lower level) by an impedance controller that exploits muscle visco-elasticity [see the Equilibrium-Point Hypothesis (EPH); Flash, 1987 for more details]. Later studies however, showed that in other experimental conditions hand movements were curved and models such as the minimum-torque change (Uno et al., 1989) and the minimum-variance (Harris and Wolpert, 1998) were able to capture these human movement features by solving an optimal control problem directly in joint space.

#### Postural Synergies: Donders' law, Uncontrolled Manifold and the Leading Joint Hypothesis

Postures are somewhat *static*, possibly accounted for as equilibria of some potential field (Campolo et al., 2011), while movement is in apparent contrast with the very concept of equilibrium. The Posture/Movement problem stems out from the possible interference of postural control mechanisms with general motor strategies (Ostry and Feldman, 2003). In the last few decades, various approaches have been proposed in computational neuroscience as an attempt to reconcile posture and movement.

An extensive number of behavioral studies have shown that, at the joint-space level, during kinematically redundant tasks, humans adopt a stereotypical strategy that associates a *unique* and *path-independent* posture to a given task (Hepp, 1990; Haslwanter, 1995). This kinematic strategy is usually called *Donders' law*, since the Dutch ophthalmologist Donders showed (1847) that for any steady gazing direction (task), the human eye assumes a unique combination of elevation, azimuth, and torsion angles (posture). Donders-like strategies have also been found for pointing tasks involving the head (Ceylan et al., 2000; Crawford et al., 2003), the wrist (Campolo et al., 2009), the shoulder (Hore et al., 1992) and for pointing/reaching tasks involving the upper arm (Liebermann et al., 2006; Ewart et al., 2016).

It has been suggested that the brain implements Donders' Law as a flexible family of *holonomic constraints* (Medendorp et al., 2000; Crawford et al., 2003) to solve redundancy as well as to fulfill some *optimality* criteria that might vary in different experimental scenarios and physiological conditions (Ceylan et al., 2000; Medendorp et al., 2000; Wong, 2004).

From a computational perspective, Donders-like postural strategies, can be captured by solving a constrained optimization problem which returns the unique optimal posture that minimizes a given (posture-dependent) objective function while fulfilling a desired task-constraint (Cruse et al., 1990; De Sapio et al., 2006; Campolo et al., 2011). Because this type of *postural models* only computes static/equilibrium-configurations they are usually not suitable for planning movements. *Transport models* (Vetter et al., 2002) such as minimum-torque-change (Uno et al., 1989), minimum-work (Soechting et al., 1995), minimum-variance (Vetter et al., 2002), do provide a solution to the Posture/Movement problem but, in their original formulation are *incompatible* with Donders' law as they predict path-dependent equilibrium postures (Admiraal et al., 2004).

Kinematic constraints such as Donders' law, suggest that the brain may plan and control equilibrium postures directly in joint-space, by constraining redundant postures to a sub-manifold (Donders' surface) of the joint-space. Experimental studies involving redundant DOFs however, have also shown that motor variability is always higher along *task-irrelevant* directions (also known in human motor control as *uncontrolled manifold*) of the joint-space rather than along task-relevant directions (Latash et al., 2007). These results led to the Uncontrolled Manifold hypothesis (Scholz and Schöner, 1999) according to which the brain does not freeze redundant DOFs into a holonomic constraint (such as Donders' law) but instead uses redundant DOFs to push “bad motor variability” (i.e., directly affecting the task) along task-irrelevant directions of the joint space. In other words, according to the UCM hypothesis the brain would only stabilize elemental variables (such as joint rotations) that directly affect task performance while leaving task-irrelevant directions *uncontrolled*.

An alternative theory on how the brain may simplify the control of redundant DOFs is the Leading Joint Hypothesis (LJH) (Dounskaia, 2005). Central to the theory is the fact that link segments are coupled to each other by non-linear interaction torques so that motion in one joint unavoidably introduce motions to nearby joints, especially for fast speed movements. According to the LJH, the brain, depending on the specific task, organizes joints hierarchically: the “leading” joint, typically a proximal joint of the chain, is accelerated/decelerated as in a single joint movement, hence neglecting interaction torques and motions at the other joints. Subordinate joints instead, “monitor the interaction torque effect and create net torque that results in limb motion characteristics required by the task, including movement direction, accuracy, and so on.” Although in line with intuition, the LJH, to the best of authors knowledge, does not really propose a computational framework.

#### Optimal Feedback Control and Passive Motion Paradigm

The UCM and the LJH do provide theories of human motor control and mathematical frameworks to analyse human movements in terms of joint variability and leading/subordinate joints respectively. However, very little is known on how the brain may actually implement such motor strategies. Optimal feedback control (OFC) is probably one of the most accredited computational model of human motor control that can reproduce both average trajectories of human reaching movements and, to some extend, can predict the patterns of motor variability typical of the UCM hypothesis (Todorov and Jordan, 2002). Contrary to the robotics task-space control, in the OFC framework there is no distinction between planning and execution and task and joint space trajectories simply unfolds as the optimal controller adjusts feedback gains to suit the overall goals of the system. The OFC also predicts movement variability in line with the UCM hypothesis as deviations from the average trajectory are not correct by the controller if they do not affect task performance (minimum intervention principle).

Although the OFC framework has been very successful at modeling movement strategies typical of planar non-redundant point-to-point reaching movements (Scott, 2004), some computational studies have reported difficulties in solving optimal control problem in the presence of both kinematic redundancy and static forces (gravitational and/or elastic). This is because, to hold the body still at equilibrium (i.e., at the end of a movement), suitable boundary conditions must be specified so that the optimal muscle forces can counterbalance the static forces acting on the body (see Guigon et al., 2007 and references therein). Recently, this Posture/Movement problem has been tackled with the Separation Principle according to which the brain processes static (i.e., configuration-dependent) and dynamic (i.e., velocity-dependent) joint torques separately (Hollerbach and Flash, 1982; Atkeson and Hollerbach, 1985; Guigon et al., 2007). By combining the optimal control framework with the Separation Principle, Guigon and colleagues were able to implement human-like motor strategies in redundant manipulators (Guigon et al., 2007; Taïx et al., 2013). However, their approach, formulated at the joint-space level, results into path-dependent (i.e., dependent on the movement history and initial body configuration) terminal postures and therefore such an approach cannot predict kinematic synergies such as Donders' law.

An alternative theory to the OFC framework is the so-called Passive Motion Paradigm (PMP) (Mussa-Ivaldi et al., 1988; Mohan and Morasso, 2011; Morasso et al., 2015) PMP can be considered a computational generalization of the EPH, in that *goals and kinematic constraints can be superimposed when viewed as force-fields*. First proposed in the 80 s (Mussa-Ivaldi et al., 1988), the PMP has evolved over the years and has been proposed as a theory of human trajectory formation and as bio-inspired trajectory planner for redundant robots (Mohan and Morasso, 2007; Morasso et al., 2010; Mohan et al., 2011).

One of the major strengths of the PMP lies in its computational simplicity. While full details of the PMP are found in Mohan et al. (2011) and references therein, its basic features are illustrated in Figure 1. In the standard PMP model, a robotic manipulator is seen as a rigid structure (i.e., an arm-like kinematic chain) with “intrinsic” properties defined at the level of joint-space (e.g., joint angles *q*_{1}, *q*_{2}, *q*_{3}) and “extrinsic” properties defined at the level of task-space (e.g., actual and desired endpoint postures * x* and

**x**_{d}, respectively). The redundancy problem is solved by postural mechanisms implemented via the action of an

*intrinsic impedance*, for example in the form of purely viscous (mechanical dampers) or viscoelastic (dampers and springs) elements interconnected at joint level. On the other hand, movement is planned at task-level and implemented by an

*extrinsic impedance*,

*=*

**F***K*(

**x**_{d}−

*) in Figure 1, acting as a generalized spring which continuously drives the end-effector (at some position*

**x***) toward the goal*

**x**

**x**_{d}while the intrinsic impedance takes care of postures.

**Figure 1. λ**_{0}-PMP as an extension of the Passive Motion Paradigm. **(A)** Example of a 3DOF human-like arm performing a redundant 2D reaching task. **(B)** Block diagram of the general **λ**_{0}-PMP model.

The standard PMP comes in two forms, with the only difference in terms of intrinsic impedance: one being *purely viscous* and the other being *viscoelastic*. In the first case, it can be easily shown (Tommasino and Campolo, 2017) that a purely viscous intrinsic impedance solves the posture/movement problem but is *incompatible* with Donders' law (as it does not yield repeatable postures). In the second case, the intrinsic viscoelastic impedance ensures unique postures (due to an elastic potential in joint-space) but does not solve the posture/movement problem. A simple way to see this is that the intrinsic springs “pull” the end-effector back to a rest position (* q**), in contrast with the extrinsic spring which pulls the end-effector toward a target

**x**_{d}. To ensure task completion (i.e.,

*=*

**x**

**x**_{d}) one should set the target at a different location, say

**x**_{d′}, so that the end-effector ends up being in equilibrium at the planned target

**x**_{d}. Computing

**x**_{d′}is not trivial and somewhat blurs the separation between task and posture as

**x**_{d′}depends on both the intrinsic and the extrinsic elastic potentials.

### An Extended Passive Motion Paradigm (λ_{0}-PMP)

One way to prevent the interference between intrinsic and extrinsic elastic potentials is to *block any effect of the intrinsic potential onto the task*. Inspired by the *Separation Principle* (of static and dynamic torques) (Guigon et al., 2007), we recently proposed the **λ**_{0}-PMP model (Tommasino and Campolo, 2017), an extension of the standard PMP. Experimental evidence shows that the human brain processes *static* (or configuration-dependent) and *dynamic* (or velocity-dependent) *force fields separately* (Hollerbach and Flash, 1982; Atkeson and Hollerbach, 1985; Nishikawa et al., 1999; Kurtzer et al., 2005b). Because static forces such as gravitational or elastic fields are predominant during slow movements and are not affected by movement speed, the Separation Principle (Guigon et al., 2007) has been proposed as a simplifying control strategy for the brain to learn new movements (Nishikawa et al., 1999), to efficiently time-scale arm trajectories (Hollerbach and Flash, 1982; Atkeson and Hollerbach, 1985) and to robustly cope with the effect of gravity in different environments (Kurtzer et al., 2005a).

In literature, the Separation Principle is typically applied at joint-space level (larger than task-space, dimension-wise, when dealing with redundant manipulators), assuming that static contributions (either due to gravity or to elastic fields) are perfectly compensated for by the brain (or by the robot controller) so that they can be removed from the dynamic equations of the limb under control (Guigon et al., 2007; Taïx et al., 2013). In our recent work (Tommasino and Campolo, 2017), we derived the **λ**_{0}-PMP model by (i) re-framing the problem within the *constrained minimization framework* and applied the Lagrange Multipliers method; (ii) noting that the Lagrange Multipliers **λ** define a *task-space force field*; (iii) applying the Separation Principle to **λ** and defining a *static task-space force field* **λ**_{0} (from which the name of the method). This task-space force **λ**_{0}, also highlighted in Figure 1 as an addition to the standard PMP, produces *partial compensation* of joint torques, blocking their effect *only* on the tasks space, leaving joint torques free to act in the *null-space*, and driving the posture toward minima of the potential without interfering with task-space objectives. This captures the essence of postural synergies such as Donders' law which can now be seen as generated from a joint-space potential combined with a task-space force field.

### Scope of This Work and Contribution

With reference to Figure 1B, for the **λ**_{0}-PMP, once the Jacobian matrix *J* is defined (given the geometry of the manipulator and of the task), the parameters which need to be determined are the *intrinsic stiffness matrix K*^{J}; the *intrinsic damping matrix W* (or, equivalently, the admittance *W*^{−1}); and the *extrinsic stiffness matrix K*. Although all these intrinsic and extrinsic parameters are required to plan motion, this work will focus on the role of intrinsic properties and in particular the intrinsic damping matrix *W*.

In previous works, we focused on postural strategies and showed how Donders' Law can be captured via an intrinsic elastic potential (Campolo et al., 2011; Tommasino and Campolo, 2016) and how nonlinear inverse optimization can be used to determine the coefficients of the intrinsic stiffness *K*^{J} to fit experimental data (Tommasino and Campolo, 2017). In this work, we shift our focus on movement dynamics, which are primarily shaped by the damping matrix *W*. Rather than trying to use the coefficients of the matrix *W* as “extra degrees of freedom” to better fit experimental data *a posteriori*, we assume *a priori* that *damping is proportional to stiffness*, in line with experimental evidence (Tsuji et al., 1995; Perreault et al., 2004; Tee et al., 2004; Peaden and Charles, 2014). In other words, we hypothesize that the same biomechanical factors which determine the “shape” of *K*^{J} (i.e., its eigenvectors and eigenvalues) also determine the “shape” of *W*.

With this hypothesis in place, the intrinsic stiffness still has an “indirect effect” as it shapes the intrinsic damping matrix *W*, whose dynamic effects are not blocked by **λ**_{0}. We shall specifically show how this mechanism determines curvature of task-space trajectories during pointing tasks performed with the wrist, in line with the experimental evidence also reported in literature by Charles and Hogan (2010). Lastly, it should be noted that any stable task-space force field can be used as a movement planner and some possible choices have already been reported in Tommasino and Campolo (2017). In line with the PMP, in this work we assume that the task planner is a *virtual* elastic field driving the end-effector toward the desired target. A detailed comparison of different task-space planners will be reported in a separate work.

## 2. Materials and Methods

This section presents the **λ**_{0}-PMP, a novel extension of the Passive Motion Paradigm, and its specialization to wrist pointing tasks which will be later used in a comparative analysis with experimental data.

Although bearing remarkable similarities with the Passive Motion Paradigm, the theoretical derivation of the **λ**_{0}-PMP follows a principled approach, described in detail in Tommasino and Campolo (2017). However, this similarity allows presenting our model as an extension of the PMP, facilitating readers already familiar with the Passive Motion Paradigm itself. To this end, Figure 1B highlights the differences between the two standard PMP models (here denoted as PMP1 and PMP2) and ours.

### λ_{0}-PMP

One of the computational advantages of the PMP is its *ability to solve the redundancy problem* without explicit kinematic inversion and cost function computation (Mohan and Morasso, 2011). To see how this is accomplished, consider a redundant manipulator with forward kinematics

where * x* ∈ ℝ

^{m}is a given end-effector pose,

*∈ ℝ*

**q**^{n}is a given manipulator configuration and the inequality

*m*<

*n*denotes kinematic redundancy. As an example, Figure 1A shows a planar human-like arm with a three-dimensional joint space (consisting of three rotational joints $\text{q}={\left[{q}_{1}\text{}{q}_{2}\text{}{q}_{3}\right]}^{T}$) and with a two-dimensional task-space encoding of the actual hand position

*and the desired hand position*

**x**

**x**_{d}. Once the Forward Kinematics (

*FK*) of the manipulator is defined in relation to a specific task, one can compute the

*task Jacobian*, an

*n*×

*m*matrix which maps joint space velocities $\dot{q}$ into task-space velocities

**ẋ**:

The redundancy problem lies in the fact that, even with a full-ranked Jacobian matrix, there might exist many (infinite) joint velocities which result in the same velocity at the end-effector **ẋ**. This problem can be solved with a mechanical analogy, imagining that a mechanical manipulator, with negligible inertia and purely viscous (symmetric and positive-definite) joint impedance *W* producing viscous joint torques $W\dot{q}$, is passively moved at the end-effector with an imposed velocity * ẋ*. This action will produce a

*unique joint velocity*

This type of redundancy solution is also known as a *W*-weighted generalized pseudo-inverse (Klein and Huang, 1983; Doty et al., 1993) but, rather than its derivation, here we want to emphasize its physical interpretation. The highlighted term *B*(* q*): = (

*J*(

*)*

**q***W*

^{−1}

*J*

^{T}(

*))*

**q**^{−1}represents the

*task-space damping*, i.e., the damping force perceived at the end-effector (task-space) while imposing a task-space velocity

**ẋ**and solely due to the joint-space damping

*W*and its mapping via the Jacobian

*J*(

*).*

**q**To accomplish a task such as reaching for a target **x**_{d}, a simple way is to “pull” the end-effector toward the target with the action of an *extrinsic spring K*, producing a task-space force * F* =

*K*(

**x**_{d}−

*) on the hand always directed toward the target. The first and most basic form of PMP (Mohan and Morasso, 2011) corresponds to the thin-line loop [denoted PMP1 and including*

**x***K*,

*W*

^{−1},

*J*(

*) and*

**q***J*

^{T}(

*)] in Figure 1B. This form of PMP can solve redundancy but is*

**q***incompatible*with Donders' law. More details can be found in Tommasino and Campolo (2017) but it is straightforward to see that, once on the target, i.e.,

*=*

**x**

**x**_{d}, no force is produced by the extrinsic spring (

*−*

**x**

**x**_{d}= 0) and any posture

*such that*

**q**

**x**_{d}=

*FK*(

*) will therefore be maintained indefinitely.*

**q**To guarantee unique postures, an elastic scalar potential can be introduced in the joint-space, for example, via an *intrinsic stiffness* matrix *K*^{J} at the joint-level. This will subject the manipulator to joint torques ${\tau}_{el}:=\text{}{K}^{J}(\text{q}-{\text{q}}^{*})$ which continuously drive the manipulator toward a given “rest” posture * q** (an equilibrium for the intrinsic elastic potential). The addition of elastic joint torques

**τ**

_{el}leads to the second form of PMP, denoted as PMP2 and highlighted in Figure 1B. As shown in Tommasino and Campolo (2017), this solves redundancy and accounts for Donders's law but does not solve the posture/movement problem due to the contrasting effect of the extrinsic spring

*K*, which pulls the end-effector toward the target

**x**_{d}, and intrinsic stiffness

*K*

^{J}which pulls the whole manipulator toward the “rest” posture

**. It is easy to show that, in general,*

**q**

**x**_{d}is not an equilibrium for the system. If

*=*

**x**

**x**_{d}, then the extrinsic spring

*K*will produce no force (

**x**_{d}−

*= 0) and the effect of the intrinsic stiffness*

**x***K*

^{J}on the task will not be contrasted, moving the end-effector away from

**x**_{d}.

The unwanted interference due to intrinsic elastic torques **τ**_{el} can be removed by adding the *task-space force*:

The task-force **λ**_{0} is the last piece of the puzzle needed to complete the description of the **λ**_{0}-PMP model shown in Figure 1B. For a complete theoretical derivation, the reader should refer to Tommasino and Campolo (2017), here we only wish to provide its physical intuition. As mentioned above, **τ**_{el} is an elastic torque field responsible for Donders' law, in the sense that it constantly drives the manipulator toward “natural” or “comfortable” postures (Campolo et al., 2011). In doing so, however, it also interferes with the task completion (posture/movement problem). In order to block its effect *only* in the task-space (so, preserving Donders' law in joint-space) one could proceed as follows: the elastic torque **τ**_{el}, if unblocked, would produce a joint velocity ${\dot{q}}_{el}={W}^{-1}{\tau}_{el}$ with a resulting task velocity ${\u1e8b}_{el}=J(\text{q}){\dot{q}}_{el}$. The task-force **λ**_{0} can be seen as the force needed to contrast the (task-space) damping force $B(\text{q}){\u1e8b}_{el}=B(\text{q})J(\text{q}){W}^{-1}{\tau}_{el}$. The *novel* concept of a task-space force **λ**_{0} is very useful as it provides a *force perspective* which allows other force-control strategies to be simply *superimposed* onto our postural mechanisms. The extrinsic spring force **F** = *K*(**x**_{d} − * x*) plays the role of

*Task Planner*. In fact, as shown in Tommasino and Campolo (2017), other type of force-control strategies could be superimposed, such as a visco-elastic task-space force field or an optimal force field planner minimizing the total task-space force moving the end-effector toward the desired target.

**Remark:** With reference to the diagram in Figure 1B, the task-space damping *B*(* q*) in Equation (3) transforms task-space velocities

*into task-space forces which balance out the effect of the extrinsic spring*

**ẋ***K*, leading to the following task-space dynamic equation:

Although the task-space damping is posture-dependent and more equations are needed to fully solve the dynamics, some remarkable properties can already be noted: (i) the task-damping *B*(* q*) in Equation (3) directly depends on the intrinsic damping

*W*which, therefore, directly affects task-space dynamics (Equation 5); (ii) the intrinsic stiffness

*K*

^{J}does not appear in Equation (5) and therefore does

*not*directly affect the task dynamics, however, it does it

*indirectly*through postures adjustments in the null-space which affect the Jacobian and therefore

*B*(

*).*

**q**Although in this work we only consider elastic joint-space potentials, other potentials (for example due to gravity) and their gradient can be simply added in parallel to the elastic torque **τ**_{el} in Figure 1 and, the **λ**_{0} would only block, in task-space, the effects of these posture-dependent torque fields but not velocity-dependent (i.e., dynamic) torques, such as viscous effects due to *W*. The reader is referred to our previous work (Tommasino and Campolo, 2017) for this and other details. The role of the **λ**_{0} also offers a force field perspective to the UCM and LJH hypothesis. By compensating only the task-space components of intrinsic potential fields, the null-space is left *uncontrolled* and motions along task-irrelevant directions are due exclusively to the passive dynamics of the limb under control.

### Application to Wrist Pointing Tasks

Building on previous experimental and computational studies (Campolo et al., 2009, 2010, 2011; Charles and Hogan, 2012; Formica et al., 2012; Tommasino and Campolo, 2017), we are specifically interested in capturing human-like motor strategies during pointing tasks performed with the wrist. To implement the model in Figure 1B, we shall first determine the Jacobian *J* from the forward kinematics; the intrinsic stiffness (*K*^{J}) matrix and the rest posture * q**; the damping (

*W*) matrix as well as the extrinsic stiffness matrix

*K*.

#### Forward Kinematics

With reference to Figure 2, we assume that the wrist is used to point a virtual laser beam onto a point on a computer screen, i.e., a two-dimensional task-space of coordinates $\text{x}={\left[{x}_{1}\text{}{x}_{2}\right]}^{T}\in {\mathbb{R}}^{2}$. The human wrist is modeled as an ideal, three-dimensional gimbal comprising the following three orthogonal, rotational axes (from proximal to distal):

– the Prono-Supination (PS) axis, aligned along ${\text{e}}_{x}:=\text{}{\left[1\text{}0\text{}0\right]}^{T}$;

– the Flexion-Extension (FE) axis, aligned along ${\text{e}}_{z}:=\text{}{\left[0\text{}0\text{}1\right]}^{T}$;

– the Radial-Ulnar-Deviation (RUD) axis, aligned along ${\text{e}}_{y}:=\text{}{\left[0\text{}1\text{}0\right]}^{T}$.

**Figure 2**. Center-out task and kinematic spaces involved in wrist pointing. 3D wrist configurations can be equivalently expressed in terms of 3 × 3 rotation matrices *R*(* q*), rotation vectors

**r**or joint rotations

*. The forward kinematics*

**q***=*

**x***FK*(

*) maps 3D wrist orientations onto the 2D task, expressed in screen coordinates*

**q***. Adapted from Campolo et al. (2011).*

**x**The joint-space is therefore three-dimensional and can be described via a joint vector * q* = [

*q*]

^{PS}q^{FE}q^{RUD}*∈ ℝ*

^{T}^{3}or, alternatively, via rotation vectors (Campolo et al., 2010, 2011). as shown in Figure 2.

The forward kinematics (Equation 1) for a 3DOF wrist at distance *d* = 1 m and initially pointing in the [1 0 0]^{T} direction can be written as

where *R*(* q*) represents the 3D hand orientation, computed as $R(\text{q})=exp(-{\hat{\text{e}}}_{x}{q}^{PS})exp({\hat{\text{e}}}_{z}{q}^{FE})exp({\hat{\text{e}}}_{y}{q}^{RUD})$ where the exponential notation $exp(\hat{e}\theta )$ represents the rotation about an axis

**e**by and angle θ (Murray et al., 1994). Further details are given in Campolo et al. (2011) and references therein. Once the forward kinematics is given, the Jacobian can be analytically computed based on its definition given in Equation (2).

#### Subject-Specific Intrinsic Stiffness *K*^{J} and Rest Posture *q** from Experimental Data

For the 3DOF wrist, the intrinsic stiffness (as well as the damping) is represented by a 3 × 3 *symmetric matrix*. The rest posture * q** represents the posture (three joint angles) of minimum elastic energy. Using nonlinear inverse optimization (NIO) techniques (Tommasino and Campolo, 2016), a subject-specific matrix

*K*

^{J}and rest posture

** can be directly derived from experimental data. As detailed in Tommasino and Campolo (2016), experimental data consisting of thousands of data points are fitted to a quadratic surface, typically used in literature to encode Donders' law. This can be seen as an extreme down-sampling of experimental data and the resultant quadratic surface can be seen as an average Donders' surface. The reader is referred to Tommasino and Campolo (2016) for the detailed procedure based on nonlinear inverse optimization. One thing to highlight is that it is the relative*

**q***ratio*between eigenvalues of

*K*

^{J}which determines a specific Donders' law, not the absolute values. For this reason, the trace of the matrix can be set to any arbitrary (positive) number. To be in line with biomechanical (passive) stiffness values found in literature (Peaden and Charles, 2014), we set this value to be

*trace*(

*K*

^{J}) = 4 Nm/rad.

#### Damping *W* and Intrinsic Time Constant

While the intrinsic stiffness matrix is derived directly from a fitting process of experimental data, for the intrinsic damping matrix *W*, rather than trying to use the coefficients of the matrix *W* as “extra degrees of freedom” to better fit experimental data, we assume that *damping is proportional to stiffness*, in line with experimental evidence (Tsuji et al., 1995; Perreault et al., 2004; Tee et al., 2004; Peaden and Charles, 2014). In other words, we hypothesize that the same biomechanical factors which determine the “shape” (in terms of eigenvectors and eigenvalues) of *K*^{J} will determine a similar “shape” for *W*. For this reason we set the damping to be proportional to the intrinsic stiffness

where τ_{0} is a scalar (positive) value with the units of time, and can be therefore thought of as an *intrinsic time constant*. The reason is that, for a simple scalar, linear spring-damper system, the ratio between damping and stiffness determines exactly the time constant of the system.

#### Extrinsic Stiffness *K* and Task-Space Dynamics

The extrinsic stiffness *K* is responsible for the task-space dynamics together with the task-space damping *B*(* q*), as highlighted in Equation (5). However,

*B*(

*) is determined once*

**q***J*and

*W*are given, as in Equation (3). In this work, we are considering very simple center-out tasks, as described below. As there is no

*a priory*preferential direction in the task-space, we shall consider an

*isotropic*extrinsic stiffness

*K*, although other choices of task planners are possible (Tommasino and Campolo, 2017) and will be the focus of future works. When the extrinsic stiffness is constant, our computational model predicts trajectories that evolve in time according to a first order dynamic typical of a visco-elastic system with constant parameters. In other words, the desired target is reached with an exponential velocity profiles that decays to zero only after an infinite amount of time. This feature is clearly not bio-inspired as biological movements are characterized by bell-shaped velocity profiles. In the PMP, Morasso and colleagues have overcome this issue with the introduction of a

*time base generator*, i.e., a time-dependent gain matrix that rescales end-effector velocities according to a minimum-jerk profiles (Morasso et al., 2010). However, in this work we pursue the approach proposed by Arimoto et al. (2005), as it could reproduce velocity profiles more similar to our experiments. More specifically, a time-varying extrinsic stiffness matrix:

with the property of increasing its stiffness value from zero to *k* with an *extrinsic time constant* τ (notice that when pointing to a new target the time *t* is reset to zero), is used to avoid first order dynamics typical of visco-elastic systems with constant stiffness and damping parameters.

### Example: Anisotropic Damping and Curved Task-Space Trajectories

As an example, Figure 3 shows the trajectories predicted via the **λ**_{0}-PMP with an anisotropic intrinsic damping *W*. More specifically, every outbound and inbound movement was simulated for a duration *T* = 0.4 [*s*], and with time-constants τ = τ_{0} = 0.08 [*s*], i.e., one-fifth of *T*. The anisotropic damping *W* was set according to Equation (7) as:

hence proportional to an anisotropic intrinsic stiffness *K*^{J}. The rest posture was set as * q** = [5 0 0]

^{T}[

*deg*] and the scalar stiffness $k=22.5\left[\frac{Nm}{rad}\right]$.

**Figure 3**. Task space paths **(A)**, joint trajectories **(B)** and task-space tangential velocity profiles **(C)** predicted via the **λ**_{0}-PMP with the anisotropic damping *W* of Equation (9).

As shown in Figure 3A the anisotropic damping results into paths of different degree of curvature depending on the specific movement direction. Moreover, outbound and inbound movements follow different paths, especially along the (NW-SE) and (SW-NE) directions. Figure 3B shows the joint space trajectories predicted by the model and Figure 3C shows that task-space tangential velocity profiles are bell-shaped thanks to the time-varying stiffness *K*(*t*) (Arimoto et al., 2005).

## 3. Comparative Analysis of Task-Dynamics: Experimental Pointing Tasks vs. Donders-Fitted λ_{0}-PMP Model Predictions

In this section, we will compare the *average* experimental task-space trajectories, as previously measured in Campolo et al. (2011) from human subjects during wrist pointing tasks, with those predicted via a *Donders-fitted* **λ**_{0}-PMP model, i.e., a **λ**_{0}-PMP model for which the *only postural parameters are fitted to capture the Donders' law for a specific subject*. The major limitation of our previous model (Campolo et al., 2011) is that it was limited to static postures, while our current **λ**_{0}-PMP model can also generate movements.

The main hypothesis is that a Donders-fitted model **λ**_{0}-PMP, i.e., fitted to only capture postural strategies, is also able to display path dynamics such as curved task-space trajectories as experimentally found by Charles and Hogan (2010). A major difference with their experimental paradigm is that their subjects only used FE and RUD movements, as PS movements were restrained, so it was not a redundant task. In our case, subjects are free to rotate the forearm about the PS axis, adding a degree of redundancy.

### Donders-Fitted **λ**_{0}-PMP Model for Wrist-Pointing Tasks

Our **λ**_{0}-PMP model in Figure 1B requires specification of a Jacobian [*J*(* q*)], a task-planner (

*K*) as well as intrinsic damping (

*W*) and intrinsic postural parameters (

*K*

^{J}and

**). Once specialized to wrist-pointing tasks and ideally assuming a similar wrist structure for all subjects, the forward kinematics (Equation 6), and therefore the Jacobian*

**q***J*(

*), will be the same for all subjects. On the other hand, we shall fit subject-specific postural parameters*

**q***K*

^{J}and

**. Note that these parameters alone only capture Donders' law, i.e., they can identify optimal postures for giving pointing directions (Campolo et al., 2011; Tommasino and Campolo, 2016) but cannot tell where to point. The actual motion, in particular the geometry of task-space trajectories, will be shaped by the task dynamics (Equation 5). Here, rather than fitting every single movement*

**q***a posteriori*with a specific damping

*W*, we make the

*a priori*hypothesis that

*intrinsic damping is proportional to intrinsic stiffness*, via an intrinsic time constant as in Equation (7).

As shown in Equation (5), task-space dynamics depend on *K* and on *B*(* q*) which, in turn, depends on the intrinsic damping

*W*via Equation (3). For the task-planner, we shall assume an extrinsic

*K*(

*t*) as in Equation (8) hence isotropic and therefore not directly responsible for path curvatures. Both the intrinsic and extrinsic time constant, in Equations (7), (8) respectively, affect the speed of the simulated trajectory, in particular, the time required for the simulated wrist, to reach the target in “steady-state” (i.e., an equilibrium posture compatible with Donders' law) after the beginning of the movement. In general, movement speed can be target and subject specific, hence we set both time constants to be proportional to the average movement duration

*T*

_{sj}that subject

*s*needs to point to the target

*j*. More specifically, we heuristically found that, by setting τ = τ

_{0}=

*T*

_{sj}/5 the model predicts both task-space and joint space dynamics that are compatible with the experimental ones (see results below). Similar to Equation (7), we used the time-constant τ

_{0}to tune the scalar stiffness

*k*in Equation (8) as:

where *b*_{max} is the maximum eigenvalue of the matrix *B*(**q**_{0}) and **q**_{0} is the initial wrist configuration prior to the starting of the movement. Therefore, *k* was set on a subject-specific (because of *B*(* q*)) and movement-specific basis (because τ depends on the average time

*T*that the subject needs to perform the movement).

We know that our model predicts curvatures in task-space, as shown in Figure 3. We shall now compare the average curvature displayed by a specific human subject with the curvature predicted by our **λ**_{0}-PMP model, once Donders-fitted to a specific subject.

### Experimental Protocol

We asked six subjects to perform center-out pointing tasks toward nine targets on a computer screen. As shown in Figure 2, the nine targets consist of a central target and eight peripheral ones arranged over a circle (with a radius of 15°) and oriented along the eight cardinal directions, i.e., North (N), NorthEast (NE), etc., which also define the naming convention).

Each subject performs 10 trials at self-paced speed. Each trial consists of eight outbound movements (from the center to a peripheral target) and 8 inbound movements (from a peripheral target to the center). In a trial, each peripheral target is visited only once and an outbound movement is always followed by an inbound movement. The order in which targets are visited is computed prior to the start of the trial as a pseudo-random permutation.

Throughout the experiment, subjects grasp a light-weight 3D printed handle mounting an inertial measurement unit (IMU) that records hand orientations *R*(* q*), with respect to the fixed reference frame, at 120 Hz. A computer monitor is used to display the center-out task to the subject. The visual feedback consists of the desired target position (a red circle) and the current location pointed at by the subject (a yellow circle). The current location is displayed at coordinates $\text{x}={\left[{x}_{1}\text{}{x}_{2}\right]}^{T}$ computed as in Equation (1), is updated realtime via Equation (6), where

*R*(

*) is sensed by the IMU.*

**q**### Data Analysis

In this work, we are mainly interested in task-space dynamics, in particular the fact that trajectories during pointing tasks with the wrist appear more curved than in similar tasks performed with the arm (Charles and Hogan, 2010).

#### Movement Start and End Times

To this end, we follow the same data analysis method proposed in Charles and Hogan (2010). Specifically, the recorded kinematic data is first filtered with smoothing splines (Dohrmann et al., 1988; Charles and Hogan, 2010) to ease numerical differentiation in estimating task-space velocity profiles. The starting and ending times of a movement are identified from the task-space tangential velocity profiles: the start of movement is set to occur at the time of the first data sample *before* the velocity peak with a value below 20% peak velocity. Similarly, the end of a movement is set to occur at the time of the first data sample *after* the velocity peak with a value below 20% the peak velocity. Movements featuring a path length and/or a duration beyond two interquartile from the (subject-specific) median were excluded from the analysis. To compute the average trajectory of a movement, the data was normalized with respect to the movement time and then linearly interpolated at 20 equally temporally spaced samples.

#### Path Curvature and Hysteresis

To assess path curvature in task-space, we follow the method proposed in Charles and Hogan (2010) to test whether task-space paths are on average curved and if so, whether outbound and inbound movements had different direction of curvatures. More specifically, since each movement occurs between two targets, we consider the straight-line connecting the two targets and directed from the initial target to the final one. This direction is used to determine whether the actual movement is on the left or on the right of the straight line, as depicted in Figure 4. In particular, we shall consider the whole area enclosed between the actual movement and the straight line and split this area into “right” area (*A*_{R}), i.e., the enclosed area to the right of the straight line and “left” area (*A*_{L}) as the enclosed area to the left of the straight line. Both left and right areas are defined non-negative and are normalized with respect to the square of the nominal target-to-target distance (${(\frac{\pi}{12})}^{2}$ [*m*^{2}]). For each movement, either inbound or outbound, we compute the following measures:

– *total area A*_{sum}: = *A*_{R} + *A*_{L} (non-negative by definition), indicating deviations of the actual movement from the straight-line.

– *net area A*_{net}: = *A*_{R} − *A*_{L}, indicating tendency of a path to deviate more on the right (*A*_{net} > 0) or to the left (*A*_{net} < 0).

**Figure 4**. Movement curvature is assessed by calculating the area enclosed to the left (*A*_{L}) and to the right (*A*_{R}) of the straight-line connecting the starting and ending of a movement. The total area *A*_{sum} = *A*_{L} + *A*_{R} indicates whether movements are curved and the net area *A*_{net} whether there is a tendency to veer more on the right (*A*_{net} > 0) or to the left *A*_{net} < 0.

Finally, since an outbound movement is always followed by an inbound movement, we also consider the *path hysteresis* defined as ${A}_{hyst}:=\text{}{A}_{net}^{OUT}+{A}_{net}^{IN}$, i.e., the area enclosed in between outbound and inbound paths.

To assess the statistical significance of each measure, we use a *t*-test (with α = 0.05) to test the following hypotheses: (1) paths are curved (*Asum* ≠ 0); (2) outbound paths have a preferred curvature direction (${A}_{net}^{OUT}\ne 0$); (3) inbound paths have a preferred curvature direction (${A}_{net}^{IN}\ne 0$); and (4) an outbound-inbound sequence presents hysteresis (${A}_{net}^{OUT}\ne -{A}_{net}^{IN}$).

### Results

For all subjects and for all movements we found *A*_{sum} to be statistically different from zero suggesting that task-space paths executed with the wrist are not straight also in presence of redundancy (this was not the case in Charles and Hogan, 2010, where PS was locked).

Figure 5 shows the average outbound and inbound paths of the six subjects together with their standard deviations (shaded areas). Thick lines mark movements for which *A*_{net} was statistically different from zero (i.e., a preferred curvature direction) while stars mark segments with statistically significant hysteresis (i.e., outbound and inbound follow different paths). Superimposed with experimental trajectories, Figure 5 also shows the task-space trajectories predicted via a Donders-fitted **λ**_{0}-PMP model (dashed lines). The subject-specific postural parameters *K*^{J} and * q** (estimated with method proposed in Tommasino and Campolo (2016)), used to simulate the model for each subject, are shown in Tables 1–2.

**Figure 5**. Average task-space trajectories. Shaded areas show the standard deviations for both outbound and inbound movements. Thick lines are relative to paths with *A*_{net} statistically different from zero (i.e., a preferred curvature direction). The stars mark movement for which ${A}_{net}^{IN}$ was statistically different from ${A}_{net}^{OUT}$, i.e., those movement that present hysteresis.

**Table 1**. Subject-specific intrinsic stiffness (*K*^{J}) parameters estimated via NIO from the average postural strategy.

**Table 2**. Subject-specific equilibrium postures (* q**) estimated via NIO from the average postural strategy.

Figure 6 compares the experimental *A*_{net} (average and standard deviation) with the model predicted *A*_{net}. This comparison indicates whether the simulated paths have the same curvature direction and magnitude as the experimental ones. A *t*-test (*p* < 0.05) was used for each movement to assess if the average *A*_{net} was statistically different from the model predicted *A*_{net} (stars).

**Figure 6**. Experimental vs. Model predicted *A*_{net}. Error bars represent the standard deviation of the experimental ANET. Stars mark a model-predicted Anet that is statistically different (*p* < 0.05) from the average experimental Anet.

With reference to Figure 5A, subject 1 shows path hysteresis only for the (SW) target, while, the only statistically different *A*_{net} where found for inbound movements from the (W) and the (SW) target (red thick lines) that both veer to the right. With reference to Figure 6A, there is no statistical difference between the model and the experimental curvatures when pointing to and from the (N) and the (W), from (NW) and to (S) targets. The model is particularly accurate in capturing the average curvature of the (N) inbound, the (S) inbound and the (W) outbound and inbound. Overall, for this subject the model can only capture the curvature of 6 out of 16 movement direction (37%).

With reference to Figure 5B, subject 2 presents hysteresis for most of the targets, except for the (E), (SW) and (SE). This subject presents preferred curvature direction when pointing to and from the (W) target, with outbound and inbound both veering to the right. There is also a preference to veer to the right and to the left when performing outbound movements toward the (SW) and (S) targets, respectively. Figure 6B shows that, for all movements, the model predicts curvatures that are not statistically different from the experimental ones.

Similar analysis can be conducted for the remaining subjects. Here we limit ourselves to observe that for subject 3 there were no differences in terms of curvatures in 11 out of 16 movements (about 70% of movements). For subject 4 there were no differences between model and experimental curvatures in 10 out of 16 movements (62% of movements). For subject 5 there were no differences between model and experimental curvatures in 8 out of 16 movements (50% of movements) and for subject 6 in 9 out of 16 movements (56%).

In summary, task-space curvature and hysteresis appear to be subject- and movement-specific and the model can capture most of this features for the majority of movements and subjects.

The experimental and simulated joint space trajectories are shown in Figure 7 (only outbound and inbound movements from the (E) the (W) target are shown). All subjects show high variability when coordinating the PS rotation (red area), most likely because this is the joint that adds redundancy to the pointing task. The model can accurately reproduce the average FE (magenta color) and RUD (green) trajectories for most of the subjects and movements, while for PS rotations, there are larger errors between the average experimental trajectory and the model.

**Figure 7**. Joint space trajectories (PS in red, FE in magenta and RUD in green), predicted by the model (dashed lines) and measured experimentally: mean (continuous line) and standard deviations (color areas). The letters indicate the target sequence. For instance, the first movement is an outbound movement toward the target (E), the second movement is an inbound movement from target (E) to target (C) and so forth.

At the starting and ending times of each movement, i.e., when the wrist is stationary, the model predicted postures only depends on the estimated parameters *K*^{J} and * q**. So, the larger the error between the model and the experimental posture, the less accurate is the estimate of

*K*

^{J}and

**. Because we are setting*

**q***W*proportional to

*K*

^{J}, part of the errors between the model and the experimental trajectories may be due to the error between the real intrinsic subject stiffness and the one estimated from the data. In addition, the model does not take into account inertial and gravitational contributions. While the former has very little effect on wrist and forearm rotations (Peaden and Charles, 2014), gravity torques have been found to be non-negligible (Peaden and Charles, 2014).

Figure 8 compares the experimental task-space tangential velocity profile and those predicted by the model for a representative subject. The time-varying extrinsic spring (Equation 8) reproduces bell-shaped velocity profiles similar to the experimental ones, although, task-space velocities predicted by the model tend to be larger than the experimental ones.

**Figure 8**. Task space velocity profiles of a representative subject [mean (continuous line) and standard deviation] and those predicted by the **λ**_{0}-PMP (dashed line).

## 4. Conclusion

Motion planning and postural control in the presence of kinematic redundancy continue to be central topics in both neuroscience and robotics. For example, it is still debated why hand movements follows roughly straight-line paths in some experimental conditions while they are curved in others experimental settings. For decades, minimum principles (such as minimum-jerk, minimum variance, and so forth) and optimal control have been used as a tool to model and capture human-like trajectories. Although successful in capturing some features of human movements, when formulated in joint space, these approaches are not only computational demanding but also fail to capture postural control mechanisms such as Donders' law. While it is still unclear how the brain solves redundancy (Mussa-Ivaldi et al., 2011), in robotics kinematic redundancy has been tackled with the task-space control framework that combines local optimization and W-weighted generalized pseudo-inverses. However, as robots start to look more anthropomorphic and to interact with humans, they also need to display natural and intuitive movements and posture. Hence, roboticists are looking at bio-inspired approaches to plan and control task-space trajectories, null-space movements and equilibrium robot postures. We recently addressed the problem of postural control and trajectory planning by combining classical robotic motion planning (velocity resolution control) with neuroscientific evidence and theories of human motor control. We proposed a general and unifying force-field based posture and movement planner that was primarily tested in terms of human-like postural control (equilibrium postural strategies) (Tommasino and Campolo, 2017). In this work we extend our previous results by investigating the trajectory (both in task and joint space) predicted by a specific instance of our general computational framework: the **λ**_{0}-PMP. More specifically, we focused on human motor strategies during redundant pointing tasks performed with wrist (and forearm) rotations. In a previous work, Charles and Hogan (2010) showed that when pointing with the wrist, task-space paths are curved and in general, inbound and outbound movements follow different paths. In a successive work, they posited that such features of wrist rotations are due to an anisotropic joint stiffness matrix.

Here, we put forward the hypothesis that anisotropic intrinsic damping, rather than stiffness, is primarily responsible for curved task-space paths. The novel aspect of our approach is that our model was fitted to capture postural strategies and, with the sole hypothesis that intrinsic damping is proportional to stiffness (Equation 7), the model also exhibited curvatures and hysteresis in task-space performance remarkably similar to subject-specific average motions. More specifically, we found that (i) task-space paths are curved also in presence of kinematic redundancy, extending thus the work of Charles and Hogan (2010) where the PS axis was locked; (ii) curvature and hysteresis found in experimental trajectories, on a subject-specific and target-specific basis, are a possible consequence of postural constraints.

It should be noted that our computational framework is capable of generating human-like task-space trajectories from the only knowledge of the terminal target position. Hence, for robotic applications, task-space trajectories must not be pre-programmed as in the classical task-space control approach, but are a direct consequence of the intrinsic and extrinsic impedance parameters (damping and stiffness) used in the model. For the pointing task implemented in this work there is no preferred task-space direction as subjects only receive the final target position as desired target. Therefore, in the model, for the task-space planner we used an isotropic elastic attractor to push the simulated cursor on the desired target. This solution is not only simple but, when combined with suitable intrinsic impedance parameters also results in human-like wrist trajectories. However, as also discussed in Tommasino and Campolo (2017) any task-space force field can in principle be used as task-planner, and therefore, for more complex robotic applications future works will explore the possibility of integrating *dynamic movement primitives* in our framework for the generation of adaptive and compliant skills (Calinon et al., 2013). In summary, in addition to the desired target location, our extended passive motion paradigm requires only the knowledge of: (i) an intrinsic stiffness matrix *K*^{J} and an equilibrium posture **q**_{0} that, combined with the **λ**_{0} force field, allow the prediction of equilibrium (steady-state) wrist postures compatible with experimental (subject-specific) Donders' laws: (ii) the movement duration T, from which both the intrinsic and extrinsic time constants, of the joint-space damping and task-space stiffness respectively, can be set to reach the desired target in T seconds and with an equilibrium posture compatible with Donders' law.

There are of course many approximations and assumptions in our model which, as mentioned, is not meant to predict exact trajectories but rather capturing some basic features of human-like motion. A major limitation is that the intrinsic stiffness *K*^{J} is only a very simplified attempt to approximate the real, nonlinear, time-variant mechanical stiffness typically of human arm. This in turn affects not only the predicted postural strategies (i.e., wrist configuration at the beginning and ending of a movement) but also the predicted trajectories as the relationship between damping and stiffness is certainly more complex than the simple proportionality assumed in Equation (7). Furthermore, we only considered an isotropic task planner to investigate the effect of joint damping on path curvatures. However, future works need to compare how different and possibly anisotropic task planners (Tommasino and Campolo, 2017), when combined with anisotropic joint damping, predict subject-specific path's curvature.

A second limitation is that the **λ**_{0}-PMP totally neglects feedback, as it is meant to address *motion planning* rather than execution. Our model is however useful at a planning stage, while feedback should be incorporated for movement execution.

As a third limitation, our model is to be considered as a *first order postural and motor planner*, in the sense that it does not take into account the inertial properties of human or robotic arms. This is a specific choice (in some cases an inertia might not even be available, e.g., in motor imagery scenarios) and the model could be extended to include inertial properties. In fact, the role that the manipulator intrinsic inertia would have is the same that the intrinsic damping has in our model. Such an approach would lead to models along the lines proposed by Khatib et al. (2009). Our approach however, is similar to Dietrich et al. (2015) where the manipulator joint stiffness (see Equation 7), compared to manipulator inertia, has been shown to be a more reliable weighting matrix for the calculation of W-weighted pseudoinverse and null-space projector operator.

In conclusion this work presents an extended version of the PMP that can deal with kinematic redundancy in compliance with Donders' law and solve the posture/movement problem. Just like the PMP, our model can find extensive use in planning human-like motions for humanoid robots and, at the same time, be able to capture *natural postures* in compliance with Donders' Law.

## Author Contributions

PT and DC wrote and revised the manuscript, and conceived the work; PT performed simulations and data analysis.

## Funding

This work was partly supported by the A*STAR Industrial Robotics Program, 2013–2016, and by the NMRC project BnB/0006b/2013, Ministry of Health, Singapore.

## Conflict of Interest Statement

The authors declare that the research was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.

The reviewer DH and handling Editor declared their shared affiliation.

## Footnotes

1. ^Note that any positive-definite matrix can be used as weight and that in general *W* is configuration-dependent.

2. ^The task-space force field is usually generated by combining a desired task-space trajectory with a task-space impedance.

## References

Admiraal, M. A., Kusters, M., and Gielen, S. (2004). Modeling kinematics and dynamics of human arm movements. *Motor Control* 8, 312–338. doi: 10.1123/mcj.8.3.312

Albu-Schaffer, A., Eiberger, O., Grebenstein, M., Haddadin, S., Ott, C., Wimbock, T., et al. (2008). Soft robotics. *IEEE Robot. Automat. Mag.* 15, 20–30. doi: 10.1109/MRA.2008.927979

Arimoto, S., Sekimoto, M., and Ozawa, R. (2005). A challenge to bernstein's degrees-of-freedom problem in both cases of human and robotic multi-joint movements. *IEICE Trans. Fundam. Electron. Commun. Comput. Sci.* 88, 2484–2495. doi: 10.1093/ietfec/e88-a.10.2484

Atkeson, C. G., and Hollerbach, J. M. (1985). Kinematic features of unrestrained vertical arm movements. *J. Neurosci.* 5, 2318–2330.

Bernstein, N. A. (1967). *The Co-Ordination and Regulation of Movements*. Oxford, New York, NY: Pergamon Press.

Calinon, S., Kormushev, P., and Caldwell, D. G. (2013). Compliant skills acquisition and multi-optima policy search with em-based reinforcement learning. *Robot. Auton. Syst.* 61, 369–379. doi: 10.1016/j.robot.2012.09.012

Campolo, D., Accoto, D., Formica, D., and Guglielmelli, E. (2009). Intrinsic constraints of neural origin: assessment and application to rehabilitation robotics. *Robot. IEEE Trans.* 25, 492–501. doi: 10.1109/TRO.2009.2019781

Campolo, D., Formica, D., Guglielmelli, E., and Keller, F. (2010). Kinematic analysis of the human wrist during pointing tasks. *Exp. Brain Res.* 201, 561–573. doi: 10.1007/s00221-009-2073-1

Campolo, D., Widjaja, F., Esmaeili, M., and Burdet, E. (2011). Pointing with the wrist: a postural model for donders' law. *Exp. Brain Res.* 212, 417–427. doi: 10.1007/s00221-011-2747-3

Ceylan, M., Henriques, D., Tweed, D., and Crawford, J. (2000). Task-dependent constraints in motor control: pinhole goggles make the head move like an eye. *J. Neurosci.* 20, 2719–2730.

Charles, S. K., and Hogan, N. (2010). The curvature and variability of wrist and arm movements. *Exp. Brain Res.* 203, 63–73. doi: 10.1007/s00221-010-2210-x

Charles, S. K., and Hogan, N. (2012). Stiffness, not inertial coupling, determines path curvature of wrist motions. *J. Neurophysiol.* 107, 1230–1240. doi: 10.1152/jn.00428.2011

Crawford, J., Martinez-Trujillo, J., and Klier, E. (2003). Neural control of three-dimensional eye and head movements. *Curr. Opin. Neurobiol.* 13, 655–662. doi: 10.1016/j.conb.2003.10.009

Cruse, H., Wischmeyer, E., Brüwer, M., Brockfeld, P., and Dress, A. (1990). On the cost functions for the control of the human arm movement. *Biol. Cybern.* 62, 519–528. doi: 10.1007/BF00205114

De Sapio, V., Warren, J., and Khatib, O. (2006). “Predicting reaching postures using a kinematically constrained shoulder model,” in *Advances in Robot Kinematics*, eds J. Lenarčič and B. Roth (Springer), 209–218.

Degallier, S., and Ijspeert, A. (2010). Modeling discrete and rhythmic movements through motor primitives: a review. *Biol. Cybern.* 103, 319–338. doi: 10.1007/s00422-010-0403-9

Dietrich, A., Ott, C., and Albu-Schäffer, A. (2015). An overview of null space projections for redundant, torque-controlled robots. *Int. J. Robot. Res.* 34, 1385–1400. doi: 10.1177/0278364914566516

Dohrmann, C., Busby, H., and Trujillo, D. (1988). Smoothing noisy data using dynamic programming and generalized cross-validation. *J. Biomech. Eng.* 110, 37–41. doi: 10.1115/1.3108403

Doty, K. L., Melchiorri, C., and Bonivento, C. (1993). A theory of generalized inverses applied to robotics. *Int. J. Robot. Res.* 12, 1–19. doi: 10.1177/027836499301200101

Dounskaia, N. (2005). The internal model and the leading joint hypothesis: implications for control of multi-joint movements. *Exp. Brain Res.* 166, 1–16. doi: 10.1007/s00221-005-2339-1

English, J. D., and Maciejewski, A. A. (2000). On the implementation of velocity control for kinematically redundant manipulators. *IEEE Trans Syst. Man Cybern A Syst. Hum.* 30, 233–237. doi: 10.1109/3468.844350

Ewart, S., Hynes, S. M., Darling, W. G., and Capaday, C. (2016). A donders' like law for arm movements: the signal not the noise. *Front. Human Neurosci.* 10:136. doi: 10.3389/fnhum.2016.00136

Ficuciello, F., Villani, L., and Siciliano, B. (2015). Variable impedance control of redundant manipulators for intuitive human–robot physical interaction. *IEEE Trans. Robot.* 31, 850–863. doi: 10.1109/TRO.2015.2430053

Flash, T. (1987). The control of hand equilibrium trajectories in multi-joint arm movements. *Biol. Cybern.* 57, 257–274. doi: 10.1007/BF00338819

Formica, D., Charles, S. K., Zollo, L., Guglielmelli, E., Hogan, N., and Krebs, H. I. (2012). The passive stiffness of the wrist and forearm. *J. Neurophysiol.* 108, 1158–1166. doi: 10.1152/jn.01014.2011

Guigon, E., Baraduc, P., and Desmurget, M. (2007). Computational motor control: redundancy and invariance. *J. Neurophysiol.* 97, 331–347. doi: 10.1152/jn.00290.2006

Haddadin, S., Albu-Schäffer, A., and Hirzinger, G. (2010). “Safe physical human-robot interaction: measurements, analysis and new insights,” in *Robotics Research*, eds M. Kaneko and Y. Nakamura (Berlin: Springer), 395–407.

Harris, C. M., and Wolpert, D. M. (1998). Signal-dependent noise determines motor planning. *Nature* 394, 780–784. doi: 10.1038/29528

Haslwanter, T. (1995). Mathematics of three-dimensional eye rotations. *Vis. Res.* 35, 1727–1739. doi: 10.1016/0042-6989(94)00257-M

Hollerbach, J. M., and Flash, T. (1982). Dynamic interactions between limb segments during planar arm movement. *Biol. Cybern.* 44, 67–77. doi: 10.1007/BF00353957

Hore, J., Watts, S., and Vilis, T. (1992). Constraints on arm position when pointing in three dimensions: Donders' law and the fick gimbal strategy. *J. Neurophysiol.* 68, 374–383.

Khatib, O., Demircan, E., De Sapio, V., Sentis, L., Besier, T., and Delp, S. (2009). Robotics-based synthesis of human motion. *J. Physiol. Paris* 103, 211–219. doi: 10.1016/j.jphysparis.2009.08.004

Khatib, O., Warren, J., De Sapio, V., and Sentis, L. (2004). “Human-like motion from physiologically-based potential energies,” in *On Advances in Robot Kinematics*, eds J. Lenarcic and C. Galletti (Dordrecht: Springer), 145–154.

Kim, D., Jang, C., and Park, F. C. (2013). Kinematic feedback control laws for generating natural arm movements. *Bioinspir. Biomim.* 9:016002. doi: 10.1088/1748-3182/9/1/016002

Kim, H., Miller, L. M., Al-Refai, A., Brand, M., and Rosen, J. (2011). “Redundancy resolution of a human arm for controlling a seven dof wearable robotic system,” in *2011 Annual International Conference of the IEEE Engineering in Medicine and Biology Society*. (Boston, MA: IEEE), 3471–3474.

Klein, C. A., and Huang, C.-H. (1983). Review of pseudoinverse control for use with kinematically redundant manipulators. *IEEE Trans. Syst. Man Cybern.* SMC-13, 245–250. doi: 10.1109/TSMC.1983.6313123

Kurtzer, I., DiZio, P. A., and Lackner, J. R. (2005a). Adaptation to a novel multi-force environment. *Exp. Brain Res.* 164, 120–132. doi: 10.1007/s00221-005-2216-y

Kurtzer, I., Herter, T. M., and Scott, S. H. (2005b). Random change in cortical load representation suggests distinct control of posture and movement. *Nat. Neurosci.* 8, 498–504. doi: 10.1038/nn1420

Latash, M. L., Scholz, J. P., and Schoner, G. (2007). Toward a new theory of motor synergies. *Motor Control* 11:276. doi: 10.1123/mcj.11.3.276

Liebermann, D., Biess, A., Friedman, J., Gielen, C., and Flash, T. (2006). Intrinsic joint kinematic planning. i: reassessing the listing's law constraint in the control of three-dimensional arm movements. *Exp. Brain Res.* 171, 139–154. doi: 10.1007/s00221-005-0265-x

Medendorp, W., Crawford, J., Henriques, D., Van Gisbergen, J., and Gielen, C. (2000). Kinematic strategies for upper arm–forearm coordination in three dimensions. *J. Neurophysiol.* 84, 2302–2316.

Mistry, M., and Schaal, S. (2015). “Chapter 6: Representation and control of the task space in humans and humanoid robots,” in *Humanoid Robotics and Neuroscience: Science, Engineering and Society*, ed G. Cheng (Boca Raton, FL: CRC Press/Taylor & Francis).

Mohan, V., and Morasso, P. (2007). Towards reasoning and coordinating action in the mental space. *Int. J. Neural Syst.* 17, 329–341. doi: 10.1142/S0129065707001172

Mohan, V., and Morasso, P. (2011). Passive motion paradigm: an alternative to optimal control. *Front. Neurorobot.* 5:4. doi: 10.3389/fnbot.2011.00004

Mohan, V., Morasso, P., Zenzeri, J., Metta, G., Chakravarthy, V. S., and Sandini, G. (2011). Teaching a humanoid robot to draw “shapes.” *Auton. Robots* 31, 21–53. doi: 10.1007/s10514-011-9229-0

Morasso, P., Casadio, M., Mohan, V., Rea, F., and Zenzeri, J. (2015). Revisiting the body-schema concept in the context of whole-body postural-focal dynamics. *Front. Hum. Neurosci.* 9:93. doi: 10.3389/fnhum.2015.00083

Morasso, P., Casadio, M., Mohan, V., and Zenzeri, J. (2010). A neural mechanism of synergy formation for whole body reaching. *Biol. Cybern.* 102, 45–55. doi: 10.1007/s00422-009-0349-y

Murray, R. M., Li, Z., Sastry, S. S., and Sastry, S. S. (1994). *A Mathematical Introduction to Robotic Manipulation*. Boca Raton: CRC Press.

Mussa-Ivaldi, F. A., Casadio, M., Danziger, Z. C., Mosier, K. M., and Scheidt, R. A. (2011). Sensory motor remapping of space in human–machine interfaces. *Prog. Brain Res.* 191:45. doi: 10.1016/B978-0-444-53752-2.00014-X

Mussa-Ivaldi, F. A., and Hogan, N. (1991). Integrable solutions of kinematic redundancy via impedance control. *Int. J. Robot. Res.* 10, 481–491. doi: 10.1177/027836499101000504

Nakanishi, J., Cory, R., Mistry, M., Peters, J., and Schaal, S. (2008). Operational space control: a theoretical and empirical comparison. *Int. J. Robot. Res.* 27, 737–757. doi: 10.1177/0278364908091463

Nenchev, D. N. (1989). Redundancy resolution through local optimization: A review. *J. Robot. Syst.* 6, 769–798. doi: 10.1002/rob.4620060607

Nishikawa, K. C., Murray, S. T., and Flanders, M. (1999). Do arm postures vary with the speed of reaching? *J. Neurophysiol.* 81, 2582–2586.

Ostry, D. J., and Feldman, A. G. (2003). A critical evaluation of the force control hypothesis in motor control. *Exp. Brain Res.* 153, 275–288. doi: 10.1007/s00221-003-1624-0

Peaden, A. W., and Charles, S. K. (2014). Dynamics of wrist and forearm rotations. *J. Biomech.* 47, 2779–2785. doi: 10.1016/j.jbiomech.2014.01.053

Perreault, E. J., Kirsch, R. F., and Crago, P. E. (2004). Multijoint dynamics and postural stability of the human arm. *Exp. Brain Res.* 157, 507–517. doi: 10.1007/s00221-004-1864-7

Peters, J., and Schaal, S. (2007). “Reinforcement learning by reward-weighted regression for operational space control,” in *Proceedings of the 24th International Conference on Machine Learning* (Corvallis, OR: ACM), 745–750.

Schaal, S., and Schweighofer, N. (2005). Computational motor control in humans and robots. *Curr. Opin. Neurobiol.* 15, 675–682. doi: 10.1016/j.conb.2005.10.009

Scholz, J. P., and Schöner, G. (1999). The uncontrolled manifold concept: identifying control variables for a functional task. *Exp. Brain Res.* 126, 289–306. doi: 10.1007/s002210050738

Scott, S. H. (2004). Optimal feedback control and the neural basis of volitional motor control. *Nat. Rev. Neurosci.* 5, 532–546. doi: 10.1038/nrn1427

Smith, F., and Rooks, B. (2006). The harmonious robot. *Indust. Robot* 33, 125–130. doi: 10.1108/01439910610651446

Soechting, J. F., Buneo, C. A., Herrmann, U., and Flanders, M. (1995). Moving effortlessly in three dimensions: does donders' law apply to arm movement? *J. Neurosci.* 15, 6271–6280.

Taïx, M., Tran, M. T., Souères, P., and Guigon, E. (2013). Generating human-like reaching movements with a humanoid robot: a computational approach. *J. Comput. Sci.* 4, 269–284. doi: 10.1016/j.jocs.2012.08.001

Tee, K. P., Burdet, E., Chew, C.-M., and Milner, T. E. (2004). A model of force and impedance in human arm movements. *Biol. Cybern.* 90, 368–375. doi: 10.1007/s00422-004-0484-4

Todorov, E., and Jordan, M. I. (2002). Optimal feedback control as a theory of motor coordination. *Nat. Neurosci.* 5, 1226–1235. doi: 10.1038/nn963

Tommasino, P., and Campolo, D. (2016). “Human-like pointing strategies via non-linear inverse optimization,” in *2016 6th IEEE International Conference on Biomedical Robotics and Biomechatronics (BioRob)* (Singapore: IEEE), 930–935.

Tommasino, P., and Campolo, D. (2017). Task-space separation principle: a force-field approach to motion planning for redundant manipulators. *Bioinspir. Biomim.* 12:026003. doi: 10.1088/1748-3190/aa5558

Tsuji, T., Morasso, P. G., Goto, K., and Ito, K. (1995). Human hand impedance characteristics during maintained posture. *Biol. Cybern.* 72, 475–485. doi: 10.1007/BF00199890

Uno, Y., Kawato, M., and Suzuki, R. (1989). Formation and control of optimal trajectory in human multijoint arm movement. *Biol. Cybern.* 61, 89–101. doi: 10.1007/BF00204593

Vanderborght, B., Albu-Schäffer, A., Bicchi, A., Burdet, E., Caldwell, D. G., Carloni, R., et al. (2013). Variable impedance actuators: a review. *Robot. Auton. Syst.* 61, 1601–1614. doi: 10.1016/j.robot.2013.06.009

Vetter, P., Flash, T., and Wolpert, D. M. (2002). Planning movements in a simple redundant task. *Curr. Biol.* 12, 488–491. doi: 10.1016/S0960-9822(02)00715-7

Wong, A. M. (2004). Listing's law: clinical significance and implications for neural control. *Surv. Ophthalmol.* 49, 563–575. doi: 10.1016/S0039-6257(04)00134-1

Keywords: kinematic redundancy, postural synergies, Donders' law, posture, movement, pointing

Citation: Tommasino P and Campolo D (2017) An Extended Passive Motion Paradigm for Human-Like Posture and Movement Planning in Redundant Manipulators. *Front. Neurorobot*. 11:65. doi: 10.3389/fnbot.2017.00065

Received: 30 June 2017; Accepted: 17 November 2017;

Published: 30 November 2017.

Edited by:

Yangming Li, University of Washington, United StatesReviewed by:

Vittorio B. Lippi, Universitätsklinikum Freiburg, GermanyDanying Hu, University of Washington, United States

Copyright © 2017 Tommasino and Campolo. This is an open-access article distributed under the terms of the Creative Commons Attribution License (CC BY). The use, distribution or reproduction in other forums is permitted, provided the original author(s) or licensor are credited and that the original publication in this journal is cited, in accordance with accepted academic practice. No use, distribution or reproduction is permitted which does not comply with these terms.

*Correspondence: Paolo Tommasino, p.tommasino@hsantalucia.it

Domenico Campolo, d.campolo@ntu.edu.sg