arXiv is now an independent nonprofit! Learn more
License: arXiv.org perpetual non-exclusive license
arXiv:2608.19754v1 [math.OC] 20 Aug 2026
A Controllability Gramain Shaping with LMI Constraints
under Bures–Wasserstein Distance
Koju Nishimotot Thanks: ⁢ This work has been submitted to the IEEE for possible publication. Copyright may be transferred without notice, after which this version may no longer be accessible. Thanks:  Koju Nishimoto is with the Institute of Technology, Shimizu Corporation, Tokyo 135-0044, Japan koju.nishimoto@shimz.co.jp    Yuki Onishi Thanks:  Yuki Onishi is with the National Institute of Informatics, Chiba 277-0882, Japan onishi@nii.ac.jp    Riku Funada Thanks:  Riku Funada is with the Graduate School of Informatics, Kyoto University, Kyoto 606-8501, Japan funada@i.kyoto-u.ac.jp    Mitsuji Sampei Thanks:  Mitsuji Sampei is with the Polytechnic University of Japan, Tokyo 187-0035, Japan mitsuji@sampei.jp
Abstract

This paper proposes a controller design method for shaping the controllability Gramian into a desired form to design the effect from exogenous inputs to the system state. Using the Bures–Wasserstein distance, we formulate the shaping problem as the minimization of the distance between the system Gramian and a desired Gramian, and the objective function is shown to be strictly convex on the set of symmetric positive definite matrices. In addition, by deriving a semidefinite programming formulation via a linear matrix inequality (LMI), computational efficiency is improved and additional LMI constraints can be incorporated. When the exogenous input is modeled as Gaussian white noise, the proposed framework is closely related to H2H_{2} control, which can be interpreted as a special case of optimal transport. Numerical examples demonstrate anisotropic controllability design for a guidance robot and verify the ability to impose additional directional constraints through LMIs. The numerical examples also confirm that the proposed method approaches H2H_{2} control as the desired Gramian tends to zero.

I Introduction

Designing systems that are easy to control is important for smooth operation. However, the “ease of control” depends on the objective and application, and is not easy to evaluate in a general framework. Since many control problems have been formulated mathematically in control theory, defining “ease of control” within this framework is expected to provide a general measure for analysis and design. In classical control, input-output properties and disturbance responses are evaluated through the frequency responses of transfer and sensitivity functions [1]. For nonlinear systems, application-dependent measures are also used, such as manipulability ellipsoids in robotics [2] and design indices for drones considering fault tolerance and hovering performance [3].

In systems driven by exogenous inputs, it is important to design not only stability and tracking performance but also the response to such inputs. In particular, it is important to specify the directions in the state space along which the system is easy or difficult to move. This is particularly important in human-interactive systems, where operability and stability must be balanced. Impedance control [4] and admittance control [5] shape the relation between external forces and motion, but mainly prescribe input-output relations or local responses, rather than directional reachability over the entire state space.

The controllability Gramian [6, 7, 8, 9] is suitable for this purpose because it characterizes reachability in terms of input energy. By shaping the controllability Gramian, one can quantitatively design the apparent controllability from exogenous inputs and quantify both ease and difficulty of motion in each state direction. This idea is expected to be applicable to systems such as guidance robots for visually impaired users [10, 11] and manipulators with direct teaching [12, 13]. The authors have previously proposed Gramian shaping for such systems from the user’s perspective [14]. In the Gramian shaping, a desired Gramian is specified, and the controllability Gramian from the exogenous input is shaped by an internal feedback input so as to approach the desired one. Through the anisotropy of the Gramian, this approach enables quantitative design of ease and difficulty of control in each state direction.

To make such reachability design viable, the distance between the system Gramian and the desired Gramian should yield a tractable optimization problem to admit a clear interpretation. In the previous Gramian shaping method [14], this discrepancy was measured by the affine-invariant Riemannian (AIR) distance [15]. However, AIR-based Gramian shaping leads to a nonconvex optimization problem, so global optimality is not guaranteed and efficient algorithms are not readily available. As a result, robustness and computational efficiency are difficult to ensure. Moreover, the AIR distance has no clear physical interpretation, making it difficult to relate Gramian shaping to existing control frameworks.

To overcome these limitations, this paper proposes a new Gramian shaping method based on the Bures–Wasserstein distance (BW distance). The BW distance is defined on symmetric positive-semidefinite matrices [16] and coincides with the 22-Wasserstein distance between Gaussian distributions with the same mean [17]. Thanks to this property, it has been used in graph generation [18], statistical theory based on BW barycenters [19, 20, 21], and geodesic analysis [22].

The main contributions of this paper are summarized as follows.

  1. 1.

    We introduce the BW distance into controllability Gramian shaping from exogenous inputs to make the optimization problem convex on the set of symmetric positive definite matrices. Thus, BW-based Gramian shaping can be formulated as a convex optimization problem.

  2. 2.

    Using the linear matrix inequality (LMI) representation of the BW distance, we derive a semidefinite programming (SDP) formulation of Gramian shaping, which allows various additional LMI constraints.

  3. 3.

    We clarify the relation between the proposed method and H2H_{2} control, and show that H2H_{2} control can be interpreted as a special case of BW-based Gramian shaping.

This paper is organized as follows. Section II reviews the controllability Gramian, introduces the Gramian for exogenous inputs, and summarizes the relation between realizable Gramians and feedback gains. Section III defines the proposed method, namely, BW-based Gramian shaping and shows that it can be formulated as a convex problem. Section IV presents an SDP-based solution using an LMI representation of the BW distance. Section V discusses the relation between the proposed method and H2H_{2} control, showing that the proposed framework provides a link between classical optimal control and optimal transport. Section VI verifies the effectiveness of the proposed method through numerical examples.

Notation: Vectors are denoted by lowercase bold letters such as 𝒂\bm{a}, and matrices by uppercase bold letters such as 𝑨\bm{A}. 𝑰n\bm{I}_{n} and 𝑶n\bm{O}_{n} denote the n×nn\times n identity matrix and zero matrix, respectively. 𝑶n×m\bm{O}_{n\times m} denotes the n×mn\times m zero matrix, and 𝟎n\bm{0}_{n} denotes the nn-dimensional zero vector. 𝑨\bm{A}^{\top} and 𝑨H\bm{A}^{H} denote the transpose and Hermitian transpose of 𝑨\bm{A}, respectively. 𝑨\bm{A}^{\dagger} denotes the Moore–Penrose pseudoinverse of 𝑨\bm{A}. n\mathbb{R}^{n} and n×m\mathbb{R}^{n\times m} denote the set of nn-dimensional real vectors and the set of n×mn\times m real matrices, respectively. +\mathbb{R}_{+} denotes the set of nonnegative real numbers. 𝕊+n\mathbb{S}_{+}^{n} denotes the set of n×nn\times n symmetric positive-semidefinite matrices, and 𝕊++n\mathbb{S}_{++}^{n} denotes the set of n×nn\times n symmetric positive definite matrices. 𝒪(n)\mathcal{O}(n) and 𝒮𝒪(n)\mathcal{SO}(n) denote the orthogonal group and the special orthogonal group in dimension nn, respectively. A diagonal matrix with diagonal entries a1,a2,,ana_{1},a_{2},\ldots,a_{n} is denoted by diag(a1,a2,,an)\mathrm{diag}\left(a_{1},a_{2},\ldots,a_{n}\right). A block diagonal matrix formed by the matrices 𝑨1,𝑨2,,𝑨n\bm{A}_{1},\bm{A}_{2},\ldots,\bm{A}_{n} is denoted by blkdiag(𝑨1,𝑨2,,𝑨n)\mathrm{blkdiag}\left(\bm{A}_{1},\bm{A}_{2},\ldots,\bm{A}_{n}\right). For 𝑨𝕊++n\bm{A}\in\mathbb{S}_{++}^{n}, there exists a spectral decomposition 𝑨=𝑼𝚲𝑼\bm{A}=\bm{U}\bm{\Lambda}\bm{U}^{\top}, where 𝚲=diag(λ1,λ2,,λn)\bm{\Lambda}=\mathrm{diag}(\lambda_{1},\lambda_{2},\ldots,\lambda_{n}), λi>0\lambda_{i}>0 for all i{1,2,,n}i\in\{1,2,\ldots,n\}, and 𝑼𝒪(n)\bm{U}\in\mathcal{O}(n). For a real number α\alpha, the matrix power of a symmetric positive definite matrix is defined by 𝑨α=𝑼𝚲α𝑼\bm{A}^{\alpha}=\bm{U}\bm{\Lambda}^{\alpha}\bm{U}^{\top}, where 𝚲α=diag(λ1α,λ2α,,λnα)\bm{\Lambda}^{\alpha}=\mathrm{diag}(\lambda_{1}^{\alpha},\lambda_{2}^{\alpha},\ldots,\lambda_{n}^{\alpha}).

