Manifolds, Geometry, and Roboticsrss2017.lids.mit.edu/docs/invitedtalks/park-manifolds...Manifolds,...
Transcript of Manifolds, Geometry, and Roboticsrss2017.lids.mit.edu/docs/invitedtalks/park-manifolds...Manifolds,...
Manifolds, Geometry, and Robotics
Frank C. ParkSeoul National University
Ideas and methods from differential geometry and Lie groups have played a crucial role in establishing the scientific foundations of robotics, and more than ever, influence the way we think about and formulate the latest problems in robotics. In this talk I will trace some of this history, and also highlight some recent developments in this geometric line of inquiry. The focus for the most part will be on robot mechanics, planning, and control, but some results from vision and image analysis, and human modeling, will be presented. I will also make the case that many mainstream problems in robotics, particularly those that at some stage involve nonlinear dimension reduction techniques or some other facet of machine learning, can be framed as the geometric problem of mapping one curved space into another, so as to minimize some notion of distortion. ARiemannian geometric framework will be developed for this distortion minimization problem, and its generality illustrated via examples from robot design to manifold learning.
Abstract
Outline A survey of differential geometric methods in robotics:โA retrospective critiqueโ Some recent results and open problems
Problems and case studies drawn from:โ Kinematics and path planningโDynamics and motion optimizationโVision and image analysisโHuman and robot modelingโMachine learning
Roger Brockett, Shankar Sastry, Mark Spong, Dan Koditschek, Matt Mason, John Baillieul, PS Krishnaprasad, Tony Bloch, Josip Loncaric, David Montana, Brad Paden, Vijay Kumar, Mike McCarthy, Richard Murray, Zexiang Li, Jean-Paul Laumond, Antonio Bicchi, Joel Burdick, Elon Rimon, Greg Chirikjian, Howie Choset, Kevin Lynch, Todd Murphey, Andreas Mueller, Milos Zefran, Claire Tomlin, Andrew Lewis, Francesco Bullo, Naomi Leonard, Kristi Morgansen, Rob Mahony, Ross Hatton, and many moreโฆ
Contributors
A
Shortest path on globe โ shortest path on mapNorth and south poles map to lines of latitude
Why geometry matters
2-D maps galore
[Example] The average of three points on a circle Cartesian coordinates:
Polar coordinates:
( ) ( ) ( )( )3
132
22
22
22
22
,:Mean
1,0:C , ,:B , ,:A โ
( ) ( ) ( )( )ฯ
ฯฯฯ
65
21
41
47
,1:Mean
,1: , ,1:B , ,1:A C
A
BC
Intrinsic meanExtrinsic mean
Why geometry matters
-
Result depends on the local coordinates used
Determinant not preserved
Determinant preserved
Arithmetic mean
[Example] The average of two symmetric positive-definite matrices:
Intrinsic mean
Why geometry matters
๐๐0 = 1 00 7 , ๐๐1 = 7 0
0 1
๐๐ = 4 00 4
๐๐๐ = 7 00 7 ๐๐ = ๐๐ ๐๐
๐๐ ๐๐
Nigel: The numbers all go to eleven. Look, right across the board, eleven, eleven, eleven and...
Marty: Oh, I see. And most amps go up to ten?Nigel: Exactly.Marty: Does that mean it's louder? Is it any louder?Nigel: Well, it's one louder, isn't it? It's not ten. You
see, most blokes, you know, will be playing at ten. You're on ten here, all the way up, all the way up, all the way up, you're on ten on your guitar. Where can you go from there? Where?
Marty: I don't know.Nigel: Nowhere. Exactly. What we do is, if we need that
extra push over the cliff, you know what we do?Marty: Put it up to eleven.Nigel: Eleven. Exactly. One louder.
This is Spinal Tap (1984, Rob Reiner)
Marty: Why don't you make ten a little louder, make that the top number and make that a little louder?
Nigel: These go to eleven.
The unit two-sphere is parametrized asSpherical coordinates:
Freshman calculus revisited
๐ฅ๐ฅ2 + ๐ฆ๐ฆ2 + ๐ง๐ง2 = 1.
x = cos ๐๐ sin๐๐y = sin ๐๐ sin๐๐๐ง๐ง = cos ๐๐
Given a curve on the sphere, its incremental arclength is
(๐ฅ๐ฅ ๐ก๐ก ,๐ฆ๐ฆ ๐ก๐ก , ๐ง๐ง ๐ก๐ก )
๐๐๐ ๐ 2 = ๐๐๐ฅ๐ฅ2 + ๐๐๐ฆ๐ฆ2 + ๐๐๐ง๐ง2 = ๐๐๐๐2 + sin2 ๐๐ ๐๐๐๐2
Length of
Area of
Freshman calculus revisited
= ๏ฟฝ๐ด๐ด
sin ๐๐ ๐๐๐๐ ๐๐๐๐
= ๏ฟฝ0
๐๐๏ฟฝฬ๏ฟฝ๐2 + ๏ฟฝฬ๏ฟฝ๐2sin ๐๐ ๐๐๐ก๐ก
Calculating lengths and areas on the sphere using spherical coordinates:
Manifolds
Manifold โณ
local coordinates x
*Invertible with a differentiable inverse. Essentialy, one can be smoothly deformed into the other.
A differentiable manifold is a space that is locally diffeomorphic* to Euclidean space (e.g., a multidimensional surface)
Riemannian metrics
๐๐๐ ๐ 2 = ๏ฟฝ๐๐
๏ฟฝ๐๐
๐๐๐๐๐๐ ๐ฅ๐ฅ ๐๐๐ฅ๐ฅ๐๐๐๐๐ฅ๐ฅ๐๐
= ๐๐๐ฅ๐ฅ๐๐๐บ๐บ ๐ฅ๐ฅ ๐๐๐ฅ๐ฅ
A Riemannian metric is an inner product defined on each tangent space that varies smoothly over โณ
๐บ๐บ ๐ฅ๐ฅ โ โ๐๐ร๐๐
symmetric positive-definite
Calculus on Riemannian manifolds
= ๏ฟฝโฏ๏ฟฝ๐ฑ๐ฑ
det ๐บ๐บ(๐ฅ๐ฅ) ๐๐๐ฅ๐ฅ1 โฏ๐๐๐ฅ๐ฅ๐๐
Volume of a subset ๐ฑ๐ฑ of โณ:Volume = โซ๐ฑ๐ฑ ๐๐๐๐
= ๏ฟฝ0
๐๐๏ฟฝฬ๏ฟฝ๐ฅ ๐ก๐ก ๐๐๐บ๐บ ๐ฅ๐ฅ ๐ก๐ก ๏ฟฝฬ๏ฟฝ๐ฅ ๐ก๐ก ๐๐๐ก๐ก
Length of a curve ๐ถ๐ถ on โณ:
Length = ๏ฟฝ๐ถ๐ถ๐๐๐ ๐
Lie groups A manifold that is also an algebraic group is a Lie group The tangent space at the identity is the Lie algebra โ. The exponential map exp: โ โ ๐ข๐ข
acts as a set of local coordinates for ๐ข๐ข [Example] GL(n), the set of ๐๐ ร ๐๐
nonsingular real matrices, is a Lie group under matrix multiplication. Its Lie algebra gl(n) is โ๐๐ร๐๐.
Mappings may be in complicated parametric form Sometimes the manifolds are unknown or changing Riemannian metrics must be specified on one or both spaces Noise models on manifolds may need to be defined
Robots and manifolds
๐๐๐ ๐ 2 = ๏ฟฝ๐๐
๏ฟฝ๐๐
๐๐๐๐๐๐ ๐ฅ๐ฅ ๐๐๐ฅ๐ฅ๐๐๐๐๐ฅ๐ฅ๐๐
Joint Configuration Space
local coordinates
forward kinematics
Task Space
local coordinates
๐๐๐ ๐ 2 = ๏ฟฝ๐ผ๐ผ
๏ฟฝ๐ฝ๐ฝ
โ๐ผ๐ผ๐ฝ๐ฝ ๐ฆ๐ฆ ๐๐๐ฆ๐ฆ๐ผ๐ผ๐๐๐ฆ๐ฆ๐ฝ๐ฝ
Kinematics and Path Planning
Minimal geodesics on Lie groupsLet ๐ข๐ข be a matrix Lie group with Lie algebra โ, and let โจ โ , โ โฉ be an inner product on โ. The (left-invariant) minimal geodesic between ๐๐0,๐๐1 โ ๐ข๐ข can be found by solving the following optimal control problem:
min๐๐ ๐ก๐ก
๏ฟฝ0
1โจ๐๐ ๐ก๐ก ,๐๐ ๐ก๐ก โฉ๐๐๐ก๐ก
Subject to ๏ฟฝฬ๏ฟฝ๐ = ๐๐๐๐,๐๐(๐ก๐ก) โ ๐ข๐ข, ๐๐(๐ก๐ก) โ โ, with boundary condition ๐๐ 0 = ๐๐0,๐๐ 1 = ๐๐1.
Minimal geodesics on Lie groupsFor the choice โจ๐๐,๐๐โฉ = Tr(๐๐๐๐๐๐) , the solution must satisfy
๏ฟฝฬ๏ฟฝ๐ = ๐๐๐๐๏ฟฝฬ๏ฟฝ๐ = ๐๐๐๐๐๐ โ ๐๐๐๐๐๐ = ๐๐๐๐ ,๐๐ .
If the objective function is replaced by โซ01 ๏ฟฝฬ๏ฟฝ๐ , ๏ฟฝฬ๏ฟฝ๐ ๐๐๐ก๐ก, the
solution must satisfy ๏ฟฝฬ๏ฟฝ๐ = ๐๐๐๐ and ๏ฟฝโ๏ฟฝ๐ = ๐๐๐๐, ๏ฟฝฬ๏ฟฝ๐ .
Minimal geodesics, and minimum acceleration paths, can be found on various Lie groups by solving the above two-point boundary value problems. For SO(n) and SE(n) the minimal geodesics are particularly simple to characterize.
Distance metrics on SE(3)
๐๐ ๐๐1,๐๐2 = distance between ๐๐1 and ๐๐2
Distance metrics on SE(3)
If ๐๐ ๐๐1๐,๐๐2๐ = ๐๐ ๐๐๐๐1,๐๐๐๐2 =๐๐ ๐๐1,๐๐2 for all U โ ๐๐๐๐(3),๐๐ ๏ฟฝ ,๏ฟฝ is a left-invariant distance metric.
Distance metrics on SE(3)
If ๐๐ ๐๐1๐,๐๐2๐ = ๐๐ ๐๐1๐๐,๐๐2๐๐ =๐๐ ๐๐1,๐๐2 for all V โ ๐๐๐๐(3),๐๐ ๏ฟฝ ,๏ฟฝ is a right-invariant distance metric.
Distance metrics on SE(3)
If ๐๐ ๐๐1๐,๐๐2๐ = ๐๐ ๐๐๐๐1๐๐,๐๐๐๐2๐๐ =๐๐ ๐๐1,๐๐2 for all U, V โ ๐๐๐๐(3),๐๐ ๏ฟฝ ,๏ฟฝ is a bi-invariant distance metric.
Bi-invariant metrics on SO(3) exist: some simple ones are๐๐ ๐ ๐ 1,๐ ๐ 2 = || log ๐ ๐ 1๐๐๐ ๐ 2 || = ๐๐ โ [0,๐๐]
๐๐ ๐ ๐ 1,๐ ๐ 2 = ๐ ๐ 1 โ ๐ ๐ 2 = 3 โ ๐๐๐๐(๐ ๐ 1๐๐๐ ๐ 2) = 1 โ cos ๐๐
No bi-invariant metric exists on SE(3) Left- and right-invariant metrics exist on SE(3): a simple
left-invariant metric is ๐๐ ๐๐1,๐๐2 = ๐๐ ๐ ๐ 1,๐ ๐ 2 + ๐๐1 โ ๐๐2 Any distance metric on SE(3) depends on the choice of
length scale for physical space
Some facts about distance metrics on SE(3)
(Too) many papers on SE(3) distance metrics have been written! Robots are doing fine even without bi-invariance (but make
sure the metric you use is left-invariant) Notwithstanding J. Duffyโs claims about โThe fallacy of
modern hybrid control theory that is based on โorthogonal complementsโ of twist and wrench spaces,โ J. Robotic Systems, 1989, hybrid force-position control seems to be working well.
Remarks
The product-of-exponentials (PoE) formula for open kinematic chains (Brockett 1989) puts on a more sure footing the classical screw-theoretic tools for kinematic modeling and analysis:
๐๐ = ๐๐ ๐๐1 ๐๐1 โฏ ๐๐ ๐๐๐๐ ๐๐๐๐๐๐ Some advantages: no link frames needed, intuitive physical meaning,
easy differentiation, can apply well-known machinery and results of general matrix Lie groups, etc. It is mystifying to me why the PoE formula is not more widely taught
and used, and why people still cling to their Denavit-Hartenbergparameters.
Robot kinematics: modern screw theory
Some relevant robotics textbooksTargeted to upper-level undergraduates, can be complemented by more advanced textbooks like A Mathematical Introduction to Robotic Manpulation (Murray, Li, Sastry) and Mechanics of Robot Manipulation(Mason). Free PDF available athttp://modernrobotics.org
Closed chain kinematics
Differential geometric methods have been especially useful in their analysis: representing the forward kinematics ๐๐ ๐๐,๐๐ โ ๐๐,โ as a mapping between Riemannian manifolds, manipulabilityand singularity analysis can be performed via analysis of the pullback form (in local coordinates, ๐ฝ๐ฝ๐๐๐ป๐ป๐ฝ๐ฝ๐บ๐บโ1).
Closed chains typically have curved configuration spaces, and can be under- or over-actuated. Their singularity behavior is also more varied and subtle.
Dmitry Berenson et al, "Manipulation planning on constraint manifolds," ICRA 2009.
Path planning on constraint manifolds
Path planning for robots subject to holonomic constraints (e.g., closed chains, contact conditions). The configuration space is a curved manifold whose structure we do not exactly know in advance.
A simple RRT sampling-based algorithm
Start node
Goal node
Random node
Constraint manifold
A simple RRT sampling-based algorithm
Start node
Goal node
Nearestneighbornode
Random node
Constraint manifold
Start node
Goal node
Nearestneighbornode
Random node
Constraint manifold
A simple RRT sampling-based algorithm
Start node
Goal node
qs4reached
qgreached
Constraint manifold
A simple RRT sampling-based algorithm
Tangent Bundle RRT (Kim et al 2016)
Tangent Bundle RRT: An RRT algorithm for planning on curved configuration spaces:
- Trees are first propagated on the tangent bundle- Local curvature information is used to grow the tangent space
trees to an appropriate size.
Start node
Goal node
New node
Nearest neighbornode
Tangent Bundle RRT
Start node
Goal node
Constraint manifold
Initializing- Start and goal nodes assumed to be on constraint manifold.- Tangent spaces are constructed at start and goal nodes.
Tangent Bundle RRT
Start node
Goal node
Random node
Constraint manifold
New node
New node
Random sampling on tangent spaces:- Generate a random sample node on a tangent space.- Find the nearest neighbor node in the tangent space and take a
single step of fixed size toward random target node.- Find the nearest neighbor node on the opposite tree and then
extend tree via tangent space.
Tangent Bundle RRT
Goal node
Random node
Constraint manifold
Start node
New node
New node
Creating a new tangent space:- When the distance to the constraint manifold exceeds a certain
threshold, project the extended node to the constraint manifold and create a new bounded tangent space.
Tangent Bundle RRT
Start node
Goal node
New node
Nearest neighbornode
Select a tangent space using a size-biased function (roulette selection): For each tangent space, assigned a fitness value that is- proportional to the size of the tangent space and,- Inversely proportional to the number of nodes belonging to the
tangent space.
Tangent bundle RRTConstructing a bounded tangent space: Use local curvature information to find the
principal basis of the tangent space, and to bound the tangent space domain.
Principal curvatures and principal vectors can be computed from the second fundamental form of the constraint manifold (details need to be worked out if there is more than one normal direction)
If the principal curvatures are close to zero, the manifold is nearly flat, and thus relatively larger steps can be taken along the corresponding principal directions
Tangent bundle RRTQ: Is the extra computation and bookkeeping worth it?A: Itโs highly problem-dependent, but for higher-dimensional systems, it seems so.
Planning on Foliations
Planning on Foliations
Planning on Foliations
Planning on Foliations
Planning on Foliations
Planning on Foliations
Release posture
Re-grasp posture
Jump motion
Planning on Foliations
Leaf
Planning on Foliations
Planning on Foliations
Planning on Foliations
Foliation, โฑ
Planning on Foliations
Connected path
Jump path
Connected path
Planning on Foliations (J Kim et al 2016)
Planning on Foliations
Dynamics and Motion Optimization
B. Armstrong, O. Khatib, J. Burdick, โThe explicit dynamic model and inertial parameters of the Puma 560 Robot arm,โ Proc. ICRA, 1986.
PUMA 560 dynamics equations
PUMA 560 dynamics equations
PUMA 560 dynamics equations (page 2)
PUMA 560 dynamics equations (page 3)
- Recursive formulations of Newton-Euler dynamics already derived in early 1980s.
- Recursive formulations based on screw theory (Featherstone), spatial operator algebra (Rodriguez and Jain), Lie group concepts.
- Initialization: ๐๐0 = ๏ฟฝฬ๏ฟฝ๐0 = ๐น๐น๐๐+1 = 0- For ๐๐ = 1 to ๐๐ do:
- ๐๐๐๐โ1,๐๐ = ๐๐๐๐๐๐S๐๐๐๐๐๐- ๐๐๐๐ = Ad๐๐๐๐,๐๐โ1 ๐๐๐๐โ1 + ๐๐๐๐ ๏ฟฝฬ๏ฟฝ๐๐๐- ๏ฟฝฬ๏ฟฝ๐๐๐ = ๐๐๐๐๏ฟฝฬ๏ฟฝ๐๐๐ + ๐ด๐ด๐๐๐๐๐๐,๐๐โ1 ๏ฟฝฬ๏ฟฝ๐๐๐โ1 + [Ad๐๐๐๐,๐๐โ1 ๐๐๐๐โ1 , ๐๐๐๐๏ฟฝฬ๏ฟฝ๐๐๐]
- For ๐๐ = ๐๐ to 1 do: - ๐น๐น๐๐ = Ad๐๐๐๐,๐๐โ1
โ ๐น๐น๐๐+1 + ๐บ๐บ๐๐๏ฟฝฬ๏ฟฝ๐๐๐ad๐๐๐๐โ ๐บ๐บ๐๐๐๐๐๐
- ๐๐๐๐ = ๐๐๐๐๐๐๐น๐น๐๐
Recursive dynamics to the rescue
- Finite difference approximations of gradients (and Hessians) often lead to poor convergence and numerical instabilities.
- Derivation of recursive algorithms for analytic gradients and Hessians using Lie group operators and transformations:
The importance of analytic gradients
J. Bobrow et al, ICRA Video Proceedings, 1999.
Maximum payload lifting
Vision processing, object recognition, classification
Sensing (joint, force, tactile, laser, sonar, etc.)
Localization/SLAM Manipulation planning Control (arms, legs, torso,
hands, wheels) Communication Task scheduling and
planning
Things a robot must do (in parallel)Robots are being asked to simultaneously do more and more with only limited resources available for computation, communication, memory, etc.
Control laws and trajectories need to be designed in a way that minimizes the use of such resources.
Control depends on both time and state Simplest control is a constant one Cost of control implementation (โattentionโ) is
proportional to the rate at which the control changes with respect to state and time. A control that requires little attention is one that is robust
to discretization of time and state
Measuring the cost of control
Given system ๏ฟฝฬ๏ฟฝ๐ฅ = ๐๐(๐ฅ๐ฅ,๐ข๐ข, ๐ก๐ก), consider the following controller cost:
๏ฟฝ๐๐๐ข๐ข๐๐๐ฅ๐ฅ
2
+๐๐๐ข๐ข๐๐๐ก๐ก
2
dx dt
- A multi-dimensional calculus of variations problem (integral over both space and time)
- Existence of solutions not always guaranteed
Brockettโs attention functional
Assuming control of the form ๐ข๐ข = ๐พ๐พ ๐ก๐ก ๐ฅ๐ฅ + ๐ฃ๐ฃ ๐ก๐ก and state space integration is bounded, a minimum attention LQR control law* can be formulated as a finite-dimensional optimization problem:
min๐๐๐๐,๐๐>0
๐ฝ๐ฝ๐๐๐ก๐ก๐ก๐ก = ๏ฟฝ๐ก๐ก0
๐ก๐ก๐๐๐พ๐พ(๐ก๐ก) 2 + ๏ฟฝฬ๏ฟฝ๐ขโ โ ๐พ๐พ(๐ก๐ก) ๏ฟฝฬ๏ฟฝ๐ฅโ 2๐๐๐ก๐ก
๐ข๐ข ๐ฅ๐ฅ, ๐ก๐ก = ๐พ๐พ ๐ก๐ก ๐ฅ๐ฅ โ ๐ฅ๐ฅโ ๐ก๐ก + ๐ข๐ขโ ๐ก๐ก๐พ๐พ ๐ก๐ก = โ๐ ๐ โ1๐ต๐ต๐๐ ๐ก๐ก ๐๐(๐ก๐ก)
โ๏ฟฝฬ๏ฟฝ๐ = ๐๐๐ด๐ด ๐ก๐ก + ๐ด๐ด๐๐ ๐ก๐ก โ ๐๐๐ต๐ต ๐ก๐ก ๐ ๐ โ1๐ต๐ต๐๐ ๐ก๐ก ๐๐ + ๐๐,๐๐ ๐ก๐ก๐๐ = ๐๐๐๐
x*,u* are given, e.g., as the outcome of some offline optimization procedure or supplied by the user.
An approximate solution
Numerical experiments for a 2-dof arm catching a ball while tracking a minimum torque change trajectory:
Feedback gains increase with timeFeedforward inputs decrease with time
Feedback gain Feedforward input
Example: Robot ball catching
Vision and Image Analysis
๐ด๐ด,๐ต๐ต,๐๐,๐๐ can be elements of ๐๐๐๐ 3 or ๐๐๐๐ 3
๐ด๐ด,๐ต๐ต are obtained from sensor measurements
๐๐,๐๐ are unknowns to be determined.
Two-frame sensor calibration
Two-frame sensor calibration
Given ๐๐ measurement pairs
Find the optimal pair that minimizes the fitting criterion.
Two-frame sensor calibration
โข are noisy; there does not exist any
that perfectly satisfies
โข Determine that minimizes
noisenoise
Multimodal image volume registration: Find optimal transformation that maximizes the mutual information between two image volumes.
Multimodal image registration
Detailed tissue structure provided by MRI (upper left) is combined with abnormal regions detected by PET (upper right). The red regions in the fused image represent the anomalous regions.
Problem definition: ๐๐โ = arg max๐๐
๐ผ๐ผ(๐ด๐ด ๐๐๐ฅ๐ฅ ,๐ต๐ต ๐ฅ๐ฅ ) where T is an element of some transformation group (SO(3), SE(3),
SL(3) are widely used). ๐ฅ๐ฅ โ โ3 are the volume coordinates, A,B are volume data, ๐ผ๐ผ โ ,โ is the mutual information criterion,
Evaluating the objective function is numerically expensive and analytic gradients are not available. Instead, it is common to resort to direct search methods like the Nelder-Mead algorithm.
Multimodal image registration
The above reduce to an optimization problem on matrix Lie groups: For the n-frame sensor calibration problem, the objective function reduces to
the form โ๐๐ ๐๐๐๐(๐๐๐ด๐ด๐๐๐๐๐๐๐ต๐ต๐๐ โ ๐๐๐ถ๐ถ๐๐). Analytic gradients and Hessians are available, and steepest descent along minimal geodesics seems to work quite well.
In the multimodal image registration problem, Nelder-Mead can be generalized to the group by using minimal geodesics as the edges of the simplex.
There is a well-developed literature on optimization on Lie groups, including generalizations of common vector space algorithms to matrix Lie groups and manifolds.
Optimization on matrix Lie groups
Each voxel is a 3D multivariate normal distribution. The mean indicates the position, while the covariance indicates the direction of diffusion of water molecules. Segmentation of a DTI image requires a metric on the manifold of multivariate Gaussian distributions.
Diffusion tensor image segmentation
Using the standard approach of calculating distances on the means and covariances separately, and summing the two for the total distance, results in dist(a,b) = dist(b,c), which is unsatisfactory.
In this example, water molecules are able to move more easily in the x-axis direction. Therefore, diffusion tensors (b) and (c) are closer than (a) and (b)
Geometry of DTI segmentation
An n-dimensional statistical manifold โณ is a set of probability distributions parametrized by some smooth, continuously-varying parameter ๐๐ โ โ๐๐.
๐ฅ๐ฅ
๐ฅ๐ฅ
๐๐1 โ โ๐๐๐๐2 โ โ๐๐
๐๐(๐ฅ๐ฅ|๐๐1)
๐๐(๐ฅ๐ฅ|๐๐2)
(โณ,๐๐)โ๐๐
Geometry of statistical manifolds
The Fisher information defines a Riemannian metric ๐๐on a statistical manifold โณ:
๐๐๐๐๐๐ ๐๐ = ๐ผ๐ผ๐ฅ๐ฅ ~๐๐(.|๐๐)๐๐ log ๐๐ ๐ฅ๐ฅ ๐๐
๐๐๐๐๐๐๐๐ log ๐๐ ๐ฅ๐ฅ ๐๐
๐๐๐๐๐๐
Connection to KL divergence:๐ท๐ท๐พ๐พ๐พ๐พ ๐๐ . ๐๐ ||๐๐ . ๐๐ + ๐๐๐๐ =
12๐๐๐๐๐๐๐๐ ๐๐ ๐๐๐๐ + ๐๐( ๐๐๐๐ 2)
Geometry of statistical manifolds
The manifold of Gaussian distributions ๐ฉ๐ฉ ๐๐๐ฉ๐ฉ ๐๐ = ๐๐ = ๐๐, ฮฃ ๐๐ โ โ๐๐,ฮฃ โ ๐ซ๐ซ(๐๐)} , where ๐ซ๐ซ ๐๐ = ๐๐ โ โ๐๐ร๐๐ ๐๐ = ๐๐๐๐ ,๐๐ โป 0}
Fisher information metric on ๐ฉ๐ฉ ๐๐๐๐๐ ๐ 2 = ๐๐๐๐๐๐๐๐ ๐๐ ๐๐๐๐ = ๐๐๐๐๐๐ฮฃโ1๐๐๐๐ +
12๐ก๐ก๐๐ ฮฃโ1๐๐ฮฃ 2
Euler-Lagrange equations for geodesics on ๐ฉ๐ฉ ๐๐๐๐2๐๐๐๐๐ก๐ก2
โ ๐๐ฮฃ๐๐๐ก๐กฮฃโ1 ๐๐๐๐
๐๐๐ก๐ก= 0
๐๐2ฮฃ๐๐๐ก๐ก2
+ ๐๐๐๐๐๐๐ก๐ก
๐๐๐๐๐๐
๐๐๐ก๐กโ ๐๐ฮฃ
๐๐๐ก๐กฮฃโ1 ๐๐ฮฃ
๐๐๐ก๐ก= 0
Geometry of Gaussian distributions
Geodesic Path on ๐ฉ๐ฉ 2
๐๐0 = 00 , ฮฃ0 = 1 0
0 0.1 , ๐๐1 = 11 , ฮฃ1 = 0.1 0
0 1
-0.2 0 0.2 0.4 0.6 0.8 1 1.2-0.2
0
0.2
0.4
0.6
0.8
1
1.2
1.4
Geometry of Gaussian distributions
Fisher information metric on ๐ฉ๐ฉ ๐๐ with fixed mean ๏ฟฝฬ ๏ฟฝ๐๐๐๐ ๐ 2 =
12๐ก๐ก๐๐ ฮฃโ1๐๐ฮฃ 2
Affine-invariant metric on ๐๐ ๐๐ Invariant under general linear group ๐บ๐บ๐บ๐บ(๐๐) action
ฮฃ โ ๐๐๐๐ฮฃ๐๐, ๐๐ โ ๐บ๐บ๐บ๐บ ๐๐which implies coordinate invariance. Closed-form geodesic distance
๐๐๐ซ๐ซ(๐๐) ฮฃ1, ฮฃ2 = ๏ฟฝ๐๐=1
๐๐
(log ๐๐๐๐(ฮฃ1โ1ฮฃ2))21/2
Restriction to covariances
Using covarianceand Euclidean distance Using MND distance
Results of segmentation for brain DTI
Human and Robot Model Identification
Need to identify mass-inertial parameters ฮฆ.ฮฆ is linear with respect to the
dynamics.
Inertial parameter identificationDynamics:
๏ฟฝฬ๏ฟฝ๐ = ๐๐ โ ๐ฝ๐ฝ๐๐ ๐๐ ๐น๐น๐๐๐ฅ๐ฅ๐ก๐ก= ๐๐ ๐๐,ฮฆ ๏ฟฝฬ๏ฟฝ๐ + ๐๐ ๐๐, ๏ฟฝฬ๏ฟฝ๐,ฮฆ
= ฮ ๐๐, ๏ฟฝฬ๏ฟฝ๐, ๏ฟฝฬ๏ฟฝ๐ โ ฮฆ
Rigid body mass-inertial properties
๐ผ๐ผ๐๐ =๐ผ๐ผ๐๐๐ฅ๐ฅ๐ฅ๐ฅ ๐ผ๐ผ๐๐
๐ฅ๐ฅ๐ฆ๐ฆ
๐ผ๐ผ๐๐๐ฅ๐ฅ๐ฆ๐ฆ ๐ผ๐ผ๐๐
๐ฆ๐ฆ๐ฆ๐ฆ๐ผ๐ผ๐๐๐ฅ๐ฅ๐ง๐ง
๐ผ๐ผ๐๐๐ฆ๐ฆ๐ง๐ง
๐ผ๐ผ๐๐๐ฅ๐ฅ๐ง๐ง ๐ผ๐ผ๐๐๐ฆ๐ฆ๐ง๐ง ๐ผ๐ผ๐๐๐ง๐ง๐ง๐ง
๐๐
๐๐๏ฟฝโ๏ฟฝ๐
Clearly ๐๐ > 0 and ๐ผ๐ผ๐๐ > 0 The fact that ๐ผ๐ผ๐๐ > 0 is necessary but
not sufficient: Because mass density is non-negative everywhere, the following must also hold:
๐๐๐๐ + ๐๐๐๐ > ๐๐๐๐๐๐๐๐ + ๐๐๐๐ > ๐๐๐๐๐๐๐๐ + ๐๐๐๐ > ๐๐๐๐
where ๐๐1, ๐๐2, ๐๐3 are the eigenvalues of ๐ผ๐ผ๐๐ (so-called triangle inequality relation for rigid body inertias)
Rigid body mass-inertial properties
โ๐๐ = ๐๐ โ ๐๐๐๐
๐ผ๐ผ๐๐ =๐ผ๐ผ๐๐๐ฅ๐ฅ๐ฅ๐ฅ ๐ผ๐ผ๐๐
๐ฅ๐ฅ๐ฆ๐ฆ
๐ผ๐ผ๐๐๐ฅ๐ฅ๐ฆ๐ฆ ๐ผ๐ผ๐๐
๐ฆ๐ฆ๐ฆ๐ฆ๐ผ๐ผ๐๐๐ฅ๐ฅ๐ง๐ง
๐ผ๐ผ๐๐๐ฆ๐ฆ๐ง๐ง
๐ผ๐ผ๐๐๐ฅ๐ฅ๐ง๐ง ๐ผ๐ผ๐๐๐ฆ๐ฆ๐ง๐ง ๐ผ๐ผ๐๐๐ง๐ง๐ง๐ง
๐๐
๐๐๐๐๐๐
๐๐๏ฟฝโ๏ฟฝ๐
For the purposes of dynamic calibration it is more convenient to identify the inertia parameters with respect to a body frame {b}, i.e., the six parameters associated with ๐ผ๐ผ๐๐ , the three parameters associated with โ๐๐, and the mass ๐๐, resulting in a total of 10 parameters, denoted ๐๐ โ โ10, per rigid body.
Wensing et al (2017) showed that Traversaroโs sufficiency conditions are equivalent to the following:
๐๐ ๐๐ =๐๐๐๐ โ๐๐โ๐๐๐๐ ๐๐ โ โ4ร4
is positive definite (i.e. ๐๐ ๐๐ โ ๐ซ๐ซ(4)) , where๐๐๐๐ = โซ ๐ฅ๐ฅ๐ฅ๐ฅ๐๐๐๐ ๐ฅ๐ฅ ๐๐๐๐ = 1
2๐ก๐ก๐๐ ๐ผ๐ผ๐๐ โ ๐๐ โ ๐ผ๐ผ๐๐
with ๐๐ ๐ฅ๐ฅ the mass density function.
Rigid body mass-inertial properties
Let ๐๐๐๐ โ โ10 be the inertial parameters for link ๐๐, and ฮฆ = ๐๐1,โฏ ,๐๐๐๐ โ โ10๐๐.
Sampling the dynamics at T time instances, the identification problem reduces to a least-squares problem:
๐จ๐จ โ ๐ฑ๐ฑ = ๐๐ โ โ๐๐๐๐
where ๐ด๐ด =ฮ ๐๐(๐ก๐ก1 , ๏ฟฝฬ๏ฟฝ๐ ๐ก๐ก1 , ๏ฟฝฬ๏ฟฝ๐(๐ก๐ก1)) โ โ๐๐ร10๐๐
โฎฮ ๐๐(๐ก๐ก๐๐ , ๏ฟฝฬ๏ฟฝ๐ ๐ก๐ก๐๐ , ๏ฟฝฬ๏ฟฝ๐(๐ก๐ก๐๐)) โ โ๐๐ร10๐๐
=๐๐1๐๐โฎ
๐๐๐๐๐๐๐๐and ๐๐ =
๏ฟฝฬ๏ฟฝ๐ ๐ก๐ก1 โ โ๐๐
โฎ๏ฟฝฬ๏ฟฝ๐(๐ก๐ก๐๐) โ โ๐๐
=๐๐1โฎ
๐๐๐๐๐๐
๐ท๐ท should also satisfy๐ท๐ท ๐๐๐๐ > ๐๐ , ๐๐ = ๐๐,โฏ ,๐ต๐ต.
Inertial parameter identification
ฮฆโณ๐๐ โ ๐ซ๐ซ 4 ๐๐
โ10๐๐
โ2 โ3
โ1 โ๐๐๐๐
Find ฮฆ in โณ๐๐ โ ๐ซ๐ซ 4 ๐๐ closest to each of the hyperplanes โ๐๐ =๐ฅ๐ฅ โถ ๐๐๐๐๐๐๐ฅ๐ฅ = ๐๐๐๐ . Implies the need for a distance metric ๐๐(โ ,โ ) on ฮฆ.
Geometry of ๐จ๐จ โ ๐ฑ๐ฑ = ๐๐
minฮฆ, ๏ฟฝฮฆ๐๐ i=1
mk๏ฟฝ๐๐=1
๐๐๐๐
๐ค๐ค๐๐ โ ๐๐ ฮฆ, ๏ฟฝฮฆ๐๐2 + ๐พ๐พ โ ๐๐ ฮฆ, ๏ฟฝฮฆ0
2
regularizationterm
s.t.๏ฟฝฮฆ๐๐ โ โ๐๐ , ๐๐ = 1,โฏ ,๐๐๐๐
๏ฟฝฮฆ๐๐ : Projection of ฮฆ onto โ๐๐ ๐๐ = 1,โฏ ,๐๐๐๐๏ฟฝฮฆ0 : Nominal values (from, e.g., CAD orstatistical data)
For Standard Euclidean metric on ฮฆ : ๐๐ ฮฆ, ๏ฟฝฮฆ = ฮฆโ ๏ฟฝฮฆ
Geometry of ordinary least squares
ฮฆโณ๐๐ โ ๐ซ๐ซ 4 ๐๐
โ2 โ3
โ1 โ๐๐๐๐
โ10๐๐
ฮฆ1
ฮฆ2ฮฆ3
ฮฆ๐๐๐๐
ฮฆ0
Ordinary least squaresminฮฆ
๐ด๐ดฮฆ โ ๐๐ 2 + ๐พ๐พ ฮฆ โ ๏ฟฝฮฆ02
๐๐๐๐๐๐๐๐๐๐๐๐๐๐๐๐๐ง๐ง๐๐๐ก๐ก๐๐๐๐๐๐โ๐ก๐ก๐๐๐๐๐๐
with closed-form solution ฮฆ๐พ๐พ๐๐ = ๐ด๐ด๐๐๐ด๐ด + ๐พ๐พ๐ผ๐ผ โ1
(๐ด๐ด๐๐๐๐ + ๐พ๐พฮฆ0) is equivalent to the following :
minฮฆ, ๏ฟฝฮฆ๐๐ i=1
mk๏ฟฝ๐๐=1
๐๐๐๐
๐๐๐๐ 2 ฮฆ โ ๏ฟฝฮฆ๐๐2 + ๐พ๐พ ฮฆ โ ๏ฟฝฮฆ0
2
regularizationterm
s.t.๏ฟฝฮฆ๐๐ โ โ๐๐ , ๐๐ = 1,โฏ ,๐๐๐๐๏ฟฝฮฆ๐๐ : Euclidean Projection of ฮฆ onto โ๐๐
๏ฟฝฮฆ0 : Prior value
Geodesic distance based least-squares solution:
๐๐โณ๐๐ ฮฆ, ๏ฟฝฮฆ = โ๐๐=1๐๐ ๐๐๐ซ๐ซ 4 ๐๐ ๐๐๐๐ ,๐๐ ๏ฟฝ๐๐๐๐
Using geodesic distance on P(n)
minฮฆ, ๏ฟฝฮฆ๐๐ i=1
mk๏ฟฝ๐๐=1
๐๐๐๐
๐ค๐ค๐๐ โ ๐๐โณ๐๐ ฮฆ, ๏ฟฝฮฆ๐๐2 + ๐พ๐พ๐๐โณ๐๐ ฮฆ, ๏ฟฝฮฆ0
2
๐๐๐๐๐๐๐๐๐๐๐๐๐๐๐๐๐ง๐ง๐๐๐ก๐ก๐๐๐๐๐๐โ๐ก๐ก๐๐๐๐๐๐
s.t.๏ฟฝฮฆ๐๐ โ โ๐๐ , ๐๐ = 1,โฏ ,๐๐๐๐
โ10๐๐
ฮฆโณ๐๐ โ ๐ซ๐ซ 4 ๐๐
โ2 โ3
โ1 โ๐๐๐๐
ฮฆ1
ฮฆ2
ฮฆ3
ฮฆ๐๐๐๐
ฮฆ0
๏ฟฝฮฆ๐๐ : Geodesic Projection of ฮฆ onto โ๐๐
๏ฟฝฮฆ0 : Prior value
Example
Prior
Ordinary least-squares with LMI
Geodesic distance on P(n)
Mass deviations
Mass deviations
Machine Learning
Manifold hypothesis Consider vector representation of data, e.g., an image, as ๐ฅ๐ฅ โ โ๐ท๐ท
Meaningful data lie on a ๐๐-dim. manifold in โ๐ท๐ท, ๐๐ โช ๐ท๐ท Ex) image of number โ7โ
โ๐ท๐ท
โฎ
๐ฅ๐ฅ โ โ๐ท๐ท
A random vector in โ๐ท๐ท
Manifold learning and dimension reductionGiven data ๐ฅ๐ฅ๐๐ ๐๐=1,โฏ,๐๐, ๐ฅ๐ฅ๐๐ โ โ๐ท๐ท, find a map ๐๐ from data space to
lower dimensional space while minimizing a global measure of distortion:
Existing methods Linear methods: PCA (Principal Component Analysis), MDS (Multi-
Dimensional Scaling), โฆ Nonlinear methods (manifold learning): LLE (Locally Linear Embedding),
Isomap, LE (Laplacian Eigenmap), DM (Diffusion Map), โฆ
๐๐โ๐ท๐ท
usually โ๐๐, ๐๐ โช ๐ท๐ท
๐ฅ๐ฅ๐๐ โ โ๐ท๐ท๐๐(๐ฅ๐ฅ๐๐) โ โ๐๐
Coordinate-Invariant Distortion Measures Consider a smooth map ๐๐:โณ โ๐ฉ๐ฉ between two compact
Riemannian manifolds (โณ,๐๐): local coord. ๐ฅ๐ฅ = (๐ฅ๐ฅ1,โฏ , ๐ฅ๐ฅ๐๐), Riemannain metric ๐บ๐บ = (๐๐๐๐๐๐) (๐ฉ๐ฉ,โ): local coord. ๐ฆ๐ฆ = (๐ฆ๐ฆ1,โฏ ,๐ฆ๐ฆ๐๐), Riemannian metric ๐ป๐ป = (โ๐ผ๐ผ๐ฝ๐ฝ)
Isometry Map preserving length, angle, and volume - the ideal case of no distortion If dim โณ โค dim(๐ฉ๐ฉ), ๐๐ is an isometry when ๐ฑ๐ฑ ๐๐ โค๐ฏ๐ฏ(๐๐(๐๐))๐ฑ๐ฑ(๐๐) = ๐ฎ๐ฎ(๐๐) for
all ๐ฅ๐ฅ โ โณ, where ๐ฝ๐ฝ = ๐๐๐๐๐ผ๐ผ
๐๐๐ฅ๐ฅ๐๐โ โ๐๐ร๐๐
๐๐
โณ ๐ฉ๐ฉ
๐๐
๐๐(๐๐)
๐๐
๐๐(๐๐)๐ฃ๐ฃ ๐ค๐ค
๐๐๐๐๐๐(๐ฃ๐ฃ)๐๐๐๐๐๐(๐ค๐ค)๐๐๐๐โณ
๐๐๐๐(๐๐)๐ฉ๐ฉ
๐๐๐๐๐ฅ๐ฅ:๐๐๐ฅ๐ฅโณ โ ๐๐๐๐(๐ฅ๐ฅ)๐ฉ๐ฉ is the differential of ๐๐:โณ โ๐ฉ๐ฉ
Coordinate-Invariant Distortion Measures Comparing pullback metric ๐ฝ๐ฝโค๐ป๐ป๐ฝ๐ฝ(๐๐) to ๐บ๐บ(๐๐)
Let ๐๐1,โฏ , ๐๐๐๐ be roots of det ๐ฝ๐ฝโค๐ป๐ป๐ฝ๐ฝ โ ๐๐๐บ๐บ = 0(๐๐1,โฏ , ๐๐๐๐ = 1 in the case of isometry) ๐๐(๐๐1,โฏ , ๐๐๐๐) denote any symmetric function, e.g., ๐๐(๐๐1,โฏ , ๐๐๐๐) = โ๐๐=1๐๐ 1
2๐๐๐๐ โ 1 2
Global distortion measure
๏ฟฝโณ๐๐(๐๐1,โฏ , ๐๐๐๐) det๐บ๐บ ๐๐๐ฅ๐ฅ1 โฏ๐๐๐ฅ๐ฅ๐๐
๐๐๐๐๐๐โณ ๐บ๐บ(๐๐)
๐ฝ๐ฝ๐๐๐ป๐ป๐ฝ๐ฝ(๐๐)
๐๐
โณ
๐ป๐ป(๐๐(๐๐))
๐๐(๐๐)
๐๐๐๐(๐๐)๐ฉ๐ฉ
๐ฉ๐ฉpullback metric
Harmonic Maps Assume ๐๐ ๐๐1,โฏ , ๐๐๐๐ = โ๐๐=1๐๐ ๐๐๐๐, and boundary conditions ๐๐๐ฉ๐ฉ = ๐๐(๐๐โณ)
are given Define the global distortion measure as
๐ท๐ท ๐๐ = ๏ฟฝโณ
๐๐๐๐ ๐ฝ๐ฝโค๐ป๐ป๐ฝ๐ฝ๐บ๐บโ1 det๐บ๐บ ๐๐๐ฅ๐ฅ1 โฏ๐๐๐ฅ๐ฅ๐๐
Extremals of ๐ท๐ท ๐๐ are known as harmonic maps Variational equation (for ๐ผ๐ผ = 1,โฏ ,๐๐)
๏ฟฝ๐๐=1
๐๐
๏ฟฝ๐๐=1
๐๐1
det๐บ๐บ๐๐๐๐๐ฅ๐ฅ๐๐
๐๐๐๐๐ผ๐ผ
๐๐๐ฅ๐ฅ๐๐๐๐๐๐๐๐ det๐บ๐บ + ๏ฟฝ
๐ฝ๐ฝ=1
๐๐
๏ฟฝ๐พ๐พ=1
๐๐
๐๐๐๐๐๐ฮ๐ฝ๐ฝ๐พ๐พ๐ผ๐ผ ๐๐๐๐๐ฝ๐ฝ
๐๐๐ฅ๐ฅ๐๐๐๐๐๐๐พ๐พ
๐๐๐ฅ๐ฅ๐๐= 0
where ๐๐๐๐๐๐ is (๐๐, ๐๐) entry of ๐บ๐บโ1, ฮ๐ฝ๐ฝ๐พ๐พ๐ผ๐ผ denote the Christoffel symbols of the second kind
Physical interpretation: Wrap marble (๐๐) with rubber (๐๐) (Harmonic maps correspond to elastic equilibria)
โณ
๐ฉ๐ฉ ๐๐
Examples of Harmonic Maps Lines (๐๐: 0, 1 โ [0, 1]) ๐ท๐ท ๐๐ = โซ0
1 ฬ๐๐2๐๐๐ก๐ก ฬ๐๐ = 0
Geodesics (๐๐: 0, 1 โ ๐ฉ๐ฉ) ๐ท๐ท ๐๐ = โซ0
1 ฬ๐๐โค๐ป๐ป ฬ๐๐๐๐๐ก๐ก
๐๐2๐๐๐ผ๐ผ
๐๐๐ก๐ก2+ โ๐ฝ๐ฝ=1
๐๐ โ๐พ๐พ=1๐๐ ฮ๐ฝ๐ฝ๐พ๐พ๐ผ๐ผ ๐๐๐๐๐ฝ๐ฝ
๐๐๐ก๐ก๐๐๐๐๐พ๐พ
๐๐๐ก๐ก= 0
Laplaceโs equation on โ2 (๐๐: โ2 โ โ) ๐ป๐ป2๐๐ = 0 Harmonic functions
2R Spherical mechanism (๐๐:๐๐2 โ ๐๐2) ๐๐๐ ๐ 2 = ๐๐1๐๐๐ข๐ข12 + ๐๐2๐๐๐ข๐ข22, ๐๐1๐๐2 = 1 ๐ท๐ท ๐๐ = ๐๐2(๐๐1 + 2๐๐2), ๐๐1โ = 2, ๐๐2โ = 1/ 2
๐๐ 0 = 0 ๐๐ 1 = 1
๐ฉ๐ฉ
๐๐ 0 = ๐๐๐๐ 1 = ๐๐
๐ข๐ข1
๐ข๐ข2
Harmonic Maps and Robot KinematicsOpen chain planar mechanism (๐๐:๐๐๐๐ โ SE(2)) ๐๐ ๐ฅ๐ฅ1,โฏ , ๐ฅ๐ฅ๐๐ = ๐๐๐๐๐ด๐ด1๐ฅ๐ฅ1 โฏ ๐๐๐ด๐ด๐๐๐ฅ๐ฅ๐๐ ๐ท๐ท ๐๐ = ๐บ๐บ12 + 2๐บ๐บ22 + โฏ+ ๐๐๐บ๐บ๐๐2 ๐๐ + ๐๐๐๐ Optimal link length: ๐บ๐บ1โ ,โฏ , ๐บ๐บ๐๐โ = (1, 1
2, 13
,โฏ , 1๐๐
)
3R Spherical mechanism (๐๐:๐๐3 โ SO(3)) ๐๐ ๐ฅ๐ฅ1, ๐ฅ๐ฅ2, ๐ฅ๐ฅ3 = ๐๐๐ด๐ด1๐ฅ๐ฅ1๐๐๐ด๐ด2๐ฅ๐ฅ2๐๐๐ด๐ด3๐ฅ๐ฅ3 ๐ท๐ท ๐๐ is invariant to ๐ผ๐ผ,๐ฝ๐ฝ Workspace volume ๐๐ ๐๐ = sin๐ผ๐ผ sin๐ฝ๐ฝ Volume(SO(3)) ๐ผ๐ผ = 90ยฐ,๐ฝ๐ฝ = 90ยฐ maximize the workspace volume
๐ด๐ด1
๐ด๐ด2๐ด๐ด3
๐บ๐บ1 = 6
๐บ๐บ2 = 3๐บ๐บ3 = 2
๐ผ๐ผ๐ฝ๐ฝ
๐ฅ๐ฅ1
๐ฅ๐ฅ2
๐ฅ๐ฅ3
๐ด๐ด1
๐ด๐ด2
๐ด๐ด3
3-link finger example
3-link spherical wrist mechanism
Taxonomy of Manifold Learning Algorithmsโณ ๐ฉ๐ฉ ๐ฎ๐ฎโ๐๐
(inverse pseudo-metric) ๐ฏ๐ฏ ๐๐(๐๐) Volume form Constraint
LLE(Locally Linear
Embedding)
Bounded region in โ๐ท๐ท
containing data points โ๐๐ฮ๐ฅ๐ฅฮ๐ฅ๐ฅโค
(ฮ๐ฅ๐ฅ is local reconstruction error obtained when running the algorithm)
๐ผ๐ผ ๏ฟฝ๐๐=1
๐๐
๐๐๐๐ ๐๐ ๐ฅ๐ฅ ๐๐๐ฅ๐ฅ ๏ฟฝโณ๐๐ ๐ฅ๐ฅ ๐๐ ๐ฅ๐ฅ โค๐๐ ๐ฅ๐ฅ ๐๐๐ฅ๐ฅ = ๐ผ๐ผ
LE(Laplacian Eigenmap)
Same as above โ๐๐ ๏ฟฝโณโฉ๐ต๐ต๐๐(๐ฅ๐ฅ)
๐๐ ๐ฅ๐ฅ, ๐ง๐ง ๐ฅ๐ฅ โ ๐ง๐ง ๐ฅ๐ฅ โ ๐ง๐ง โค๐๐ ๐ง๐ง ๐๐๐ง๐ง ๐ผ๐ผ ๏ฟฝ๐๐=1
๐๐
๐๐๐๐ ๐๐ ๐ฅ๐ฅ ๐๐๐ฅ๐ฅ ๏ฟฝโณ๐๐(๐ฅ๐ฅ)๐๐ ๐ฅ๐ฅ ๐๐ ๐ฅ๐ฅ โค๐๐ ๐ฅ๐ฅ ๐๐๐ฅ๐ฅ = ๐ผ๐ผ
(๐๐ ๐ฅ๐ฅ = โซโณโฉ๐ต๐ต๐๐(๐ฅ๐ฅ) ๐๐ ๐ฅ๐ฅ, ๐ง๐ง ๐๐ ๐ง๐ง ๐๐๐ง๐ง)
DM(Diffusion
Map)Same as above โ๐๐ ๏ฟฝ
โณโฉ๐ต๐ต๐๐(๐ฅ๐ฅ)๐๐ ๐ฅ๐ฅ, ๐ง๐ง ๐ฅ๐ฅ โ ๐ง๐ง ๐ฅ๐ฅ โ ๐ง๐ง โค๐๐๐ง๐ง ๐ผ๐ผ ๏ฟฝ
๐๐=1
๐๐
๐๐๐๐ 1๐๐๐ฅ๐ฅ ๏ฟฝโณ๐๐ ๐ฅ๐ฅ ๐๐ ๐ฅ๐ฅ โค๐๐๐ฅ๐ฅ = ๐ผ๐ผ
๐๐(๐ฅ๐ฅ, ๐ฆ๐ฆ) is a kernel function usually chosen by the user
Using heat kernel ๐๐ ๐ฅ๐ฅ, ๐ฆ๐ฆ = 4๐๐โ โ๐๐/2 exp(โ ๐ฅ๐ฅโ๐ง๐ง 2
4โ)
gives a way to estimate the Laplace-Beltrami operator
Manifold learning algorithms such as LLE, LE, DM share a similar objective as harmonic maps while having equality constraint to avoid trivial solution ๐๐ = ๐๐๐๐๐๐๐ ๐ ๐ก๐ก.โ โ๐๐
Example: Swiss roll (diffusion map)
Flattened swiss roll
: data points
Diffusion map embedding
Swiss roll data (2-dim manifold in 3-dim space)
Example: Swiss roll (geometric distortion)
๐๐(๐๐) = โ๐๐=1๐๐ 12๐๐๐๐ โ 1 2
Harmonic mapping + ๐๐(๐๐) = โ๐๐=1๐๐ 1
2๐๐๐๐ โ 1 2
for boundary pointsFlattened swiss roll
: boundary points
: data points
Swiss roll data (2-dim manifold in 3-dim space)
Minimum distortion results
Example: FacesMin distortion
(๐๐(๐๐) = โ๐๐=1๐๐ 12๐๐๐๐ โ 1 2)
Laplacian eigenmap embedding
headingangle
mouthshapeheading
angle mouthshape
headingangle
Min distortion (Harmonic mapping + ๐๐(๐๐) = โ๐๐=1๐๐ 1
2๐๐๐๐ โ 1 2 for boundary points)
mouthshape
Original face image located on embedding
coordinates
Embedding coordinate
Concluding Remarks
Geometric methods have unquestionably been effective in solving a wide range of problems in roboticsMany problems in perception, planning, control,
learning, and other aspects of robotics can be reduced to a geometric problem, and geometric methods offer a powerful set of coordinate-invariant tools for their solution.
Concluding Remarks
References
(http://robotics.snu.ac.kr/fcp)
Robot Mechanics and Control
"Modern Robotics: Mechanics, Planning, and Control," KM Lynch, FC Park, Cambridge University Press, 2017 (http://modernrobotics.org)
โA Mathematical Introduction to Robotic Manpulation,โ RM Murray, ZX Li, S Sastry, CRC Press, 1994
A Lie group formulation of robot dynamics, FC Park, J Bobrow, S Ploen, Int. J. Robotics Research, 1995
Distance metrics on the rigid body motions with applications to kinematic design, FC Park, ASME J. Mech. Des., 1995
Singularity analysis of closed kinematic chains, Jinwook Kim, FC Park, ASME J. Mech. Des, 1999
Kinematic dexterity of robotic mechanisms, FC Park, R. Brockett, Int. J. Robotics Research, 1994
Least squares tracking on the Euclidean group, IEEE Trans. Autom. Contr., Y. Han and F.C. Park, 2001
Newton-type algorithms for dynamics-based robot motion optimization, SH Lee, JG Kim, FC Park et al, IEEE Trans. Robotics, 2005
References
Trajectory Optimization and Motion Planning
Newton-type algorithms for dynamics-based robot motion optimization, SH Lee, JG Kim, FC Park et al, IEEE Trans. Robotics, 2005
Smooth invariant interpolation of rotations, FC Park and B. Ravani, ACM Trans. Graphics, 1997
Progress on the algorithmic optimization of robot motion, A Sideris, J Bobrow, FC Park, in Lecture Notes in Control and Information Sciences, vol. 340, Springer-Verlag, October 2006
Convex optimization algorithms for active balancing of humanoid robots, Juyong Park, J Haan, FC Park, IEEE Trans. Robotics, 2007
Tangent bundle RRT: a randomized algorithm for constrained motion planning, B Kim, T Um, C Suh, FC Park, Robotica, 2016
Randomized path planning for tasks requiring the release and regrasp of objects, J Kim, FC Park, Advanced Robotics, 2016
Randomized path planning on vector fields, I Ko, FC Park, Int. J. Robotics Res., 2014
Motion optimization using Gaussian processs dynamical models, H Kang, FC Park, Multibody Sys. Dyn. 2014
References
Vision and Image Analysis
Numerical optimization on the Euclidean group with applications to camera calibration, S Gwak, JG Kim, FC Park, IEEE Trans. Robotics Autom., 2003.
Geometric direct search algorithms for image registration, S Lee, M Choi, H. Kim, FC Park, IEEE Trans. Image Proc., 2007.
Particle filtering on the Euclidean group: framework and applications, JH Kwon, M Choi, FC Park, CM Chun, Robotica, 2007.
Visual tracking via particle filtering on the affine group, JH Kwon, FC Park, Int. J. Robotics Res., 2010.
A geometric particle filter for template-based visual tracking, JH Kwon, HS Lee, FC Park, KM Lee, IEEE Trans. PAMI, 2014
DTI segmentation and fiber tracking using metrics on multivariate normal distributions, M Han, FC Park, J. Math. Imaging and Vision, 2014
A stochastic global optimization algorithm for the two-frame sensor calibration problem, JH Ha, DH Kang, FC Park, IEEE Trans. Ind. Elec 2016
References
Attention, Learning, Geometry
A minimum attention control law for ball catching, CJ Jang, JE Lee, SH Lee, FC Park, Bioinsp. Biomim. 2015
Kinematic feedback control laws for generating natural arm movements, DH Kim, CJ Jang, FC Park, Bioinsp. Biomim. 2013
Kinematic dexterity of robotic mechanisms, FC Park, RW Brockett, Int. J. Robotics Res. 1994
References