II Preliminaries

In this section, we first review the standard controllability Gramian for stable systems. We then introduce the controllability Gramian considered in this paper for systems driven by exogenous inputs.

Consider the following linear system with state 𝒙n\bm{x}\in\mathbb{R}^{n} and input 𝒖m\bm{u}\in\mathbb{R}^{m}:

𝒙˙\displaystyle\dot{\bm{x}} =𝑨𝒙+𝑩𝒖,\displaystyle=\bm{A}\bm{x}+\bm{B}\bm{u}, (1)

where 𝑨n×n\bm{A}\in\mathbb{R}^{n\times n} and 𝑩n×m\bm{B}\in\mathbb{R}^{n\times m}.

II-A Definition of the controllability Gramian

The controllability Gramian has been used as a measure describing the influence of inputs on the system state and as a tool for analyzing properties of systems. For linear systems, the standard controllability Gramian is defined as follows.

Definition 1 (Ch. 6[23])

The controllability Gramian of system (1) is defined, when 𝐀\bm{A} is Hurwitz stable, by

𝑷0=\displaystyle\bm{P}_{0}= 0e𝑨τ𝑩𝑩e𝑨τ𝑑τ\displaystyle\int_{-\infty}^{0}~e^{-\bm{A}\tau}\bm{B}\bm{B}^{\top}e^{-\bm{A}^{\top}\tau}~d\tau
=\displaystyle= 0e𝑨τ𝑩𝑩e𝑨τ𝑑τ.\displaystyle\int_{0}^{\infty}~e^{\bm{A}\tau}\bm{B}\bm{B}^{\top}e^{\bm{A}^{\top}\tau}~d\tau. (2)
Corollary 1 (Th. 6.1[23])

If the system is (𝐀,𝐁)(\bm{A},\bm{B})-controllable and 𝐀\bm{A} is Hurwitz stable, then the controllability Gramian is the unique symmetric positive definite solution of the following Lyapunov equation:

𝑶n=𝑨𝑷0+𝑷0𝑨+𝑩𝑩.\displaystyle\bm{O}_{n}=\bm{A}\bm{P}_{0}+\bm{P}_{0}\bm{A}^{\top}+\bm{B}\bm{B}^{\top}. (3)

If the system is unstable, that is, if 𝑨\bm{A} has an eigenvalue with a nonnegative real part, the controllability Gramian diverges and is therefore not defined in general.

The controllability Gramian 𝑷0\bm{P}_{0} corresponds to the minimum input energy: the minimum energy required to reach a state 𝒙0\bm{x}_{0} from the origin is given by 𝒙0𝑷01𝒙0\bm{x}_{0}^{\top}\bm{P}_{0}^{-1}\bm{x}_{0}. Therefore, the set {𝒙𝒙𝑷01𝒙1}\{\bm{x}\mid\bm{x}^{\top}\bm{P}_{0}^{-1}\bm{x}\leq 1\} represents the reachable region within unit input energy, and the anisotropy of 𝑷0\bm{P}_{0} characterizes the relative controllability degree in each state direction.

II-B Controllability Gramian from exogenous inputs

In this subsection, we define the controllability Gramian for systems subject to exogenous inputs. Here, 𝒖\bm{u} is regarded as an internal control input, and we introduce an exogenous input 𝒗r\bm{v}\in\mathbb{R}^{r} so that the system is described by

𝒙˙\displaystyle\dot{\bm{x}} =𝑨𝒙+𝑩𝒖+𝑫𝒗,\displaystyle=\bm{A}\bm{x}+\bm{B}\bm{u}+\bm{D}\bm{v}, (4)

where 𝑫n×r\bm{D}\in\mathbb{R}^{n\times r}. Both (𝑨,𝑩)(\bm{A},\bm{B}) and (𝑨,𝑫)(\bm{A},\bm{D}) are assumed controllable. The input 𝒗\bm{v} is exogenous. Hence, the energy sources of 𝒖\bm{u} and 𝒗\bm{v} are different, and we primarily consider systems controlled externally by a user such as a human. To stabilize this system, we apply the feedback control law 𝒖=𝑲𝒙\bm{u}=\bm{K}\bm{x}, which yields

𝒙˙=(𝑨+𝑩𝑲)𝒙+𝑫𝒗.\displaystyle\dot{\bm{x}}=(\bm{A}+\bm{B}\bm{K})\bm{x}+\bm{D}\bm{v}. (5)

Since the system is stabilized, the controllability Gramian from the new input 𝒗\bm{v} to the state 𝒙\bm{x} in (5) can be redefined as follows.

Definition 2 (Sec. 2 [14])

The controllability Gramian of system (5) is defined, as a function of the gain 𝐊\bm{K}, by

𝑷=0e(𝑨+𝑩𝑲)τ𝑫𝑫e(𝑨+𝑩𝑲)τ𝑑τ.\displaystyle\bm{P}=\int_{0}^{\infty}~e^{(\bm{A}+\bm{B}\bm{K})\tau}{\bm{D}\bm{D}^{\top}}e^{(\bm{A}+\bm{B}\bm{K})^{\top}\tau}~d\tau. (6)
Corollary 2

From the relationship between the controllability Gramian and the Lyapunov equation, the following equation holds:

(𝑨+𝑩𝑲)𝑷+𝑷(𝑨+𝑩𝑲)+𝑫𝑫=𝑶n.\displaystyle(\bm{A}+\bm{B}\bm{K})\bm{P}+\bm{P}(\bm{A}+\bm{B}\bm{K})^{\top}+{\bm{D}\bm{D}^{\top}}=\bm{O}_{n}. (7)

By redefining the controllability Gramian in the form (6), the controllability Gramian of the system now depends on the feedback gain 𝑲\bm{K}. Hence, controllability can be modified by adjusting 𝑲\bm{K}. The realizable controllability Gramians are restricted by the system structure, namely 𝑨\bm{A}, 𝑩\bm{B}, and 𝑫\bm{D}. This relation is characterized by the Lyapunov equation (7). Although (7) determines 𝑷\bm{P} and 𝑲\bm{K} simultaneously, it can be decomposed into conditions on 𝑷\bm{P} and formulas for 𝑲\bm{K} separately by Lemma 1 and Lemma 2 in Appendix. Lemma 1 gives an equality condition characterizing the realizable Gramians of system (4). Lemma 2 then provides a feedback gain that achieves the realizable Gramian. Thus, Gramian shaping can be addressed in two separate steps: Gramian design and gain derivation.

The objective of this paper is to use the controllability Gramian in controller design so as to realize desired controllability properties. More specifically, we shape the controllability Gramian (6) by adjusting the feedback gain so that it becomes as close as possible to a desired symmetric positive definite matrix. The next section presents an optimization method for shaping 𝑷\bm{P} into a desired form.

III Gramian Shaping with Bures–Wasserstein Distance

This section explains the main idea of this paper, namely, Gramian shaping based on the BW distance. Gramian shaping is a method for deforming the controllability Gramian into a desired form by exploiting the geometry of symmetric positive definite matrices [14]. This enables the design of both ease and difficulty of control for each state when the system is operated externally.

In Gramian shaping, the input is designed so that the system approaches an ideal Gramian 𝑷d\bm{P}_{d} representing the desired controllability. The ideal Gramian may be defined from a reachable set based on input energy, or designed with reference to an ideal system. Gramian shaping is achieved by minimizing the discrepancy between the controllability Gramian (6) and the ideal Gramian 𝑷d\bm{P}_{d}. In the previous study, this discrepancy between two Gramians was measured by the affine-invariant Riemannian (AIR) distance in accordance with the geometry of symmetric positive definite matrices [14]. This made it possible to perform optimization while preserving positive definiteness. However, optimization based on the AIR distance does not admit a guaranteed global optimum, and its physical interpretation is difficult. To overcome these difficulties, this paper employs the BW distance, which is a different distance function.

Definition 3 (Bures–Wasserstein distance, [17])

Given 𝐗,𝐘𝕊+n\bm{X},\bm{Y}\in\mathbb{S}_{+}^{n} define dBW(𝐗,𝐘):𝕊+n×𝕊+n+d_{\mathrm{BW}}(\bm{X},\bm{Y}):\mathbb{S}_{+}^{n}\times\mathbb{S}_{+}^{n}\to\mathbb{R}_{+} as Bures-Wasserstein distance by the relation

dBW(𝑿,𝒀)=(tr(𝑿+𝒀2(𝒀12𝑿𝒀12)12))12.\displaystyle d_{\mathrm{BW}}(\bm{X},\bm{Y})\!=\!\left(\mathrm{tr}\!\left(\bm{X}+\bm{Y}-2\left(\bm{Y}^{\frac{1}{2}}\bm{X}\bm{Y}^{\frac{1}{2}}\right)^{\frac{1}{2}}\right)\right)^{\frac{1}{2}}\!. (8)

The BW distance satisfies the axioms of a metric on 𝕊+n\mathbb{S}_{+}^{n} and 𝕊++n\mathbb{S}_{++}^{n}. It is known to coincide with the 22-Wasserstein distance between Gaussian distributions having the same mean.

The BW distance enables us to measure the difference between two Gramians. Our final goal is to design a feedback gain for Gramian shaping. Using Lemmas 1 and 2, however, this problem can be separated into realizable Gramian design and gain derivation. The first step is formulated as follows.

Problem 1 (BW-based Gramian Shaping)

For the system (4), let 𝐏d𝕊++n\bm{P}_{d}\in\mathbb{S}_{++}^{n} be a desired Gramian. Under the BW distance (8), find an optimal realizable Gramian 𝐏\bm{P}^{\ast} by solving

𝑷=argmin𝑷\displaystyle\bm{P}^{\ast}=\underset{\bm{P}}{\arg\min} dBW2(𝑷,𝑷d),\displaystyle~d_{\mathrm{BW}}^{2}(\bm{P},\bm{P}_{d}), (9a)
s.t.\displaystyle\mathrm{s.t.} 𝑷𝕊++n,\displaystyle~\bm{P}\in\mathbb{S}_{++}^{n}, (9b)
(𝑰n𝑩𝑩)(𝑨𝑷+𝑷𝑨𝑫𝑫)(𝑰n𝑩𝑩)=𝑶n.\displaystyle~\left(\bm{I}_{n}-\bm{BB}^{\dagger}\right)\left(\bm{A}\bm{P}+\bm{P}\bm{A}^{\top}\bm{DD}^{\top}\right)\left(\bm{I}_{n}-\bm{BB}^{\dagger}\right)=\bm{O}_{n}. (9c)

Constraint (9b) imposes positive definiteness of the Gramian, and constraint (9c) characterizes the set of Gramians realizable by the system (see Lemma 1 in Appendix). Thus, the controllability Gramian closest to the desired Gramian can be obtained. The second step is to obtain a corresponding feedback gain 𝑲\bm{K}^{\ast} from 𝑷\bm{P}^{\ast} using Lemma 2.

We now prove that Problem 1 is a strictly convex optimization problem. We prove that the objective function of Problem 1 is strictly convex.

Theorem 1

For a fixed 𝐏d𝕊++n\bm{P}_{d}\in\mathbb{S}_{++}^{n}, dBW2(𝐗,𝐏d):𝕊++n+d_{\mathrm{BW}}^{2}(\bm{X},\bm{P}_{d}):\mathbb{S}_{++}^{n}\to\mathbb{R}_{+} is a strictly convex function on 𝕊++n\mathbb{S}_{++}^{n}.

Proof:

Let f(𝑿)=dBW2(𝑿,𝑷d)f(\bm{X})=d_{\mathrm{BW}}^{2}(\bm{X},\bm{P}_{d}). We verify that f(𝑿)f(\bm{X}) satisfies the definition of a strictly convex function:

tf(𝑿)+(1t)f(𝒀)>f(t𝑿+(1t)𝒀),\displaystyle tf(\bm{X})+(1-t)f(\bm{Y})>f(t\bm{X}+(1-t)\bm{Y}),
t(0,1).\displaystyle~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~\forall t\in(0,1). (10)

From Definition 3, we have

tf(𝑿)+(1t)f(𝒀)\displaystyle tf(\bm{X})+(1-t)f(\bm{Y})
=\displaystyle= tr(t𝑿+(1t)𝒀+𝑷d2t(𝑷d12𝑿𝑷d12)122(1t)(𝑷d12𝒀𝑷d12)12),\displaystyle\mathrm{tr}\left(t\bm{X}+(1-t)\bm{Y}+\bm{P}_{d}-2t\left(\bm{P}_{d}^{\frac{1}{2}}\bm{X}\bm{P}_{d}^{\frac{1}{2}}\right)^{\frac{1}{2}}-2(1-t)\left(\bm{P}_{d}^{\frac{1}{2}}\bm{Y}\bm{P}_{d}^{\frac{1}{2}}\right)^{\frac{1}{2}}\right)\!, (11)
f(t𝑿+(1t)𝒀)\displaystyle f(t\bm{X}+(1-t)\bm{Y})
=\displaystyle= tr(t𝑿+(1t)𝒀+𝑷d2(t𝑷d12𝑿𝑷d12+(1t)𝑷d12𝒀𝑷d12)12).\displaystyle\mathrm{tr}\left(t\bm{X}+(1-t)\bm{Y}+\bm{P}_{d}2\left(t\bm{P}_{d}^{\frac{1}{2}}\bm{X}\bm{P}_{d}^{\frac{1}{2}}+(1-t)\bm{P}_{d}^{\frac{1}{2}}\bm{Y}\bm{P}_{d}^{\frac{1}{2}}\right)^{\frac{1}{2}}\right). (12)

Subtracting the latter from the former yields

tf(𝑿)+\displaystyle tf(\bm{X})+ (1t)f(𝒀)f(t𝑿+(1t)𝒀)\displaystyle(1-t)f(\bm{Y})-f(t\bm{X}+(1-t)\bm{Y})
=\displaystyle= 2tr((t𝑷d12𝑿𝑷d12+(1t)𝑷d12𝒀𝑷d12)12)\displaystyle 2\mathrm{tr}\!\!\left(\left(t\bm{P}_{d}^{\frac{1}{2}}\bm{X}\bm{P}_{d}^{\frac{1}{2}}+(1-t)\bm{P}_{d}^{\frac{1}{2}}\bm{Y}\bm{P}_{d}^{\frac{1}{2}}\right)^{\frac{1}{2}}\right)
\displaystyle- 2tr(t(𝑷d12𝑿𝑷d12)12+(1t)(𝑷d12𝒀𝑷d12)12).\displaystyle 2\mathrm{tr}\!\!\left(t\!\left(\bm{P}_{d}^{\frac{1}{2}}\bm{X}\bm{P}_{d}^{\frac{1}{2}}\right)^{\frac{1}{2}}\!\!\!+\!(1-t)\!\left(\bm{P}_{d}^{\frac{1}{2}}\bm{Y}\bm{P}_{d}^{\frac{1}{2}}\right)^{\frac{1}{2}}\!\right)\!. (13)

Let 𝑿=𝑷d12𝑿𝑷d12\bm{X}^{\prime}=\bm{P}_{d}^{\frac{1}{2}}\bm{X}\bm{P}_{d}^{\frac{1}{2}} and 𝒀=𝑷d12𝒀𝑷d12\bm{Y}^{\prime}=\bm{P}_{d}^{\frac{1}{2}}\bm{Y}\bm{P}_{d}^{\frac{1}{2}}, then this equation can be rewritten as

tf(𝑿)+\displaystyle tf(\bm{X})+ (1t)f(𝒀)f(t𝑿+(1t)𝒀)\displaystyle(1-t)f(\bm{Y})-f(t\bm{X}+(1-t)\bm{Y})
=\displaystyle= 2tr((t𝑿+(1t)𝒀)12)\displaystyle 2\mathrm{tr}\left(\left(t\bm{X}^{\prime}+(1-t)\bm{Y}^{\prime}\right)^{\frac{1}{2}}\right)
2(ttr(𝑿12)+(1t)tr(𝒀12)).\displaystyle-2\left(t\mathrm{tr}\left(\bm{X}^{\prime\frac{1}{2}}\right)+(1-t)\mathrm{tr}\left(\bm{Y}^{\prime\frac{1}{2}}\right)\right). (14)

We now examine the sign of the left-hand side. From Lemma 3 in Appendix, this function tr(𝑿12)\mathrm{tr}(\bm{X}^{\frac{1}{2}}) is strictly concave on 𝕊++n\mathbb{S}_{++}^{n}. That is,

tr((t𝑿+(1t)𝒀)12)\displaystyle\mathrm{tr}\left(\left(t\bm{X}^{\prime}+(1-t)\bm{Y}^{\prime}\right)^{\frac{1}{2}}\right)
(ttr(𝑿12)+(1t)tr(𝒀12))>0,\displaystyle-\left(t\mathrm{tr}\left(\bm{X}^{\prime\frac{1}{2}}\right)+(1-t)\mathrm{tr}\left(\bm{Y}^{\prime\frac{1}{2}}\right)\right)>0,
t(0,1).\displaystyle~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~\forall t\in(0,1). (15)

Since the right-hand side of (III) is strictly positive, it follows that

tf(𝑿)+(1t)f(𝒀)f(t𝑿+(1t)𝒀)>0,\displaystyle tf(\bm{X})+(1-t)f(\bm{Y})-f(t\bm{X}+(1-t)\bm{Y})>0,
t(0,1).\displaystyle~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~\forall t\in(0,1). (16)

We therefore conclude that f(𝑿)f(\bm{X}) is strictly convex on 𝕊++n\mathbb{S}_{++}^{n}. ∎Using Theorem 1, we can show that Problem 1 is a strictly convex optimization problem.

Theorem 2

Problem (9) is a convex optimization problem with a strictly convex objective function. Hence, if an optimal solution exists, it is unique.

Proof:

The feasible set is convex because 𝕊++n\mathbb{S}_{++}^{n} is convex and the constraint (9c) is affine in 𝑷\bm{P}. By Theorem 1, the objective function dBW2(𝑷,𝑷d)d_{\mathrm{BW}}^{2}(\bm{P},\bm{P}_{d}) is strictly convex on 𝕊++n\mathbb{S}_{++}^{n}. Therefore, Problem 1 is a convex optimization problem with a strictly convex objective function. Hence, if an optimal solution exists, it is unique. ∎

In the AIR-based approach [14], the optimization problem is nonconvex. This may cause dependence on the initial value, convergence to a local minimum, and make the calculation inefficient. By contrast, when the BW distance is used, the problem becomes convex, and any converged solution of the solver is guaranteed to be globally optimal. This provides Gramian shaping with the robustness of the optimization problem for which the mathematically best solution is guaranteed.

IV Solving Gramian Shaping
as Semidefinite Programming

This section explains how to solve the Gramian shaping problem numerically. As a naive approach, one can first solve Problem 1 directly and then determine the gain via Lemma 2. On the other hand, by exploiting the properties of the BW distance, we can obtain a more efficient optimization formulation.

We first reconsider Problem 1 in a form that explicitly includes gain determination.

Corollary 3

The solution 𝐏𝕊++n\bm{P}^{\ast}\in\mathbb{S}_{++}^{n} to the optimization problem (9) and the corresponding gain 𝐊\bm{K} can be obtained by solving the optimization problem:

min𝑷,𝑲\displaystyle\min_{\bm{P},\bm{K}} dBW2(𝑷,𝑷d),\displaystyle~d_{\mathrm{BW}}^{2}(\bm{P},\bm{P}_{d}), (17a)
s.t.\displaystyle\mathrm{s.t.} 𝑷𝕊++n,\displaystyle~\bm{P}\in\mathbb{S}_{++}^{n}, (17b)
(𝑨+𝑩𝑲)𝑷+𝑷(𝑨+𝑩𝑲)+𝑫𝑫=𝑶n.\displaystyle~(\bm{A}\!+\!\bm{B}\bm{K})\bm{P}\!+\!\bm{P}(\bm{A}\!+\!\bm{B}\bm{K})^{\top}\!+\!\bm{D}\bm{D}^{\top}\!=\!\bm{O}_{n}. (17c)
Proof:

This follows immediately from Lemmas 1 and Lemma 2 in Appendix. ∎

Using this LMI representation of the BW distance, we derive an SDP formulation of the Gramian shaping problem.

Problem 2 (BW-based Gramian Shaping with LMIs)

For the system (4), let 𝐏d𝕊++n\bm{P}_{d}\in\mathbb{S}_{++}^{n} be a desired Gramian. Using an LMI representation of the BW distance (8), find an optimal realizable Gramian 𝐏\bm{P}^{\ast} by solving

(𝑷,𝑬,𝑼)=argmin𝑷,𝑬,𝑼\displaystyle(\bm{P}^{\ast},\bm{E}^{\ast},\bm{U}^{\ast})=\underset{\bm{P},\bm{E},\bm{U}}{\arg\min} tr(𝑷+𝑷d2𝑼),\displaystyle~\mathrm{tr}\left(\bm{P}+\bm{P}_{d}-2\bm{U}\right), (18a)
s.t.\displaystyle\mathrm{s.t.} 𝑷𝕊++n,\displaystyle~\bm{P}\in\mathbb{S}_{++}^{n}, (18b)
[𝑷𝑼𝑼𝑷d]0,\displaystyle~\begin{bmatrix}\bm{P}&\bm{U}\\ \bm{U}^{\top}&\bm{P}_{d}\end{bmatrix}\succeq 0, (18c)
𝑨𝑷+𝑩𝑬+𝑷𝑨+𝑬𝑩\displaystyle~\bm{A}\bm{P}\!+\!\bm{B}\bm{E}\!+\!\bm{P}\bm{A}^{\top}\!+\!\bm{E}^{\top}\bm{B}^{\top}
+𝑫𝑫=𝑶n.\displaystyle~~~~\!+\!\bm{D}\bm{D}^{\top}\!=\!\bm{O}_{n}. (18d)

A corresponding feedback gain that achieves the optimal realizable Gramian is obtained as

𝑲=𝑬𝑷1.\displaystyle\bm{K}^{\ast}=\bm{E}^{\ast}\bm{P}^{\ast^{-1}}. (19)

Problem 2 can be solved numerically as an SDP. In practice, the condition 𝑷𝕊++n\bm{P}\in\mathbb{S}_{++}^{n} is typically imposed as 𝑷ϵ𝑰\bm{P}\succeq\epsilon\bm{I} with a sufficiently small positive scalar ϵ\epsilon.

Theorem 3

The solution to the optimization problem (9) can be obtained by solving the problem (18).

Proof:

Since the optimal solution 𝑷\bm{P}^{\ast} of (9) coincides with that of (17), it suffices to prove the equivalence between (17) and (18). First, because 𝑷𝕊++n\bm{P}\in\mathbb{S}_{++}^{n}, 𝑷1\bm{P}^{-1} exists. Hence, under the change of variables 𝑬=𝑲𝑷\bm{E}=\bm{K}\bm{P}, the Lyapunov constraint (17c) is equivalently rewritten as

𝑨𝑷+𝑩𝑬+𝑷𝑨+𝑬𝑩+𝑫𝑫=𝑶n.\displaystyle\bm{A}\bm{P}+\bm{B}\bm{E}+\bm{P}\bm{A}^{\top}+\bm{E}^{\top}\bm{B}^{\top}+\bm{D}\bm{D}^{\top}=\bm{O}_{n}. (20)

Conversely, for any (𝑷,𝑬)(\bm{P},\bm{E}), setting 𝑲=𝑬𝑷1\bm{K}=\bm{E}\bm{P}^{-1} recovers the original constraint. Therefore, the formulations using (𝑷,𝑲)(\bm{P},\bm{K}) and (𝑷,𝑬)(\bm{P},\bm{E}) are equivalent. Moreover, by Lemma 4 in Appendix, the optimization problem (17) can be rewritten as

min𝑷,𝑬\displaystyle\min_{\bm{P},\bm{E}} (min𝑼tr(𝑷+𝑷d2𝑼),s.t.[𝑷𝑼𝑼𝑷d]0)\displaystyle~\left(\begin{array}[]{c}\underset{\bm{U}}{\min}~\mathrm{tr}\left(\bm{P}+\bm{P}_{d}-2\bm{U}\right),\\ \mathrm{s.t.}\begin{bmatrix}\bm{P}&\bm{U}\\ \bm{U}^{\top}&\bm{P}_{d}\end{bmatrix}\succeq 0\end{array}\right)
s.t.\displaystyle\mathrm{s.t.} 𝑷𝕊++n,\displaystyle~\bm{P}\in\mathbb{S}_{++}^{n}, (21c)
𝑨𝑷+𝑩𝑬+𝑷𝑨+𝑬𝑩+𝑫𝑫=𝑶n.\displaystyle~\bm{A}\bm{P}\!+\!\bm{B}\bm{E}\!+\!\bm{P}\bm{A}^{\top}\!+\!\bm{E}^{\top}\bm{B}^{\top}\!+\!\bm{D}\bm{D}^{\top}\!=\!\bm{O}_{n}. (21d)

By Lemma 5 in Appendix, partial minimization with respect to distinct optimization variables is equivalent to simultaneous optimization. Hence, (21) and (18) are equivalent, and the optimal solutions of (9) and (18) coincide.

We conclude that the Gramian shaping problem can be solved as an SDP. Since many fast SDP solvers are available, the problem is numerically tractable. Moreover, because the problem admits an SDP formulation, additional LMI constraints can be incorporated into the Gramian design. Since many control constraints, such as upper bounds on Gramian entries and norm bounds on the internal control input [27], can be expressed as LMIs, this SDP-based Gramian shaping significantly improves the extensibility of the design framework.

V Connection between Gramian Shaping
and H2H_{2} control

This section discusses the relation between the proposed Gramian shaping framework and existing control theory. In particular, we focus on its connection to H2H_{2} control.

In this section, the exogenous input 𝒗r\bm{v}\in\mathbb{R}^{r} in (5) is assumed to be zero-mean Gaussian white noise. That is,

𝔼[𝒗(t)]\displaystyle\mathbb{E}[\bm{v}(t)] =𝟎r,𝔼[𝒗(t)𝒗(τ)]=𝑰rδ(tτ)\displaystyle=\bm{0}_{r},\qquad\mathbb{E}[\bm{v}(t)\bm{v}(\tau)^{\top}]=\bm{I}_{r}\,\delta(t-\tau) (22)

where δ(t):\delta(t):\mathbb{R}\to\mathbb{R} denotes the Dirac delta function. Then the state 𝒙(t)\bm{x}(t) becomes a stochastic process, and if the closed-loop matrix 𝑨+𝑩𝑲\bm{A}+\bm{B}\bm{K} is Hurwitz stable, the stationary covariance

𝑷w:=limt𝔼[𝒙(t)𝒙(t)]\displaystyle\bm{P}_{w}:=\lim_{t\to\infty}\mathbb{E}\!\left[\bm{x}(t)\bm{x}(t)^{\top}\right] (23)

exists. Moreover, 𝑷w\bm{P}_{w} is the unique positive-semidefinite solution of the Lyapunov equation

(𝑨+𝑩𝑲)𝑷w+𝑷w(𝑨+𝑩𝑲)+𝑫𝑫=𝑶n\displaystyle(\bm{A}+\bm{B}\bm{K})\bm{P}_{w}+\bm{P}_{w}(\bm{A}+\bm{B}\bm{K})^{\top}+\bm{D}\bm{D}^{\top}=\bm{O}_{n} (24)

and is expressed as

𝑷w=0e(𝑨+𝑩𝑲)τ𝑫𝑫e(𝑨+𝑩𝑲)τ𝑑τ\displaystyle\bm{P}_{w}=\int_{0}^{\infty}e^{\bm{(}\bm{A}+\bm{B}\bm{K})\tau}\,\bm{D}\bm{D}^{\top}\,e^{\bm{(}\bm{A}+\bm{B}\bm{K})^{\top}\tau}\,d\tau (25)

Therefore, when 𝒗\bm{v} is Gaussian white noise, the state covariance coincides mathematically with the controllability Gramian in Definition 2:

𝑷w=𝑷.\displaystyle\bm{P}_{w}=\bm{P}. (26)

We now consider H2H_{2} control for the system (4). H2H_{2} control is based on the H2H_{2} norm of the transfer function 𝑮(s)\bm{G}(s) from the disturbance 𝒗\bm{v} to the state 𝒙\bm{x}.

𝑿(s)\displaystyle\bm{X}(s) =𝑮(s)𝑾(s)\displaystyle=\bm{G}(s)\bm{W}(s) (27)
𝑮(s)\displaystyle\bm{G}(s) =(s𝑰n𝑨𝑩𝑲)1𝑫\displaystyle=\left(s\bm{I}_{n}-\bm{A}-\bm{B}\bm{K}\right)^{-1}\bm{D} (28)
𝑮2\displaystyle\left\|\bm{G}\right\|_{2} =12πtr(𝑮H(jw)𝑮(jw))𝑑w\displaystyle=\sqrt{\frac{1}{2\pi}\int_{-\infty}^{\infty}\mathrm{tr}\left(\bm{G}^{H}(jw)\bm{G}(jw)\right)dw} (29)

H2H_{2} control is defined as the optimization problem of finding the gain 𝑲\bm{K} that minimizes the H2H_{2} norm of 𝑮(s)\bm{G}(s).

min𝑲\displaystyle\min_{\bm{K}}~ 𝑮22\displaystyle\left\|\bm{G}\right\|_{2}^{2} (30a)
s.t.\displaystyle\mathrm{s.t.}~ 𝑮=[𝑨+𝑩𝑲𝑫𝑰n𝑶n×r]\displaystyle\bm{G}=\left[\begin{array}[]{c|c}\bm{A}+\bm{B}\bm{K}&\bm{D}\\ \hline\cr\bm{I}_{n}&\bm{O}_{n\times r}\end{array}\right]

The H2H_{2} control (30) can be solved as an SDP. To this end, the H2H_{2} norm is converted into a time-domain expression via Parseval’s theorem.

Proposition 1 (Sec. 4.10 [28])

For the system (4), the H2H_{2} norm (29) of the transfer function 𝐆\bm{G} from the disturbance 𝐯\bm{v} to the state 𝐱\bm{x} is given by

𝑮2=tr(𝑷w).\displaystyle\left\|\bm{G}\right\|_{2}=\sqrt{\mathrm{tr}\left(\bm{P}_{w}\right)}. (31)

Hence, H2H_{2} control can be written as the following optimization problem.

Problem 3 (H2H_{2} control with LMIs)

For the system (4), consider a problem of designing a feedback gain that minimizes the H2H_{2} norm of the transfer function from the disturbance 𝐯\bm{v} to the state 𝐱\bm{x}:

(𝑷w,𝑬)=argmin𝑷w,𝑬\displaystyle(\bm{P}_{w}^{\ast},\bm{E}^{\ast})=\underset{\bm{P}_{w},\bm{E}}{\arg\min}~ tr(𝑷w),\displaystyle\mathrm{tr}\left(\bm{P}_{w}\right), (32a)
s.t.\displaystyle\mathrm{s.t.}~ 𝑷w𝕊++n,\displaystyle\bm{P}_{w}\in\mathbb{S}_{++}^{n}, (32b)
𝑨𝑷w+𝑩𝑬+𝑷w𝑨\displaystyle\bm{A}\bm{P}_{w}+\bm{B}\bm{E}+\bm{P}_{w}\bm{A}^{\top}
+𝑬𝑩+𝑫𝑫=𝑶n.\displaystyle~~~+\bm{E}^{\top}\bm{B}^{\top}+\bm{D}\bm{D}^{\top}=\bm{O}_{n}. (32c)

The corresponding feedback gain is recovered as 𝐊=𝐄𝐏w1\bm{K}^{\ast}=\bm{E}^{\ast}\bm{P}_{w}^{{\ast}^{-1}}.

Note that also in Problem 3, in order to compute 𝑲=𝑬𝑷w1\bm{K}^{\ast}=\bm{E}^{\ast}\bm{P}_{w}^{\ast^{-1}} stably in numerical implementation, one may impose the constraint 𝑷wϵ𝑰n\bm{P}_{w}\succeq\epsilon\bm{I}_{n}. This is a numerical regularization and should be distinguished from the theoretical problem formulation.

The correspondence between the H2H_{2} control problem in Problem 3 and the Gramian shaping problem in Problem 2 can be verified directly from the closed-form expression (8) of the BW distance. If we set 𝑷d=α𝑰n\bm{P}_{d}=\alpha\bm{I}_{n} and let α0\alpha\to 0, the cross term vanishes and

limα0dBW2(𝑷,α𝑰n)=tr(𝑷)\displaystyle\lim_{\alpha\to 0}d_{\mathrm{BW}}^{2}(\bm{P},\alpha\bm{I}_{n})=\mathrm{tr}(\bm{P}) (33)

holds. In this case, the objective function of Problem 2 reduces to tr(𝑷)\mathrm{tr}(\bm{P}), and the constraints are identical. Hence, it coincides with the H2H_{2} state-feedback design problem in Problem 3. Therefore, in this limit, BW-based Gramian shaping can be regarded as a generalization that contains H2H_{2} control as a special case. It can be interpreted as a framework that generalizes minimization of the scalar measure tr(𝑷w)\mathrm{tr}(\bm{P}_{w}), which measures the magnitude of the covariance (or controllability Gramian), to minimization of the distance between the covariance matrix and a target matrix. Furthermore, from a probabilistic viewpoint, under Gaussian white disturbance, the stationary distribution of the closed-loop system (5) is 𝒩(𝟎,𝑷w)\mathcal{N}(\bm{0},\bm{P}_{w}), and the BW distance coincides with the 22-Wasserstein distance between zero-mean Gaussian distributions. Thus, H2H_{2} control can be reinterpreted as a design that drives the stationary closed-loop distribution 𝒩(𝟎,𝑷w)\mathcal{N}(\bm{0},\bm{P}_{w}) toward the degenerate Gaussian distribution 𝒩(𝟎,𝑶n)\mathcal{N}(\bm{0},\bm{O}_{n}) centered at the origin in the sense of optimal transport. This viewpoint reveals, through Gramian shaping, that classical H2H_{2} optimal control implicitly performs an optimal transport of state distributions.

VI Examples

This section verifies the proposed method through numerical examples.

VI-A Gramian shaping for a guidance robot

A guidance robot [10, 11] is required to follow a reference path while reflecting user inputs, as shown in Fig. 1. Here, Gramian shaping is used to increase controllability degree along the path and suppress it in the perpendicular direction. We also examine the design flexibility provided by additional LMI constraints.

The robot is modeled by the following acceleration-input unicycle model:

𝒙˙=[ccos(θ)csin(θ)ω00]+[0000001001](𝒖+𝒗),\displaystyle\dot{\bm{x}}=\begin{bmatrix}c\cos(\theta)\\ c\sin(\theta)\\ \omega\\ 0\\ 0\end{bmatrix}+\begin{bmatrix}0&0\\ 0&0\\ 0&0\\ 1&0\\ 0&1\end{bmatrix}(\bm{u}+\bm{v}), (34)

where 𝒖2\bm{u}\in\mathbb{R}^{2} is the internal input and 𝒗2\bm{v}\in\mathbb{R}^{2} is the user-applied exogenous input. As shown in Fig. 1, forward pulling affects translational motion, whereas lateral pulling induces rotation. Therefore, the internal input and the exogenous input are assumed to enter the system through the same input matrix.

Let 𝒙=𝒑(s)\bm{x}^{\ast}=\bm{p}(s^{\ast}) be the closest point on the reference path 𝒑(s)\bm{p}(s), and define the state deviation by δ𝒙=𝒙𝒙=[δpxδpyδθδcδω]\delta\bm{x}=\bm{x}-\bm{x}^{\ast}=\left[\delta p_{x}~\delta p_{y}~\delta\theta~\delta c~\delta\omega\right]^{\top}. Next, introduce the path-parallel and path-perpendicular errors ee_{\parallel} and ee_{\perp} by the coordinate transformation

[ee]=𝑹(θ)[δpxδpy],\displaystyle\begin{bmatrix}e_{\parallel}\\ e_{\perp}\end{bmatrix}=\bm{R}^{\top}(\theta^{\ast})\begin{bmatrix}\delta p_{x}\\ \delta p_{y}\end{bmatrix}, (35)

and define δ𝝃=[eeδθδcδω]\delta\bm{\xi}=\left[e_{\parallel}~e_{\perp}~\delta\theta~\delta c~\delta\omega\right]^{\top}. Then, linearizing the system around 𝒙\bm{x}^{\ast} yields

δ𝝃˙=𝑨δ𝝃+𝑩δ𝒖+𝑩𝒗,\displaystyle\delta\dot{\bm{\xi}}=\bm{A}\delta\bm{\xi}+\bm{B}\delta\bm{u}+\bm{B}\bm{v}, (36)

with

𝑨=[0ω010ω0c00000010000000000],𝑩=[0000001001],\displaystyle\bm{A}=\begin{bmatrix}0&\omega^{\ast}&0&1&0\\ -\omega^{\ast}&0&c^{\ast}&0&0\\ 0&0&0&0&1\\ 0&0&0&0&0\\ 0&0&0&0&0\end{bmatrix},\quad\bm{B}=\begin{bmatrix}0&0\\ 0&0\\ 0&0\\ 1&0\\ 0&1\end{bmatrix}, (37)

where δ𝒖=𝒖𝒖\delta\bm{u}=\bm{u}-\bm{u}^{\ast} and 𝒖\bm{u}^{\ast} is the nominal input achieving the reference state.

In the simulation, the user pulls the robot forward, and thus 𝒗=[10]\bm{v}=[1~0]^{\top}. The reference trajectory consists of straight and circular segments. The desired Gramian is set to

𝑷d=diag(1,0.001,1,0.1,1),\displaystyle\bm{P}_{d}=\mathrm{diag}(1,0.001,1,0.1,1), (38)

so that controllability is preserved along the path while being suppressed in the perpendicular direction.

We compare the following four cases. Case 1 has no exogenous input. Case 2 applies AIR-based Gramian shaping with exogenous input. Case 3 applies BW-based Gramian shaping with exogenous input (18). Case 4 adds the constraint

𝑷(2,2)0.001\displaystyle\bm{P}(2,2)\leq 0.001 (39)

to the BW-based Gramian shaping problem (18) in order to suppress the path-perpendicular error more strictly.

The resulting Gramians for Cases 2 and 3 are

𝑷2=[1000000.0648000.0722000.7224000000.1000000.0722001.0778],\displaystyle\bm{P}^{\ast}_{2}=\begin{bmatrix}1&0&0&0&0\\ 0&0.0648&0&0&-0.0722\\ 0&0&0.7224&0&0\\ 0&0&0&0.1000&0\\ 0&-0.0722&0&0&1.0778\end{bmatrix}, (40)
𝑷3=[0.9993000000.0020000.0401000.4008000000.1001000.0401002.0258],\displaystyle\bm{P}^{\ast}_{3}=\begin{bmatrix}0.9993&0&0&0&0\\ 0&0.0020&0&0&-0.0401\\ 0&0&0.4008&0&0\\ 0&0&0&0.1001&0\\ 0&-0.0401&0&0&2.0258\end{bmatrix}, (41)

respectively. In both cases, the perpendicular component exceeds the target value 0.0010.001, so the desired Gramian is not exactly achieved. By contrast, directly imposing (39) in Case 4 yields

𝑷4=[1000000.0010000.0216000.2161000000.1000000.0216001.2447].\displaystyle\bm{P}^{\ast}_{4}=\begin{bmatrix}1&0&0&0&0\\ 0&0.0010&0&0&-0.0216\\ 0&0&0.2161&0&0\\ 0&0&0&0.1000&0\\ 0&-0.0216&0&0&1.2447\end{bmatrix}. (42)

This illustrates an advantage of the BW-based formulation: additional design constraints can be incorporated directly as LMIs in the SDP.

The control period is 0.20.2 seconds, and the input is applied with zero-order hold. Each simulation ends when the robot reaches a ball of radius 0.10.1 centered at (px,goal,py,goal)=(2,2)({p}_{x,\mathrm{goal}},{p}_{y,\mathrm{goal}})=(-2,2). We also evaluate the average computation time of Gramian shaping at each step. The simulations are carried out in MATLAB 2024b. For AIR-based Gramian shaping, fmincon is used, whereas BW-based Gramian shaping is solved by YALMIP. The computer environment is an Intel Core i7-12700H CPU, Windows 11 Pro, and 32 GB memory.

Table I lists the goal-reaching times and average computation times. Cases 2–4 all reach the goal faster than Case 1, showing that the forward user input is properly reflected. Moreover, Cases 3 and 4 are much faster to compute than Case 2, confirming the computational advantage of BW-based Gramian shaping.

Fig. 2 shows the trajectories and the path-perpendicular error e\|e_{\perp}\|. In Cases 2 and 3, the perpendicular controllability is not sufficiently suppressed, so the exogenous input also affects the lateral direction and causes deviation from the path. In Case 4, this deviation is reduced without significantly degrading the goal-reaching time. This is because the LMI constraint directly limits the influence in the perpendicular direction.

Refer to caption
Fig. 1: Visualization of a guidance robot pulling a user while following a track. The user can give the robot some instructions with the handle.
Refer to caption
Fig. 2: Path-following trajectories in Cases 1–4 (Left) and path-perpendicular errors in Cases 2–4 (Right). In Cases 2 and 3, the exogenous input is reflected but causes deviation from the reference path. In Case 4, the additional LMI constraint suppresses this deviation.
TABLE I: Goal-reaching times and average computation times
for Cases 1–4
Case1 Case2 Case3 Case4
Goal Time[s] 35.8 12.6 13.8 15.4
Average computation time[s] - 0.328 0.100 0.086

VI-B Numerical comparison between H2H_{2} control and Gramian shaping

Section V showed that BW-based Gramian shaping with 𝑷d=α𝑰n\bm{P}_{d}=\alpha\bm{I}_{n} converges to H2H_{2} control as α0\alpha\to 0. This section verifies the relationship by a simple two-dimensional example.

Consider the system (4) with

𝑨=[0111],𝑩=[01],𝑫=[10].\displaystyle\bm{A}=\begin{bmatrix}0&1\\ -1&-1\end{bmatrix},\quad\bm{B}=\begin{bmatrix}0\\ 1\end{bmatrix},\quad\bm{D}=\begin{bmatrix}1\\ 0\end{bmatrix}. (43)

The exogenous input 𝒗\bm{v} is white noise.

We compare the stationary covariances, equivalently the controllability Gramian, obtained by H2H_{2} control with that obtained by BW-based Gramian shaping. In BW-based Gramian shaping, the desired Gramian is set to 𝑷d=α𝑰n\bm{P}_{d}=\alpha\bm{I}_{n}, and the resulting closed-loop covariance is compared with that of H2H_{2} control for different values of α\alpha. To avoid excessively high gains, the positive definite constraint 𝑷102𝑰n\bm{P}\succeq 10^{-2}\bm{I}_{n} is imposed.

The results are shown in Figs. 3 and 4. Fig. 3 plots 1000 state samples at t=100t=100 from the initial condition 𝒙(0)=𝟎\bm{x}(0)=\bm{0} for each α\alpha and for H2H_{2} control. The trajectories are simulated by the Euler–Maruyama method. For large α\alpha, the sample distribution spreads according to the target Gramian 𝑷d=α𝑰n\bm{P}_{d}=\alpha\bm{I}_{n}. As α\alpha decreases, it approaches the distribution obtained by H2H_{2} control.

Fig. 4 shows the Frobenius norm of the difference between the stationary covariance for BW-based Gramian shaping and that for H2H_{2} control, namely,

𝑷𝑷H2F.\displaystyle\|\bm{P}^{\ast}-\bm{P}_{H_{2}}\|_{F}. (44)

This confirms that the BW-based solution continuously approaches the H2H_{2} solution as α\alpha decreases, and coincides with it at α=0\alpha=0.

These results numerically support that BW-based Gramian shaping reduces to H2H_{2} control in the limit 𝑷d𝑶n\bm{P}_{d}\to\bm{O}_{n}. Hence, when BW-based Gramian shaping is interpreted as distribution control for linear stochastic systems, H2H_{2} control can be viewed as a transport problem toward a degenerate Gaussian distribution with zero covariance.

Refer to caption
Fig. 3: State sample distributions under BW-based Gramian shaping for different α\alpha and under H2H_{2} control. As α\alpha decreases, the distribution approaches that of H2H_{2} control.
Refer to caption
Fig. 4: Difference 𝑷𝑷H2F\|\bm{P}^{\ast}-\bm{P}_{H_{2}}\|_{F} between the stationary covariance obtained by BW-based Gramian shaping and that obtained by H2H_{2} control. The step size of α\alpha is 0.01. The difference decreases as α\alpha becomes smaller.

VII CONCLUSIONS

This paper proposed a BW-based method for shaping the controllability Gramian from exogenous inputs to the state into a desired form. We showed that the objective function is strictly convex and formulated the problem as an SDP using an LMI representation of the BW distance. This also enables the incorporation of additional LMI constraints. The proposed framework also clarified that H2H_{2} control is a special case of BW-based Gramian shaping under Gaussian white noise. Numerical examples demonstrated anisotropic controllability design for a guidance robot, verified the ability to impose additional LMI constraints, and confirmed through a simple example that the proposed method approaches H2H_{2} control in the corresponding limit. These results show the effectiveness of the proposed method for externally operated systems.

References

  • [1] G. F. Franklin, J. D. Powell, and A. Emami-Naeini, Feedback Control of Dynamic Systems, 8th ed. Boston: Pearson, 2019.
  • [2] K. M. Lynch and F. C. Park, Modern Robotics: Mechanics, Planning, and Control, 1st ed. USA: Cambridge Univ. Press, 2017.
  • [3] S. Mochida, R. Onuki, T. Kawagoe, T. Ito, T. Ibuki, R. Funada, and M. Sampei, “Hoverability analysis and development of a quadrotor only with clockwise rotors,” in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst. , 2022, pp. 7558–7564.
  • [4] N. Hogan, “Impedance control: An approach to manipulation,” in Proc. Amer. Control Conf., 1984, pp. 304–313.
  • [5] C. T. Landi, F. Ferraguti, L. Sabattini, C. Secchi, and C. Fantuzzi, “Admittance control parameter adaptation for physical human-robot interaction,” in Proc. IEEE Int. Conf. Robot. Autom., 2017, pp. 2911–2916.
  • [6] R. E. Kálmán, “Mathematical description of linear dynamical systems,” J. Soc. Ind. Appl. Math. Ser. A Control, vol. 1, no. 2, pp. 152–192, 1963.
  • [7] K. Sato and S. Terasaki, “Controllability scores for selecting control nodes of large-scale network systems,” IEEE Trans. Autom. Control, vol. 69, no. 7, pp. 4673–4680, 2024.
  • [8] T. H. Summers, F. L. Cortesi, and J. Lygeros, “On submodularity and controllability in complex dynamical networks,” IEEE Trans. Control Netw. Syst., vol. 3, no. 1, pp. 91–101, 2016.
  • [9] A. S. A. Dilip, “The controllability gramian, the hadamard product, and the optimal actuator/leader and sensor selection problem,” IEEE Control Syst. Lett., vol. 3, no. 4, pp. 883–888, 2019.
  • [10] S. Kayukawa, D. Sato, M. Murata, T. Ishihara, A. Kosugi, H. Takagi, S. Morishima, and C. Asakawa, “How users, facility managers, and bystanders perceive and accept a navigation robot for visually impaired people in public buildings,” in Proc. 31st IEEE Int. Conf. Robot Hum. Interact. Commun., 2022, pp. 546–553.
  • [11] H. Takagi, K. Naito, D. Sato, M. Murata, S. Kayukawa, and C. Asakawa, “Field trials of autonomous navigation robot for visually impaired people,” in Proc. Extended Abstr. CHI Conf. Hum. Factors Comput. Syst., ser. CHI EA ’25. New York, NY, USA: Assoc. Comput. Mach., 2025.
  • [12] L. Bascetta, G. Ferretti, G. Magnani, and P. Rocco, “Walk-through programming for robotic manipulators based on admittance control,” Robotica, vol. 31, no. 7, pp. 1143–1153, 2013.
  • [13] M. Ragaglia, A. Maria Zanchettin, L. Bascetta, and P. Rocco, “Accurate sensorless lead-through programming for lightweight robots in structured environments,” Robot. Comput.-Integr. Manuf., vol. 39, pp. 9–21, 2016.
  • [14] K. Nishimoto, Y. Onishi, R. Funada, and M. Sampei, “Controller design for linear systems via controllability Gramian shaping,” in Proc. IEEE Conf. Control Technol. Appl., 2024, pp. 832–838.
  • [15] R. Bhatia, Positive Definite Matrices. Princeton Univ. Press, 2007.
  • [16] J. V. Oostrum, “Bures–Wasserstein geometry for positive-definite hermitian matrices and their trace-one subset,” Inf. Geom., vol. 5, no. 2, pp. 405–425, Nov. 2022.
  • [17] R. Bhatia, T. Jain, and Y. Lim, “On the Bures–Wasserstein distance between positive definite matrices,” Expo. Math., vol. 37, no. 2, pp. 165–191, 2019.
  • [18] K. Jiang, J. Cui, X. Dong, and L. Toni, “Bures–Wasserstein flow matching for graph generation,” arXiv preprint arXiv:2506.14020, 2025.
  • [19] I. Haasler and P. Frossard, “Bures–Wasserstein means of graphs,” in Proc. 27th Int. Conf. Artif. Intell. Statist., ser. Proc. Mach. Learn. Res., vol. 238, S. Dasgupta, S. Mandt, and Y. Li, Eds. PMLR, 2024, pp. 1873–1881.
  • [20] A. Q. Jaffe and L. V. Santoro, “Large deviations principle for Bures–Wasserstein barycenters,” arXiv preprint arXiv:2409.11384, 2024.
  • [21] L. V. Santoro and V. M. Panaretos, “Large sample theory for Bures–Wasserstein barycentres,” Ann. Appl. Probab., vol. 35, no. 5, pp. 3215–3241, 2025.
  • [22] Y. Thanwerdas and X. Pennec, “Bures–Wasserstein minimizing geodesics between covariance matrices of different ranks,” SIAM J. Matrix Anal. Appl., vol. 44, no. 3, pp. 1447–1476, 2023.
  • [23] C.-T. Chen, Linear System Theory and Design, 3rd ed. USA: Oxford Univ. Press, 1998.
  • [24] A. F. Hotz and R. E. Skelton, “A covariance control theory,” in Proc. 24th IEEE Conf. Decis. Control, 1985, pp. 552–557.
  • [25] L. Ning, X. Jiang, and T. Georgiou, “On the geometry of covariance matrices,” IEEE Signal Process. Lett., vol. 20, no. 8, pp. 787–790, 2013.
  • [26] R. T. Rockafellar and R. J.-B. Wets, Variational Analysis, ser. Grundlehren der mathematischen Wissenschaften. Berlin, Heidelberg: Springer, 1998.
  • [27] S. Boyd, L. El Ghaoui, E. Feron, and V. Balakrishnan, Linear Matrix Inequalities in System and Control Theory. Philadelphia, PA, USA: Soc. Ind. Appl. Math., 1994.
  • [28] S. Skogestad and I. Postlethwaite, Multivariable Feedback Control: Analysis and Design, 2nd ed. Chichester, U.K.: John Wiley & Sons, 2005.

This appendix contains the lemmas used in this paper.

Lemma 1 (Th. 4 [24])

For an (𝐀,𝐁\bm{A},\bm{B})-controllable and (𝐀,𝐃\bm{A},\bm{D})-controllable linear system (4), there exists a controllability Gramian 𝐏\bm{P} if and only if

(𝑰n𝑩𝑩)(𝑨𝑷+𝑷𝑨+𝑫𝑫)(𝑰n𝑩𝑩)=𝑶n.\displaystyle\left(\bm{I}_{n}-\bm{BB}^{\dagger}\right)\left(\bm{A}\bm{P}+\bm{P}\bm{A}^{\top}+\bm{DD}^{\top}\right)\left(\bm{I}_{n}-\bm{BB}^{\dagger}\right)=\bm{O}_{n}. (45)
Lemma 2 (Th. 5 [24])

For the controllable linear system (4), assume that a controllability Gramian 𝐏\bm{P} is realizable by a stabilizing linear feedback law. Then all gain matrices 𝐊\bm{K} realizing 𝐏\bm{P} are given by

𝑲=12𝑩(𝑨𝑷+𝑷𝑨+𝑫𝑫𝑺d)𝑷1,\displaystyle\bm{K}=-\frac{1}{2}\bm{B}^{\dagger}\left(\bm{A}\bm{P}+\bm{P}\bm{A}^{\top}+{\bm{D}\bm{D}^{\top}}-\bm{S}_{d}\right)\bm{P}^{-1}, (46)

where 𝐒d\bm{S}_{d} is an n×nn\times n skew-symmetric matrix of the form

𝑺d=𝑵[𝑶nm𝑺d12𝑺d12𝑺d22]𝑵.\displaystyle\bm{S}_{d}=\bm{N}\left[\begin{array}[]{cc}\bm{O}_{n-m}&\bm{S}_{d_{12}}\\ -\bm{S}_{d_{12}}^{\top}&\bm{S}_{d_{22}}\end{array}\right]\bm{N}^{\top}.

𝑵𝒪(n)\bm{N}\in\mathcal{O}(n) satisfies

𝑵(𝑰𝑩𝑩)𝑵=blkdiag(𝑰nm,𝑶m).\displaystyle\bm{N}\left(\bm{I}-\bm{B}\bm{B}^{\dagger}\right)\bm{N}^{\top}=\mathrm{blkdiag}\left(\bm{I}_{n-m},\bm{O}_{m}\right). (49)

𝑺d12\bm{S}_{d12} is given by

𝑺d12=\displaystyle\bm{S}_{d12}= [𝑰nm𝑶nm×m]𝑵(𝑨𝑷+𝑷𝑨+𝑫𝑫)𝑵[𝑶nm×m𝑰nm]\displaystyle\left[\bm{I}_{n-m}~\bm{O}_{n-m\times m}\right]\bm{N}^{\top}\bigl(\bm{A}\bm{P}+\bm{P}\bm{A}^{\top}+{\bm{D}\bm{D}^{\top}}\bigr)\bm{N}\left[\bm{O}_{n-m\times m}~\bm{I}_{n-m}\right]^{\top} (50)

and 𝐒d22\bm{S}_{d22} is an arbitrary m×mm\times m skew-symmetric matrix.

Lemma 3 (Th. 7 [17])

tr(𝑿12):𝕊+n+\mathrm{tr}(\bm{X}^{\frac{1}{2}}):\mathbb{S}_{+}^{n}\to\mathbb{R}_{+} is a strictly concave function on 𝕊++n\mathbb{S}_{++}^{n}. That is, 𝐗,𝐘𝕊++n\forall\bm{X},\bm{Y}\in\mathbb{S}_{++}^{n}, 𝐗𝐘\bm{X}\neq\bm{Y}, t(0,1)\forall t\in(0,1),

tr((t𝑿+(1t)𝒀)12)\displaystyle\mathrm{tr}\left(\left(t\bm{X}+(1-t)\bm{Y}\right)^{\frac{1}{2}}\right)
(ttr(𝑿12)+(1t)tr(𝒀12))>0.\displaystyle-\left(t\mathrm{tr}\left(\bm{X}^{\frac{1}{2}}\right)+(1-t)\mathrm{tr}\left(\bm{Y}^{\frac{1}{2}}\right)\right)>0. (51)
Lemma 4 (Ch. 3 [25])

The BW distance satisfies

dBW2(𝑿,𝒀)=minU\displaystyle d_{BW}^{2}(\bm{X},\bm{Y})=\min_{U} tr(𝑿+𝒀2𝑼),\displaystyle~\mathrm{tr}\left(\bm{X}+\bm{Y}-2\bm{U}\right), (52a)
s.t.\displaystyle\mathrm{s.t.} [𝑿𝑼𝑼𝒀]0.\displaystyle~\begin{bmatrix}\bm{X}&\bm{U}\\ \bm{U}^{\top}&\bm{Y}\end{bmatrix}\succeq 0. (52b)
Lemma 5 (Ch. 11 [26])

Let XX and YY be nonempty sets, and let f:X×Yf:X\times Y\to\mathbb{R}. Assume that the minimum exists. Then

min(x,y)X×Yf(x,y)=minxX(minyYf(x,y)).\displaystyle\min_{(x,y)\in X\times Y}f(x,y)=\min_{x\in X}\left(\min_{y\in Y}f(x,y)\right). (53)