Robotic systems using learning to provide real-time vibration-suppressing control

Information

  • Patent Grant
  • 11701774
  • Patent Number
    11,701,774
  • Date Filed
    Wednesday, December 16, 2020
    3 years ago
  • Date Issued
    Tuesday, July 18, 2023
    a year ago
Abstract
A robot control method, and associated robot controllers and robots operating with such methods and controllers, providing real-time vibration suppression. The control method involves learning to support real-time, vibration-suppressing control. The method uses state-of-the-art machine learning techniques in conjunction with a differentiable dynamics simulator to yield fast and accurate vibration suppression. Vibration suppression using offline simulation approaches that can be computationally expensive may be used to create training data for the controller, which may be provide by a variety of neural network configurations. In other cases, sensory feedback from sensors onboard the robot being controlled can be used to provide training data to account for wear of the robot's components.
Description
BACKGROUND
1. Field of the Description

The present description relates, in general, to robots (or “robotic systems” or “robotic characters”) and control systems and methods for such robots. More particularly, the description relates to a method of generating control signals, in real-time, for a robotic system or robot (and to controllers implementing such a method and robotic systems or robots with such controllers) that provides, via learning, computational vibration suppression during the operations and movements of the robotic system or robot.


2. Relevant Background

Audio-animatronic figures and other robotic systems often suffer from unwanted vibrations during their operations. In particular, robotic systems or robots often will experience undesirable vibrations when undergoing fast and dynamic motions such as may be useful in a robotic character to provide expressive animations. For example, a robot may have an arm or leg that they move quickly from one location to a second location to provide a desired movement or move to a new pose, and the robot's arm or leg may vibrate significantly upon stopping at the second location. This can be undesirable when trying to replicate a particular character's movements, when trying to provide human-like motions, and so on.


Robotic systems are typically designed to be as stiff as possible, but, unfortunately, the physical system is rarely sufficiently stiff to behave like an idealized mechanical system whose components are assumed to be perfectly rigid. Hence, in real, implemented robotic systems, the unwanted vibrations will arise from compliance and deformation in both the joints and the components of the robotic system. This makes the task of animating the physical system a very challenging and tedious endeavor. In an ideal design world, the robot designers could rig a robotic character, have a skilled animator provide realistic, plausible, and natural-looking animations cycles, and then replay these animations directly on the physical system (i.e., the robot whose control is being designed). In reality, though, these animations may often lead to unwanted vibrations, which forces the designer to manually tune the motion trajectories (e.g., slow the movements down) while running experiments on the physical robot in order to try to avoid the vibrations.


Hence, there remains a need for a new method of generating control signals (and a new robot controller implementing such methods and robots/robotic systems with such controllers) to control operations of a robotic system so as to reduce (or even eliminate in some cases) unwanted vibrations of the robotic system components such as during rapid movements.


SUMMARY

With the above vibration issues in mind, a robot control method (and associated robot controllers and robots operating with such methods and controllers) is described herein that provides real-time computational vibration suppression with an onboard robotic system controller.


In some prior approaches, computational vibration techniques were performed offline in a design stage for a controller defining control signals (or trajectories set by such control signals). Given a desired animation cycle for a robotic system or robot, the control method (or its vibration suppression routine or controller module) used a dynamic simulation of the physical robot. This simulation, which takes into account the flexible components of the robot, was adapted to predict if vibrations will be seen in the physical robot or robotic system. If vibrations were predicted to be present with the input animation cycle, the control method optimized the set of motor trajectories to return a set of trajectories that were as close as possible to the artistic or original intent of the provider of the animation cycle, while minimizing unwanted vibration. Designing for stiffness leads to robotic systems that tend to be heavy, which requires strong and expensive motors to drive them. In contrast, the control method/design tool that suppresses unwanted vibrations allowed a robot designer to use lighter and/or softer (less stiff) and, therefore, less expensive systems in new robots. In other words, the offline design/control method shifted design complexity toward computation.


The computational framework developed for this offline approach took as input animations (e.g., artist-specification of an animation that defines time-varying angles for motors or the like). The computational framework changed the animations, e.g., the time-varying motor angles, to minimize (or at least reduce) the difference between simulated and target trajectories of a set of user-selected (or controller selected) points on mechanical components such as the hands, feet, and/or joints of a robotic system. To be able to predict vibrations, the components of the robot were modeled as flexible bodies, such as by discretizing them with finite elements, and the dynamic behavior of the flexible bodies were then simulated while replaying target animations. The flexible bodies were coupled to rigid bodies at either end and then simulated as part of a multibody dynamics formulation. To estimate damping and stiffness parameters of components, motion-tracking markers were placed on the physical system, and parameters were tuned to make the simulations closely match the behavior of the physical systems. The inventors have also modeled the compliance in motors. For human-scale animatronics, this can be an important ingredient to effectively suppress visible vibrations.


It was understood with this offline approach that the state of a dynamical system at a particular timestep is dependent on the states of all previous timesteps. Hence, to compare simulated trajectories to target trajectories, a full animation cycle should be simulated to be able to compare the performance to creative targets. To reduce time complexity in simulations, a reduced model may be used for FEM simulations of components. To computationally suppress vibrations, the difference between simulated and target trajectories is compared for a set of user-selected (or controller selected) points on the robotic system. Then, taking the entire motion trajectory into account, the motion profiles of the motors (time varying angles or the like) were optimized to reduce the visible vibrations. Further, this prior vibration suppression approach for a robotic controller (or design of control signals for a robotic system) was tested on very soft (lower stiffness) systems of increasing complexity. While smaller in size than many animatronic devices, thin rod-like components in experimental setups were useful in generating very soft robotic systems that can be translated into design of larger robots. The model was also extended so as to include human-sized figures where a main source of compliance are motors. The components of these figures can either be rigid enough to be represented with rigid components, thicker components represented with Finite Elements, or rod-like as for smaller robotic characters. The testing showed, that the computational technique was very effective in suppressing vibrations while staying close to the input trajectories (e.g., artist-provided animations defining trajectories).


While this computational technique successfully suppresses vibrations and enables the uncompromised (within the limits of the underlying hardware) automated transfer of animations onto a robotic system (e.g., a robotic character), the optimization is far from being real-time as it can take hours to finish. Hence, there remains a need for the new real-time vibration suppression control techniques described herein. The prior computational approaches to vibration suppression are not useful for real-time control in part due to the complexity of the simulation representation for the robotic system. For example, the flexibility or compliance in assembly components is accounted for with high-resolution finite element representations, which makes simulations computationally expensive. In brief, the prior approach provided a desired prediction accuracy but not the speed needed for use in real-time vibration suppression control. This speed is provided with the new control methods and corresponding controllers. These use state-of-the-art machine learning techniques in conjunction with a differentiable dynamics simulator to yield control signals useful for providing fast and accurate vibration suppression, e.g., with an onboard robotic controller or the like.


More particularly, a robotic system is provided that is configured for real-time vibration-suppressing control. The robotic system includes a plurality of components, connected together by mechanical joints. For modeling purposes, either a subset of components, or a subset of joints, or a combination of the two, may be considered as being flexible and therefore a source of compliance. In the case of flexible components, in practice, at least a portion of the flexible components are coupled at opposite ends to at least one of the rigid components. The robotic system also includes memory storing input comprising unfiltered control parameters specifying motion of the components over a time period. To drive the robot's components, the system includes a plurality of actuators (e.g., motors and the like) operable in response to control signals to impart the motion of the components over the time period. These actuators may also be modeled as being sources of compliance.


Significantly, the robotic system also includes a controller. The controller includes a processor communicatively linked to the memory and an optimizer provided by the processor running software. The optimizer generates filtered control parameters defining a retargeted motion for the components by adjusting the defined motion to suppress a portion of the vibrations. Further, though, the optimizer is trained via machine learning based on a set of training data prior to generating the retargeted motion, and the controller generates the control signals for operating the actuators based on the filtered control parameters. In some embodiments, the system further includes a plurality of sensors monitoring operations of the robotic system, and the training data includes sensory feedback from the plurality of sensors.


In the same or other embodiments, the optimizer is or includes a neural network configured for the machine learning and to take as input the unfiltered control parameters and output the filtered control parameters. For example, the neural network may be provided with layers of at least one of 1D convolutional networks and 1D recurrent neural networks. In such cases, the neural network may include a final node in the form of a differentiable simulator. The differentiable simulator performs a dynamic simulation of the robotic system performing the retargeted motions with the first and second sets of the components, and the dynamic simulation predicts vibrations for the robotic system in performing the retargeted motion. The differentiable simulator outputs a time varying state of the robotic system, and the controller further may include a loss function that measures, based on the time varying state, effectiveness of the learned controller by comparing differences in absolute positions or orientations of the components to their target positions or orientations. It should be noted that after training, the simulator is no longer used for evaluations, and, while training is slow, the mapping of unfiltered to filtered control parameters is fast (e.g., evaluation of a neutral network).


In some cases, the machine learning is performed prior to operations of the controller to generate the control signals and includes comparisons of target states defined by a plurality of input animations defining motions for the components via operations of the actuators and states determined by a differentiable simulator. In such cases, the differentiable simulator performs a simulation of the robotic system performing the retargeted motions with the first and second sets of the components, and the dynamic simulation predicts vibrations for the robotic system in performing the retargeted motion.


The portion of the vibrations that is suppressed may be low-frequency, large-amplitude vibrations of one or more of the components of the robot or of compliant actuators. Further, the unfiltered control parameters may include a set of motor trajectories, and the optimizer may function to modify the set of motor trajectories to generate the retargeted motion for the components.





BRIEF DESCRIPTION OF THE DRAWINGS


FIG. 1 illustrates a sequence of robotic motions/movements carried out by a robot/robotic system using retargeted animations and/or optimized motor trajectories generated by a computational method of the present description to suppress unwanted vibrations;



FIG. 2 illustrates a side perspective view of representation of a physical robot with deformable and rigid bodies in place of flexible and stiff parts of a robot's components;



FIG. 3 illustrates a graphic or schematic of the process of coupling deformable to rigid bodies used in the computation method of the present description;



FIG. 4 illustrates a graphic or schematic of the relative coordinate formulation used in the computational method to discretize deformable parts of components relative to one of the coupled rigid bodies;



FIG. 5 provides graphs of displacement magnitude versus end effector first appearance; use Center of Mass (COM) during material fitting of a testing process carried out by the inventors for the vibration-minimizing techniques of the present description;



FIG. 6 are graphs showing use of linear modes and modal derivatives and applying the mass-Principal Component Analysis (PCA) basis reduced from full Boxer simulation data to one exemplary robotic character motion;



FIG. 7 illustrates results of testing of a single motor single rod robotic system using the vibration-minimizing technique discussed herein.



FIG. 8 illustrates results of testing of a single motor two rod robotic system similar to FIG. 7;



FIG. 9 illustrates results of testing of a dancer robotic system similar to FIGS. 7 and 8;



FIG. 10 illustrates results of testing of a bartender robotic system similar to FIGS. 7-9;



FIG. 11 illustrates results of testing of a rapper's arm robotic system similar to FIGS. 7-10;



FIG. 12 illustrates results of testing of a drummer robotic system similar to FIGS. 7-11;



FIG. 13 illustrates results of testing of a boxing robotic system similar to FIGS. 7-12;



FIG. 14 is a functional block diagram of a robot or robotic system including a controller adapted to provide real-time vibration suppression according to the present description;



FIG. 15 is a schematic or flowchart of one embodiment of vibration suppression that may be carried out, at least in part, by a controller of a robotic system (such as the controller of FIG. 14);



FIG. 16 is a schematic or flowchart of a robotic controller implementation of the vibration suppression of FIG. 15; and



FIG. 17 is a schematic or flowchart of a robotic controller implementation of an alternative variant or embodiment of vibration suppression is with the differentiable simulator as a node of the neural network.





DETAILED DESCRIPTION

Briefly, a method (and robotic controllers and robots with such controllers) is described herein that involves learning to support real-time, vibration-suppressing control. The method uses state-of-the-art machine learning techniques in conjunction with a differentiable dynamics simulator to yield fast and accurate vibration suppression. To facilitate full understanding of the new vibration suppression control method, vibration suppression using approaches that are too slow for real-time control will be described initially (with reference to FIGS. 1-13), and this will be followed by a full discussion of the new real-time control techniques and controllers (or robotic systems with such controllers) that, in some cases, make use of the slower, accurate output from simulation as training data.


When animations are retargeted onto audio-animatronic figures (a form of robotic system), significant visible vibrations are observed especially for highly dynamic motions. These unwanted vibrations arise due to unavoidable compliance and deformation in joints, actuators, and assembly components. Prior to the vibration suppression approaches taught herein, the workflow to address vibrations relied on meticulous and time-consuming experimentation and on an animator with very specialized skills. Even so, the end result was often a slowed-down version of the original artistic intent, which does not use the full capabilities of the underlying robotic system.


This prior manual workflow can be replaced or greatly enhanced with the computational technique for vibration-suppressing retargeting of animations onto robot characters described first below as this technique gives desired prediction accuracy but not the speed useful for providing real-time control to achieve vibration suppression. This relatively slow computational technique relies upon a differentiable simulator that accurately predicts the dynamic behavior of a robot so as to optimize the time-varying motor values to suppress or minimize visible vibrations without slowing down the animations.


In contrast, real-time vibration-suppressing control is desirable for a number of reasons. First, if the prediction accuracy can be kept, a hardware-accelerated controller fed with sensory feedback of the robotic system enables: (1) the suppression of residual vibrations that are due to the unavoidable simulation-to-reality gap; and (2) the increased robustness of suppression strategies under system degradation (e.g., wear of components that change vibration characteristics during operations). Second, with the computational technique discussed first below, it takes hours to retarget animation, and this control optimization has to be repeated every time an animator makes a change to the animation. In contrast, a real-time vibration suppression approach (as discussed after the computational technique below) would enable the interactive animation of an animatronic figure or other robotic system. Hence, the real-time, vibration-suppressing control described provides an animator with immediate feedback on how the animation will look on a physical robot.


Creating animations for robotic characters is very challenging due to the constraints imposed by their physical nature. In particular, the combination of fast motions and unavoidable structural deformations leads to mechanical oscillations that negatively affect their performances. One goal of the offline or slower computational technique is to automatically transfer motions created using traditional animation software to physical robotic characters while avoiding such artifacts. To this end, an optimization-based, dynamics-aware motion retargeting method and system was developed that adjusts an input motion such that visually salient low-frequency, large-amplitude vibrations are suppressed. A technical core of this method and system (which may be labeled an animation system/method) includes a differentiable dynamics simulator that provides constraint-based, two-way coupling between rigid and flexible components. The efficacy of the computational method was demonstrated through experiments performed on a total of five robotic characters including a child-sized animatronic figure that featured highly dynamic drumming and boxing motions. The inventors have also used this technique on a human-sized figure where the main source of compliance was coming from the actuators.


As background to this system/method, which is too slow for real-time control, it should be understood that ever since Leonardo da Vinci's times, children and adults alike have been fascinated by mechanical systems that are designed to generate natural movements. Over the centuries, da Vinci's first automatons—the Mechanical Lion and the Knight—have evolved into lifelike animatronic figures that are routinely deployed in museums, theme parks, and movie studios across the world. Today, in part due to the advent of affordable, easy-to-use digital fabrication technologies and electromechanical components, the process of creating compelling robotic characters is easily accessible to anyone.


Keyframing techniques are commonly used to breathe life into animatronic characters. While these techniques are conceptually identical to those employed in computer animation, creating vibrant motions for real-world characters introduces unique challenges. These challenges stem from the physical characteristics of an animatronic figure's (or robotic system's) design. It is easy, for example, to design virtual characters that have as many degrees of freedom as needed. The design of their robotic counterparts, on the other hand, involves balancing motion versatility against the constraints imposed by the size, weight, and placement of its mechanical components. Furthermore, the motions of real-world characters are strictly bound to the laws of physics. While the idealized limbs of a virtual character are perfectly rigid, for example, structural deformations are unavoidable in physical systems. Unfortunately, the combination of dynamic motions, weighty components, and structural deformations leads to large-scale vibrations during robot movements matching those of the virtual world character. These mechanical oscillations are due to the cyclic transfer between kinetic and potential deformation energy, and they can negatively impact the robot character's performance of the input/target animations.


To combat vibrations, mechanical structures are typically engineered to be as stiff as possible. While such designs work well in industrial settings, these robots are heavy and bulky such that they are ill-suited for many types of robotic characters. An alternative design is to control the robot so as to slow down the motions that are performed to the point where they approach the quasi-static regime. This, of course, is also undesirable when trying to provide a robot that performs similar to a known character (e.g., repeat motions of a human character from a movie or the like). Animators are, therefore, left (before the present invention) with only one option: endlessly tweaking motions in a painstaking, trial-and-error workflow. A goal in creating the offline-based or slower motion (or robotic control) method is to fundamentally rethink this process through a physics-based motion retargeting method that is tailored for physical robots and characters provided by such robots' movements.


With this in mind, a computationally-expensive approach is first described herein for creating compelling motions for real-world characters followed by one that is fast and accurate to allow its use in real-time control of a robotic character or system. The input to the first computational method includes motions that are authored using standard animation software such as Autodesk's Maya. Leveraging a simulation model that balances speed and accuracy, the computational method generates an optimized motion that deviates from the input as little as possible while minimizing displeasing artifacts that arise from structural vibrations. The efficacy of this method is demonstrated through a variety of lightweight physical robots that generate complex motions. Hence, this first computational method provides at least the following useful aspects/steps: (a) dynamics-aware motion retargeting for physical robotic characters; (b) continuous space-time optimization for computationally suppressing structural vibrations; and (c) a general formulation of constrained multibody dynamics with two-way coupling between rigid and elastic components.


Evaluation of these aspects and the computational method/system is achieved through lively animations that are retargeted to complex robotic characters. For example, FIG. 1 shows animation 100 of a robotic system or robot 104 having a torso, a head, and wire/rod arms and legs to provide a character in the form of a boxer. FIG. 1 shows the animation (or boxing sequence) 100 that is made up of a series of movements 110, 112, 114, 116, 118, and 119 that provides fast punches, blocks, and dodges by the robot 104 using control signals generated using the retargeted animation (or motor trajectories) output by the computational method described first below for use by a robot controller (i.e., a controller operating the robot 104). As shown with movements 110-119, the computational method retargets fast and dynamic animations onto the physical robotic character 104, where the motor trajectories are optimized in order to suppress unwanted structural vibrations and to match the artistic intent as closely as possible.


As an overview of the computational method, given an animation sequence (e.g., input animation provided by an artist or the like), a goal for the computational method is to retarget the motion onto a physical robotic character while avoiding undesirable vibrations due to system dynamics. The motor angles could be extracted from the input animation sequence and replayed on the physical robot, but this may often lead to substantial unwanted vibrations, e.g., due to unavoidable compliance in the components and joints of the physical robot. This can cause the physical robot to deviate significantly from the target or input animation sequence (e.g., the boxing robot 104 of FIG. 1 may have their gloved hands at the end of the rapidly moving arms swing back and forth in a pendulum manner at the end of each motion 110-119). To address this problem, a computational tool is provided that optimizes the motor trajectories in order to suppress vibrations while matching the intended or input animation as closely as possible.


The robotic character, for the computation model, is assumed to be a multi-body system including both rigid components (such as mechanical joints and motors) and flexible bodies that will deform under dynamic motions as well as compliance in joints or actuators. FIG. 2 shows a robotic system (or subsystem of a robot or robotic character) 200 that includes rigid components 210 in the form of motors 212, hinge joints 214, 215, ball joints 216, and end members/effectors 216 and flexible components 220 (e.g., elongated links and the like). To simulate the dynamic behavior of robotic characters, flexible parts of components of the robot 200 are represented using deformable bodies and sufficiently stiff parts/components of the robot 200 are represented using rigid bodies. To enforce two-way coupling constraints between deformable and rigid bodies (such as between one of the flexible components 220 and the motors 212 or end members 216), a unified constrained dynamics model is formulated. The computational method can support assemblies with loops and components with a wide range of geometries, mass, and stiffness with the robot 200 being only a simplified example of a useful model of a physical robot (or a portion of such a robot).


As shown with robot 200 of FIG. 2, rigid components are connected to each other using mechanical joints, and flexible bodies are coupled to adjacent rigid components. To physically simulate the dynamics of the system, all sub-systems are time-stepped together in a unified integration scheme, while accurately modeling the two-way coupling effects between subsystems. The deformations on flexible bodies are moderate when observed from the coupled rigid body. By exploiting this, fast and accurate simulation of robotic characters is achieved via modal reduction techniques.


In the following, the constituent elements of the simulation are first described including elastodynamics, rigid body dynamics, and constraints. Then, a unified integration scheme is presented for dynamics simulation. Next, fast subspace simulation of the robotic characters is presented, with a detailed explanation of how the rigid-body dynamics are integrated in global coordinates while the reduced deformable simulation is solved in the local frame of the coupled rigid body. This is followed by a discussion of using a dynamics simulator to formulate a space-time optimization on motor controls in order to suppress vibrations using a continuous adjoint method. Then, the description turns to validation of the simulation model by presenting two simple and illustrative examples and to demonstration of the efficacy of the optimization method by retargeting five rich motions to complex physical robotic characters or robots.


With regard to constrained dynamics, to simulate physical robotic characters (as shown with robot 200 of FIG. 2), an elastodynamics model is used to represent flexible parts of the robot's components and rigid bodies to represent parts with a high enough stiffness. The rigid bodies, in turn, are connected to one another with either mechanical joints, such as hinges, ball-and-socket connectors, or the like, or with standard rotational motors. These connections can also be compliant.


With regard to elastodynamics, the motion of a 3D point x(X,t) on a deformable body, located at the reference location X at time t0, is governed by the equations of motion as follows:

ρ(X,t)−∇·PT(X,t)−ρg=0  Eq. (1)

where the density ρ may vary within the reference domain Ω. Integrated over Ω, the divergence of the transposed first Piola-Kirchhoff stress tensor P results in internal elastic forces that counteract inertia and gravity g (note, g is a 3D vector pointing in the direction of gravity, and its magnitude is the gravitational acceleration).


Spatially discretizing the components with finite elements and interpolating their nodal displacements with quadratic Lagrange shape functions, the standard first-order ODE may be formed as:

{dot over (u)}=v and M{dot over (v)}=f(u,v)  Eq. (2)

where u, v∈custom character3n collect the displacements and velocities of the n nodal degrees of freedom. The forces f=−fdamp−fint+fext combine internal forces fint, external forces fext that are set to gravity, and Rayleigh damping fdamp(u, {dot over (u)})=(αM+βK(u)) with mass matrix M and tangent stiffness K. The Neo-Hookean model is relied upon for accurate nonlinear stress evaluations since the robotic components undergo large rotations and deformations are moderate even with the relative coordinate formulation (described below). Above, quantities are underlined for which the same standard letters are common in rigid body dynamics (where they overlined). For compliance in motors, generalized springs may be used to formulate Eq. 2.


With regard to rigid body dynamics, to transform points in body to global coordinates, one can characterize states of bodies with their orientation R(t) and position c(t). Columns of rotations R represent a body's frame axes [rx, ry, rz], and the position of its center of mass c is represented by the frame center at time t. The state of a body is governed by the first-order ODE form of the Newton-Fuler equations, as:










[




c
.






q
.




]

=



[



w





Q

ω




]





and

[




M
_












I
c




]


[




w
.






ω
.




]


=

[




f
_







τ
c

-



[
ω
]

x



I
c


ω





]






Eq
.


(
3
)









where w is the linear and ω the angular velocity, M the mass, and Ic=RIrbRT the moment of inertia of the body, with Irb referring to the constant angular mass in body coordinates. To reduce required normalization, rotations are represented with quaternions combined with use of the 4×3-transformation matrix Q(q). The net force f acting on the body includes gravity, and, for the sake of brevity, one can absorb the term [ω]xIcω in the net torque τc in what follows. [ω]x is the matrix form of the cross-product with ω.


With regard to constraints, three types of constraints may be included in the dynamic system: (1) mechanical joints that couple rigid bodies pairwise; (2) interfaces between deformable and rigid bodies where degrees of freedom of the finite elements simulation mesh are moving as-rigidly-as-possible with the attached bodies; and (3) a mechanical joint or actuator that couples rigid bodies pairwise with a linear or nonlinear spring modeling their compliance.


As to mechanical joints, to formulate constraints between pairs of rigid bodies, rigid frames are attached to either body, and they are then transformed with their respective orientations and positions. Asking their centers or axes to coincide or remain orthogonal to one another, constraints can be formulated as:

C(t,c(t),q(t))=0  Eq. (4)

that depend on the orientations and positions of the bodies due to these transformations. For motors, the relative positions of the two frames were actively changed so that there was a direct dependence on t.


To couple deformable bodies to rigid bodies, a similar mechanism may be used that involves asking frames on either body to coincide in global coordinates. FIG. 3 illustrates with graphic 300 coupling deformable bodies to rigid bodies. A frame on either body can be defined, asking their centers and axes to be equal at time t. To define a center on the rigid body, one can extract the “centroid” {circumflex over (X)} of the area-weighted interface nodes Xi at t0, transforming its location to rigid body coordinates. At time t, one can then ask the transformed center to equal the “centroid” of the deformed interface nodes {circumflex over (x)}(t). To extract the rotation between the undeformed and deformed interface, one can compute the transformation that maps vectors Di=Xi−{circumflex over (X)} to their deformed configuration di=xi−{circumflex over (x)}. Then the orientation of the frame on the rigid body can be set to equal the rotational part of this transformation.


However, because interface nodes on the deformable body do not remain rigid, the formulation of coupling constraints is more involved. The input assemblies were not assumed to be hierarchical. Due to loops in the robotic character assemblies, deformable bodies can be coupled to more than one rigid body (e.g., as in the robotic system 200 of FIG. 2). Moreover, rather than with a penalty method, coupling in the computational method is enforced with constraints, which constitutes a more physically accurate model besides enabling the stable integration without the necessity of a tedious parameter tuning.


In a first step, the frame centers on either body are extracted that are desired to coincide throughout the motion. To this end, the area-weighted average {circumflex over (X)} and {circumflex over (x)}(t) of nodes on the interface are computed at rest and time t, respectively. The two “centroids” are then caused to coincide in the local frame of the rigid body with:

R(t0)T({circumflex over (X)}−c(t0))−R(t)T({circumflex over (x)}(t)−c(t))=0  Eq. (5)


To constrain the relative orientations of the two bodies, the optimal linear transformation A(t) is first found that transforms difference vectors Di=Xi−{circumflex over (X)} to their deformed configuration di(t)=xi(t)−{circumflex over (x)}(t) by minimizing the sum of squared differences Σiŵi(ADi−di)2, weighted with the normalized interface area incident to node i. Then, the orientations of the interface on the deformable and rigid body are set to coincide with:

R(t)R(t0)T−(PD(A(t))=0  Eq. (6)

where the polar decomposition (operator PD) is used to extract the rotational part of the transformation A. To minimize the number of constraints, the orthogonality can be enforced between columns of the combined rotation R(t)R(t0)T and the axes of the rotational part of A with three dot product constraints. Because the deformed nodes on the interface depend on the displacement, the combined constraints are:

C(t,c(t),q(t),u(t))=0  Eq. (7)

and depend on u besides the rigid body locations and orientations.


With regard to enforcing constraints, the computational method includes formed constraint Jacobians Cc, Cq, and Cu with regards to locations and orientations of rigid bodies and displacements of the deformable bodies. The constraint forces CcTΛ and CuTΛ are added to f and f, respectively. A is a vector of Lagrange multipliers (one per constraint). Note that constraint torques (CqQ)T require a transformation with matrix Q before they are added to τc. By construction, these generalized forces do not do any work on the system. Hence, they do not add nor remove energy. To form Jacobians of the coupling constraints, the derivatives of the polar decomposition are taken (with derivations of the first and second derivative of operator PD being known in the arts). While only the first derivatives are needed for simulation, second derivatives are used for gradient computations during optimization as discussed below.


In cases where flexible joints are used as sources of compliance, this may be implemented by permitting the joint orientation or position to deviate from the prescribed value, with a generalized spring applying a restoring force back towards the prescribed value. In general, this spring may be linear or nonlinear.


To form the system of differential-algebraic equations (DAE) that describe the dynamics of the robotic characters, the deformable and rigid body ODEs (Eqs. (2) and (3)) are combined as follows:

{dot over (U)}=TV=0 with T(U)=diag(E,Q(q),E)  Eq. (8)
M{dot over (V)}−F−(CUT)TΛ=0 with M(U)=diag(M,Ic(q),M)  Eq. (9)

with the algebraic equations C=0 in one unified system. In the above equations, the positions and orientations of the rigid bodies and the displacements of the deformable bodies are collected in a generalized position vector U=[c q u]T, and corresponding velocities are collected in a generalized velocity vector V=[w ω v]T. Transformation matrix T relates velocities to the time derivatives of positions, and mass matrix M relates accelerations to generalized F(U, V)=[fτc(c, q, ω) f(u, v)]T and constraint forces (CUT)T. The torque not only depends on the locations but also the orientations and angular velocities because the torques [ω]xIcω were considered to be part of τc. Matrices E are identities of appropriate but different sizes.


Considering time discretization, it will be understood that a direct time integration of the above DAEs is not possible. This is because the constraints C=0 do not directly depend on velocities such that a discretization with neither an explicit nor an implicit scheme would lead to a solvable system. To enforce the constraints, one can either use the first or second time derivatives Ċ=0 or {umlaut over (C)}=0, respectively. The use of the second time derivative results in a semi-explicit, index-1 DAE that can be discretized and solved with either an explicit or implicit scheme. However, because the components of the robotic system are flexible but very stiff, RK4 is unstable even if one were only to time-step the nonlinear deformable body ODE (see supplemental material at the end of this description). Hence, an explicit scheme is not an option. Instead, velocity constraints Ċ+αC=0, α>0 are relied upon where Baumgarte stabilization is added to avoid numerical drift in positions, resulting in the pure, index-2 DAE of:









Eq
.


(
10
)





G
=




[






E














M
-


(


C
U


T

)

T
















]

[




U
.






V
.





Λ



]

-

[




T

V





F






-

C
t


-


C
U


T

V

-

α

C





]


=
0








that can only be directly discretized and solved with an implicit scheme. This is because the constraint is independent of the algebraic variables Λ. Due to the dependence of the motor angle on time t, the partial time derivative of the constraints, Ct, is non-zero for constraints that involve motors.


While a BDF discretization of either the semi-implicit, index-1 or the pure, index-2 DAE is stable, some embodiments may use the index-2 DAE because it avoids second derivatives of the constraints for simulation and third derivatives for gradient computations for the optimization. The latter are tedious to derive and implement due to the polar decompositions in the coupling constraints.


To avoid numerical damping, the nonlinear system of DAEs, G(t, S(t), {dot over (S)}(t))=0, is discretized, with state vector S=[U V Λ]T and its time derivative {dot over (S)}=[{dot over (U)} {dot over (V)} {dot over (Λ)}]T, with a BDF-2 scheme as:







[





(



U
n

-


U
^

p



Δ


t
^



)

-


T

(

U
n

)



V
n










M

(

U
n

)



(



v
n






v
^

p



Δ


t
^



)


-

F

(


U
n

,

V
n


)

-


[



C
U

(


t
n

,

U
n


)




T

(

U
n

)

T


]



Λ
n










C
t

(


t
n

,

U
n


)

+



C
U

(


t
n

,

U
n


)



T

(

U
n

)



V
n


+

α


C

(


t
n

,

U
n


)






]

=
0





In the above equations, Sn=[Un Vn Λn]T is the unknown next state, Ŝp is set to the combination of the two previous states








-

4
3




S
p


+


1
3



S

p
-
1








that are known, and the time step to ⅔ of the chosen step size Δt (set to 1/2000 for all the inventors' demonstrations). The system was assumed to be at rest at time t0, setting the initial conditions S0 accordingly (one can use BDF1 for the first timestep). To solve the resulting nonlinear equations for the next state Sn, one can use Newton's method where the system is linearized at the current iterate.


Turning now to simulation of robotic characters, the dynamic simulation scheme (as described above) allows accurate simulation of robotic characters when actuating motors according to the artist-specified (input) motion profiles. Nevertheless, simulations are slow for complex characters due to the thousands of deformable DOFs. It becomes even prohibitively expensive as one seeks to optimize the motor profiles. This is because every objective evaluation during line search and every objective gradient evaluation requires a simulation of the entire animation.


To enable faster and accurate simulation of the robotic characters, established subspace methods may be relied upon. However, the flexible components undergo large rotations, and modal models are poorly suited to represent them. Taking a closer look at the flexible bodies, observations show that their motion is passive, driven by the inertial forces that are due to transformations of coupled rigid bodies. Moreover, their deformations are moderate with regards to the body coordinates of the latter. Inspired by multi-domain reduced simulation, the reduced deformable dynamics can be integrated in relative coordinates of one of the coupled rigid bodies, time-stepping the rigid body motion in global coordinates.


Before a discussion of the reduced formulation is presented, though, it may be useful to first describe full simulation in relative coordinates. For every deformable body, the adjacent rigid body can be chosen that primarily delivers its motion as reference. As discretized as discussed above, a point X∈custom character3 in the reference domain Ω is mapped to its deformed position x(X, t)∈custom character3 via interpolation of the nodal displacements u∈custom character3n as:

x(X,t)=X+u(X,t)u(X,t)=Φ(X)u(t)  Eq. (11)

where Φ∈custom character3×3n is the concatenation of 3×3 diagonal matrices set to the identity times the quadratic basis function of the corresponding node.


Discretized relative to one of the coupled rigid bodies (as shown in graphic 400 of FIG. 4), the reference point Xlcustom character3 in local coordinates of the coupled body is transformed to its global deformed configuration according to the following

x(Xl,t)=R(t)[Xll(Xlul(t)]+c(t)  Eq. (12)

with the displacement ul and the basis Φl defined with regards to the local frame. To increase readability, the subscript l is dropped in the following discussion.


Starting from Eq. (1) and omitting the arguments in the interest of brevity, the weak form of the equations of motion can be formulated as:

ΩΦTRT{umlaut over (x)}−∇X·PT−ρg)dX=0⇒∫ΩρΦTRT{umlaut over (x)} dX=∫ΩΦTRT∇·PTdX+∫ΩρΦTRTg dX  Eq, (13)

where the equations are transformed to local coordinates of the coupled body by multiplying with RT. The integral on the left represents inertial forces (generalized mass times acceleration), and the two integrals on the right represent internal elastic and external gravitational forces, respectively. Plugging the second time derivative of the deformed configuration in relative coordinates (Eq. (12)) into the integral on the left (see supplemental materials at the end of this description for generalized mass matrices M1-M6 and for a detailed derivation), the inertial forces are formed that correspond to the linear and angular acceleration of the rigid bodies of the robotic systems, and the acceleration of the deformable bodies is provided as:

Mω{dot over (ω)} Mw{dot over (w)} M{dot over (v)}  Eq. (14)
Mω(q,u)=−(M1+M2(u))RTMw(q)=M3RT  Eq. (15)

together with the fictitious centrifugal and Coriolis forces:

fcen(q,u,ω)=ΣjTR(M4j+M5j(u))RTωej)−(M6+Mu)(ω·ω)  Eq. (16)
fcor(q,ω,v)=−2M2(v)RTω  Eq. (17)

that are due to use of the relative coordinate formulation, with ej being the j-th column of the identity matrix.


It remains to discuss the first and second integrals on the left. Because the Green strain (invariant under rigid body motion) is relied upon and the deformable bodies are time stepped in their respective relative coordinates, the internal and damping forces for each individual deformable body can be discretized as usual (as discussed above). Because the constant gravity vector g is defined in absolute coordinates, it can be rotated to relative coordinates before integrating the third integral, setting the gravitational forces of the deformable body to fgrav(q)=M3RTg.


In summary, to time-step deformable bodies in relative coordinates, the deformable body ODE, M{dot over (V)}−F=0, can be replaced in the simulation DAE (Eq. (8)) with the relative formulation of:











[




M
_















I
c










M
_

w





M
_

ω




M
_




]

[




w
.






ω
.






v
.




]

=

[




f
_






τ
c






f
_




]





Eq
.


(
18
)









where f is set to the forces−fcen−fcor−fdamp−fint+fgrav.


The generalized mass matrices are either constant (M, M1, M3, M6), consist of constant blocks (M4), or are or consist of blocks that are linearly dependent on the displacements or velocities of the deformable bodies (see supplemental explanation at end of description). Hence, they are well-suited for precomputation.


Note that while these mass matrices may be similar to ones previously derived, the relative formulation differs in the following two fundamental ways. First, others' multi-domain simulation works on deformable bodies only, time-stepping each body in relative coordinates of the deformable subdomain of its parent. Hence, prior methods only work on hierarchical input and do not support loops. Because deformable bodies are represented relative to a rigid body and all of the rigid bodies are time stepped in global coordinates, the computational method can couple deformable bodies to several rigid bodies. This supports loops in the robotic character assemblies. Second, in the prior systems, frame rotations and accelerations were extracted from the previous state when the inertial forces were integrated. Hence, previous work involved integrating the latter explicitly. In contrast, the inertial forces in the computational method described herein depend on the next state of both the rigid and deformable bodies, which enables stable and accurate integration with an implicit scheme.


With regard to reduced simulation in relative coordinates, local deformations of individual deformable bodies can be expressed in a subspace while keeping the accuracy required for desired retargeting. Precomputing modes, Urcustom character3n×r, r«3n, one can time-step with the same system (Eq. (18)) as for full simulation, projecting it onto and solving in the reduced space instead. To compute constant (blocks of) mass matrices for the reduced system, the basis Φ can be set to the reduced basis ΦUr (see supplemental explanations at the end of this description for derivations). Precomputing the reduced mass matrices, all of the inertial and gravitational forces can be integrated in O(r2) flops, without the need for computations in full space (with reliance on cubature for efficient evaluations of reduced internal forces and tangent stiffness). To construct the subspace for the constrained deformations, a PCA basis may be used. To this end, full simulations may be first run of the robotic characters followed by performing mass-PCA on the local displacements of each individual deformable component. It is worth pointing out that this defines subspaces for individual components instead of a single subspace for the entire character.


The next step or process performed by the computation-based controller/design module with vibration suppression involves optimization. To retarget artist-specified (or other) input to a particular physical robot, it is desirable to try to minimize the difference of simulated target states, putting a priority on the suppression of low-frequency motion of large amplitude. Due to the flexibility in the robot's components or joints, the robot deforms under gravity even if the target animation is slowed down to the degree where inertial forces can be neglected. Since one cannot hope to remove deformations due to gravity, a quasi-static solve is first performed with motor angles set according to the input profiles. Performing these quasi-state solves at the same time intervals as used for dynamic simulations defines the target states {tilde over (S)}(t). In the remainder of this section, a discussion is provided of how to minimize the distance of the simulated states S(t) to target states {tilde over (S)}(t) while suppressing visible low-frequency vibrations by making adjustments to parameterized motor profiles.


Regarding parameterization, the time-varying motor profiles can be represented as θi(t,pi) with a spline interpolation, parameterized with parameters pi. Because C2-continuity is used to prevent infinite motor torques in simulations, B-Splines may be used. Collecting the parameters of all motors in a parameter vector p, the parameterized profiles are initialized by fitting them to the input profiles.


Regarding the retargeting objective, a first objective may be to minimize the distance between simulated and target states, integrated over the interval [0, T]. However, with this objective, the system is essentially being asked to remain as-rigid- or as-stiff-as-possible, preventing it from suppressing visible vibrations. The robotic characters studied herein included components that are rigid in proximity to mechanical joints or motors. Thinking of them as articulated characters, the method aimed at suppressing low-frequency, global vibrations of large amplitude. Hence, the simulated positions of the rigid bodies are asked to remain as-close-as-possible to their target state in absolute coordinates with:











g
pos

(

t
,

U

(
p
)


)

=


1
2







c

(

t
,

U

(
p
)


)

-


c
~

(
t
)




2






Eq
.


(
19
)








If the positions and orientations of all rigid bodies adjacent to the flexible part of a component are all asked or set to remain as-rigid-as-possible, the process is again asking for stiffness and preventing compensation of global vibrations. However, for some applications it may be desirable to be able to penalize derivations of body orientations from a specified target (e.g., for the end effector attached to a robotic character that is holding an object that could spill contents from the object or the like such as a bartender character). To penalize differences between simulated and target orientations, a second objective can be introduced with:











g
ori

(

t
,

U

(
p
)


)

=


1
2



(



(


r
x

·


r
~

z


)

2

+


(


r
y

·


r
~

z


)

2

+


(


r
z

·


r
~

x


)

2


)






Eq
.


(
20
)









where the r-axes are the columns of the simulated and target rotations, R(t, U(p)) and {tilde over (R)}(t), of a rigid body. By integrating these differences over time, the retargeting objective is formulated as:










G

(

U

(
p
)

)

=



0
T



g

(

t
,

U

(

t
,
p

)


)


dt






Eq
.


(
21
)














g

(

t
,

U

(

t
,
p

)


)

=




k




w
pos
k

(
t
)



g
pos
k



+



w
ori
k

(
t
)



g
ori
k







Eq
.


(
22
)









where the time-varying weights, wposk(t) and worik(t), for the body k provide a means to emphasize particular fractions of an animation. Note that these weights are constant in the sense that no time derivatives are required for numerical optimization. During retargeting, weights worik are set for most bodies at zero.


Regarding regularization, the objective measures performance with regards to absolute coordinates. To provide a means to penalize relative differences, hence closeness to the artistic input, a regularizer can be formulated that compares the current to the input profiles. In addition, the motor profiles are set or asked to be smooth by penalizing high accelerations as follows:











r
pro
i

(
p
)

=



1
2




(



θ
i

(

t
,
p

)

-



θ
~

i

(
t
)


)

2


and




r
acc
i

(
p
)


=


1
2




(



θ
¨

i

(

t
,
p

)

)

2







Eq
.


(
23
)









Analogously to these objectives, the regularization terms are weighed with weights that vary with time but are constant from an optimization perspective in:










R

(
p
)

=



0
T



(




i




w
pro
i

(
t
)



r
pro
i



+



w
acc
i

(
t
)



r
acc
i



)


dt






Eq
.


(
24
)









Note that the regularizer only depends on the spline parameters but not on the state of the robot. With regard to DAE-constrained retargeting, to retarget motion profiles to the physical robots, the objective may be minimized under the dynamic equilibrium constraint, G=0, satisfied at every t∈[0, T]:












min
p



G

(

p
,

U

(
p
)


)


+

R

(
p
)






subject


to



G

(

t
,
p
,

S

(

t
,
p

)

,


S
.

(

t
,
p

)


)


=
0





and



S

(

t
0

)


=

S
0






Eq
.


(
25
)









Because it is assumed that the system is at rest at the start of an animation sequence, the initial conditions S0 do not depend on the parameters p.


At this point in the description, it may be useful to turn to the adjoint system and the objective gradient. While sensitivity analysis and adjoint method have become standard tools to implicitly enforce quasi-static equilibrium constraints in minimizations of design objectives, the computation of analytical gradients of the retargeting objective requires more machinery. Like for quasi-static problems, one can solve the equilibrium constraint whenever adjustments are made to spline parameters and then seek to evaluate the objective or objective gradient. To compute analytical gradients for DAE models, there are two options: forward and backward sensitivity analysis. If the number of parameters is small and not exceeding the number of simulation DOFs, forward analysis is preferable. In all other circumstances, backward analysis is the method of choice. Because the number of the state variables in the computational tool is in the order of hundreds (for reduced simulation) and the number of parameters in the order of thousands, backward analysis may be relied upon (with the understanding forward analysis may be practical in other applications).


Pointing the reader to the supplemental material beginning at about para. [00101] of this description for a detailed derivation, a recipe is provided here of how to compute analytical gradients. Upon parameter changes, the simulation DAE, G=0 for t∈[0, T], is solved and the states S(t) are stored for later use. By time-stepping backwards, the linear DAE is then solved with:











[



E














M
T


















]



λ
.


=



(


-

[











U
.

T



M
U
T










]


+

[




G
U
T






G
V
T






G
Λ
T




]


)


λ

+

[




g
U
T






g
V
T









]






Eq
.


(
26
)









with initial conditions, λ(T)=0, for the adjoint variables λ(t). In evaluations of gradients gU and gV of the objective, Jacobians GU, GV, and GΛ of the constrained dynamics equations (Eq. (10)) and the generalized mass matrix M and its Jacobian with regard to generalized positions, the states S(t) can be used from the solve of the simulation DAE. Then, the objective gradient can be evaluated as:











d

G


d

p


=

-



0
T



λ
T



G
p


d

t







Eq
.


(
27
)









where the states S(t) are used from forward-stepping G=0 in evaluations of Jacobian Gp and λ(t) from backward-stepping the corresponding adjoint system.


Discretizing both DAEs (Eqs. (10) and (26)) with a BDF2 scheme with the same time interval (dividing the interval [0, T] by the number of desired time steps), correspondence is ensured along the time axis. For numerical integration of the objective and objective gradient, one can rely on a cubic Simpson rule and for minimization of the objective on a standard BFGS.


Now, it may be useful to describe the results of use of the vibration-minimizing motion retargeting technique to generate output and use of this output to control robots. The computational framework can be used to optimize six examples with seven different motion sequences, ranging from didactic mechanical systems to full-body robotic characters. By progressively increasing the complexity of the assemblies, the target motion sequence, and the physical size of the demos, the suitability of the method can be demonstrated for complex and large-scale robotic systems. For all the examples, the following were generated (and are shown, at least in part, in the attached figures): the target animation sequence, the naïve playback of the target animation on the physical robot or robotic character, and the playback (i.e., control of the robot with control signals generated based on the output of the new computational framework) of the optimized animation on the physical robot or robotic character. The self-weight gravity was modeled across all the deformable and rigid components in the results, and the static configuration under gravity was used as the initial conditions to the simulation. The target animation trajectory was estimated by running a quasi-static simulation through the whole animation sequence.


Regarding fabrication, all the demonstrators/test robots were driven with Dynamixel XM-430-W210 servomotors, controlled from a PC through a Dynamixel U2D2 interface. The servos provided sufficiently high torque such that one can assume them to follow the specified motor angle trajectory with no derivation. The test robots were assembled using a combination of off-the-shelf Dynamixel mounting brackets, a small number of custom aluminum machined connectors, spring steel rods (diameters 4 and 5 mm) and 3D-printed parts. Structural parts were printed with Digital ABS material on an Objet Connex 350 and parts for visual appearance were printed with PLA on an Ultimaker 2+. Flat parts for the 13-DOF robot were laser cut from acetal sheets. The 100 g and 200 g weights were machined from brass.


Regarding material fitting, in order to accurately simulate the dynamics, the physical parameters (such as Young's modulus and damping coefficients) were fitted to the deformable rod and the 3D-printed material by comparing the simulation results to the motion captured data. FIG. 5, with graphs 510, 520, 530, and 540, shows the physical setup the inventors used to mount the deformable body, either a rod or a 3D-printed piece, on a single-DOF motor. As shown, using motion capture data, one can fit elastic and damping properties for FEM simulation of the deformable rod and 3D-printed material. Parameters were fitted with bisection, and the final parameters were obtained within five iterations. The simulation data fits well with the mocap data, and the obtained material parameters were in agreement with values from the literature. In the material fitting, a 100 g rigid mass was attached to the end of the deformable body, such that the physical properties were measured in the frequency range of interest. The deformable body vibrates due to the motor rotation, and an OptiTrack system was used to capture the end effector motion. It was observed that the reduced simulation results closely matched the captured motion (see graphs 520 and 540). The simulation accuracy benefits significantly from using quadratic finite elements and due to the implicit BDF2 scheme one does not observe numerical damping problems. A similar procedure can be used to identify the stiffness and damping parameters of the generalized springs which are used to represent the compliance in joints or actuators.


With regard to validation, in the experiments, mass-PCA modes were used instead of standard linear modes for multiple reasons. The vibrations in the systems were moderately large, and a large number of linear modes would therefore be required to express the deformation. For large deformations, linear modes can be augmented with modal derivatives, which are known to provide visually-good dynamics. However, in many cases, the inventors found these to not perform well in their present application as illustrated in the graphs 610 and 620 of FIG. 6 (see graph 610, particularly), where 80 linear modes and modal derivatives (40 FPS were used but still saw significant mismatch). Graph 610 shows results of using linear modes and modal derivatives, where the reduced simulation activates circular motion and the dynamics frequency does not match the mocap data (see graphs 510 and 530 of FIG. 5). Graph 620 shows the results of applying the mass-PCA basis reduced from the full boxer simulation data to the unseen drumming motion, which shows that the reduced simulation very closely matches the full simulation data on the untrained motion. In contrast to the results of graph 610, the PCA modes (graph 520 of FIG. 5) match the captured data well using eleven modes (275 FPS) Moreover, with a sufficient number of PCA modes one can achieve similar accuracy to full simulation, whereas with linear and modal derivatives one has to tune material properties to non-physical values due to the numerical stiffening. For the present animation retargeting problem, PCA modes suffice to express the observed vibrations and can even extrapolate to different motions with similar vibrations (see graph 620 in FIG. 6). Different from standard linear modes, PCA modes do not introduce any locking artifacts due to constraints as the full simulation enforces the constraints across the motion.


The first example is a robotic system in the form of a single vertical deformable rod (spring steel, 70 cm height) mounted on a servo-motor, with a 100 g mass attached at the end. FIG. 7 illustrates (with animation frames) testing of such a target robot 710 and fabricated robot 712, during target animations 720, non-optimized playback 722, optimized playback 724, and optimized control of a fabricated robot 712 along with graphical representations or trajectory plots 730 and 740 of the test results. As shown, by preempting the movement of the input animation (see graph 740), the optimized control produces a motion sequence that closely matches the target, as indicated by the animation frames of graphs 720-726 and trajectory plot of graph 730.


In this test, starting from the vertical rest configuration, the motor was rotated by 30 degrees, paused for 1.5 seconds, and then returned to the rest configuration. With the non-optimized piecewise linear motor control, the compliant rod vibrates substantially around the target poses and deviated from the target motion significantly. The optimization taught herein uses the center of mass (COM) trajectory of the end effector as the objective. It can be observed that the optimized motor control suppresses the vibration, while the timing of the intended motion is kept as closely as possible. It can be seen that this is done in part by smoothing out the transitions to poses and, in part, by preempting the motions and adding deformations ahead that cancel oscillations.


Extending the first example, a second exemplary test robot can be provided by moving the motor from the base to the middle where two 30 cm compliant rods can be connected. FIG. 8 illustrates results of testing of such a single motor two rod robot with the target robot 810 and fabricated robot 812 with animation frames during target 820, non-optimized playback 822, optimized playback 824, and optimized controlled motion 826 of fabricated robot 812 along with graphs 830 and 840 showing test results including end effector trajectory and motor control. Compared to the piecewise linear motor control, the optimized smooth control signal used for fabricated robot 812 as shown at 826 successfully suppresses the variation to be under a very small amount. Similar to the first example, a 200 g rigid mass was attached as the end effector. Starting from the straight vertical pose, the upper rod was rotated by 90 degrees to a horizontal pose. Due to the mass inertia, the lower rod deforms and under the non-optimized motor control, the system vibrates significantly. The optimization process taught herein uses the COM of both the end effector and the motor in the objectives. FIG. 8 shows that the optimization result successfully removes the unwanted vibrations to a large degree.


As a third example, the robot takes the form of a dancer to increase the complexity to a 4-DOF character assembly where a 25 cm rod that represents the dancer's body and two arms are connected at the clavicle. This can be seen in FIG. 9.


In this test, each arm of the robot included two motors at the shoulder, one deformable rod as the arm, and a 200 g mass as the hand. The target motion was an 8.5-second dance sequence featuring expressive 3D arm movements. A naïve transfer of the motion sequence to the servo-motors causes very significant vibrations, in particular due to the waving motion of the left hand (see series 920 in FIG. 9), causing the resulting motion of the physical character to very different from the target movements (input animation).



FIG. 9 shows a target/design robot 910 performing a series of movements 920 (with the robot shown over the top of input/target animations) with resulting COM deviation in graph 925, with the target/design robot 910 performing a series of optimized movements 930 with resulting COM deviation in graph 935, and with the fabricated robot 912 performing the series of optimized movements 940 with resulting COM deviation in graph 945. Five representative frames are provided for non-optimized and optimized simulation overlaid with the target animation and for the retargeted optimized motion on the physical character. Displacement error visualization on the clavicle, left, and right hand are provided in graphs 925, 935, and 945. Here, the presented optimized result corresponds to the first experiment where all the matching targets were assigned with a weight of unity. The first three frames show the waving motion while the last two frames are dancing poses. The non-optimized one shows substantial vibrations on the body rod which lead to large deviation everywhere whereas the optimized control successfully removes the excess vibration. Note, the vibration-minimizing control method does not completely cancel the deviation during the waving sequence but with such a small amount of body rod deformation the vibration caused from waving can largely be cancelled for the subsequent motion.


In order to suppress the undesirable vibrations, the control signals for the four motors were optimized such that the COM trajectories of both the hands and the clavicle match the target as closely as possible. To demonstrate the user control over the optimization results, three different sets of weights were experimented with on the target matching terms. In the first experiment, a weight of unity was assigned to all the target points. The resulting motion was close to the target animation sequence, without inducing noticeable vibrations. However, for the waving sequence, the displacement of the left hand end effector was mostly achieved by the deformation of the body rod as opposed to the rotation of the corresponding shoulder motors. Therefore, in the second experiment, the objective weight for trajectory matching was increased at the clavicle by 100 times. As expected, little vibration was still achieved across the motion sequence and, at the same time, the deformation at the torso was also reduced, at the expense of weakening the waving motion. The system also allows for time-varying weights, enabling the user to control the significance of separate motion segments. In the third experiment, in order to restore the waving motion, a time-varying weight was assigned to the left hand over the motion by increasing its weight by 100 times specifically for the waving segment. Interestingly, in this scenario, the right arm deviates more from the input target and performs a counteracting motion to balance the wave and prevent vibrations. These examples demonstrate that the computation-based control system is able to suppress vibrations in multiple different ways and can, thus, be tuned by the user in order to match a particular artistic intent.


As well as being visually displeasing, vibrations can also negatively impact the functional performance of robot characters. In a fourth demonstrator/test robot, a 4-DOF bartender robot arm (3-DOF translation, 1-DOF rotation at the end effector) is studied, that is holding a glass of water and moving it through three locations. This is shown in FIG. 10 with target robot 1010 holding water in glass 1011 and with fabricated robot 1012 holding water in glass 1013. The top row provides a set of frames 1020 of the simulated optimization result for four frames in the animation/motion sequence, with the target being matched almost perfectly. The middle row provides another set of frames 1030 showing the physical robot 1012 executing the non-optimized trajectory and spilling the drink (frames two and four), and the bottom row provided a set of frames 1040 showing the physical robot 1012 following the optimized trajectory with no spillage (i.e., little to no unwanted vibrations).


In the bartender robot test, the height of the robot (without the base) was 45 cm. For this demonstration/test, the controller was operated so as to not only try to match the position trajectories at the elbow and end effector but also match the end effector orientation such that the glass remains upright. The input motion trajectory when played back on the robot, causes the robot to spill the drink due to the vibration. By running the new optimization, though, on this input, the robot can be controlled to perform the same motion sequence without spilling the drink. It was assumed that the water in the cup behaves as a rigid body of fixed mass, and although this is an oversimplification, it can be seen that it is sufficient for this testing. FIG. 10 shows the optimized simulation result at 1030, the non-optimized motion at 1020 that cause the drink to spill, and the optimized robot 1012 at 1040 that does not spill the drink. This test showcases the computational-based method and indicates it has applications in functional areas of robotics (not just visual applications).


In another test case, a robotic rapper's arm was controlled to reduce vibration to demonstrate that the method supports mechanical systems with kinematics loops. The robotic system was simulated as shown with robot 1110 under non-optimized control with sequence 1120 in which the arm deviates significantly from the input sequence. Optimized control is shown in sequence 1130 for simulated robot 1110 and provides dynamic motion that is visually indistinguishable from the target. The tested robotic system (simulated at 1110) included two 3D-printed compliant arm components connected with a 4-bar linkage and four motors controlling the 3D shoulder motion and a 1-DOF elbow motion. Unlike conventional rigid 4-bar linkages, the test rapper robot had two compliant links and two rigid links that were connected with two hinge joints, one universal joint and one spherical joint in order to obtain the correct number of constraints while allowing for the deformable components to move out-of-plane. The input motion was designed to be a rapping sequence where the arm is moving in a wide-range 3D space. The optimized motor controls successfully remove the substantial vibrations that are present when operating the robot with the non-optimized control input.


The scalability of the computational framework was examined by retargeting a drumming motion sequence for a 13-DOF full-body robot with a height of 80 cm. This is shown with simulated/target robot 1210 performing non-optimized motion overlaid with target motion in frames 1220, with simulated/target robot 1210 performing optimized motion in frames 1230, and with a fabricated physical robot 1212 performing the retargeted motions in frames 1240. With the non-optimized control, the vibration is excessive whereas vibration is nearly invisible with optimized control as seen in sequence 1230.


Each arm had 3 DOFs at the shoulder and 1 DOF at the elbow. In addition, the upper body was actuated with five motors controlling the motion of the head, neck, torso, spine, and pelvis. The character legs were two 45 cm rods fixed at a base, and the lower arms were 10 cm rods. The entire drumming motion lasted 10 seconds. It can be seen that the main deformation mode, which is significantly excited by the drumming motion, was a backward-forward swaying motion. Interestingly, for the non-optimized case, the vibration amplitude exhibits significant periodic vibration over time (at some points being close to zero), and this is seen both in the simulated and the physical systems. This would make it very challenging to manually smoothen or offset control for vibration suppression. The optimization provided by the new controller/design system targets the center of mass trajectories of the head, pelvis, and both hands. Without any noticeable degeneracy of motion quality, the vibration error was successfully suppressed for the whole system (e.g., peak amplitude reduced from 7 cm to 1 cm).


Further, it was shown that a different motion sequence, i.e., boxing, can readily be retargeted to the same full-body character as the drumming robot, with only replacement of the hands with boxing gloves. FIG. 13 illustrates the robot 1210 (modified to include boxing gloves as end effectors rather than hands) in a series of movements with frames 1320 during non-optimized control (playback of input animation) and in a series of movement with frames 1330 during optimized control, which largely removes the vibration and matches the target motions with high visual quality. The physical robot executing the optimized trajectory is shown in FIG. 1. Unlike the drumming motion with repetitive beats, the boxing motion contains more fast and abrupt motions. The naïve retargeting causes excessive vibrations, especially when the character dodges and moves his upper body backward and forward. With the same objective and optimization parameters as for the drummer, the optimized motor signals (output by a computation-based optimization module described herein) control the deviation error under 1.5 cm (compared to 9 cm before the optimization) while preserving the input animation without noticeable visual difference.


With regard to one useful practical implementation of the method in a computing system/robot controller (offline and offboard or onboard the robot being controlled), the simulations and optimizations were performed on a machine with an Intel Core i7700 processor (4 cores, 4.2 GHz) with 32 GB of RAM. The evaluation of internal force and tangent stiffness matrices of the deformable bodies are performed in multi-threads. For minimization, the standard interior-point method was relied upon and BFGS as implemented in the KNITRO software package. In the experiments, the relative residual tolerance was set to 10−4 and the maximum number of minimization iterations to 100. The minimizations converged well and substantially decreased the vibrations from the input sequence, without sacrificing the quality of motion.


In the above description, a computational tool is presented that retargets artist-created animation (or other input animation) onto physical robotic characters while minimizing unwanted vibrations due to system dynamics. Using modal reduction to speed up simulation, the two-way coupling between rigid bodies and flexible bodies was accurately modeled. Leveraging this simulation model, the motor control was optimized via a continuous adjoint method such that the physical character motion matches the artistic intent as closely as possible. The approach provides an automated way to retarget digital animations onto physical characters and could also be used to evaluate the design of a physical robot before it is built. Moreover, by suppressing vibrations with the tuning of motor trajectories, the tool enables the design of expressive robotic characters that can be less stiff and, therefore, lighter, cheaper, and more accessible to all.


Beyond the application of motion retargeting, the pipeline incorporates elements that will in general be valuable for simulation of multi-body systems incorporating coupled rigid-body dynamics and deformable bodies. The simulator captures the dynamic response of the physical characters well. However, it can be observed that there is still some deviation between the simulated dynamics and physical system, leading to small residual vibrations. This is likely due to the assumptions of perfectly stiff motor controls and mechanical joints, which in reality will have some non-infinite stiffness. A promising approach for eliminating these small residual vibrations would be to implement an online closed-loop controller on the robot, where the tracked marker point trajectory is measured, and the motor control adjusted accordingly. This would make the approach more robust to modeling errors and to unexpected variations in the external loads.


In one implementation, the user decides which components to model as rigid and which to model as deformable. In many applications, this distinction is easy to make. However, for very large and complex assemblies, it could be beneficial to automate this selection. While the design of the robotic characters is held fixed and focus is provided on the control problem herein, the formulation of the computational tool would also support the optimization of parameterized dimensions of components or the positions and orientations of mechanical joints.


Below, implementation-ready generalized mass matrices are provided for the relative coordinate formulation (with detailed derivatives provided afterwards). In derivations of mass matrices, one can make use of the observation that the interpolated displacements can be written as sums of columns of the 3×3n basis matrix times a single entry uk of the displacements u∈custom character3n to provide:

u(X,t)=Φ(X)u(t)=ΣkΦk(X)uk(t)  Eq. (28)

The mass matrices are:












M

1

_

=



Ω





ρΦ
T

[
X
]

x


dX










M

2

_



(
u
)


=



k



(



Ω





ρΦ
T

[

Φ
k

]

x


d

X


)



u
k









M

3

_

=



Ω



ρΦ
T


dX










M

4

_

j

=



Ω


ρ

X


Φ
j
T


dX










M

5

_

j



(
u
)


=



k



(



Ω



ρΦ
k



Φ
j
T


d

X


)



u
k









M

6

_

=



Ω



ρΦ
T


dX







Eq
.


(
29
)








The following provides supplemental materials relevant to the materials discussed in detail above including derivations of the relative coordinate formulation of the equations of motion and derivations of the adjoint system that is used to compute analytical gradients for the retargeting optimization.


Turning first to derivation of the relative coordinate formulation, the deformed configuration is provided by:

x(X,t)=R(t)[X+Φ(X)u(t)]+c(t)


In deriving the corresponding velocity and acceleration, the arguments in the expression x=R(X+Φu)+c are dropped.


The velocity of the deformed configuration is:










x
.

=




R
.

(

X
+

Φ

u


)

+

R

Φ


u
.


+

c
.








=





[
ω
]

x



R

(

X
+

Φ

u


)


+

R

Φ

v

+
w









and its acceleration:










x
¨

=




R
¨

(

X
+

Φ

u


)

+

2


R
.


Φ


u
.


+

R

Φ


u
¨


+

c
¨








=




(




[

ω
.

]

x


R

+



[
ω
]

x
2


R


)



(

X
+

Φ

u


)


+



2
[
ω
]

x


R

Φ

v

+

R

Φ


v
.


+

w
.








=



R

Φ

v

+



[

ω
.

]

x



R

(

X
+

Φ

u


)


+

w
.

+



[
ω
]

x
2



R

(

X
+

Φ

u


)


+



2
[
ω
]

x


R

Φ

v



=

R

Φ


v
.






db



acc
.





-













R

(



[
X
]

x

+


[

Φ

u

]

x


)



R
T



ω
.


+

w
.





Rb



acc
.




+




R
[


R
T


ω

]

x
2



(

X
+

Φ

u


)





Centrifugal



acc
.




+


2



R
[


R
T


ω

]

x


Φ

v




Coriolis



acc
.












In the above derivations, the identities {dot over (R)}=[ω]xR and {umlaut over (R)}=[{dot over (ω)}]xR+[ω]x2R are used in the first three lines. Because [RTa]x b=RTa×RTRb=RT[a]xRb, the identity RT[a]xR=[RTa]x holds. For acceleration terms that have subexpressions [a]xRb, the latter identity is used to move the rotation matrix to the left RRT[a]x Rb=R[RTa]xb. For the rigid body acceleration term, the identities [a]xb=−[b]xa and [a+b]x=[a]x+[b]x are used.


To form the inertial forces,

ΩΦTRTρ{umlaut over (x)}dX=∫ΩρΦTRT{umlaut over (x)}dX

the individual acceleration terms are integrated. When integrating the acceleration of the deformable body (db acc.), it is seen why it is useful to multiply with the transpose of the rigid body rotation:

ΩρΦTRTRΦ{dot over (v)} dX=(∫ΩρΦTΦdX){dot over (v)}=M{dot over (v)}

Integration results in the same mass matrix as for the absolute coordinate formulation Mϵcustom character3n×3n.


Integration of the rigid body acceleration (rb acc.) leads to a force:

−(M1+M2(u))RT{dot over (ω)}+M3×RT{dot over (w)}

that depends on a total of three mass matrices:

M1=∫ΩρΦT[X]xdXM2(u)=∫ωρΦTu]xdX M3=∫ΩρΦTdX

where M1custom character3n×3 and M3custom character3n×3 are constant and M2custom character3n×3 depends on the displacement. To efficiently computer M2, the displacement Φu is substituted with Σk=13nΦkuk to give:









M

2

_



(
u
)


=




k
=
1


3

n




(



Ω


ρ




Φ
T

[

Φ
k

]

x


d

X


)



u
k








and precompute the 3n×3 blocks in brackets.


To derive the centrifugal forces, the corresponding acceleration (centrifugal acc.) is first split into two terms:

R((RTω)·(X+Φu))RTω−R(X+Φu)(ω·ω)

where the identity a×(b×c)=(a·c)b−c(a·b) is applied to the subexpression [RTω]x2(X+Φu)=(RTω)×(RTω)×(X+Φu).


To integrate the first term, the integral is split into a sum of integrals and the transpose of the j-th column of Φ:












k
=
1


3

n




(



Ω




ρΦ
j
T

(


R
T


ω

)

·

(

X
+


Φ
k



u
k



)



)



R
T


ω

dX


=



ω
T



R

(




k
=
1


3

n





Ω



ρ

(

X
+


Φ
k



u
k



)



Φ
j
T


d

X



)



R
T


ω

=



ω
T



R

(

(



Ω


ρ

X


Φ
j
T


d

X


)

)


+




k
=
1


3

n




(



Ω


ρ


Φ
k



Φ
j
T


d

X


)



u
k






)



R
T


ω





The derivation of the second term is straightforward.


To form the resulting centrifugal forces:








f
cen

(

q
,
u
,
ω

)

=





j
=
1


3

n




ω
T



R

(




M

4

_

j

+




M

5

_

j



(
u
)



)



R
T


ω


e
j



-


(



M

6

_

+


M
_


u


)



(

ω
·
ω

)








where ej is the j-th column of the 3n×3n identity matrix, and the additional mass matrices are precomputed:










M

4

_

j

=



Ω


ρ

X


Φ
j
T


dX










M

5

_

j



(
u
)


=




k
=
1


3

n




(



Ω


ρ


Φ
k



Φ
j
T


d

X


)



u
k









M

6

_

=



Ω


ρ


Φ
j
T


X

d

X







Analogously to M2, the blocks in brackets for matrix M5j are precomputed. Because Φ has 3n columns, there are 3n 3×3 matrices M4j and M5j(u)(j=1, . . . , 3n). M6 is a 3n vector.


To derive the Coriolis force:

fcor(q,ω,v)=−2M2(v)RTω

[RTω]x is substituted for a and Φv for b in the identity [a]xb=−[b]xa in the Coriolis term (Coriolis acc.) prior to integration. For this term, M2 is reused, setting its parameter to the velocities v instead of the displacement u. Note that the fictitious centrifugal and Coriolis forces depend on q because quaternions are used instead of rotation matrices. In some implementations, rotations may be extracted from quaternions R(q).


In a reduced formulation, the displacements are defined as:

u(X,t)=Φ(X)Urur(t)


To derive the reduced mass matrices and inertial forces, the full basis Φ(X) can be replaced with the reduced basis Φr(X)=Φ(X)Ur in the above derivations. Again, arguments are dropped for conciseness. Φr is now a 3×r-matrix, ur a r-vector, and ϕr,kcustom character3 the k-th column of Φr.


The mass matrices are:









M
_

r

=



U
r
T



M
_



U
r


=

E
rxr









M

1

_

r

=


U
r
T




M

1

_










M

2

_

r



u
r


=

(




k
=
1

r



(



Ω





ρΦ
r
T

[

Φ

r
,
k


]

x


d

X


)



u

r
,
k




)








M

3

_

r

=


U
r
T




M

3

_









M

4

_


r
,
j


=



Ω


ρ

X


Φ

r
,
j

T


dX










M

5

_


r
,
j




(

u
r

)


=




k
=
1

r



(



Ω



ρΦ

r
,
k




Φ

r
,
j

T


d

X


)



u

r
,
k











M

6

_

r

=


U
r
T




M

6

_








where numerical integration is used to precompute the blocks in brackets for M2r(ur) and M5r,j(ur), and the j-th 3×3 matrices M4r,j.


The inertial forces corresponding to the deformable body (db acc.) reduce to:

UrTMUr{dot over (v)}r={dot over (v)}r

and for the rigid body (rb acc.) to:

−(M1r+M2r(ur))RT{dot over (ω)}+M3rRT{dot over (w)}


The centrifugal force becomes:








f
cen

(

q
,

u
r

,
ω

)

=





j
=
1

r



ω
T



R

(




M

4

_


r
,
j


+




M

5

_


r
,
j




(
u
)



)



R
T


ω


e
j



-


(



M

6

_

+


M
_


u


)



(

ω
·
ω

)








where ej is the j-th column of the r×r identity matrix, and the reduced Coriolis force is:

fcor(q,ω,vr)=−2M2r(vr)RTω


With regard to derivation of the adjoint system, one is required to solve the retargeting problem:









min
P


G

(

p
,

U

(
p
)


)


+

R

(
p
)






subject


to



G

(

t
,
p
,

S

(

t
,
p

)

,


S
.

(

t
,
p

)


)


=


0


and



S

(
0
)


=


S
0

(
p
)








which requires the computation of an analytical gradient








d


G

(

p
,

U

(
p
)


)



d

p


.




While the presented semi-implicit DAE system can easily be brought into standard Hessenberg index-2 form, we prefer to keep the mass matrix M on the left-hand side because it simplifies the adjoint DAE.


To keep the derivation general, the objective is assumed to depend on the state S for the first part of the derivation:







G

(

p
,

S

(
p
)


)

=



0
T



g

(

t
,
p
,

S

(
p
)


)


dt






The augmented objective with continuous, time-dependent Lagrange multipliers λ(t) for the above problem is:







I

(

p
,
S

)

=


G

(

p
,
S

)





0
T



λ
T



G

(

t
,
p
,
S
,

S
.


)


dt







Because the DAE system is satisfied at every t, the total derivative of G and I are equivalent such that:








d

G


d

p


=




0
T



(


g
p

+


g
s



S
p



)


d

t


-



0
T



(


G
p

+


G
S



S
p


+


G

S
.





S
.

p



)


d

t








where subscripts are used for partial derivatives. Note that Sp and {dot over (S)}p are total derivatives.


Integration by parts of the term λTG{dot over (S)}{dot over (S)}p:












0
T



λ
T



G

S
.





S
.

p


d

t


=

(


λ
T



G

S
.




S
p


)




"\[RightBracketingBar]"


0
T

-



0
T



d

d

t




(


λ
T



G

S
.



)



S
p


d

t







enables the dependence on {dot over (S)}p to be turned into a dependence on Sp:










d

G


d

p


=




0
T



(


g
p

-


λ
T



G
p



)


d

t


-



0
T



(


-

g
S


+


λ
T



G
S


-


d

d

t




(


λ
T



G

S
.



)



)



S
p


dt


-



(


λ
T



G

S
.




S
p


)






"\[RightBracketingBar]"


0
T




By setting the term in brackets of the second integrand to zero, the adjoint system is then formed:








d

d

t




(


λ
T



G

S
.



)


=



λ
T



G
S


+

g
S






Applying the chain rule and transposing the system, the adjoint DAE is formed:








G

S
.

T



λ
.


=



(


-


(


d


G

S
.




d

t


)

T


+

G
S
T


)


λ

+

g
S
T






For this particular DAE system:






G
=


[





U
.

-


T

(
U
)


V









M

(
U
)



V
.


-

F

(

U
,
V

)

-



(



C
U

(

t
,
U

)



T

(
U
)


)

T


Λ









C
t

(

t
,
U

)

+



C
U

(

t
,
U

)



T

(
U
)


V

+

α


C

(

t
,
U

)






]

=
0






the Jacobian with regard to the state is:

GS=[GU(t,U,V)GV(t,U,V)GΛ(t,U)]

with columns:








G
U

=

[





-


T
U

(
U
)



V









M
U

(
U
)



V
.


-


F
U

(

U
,
V

)

-


(




C

U
,
U


(

t
,
U

)



T

(
U
)


+



C
U

(

t
,
U

)




T
U

(
U
)



)

T









C

t
,
U


(

t
,
U

)

+


(




C

U
,
U


(

t
,
U

)



T

(
U
)


+



C
U

(

t
,
U

)




T
U

(
U
)



)


V

+

α


C

(

t
,
U

)






]









G
V

=

[




-

T

(
U
)







-


F
V

(


U



V

)









C
U

(

t
,
U

)



T

(
U
)





]


,


and



G
Λ


=

[

-


(



C
U

(

t
,
U

)



T

(
U
)


)

T


]










where



C

t
,
U



=






2

C




t




U





and



C

U
,
U



=





2

C




U
2



.








The Jacobian with regard to the time-derivative of the state is:







G

S
.


=

[



E











M

(
U
)












]






And its time-derivative is:








d



G
.


S
.




d

t


=

[











M
U

(
U
)



U
.










]






where only the “center” element of the 3-by-3 block matrix is non-zero.


For the particular system discussed herein, g only depends on generalized positions and velocities:

gS=[gUgV]


In summary, the linear adjoint DAE is:








[



E














M
T


















]



λ
.


=



(


-

[




















U
.

T



M
U
T



















]


+


[




G
U
T






G
V
T






G
Λ
T




]


)


λ

+

[




g
U
T









g
V
T












]






It remains to discuss initial conditions. To evaluate the gradient








d

G


d

p


,





one requires:

TG{dot over (S)}Sp)|t=0 and (λTG{dot over (S)}Sp)|t=T


At time t=0, the Jacobian Sp is equal to the analytical derivative







d


S
o



d

p






of the initial conditions S0. If the initial conditions for the adjoint DAE are set to be λ(T)=0, then:

TG{dot over (S)}Sp)|t=T=0


Note that the initial conditions S0 for the DAE are not dependent on p because the system is assumed to be at rest at the start of an animation. Hence, Sp is zero at time t=0, and, therefore:

TG{dot over (S)}Sp)|t=0=0


If objective g depends on the algebraic variables Λ, the initial conditions for the adjoint DAE, λ(T)=0, are in conflict with the adjoint DAE, and an additional treatment is necessary.


In summary, the analytical gradient of the objective is:








d

G


d

p


=



0
T



(


g
p

-


λ
T



G
p



)


d

t







where the adjoint variables λ(T) are computed by solving the linear adjoint DAE:








[



E














M
T


















]



λ
.


=



(


-

[




















U
.

T



M
U
T



















]


+


[




G
U
T






G
V
T






G
Λ
T




]


)


λ

+

[




g
U
T









g
V
T












]







with initial conditions.


With this explanation of a computation method involving differentiable simulation understood, it is appropriate for the description to turn to two different implementations of a robot control method (and robotic controllers and robots with such controllers) using learning to support real-time, vibration-suppressing control. In brief, each implementation of the method uses state-of-the-art machine learning techniques in conjunction with a differentiable dynamics simulator to yield fast and accurate vibration suppression.


The new control method may be implemented in a robot or robotic system with a hardware-accelerated controller. This controller may use accurate (and slow) differentiable simulation to learn or train the control techniques (e.g., use the output of the differentiable simulation as training data for machine learning). In these or other controllers, hardware acceleration can then be used to provide real-time control of a robot's actuators (e.g., motors) with control signals (e.g., filtered control parameters and the like for motors). The robot/robotic system may be configured to provide sensory feedback (output of one-to-many sensors on the robot/robotic system) to: (1) suppress residual vibrations (e.g., simulation-to-real gap); and (2) increase robustness (e.g., with regard to system degradation or wear over time for the robot/robotic system components).



FIG. 14 illustrates a functional block diagram of a robot or robotic system 1400 of the present description. The robotic system 1400 includes a controller 1410 with a processor(s) 1412 running software or executing code (in onboard memory 1460) to provide a variety of control functions. Specifically, the processor 1412 executes code to provide machine learning with module 1414, and this may be used to train or learn operations of the controller 1410 including that of the differentiable simulator 1416 and/or optimization module (or optimizer 1418), as is discussed in more detail below.


The controller uses the simulator 1416 and optimization module 1418 to generate control signals (e.g., filtered control parameters such as motor trajectories) that are output to actuators (e.g., motors 1430) to move the flexible and rigid components 1440 of the robotic system 1400 with real-time vibration suppression. The system 1400 includes memory 1460 that stores received or generated training data 1462 that is processed by the machine learning module 1414 to train the simulator 1416 and/or optimizer 1418. The memory 1460 also stores input 1464 that may take the form of animations or unfiltered control parameters (e.g., motor trajectories created based on animations) for the robotic system 1400. The controller 1410, based on machine learning, uses these inputs 1464 to generate the control signals 1420. In operations of some embodiments, sensory feedback (or sensor output) 1454 from one-to-many onboard sensors 1450 are used to initially or further train or learn the controller 1410 (e.g., to account for wear).


In some implementations, the system 1400 is configured for suppressing vibration during operations of the robotic system. The system includes memory (e.g., any useful data storage device) storing a definition of a robot defining a plurality of components of the robot and storing an input animation for the robot defining motion of the components of the robot over a time period. The system also includes a processor (which may include one or more processing devices) communicatively linked to the memory (in a wired or wireless manner allowing communication of digital data). The system further includes a simulator provided by the processor running software (or executing code or instructions in onboard RAM or the like). During operations of the system, the simulator performs a dynamic simulation of the robot performing the input animation including modeling a first set of the components as flexible components (or bodies) and a second set of the components as rigid components (or bodies). Note, the simulation is only performed during training. For real-time control, the differentiable simulation is no longer needed nor used (because it would be too slow). Each of the flexible components is coupled at opposite ends to one of the rigid components, and the dynamic simulation predicts vibrations for the robot in performing the defined motion. The system further includes an optimizer provided by the processor running software (e.g., executing instructions or code in RAM or the like). The optimizer generates a retargeted motion for the components by adjusting the defined motion to suppress a portion of the vibrations.


In some embodiments of the system, the portion of the vibrations that is suppressed is low-frequency, large-amplitude vibrations of one or more of the components of the robot. In these and other embodiments, the ends of the flexible components are coupled to the rigid components using constraint-based, two-way coupling. Flexible joints may also be sources of compliance. Further, the input animation may include a set of motor trajectories, and, in such cases, the optimizer modifies the set of motor trajectories to generate the retargeted motion for the components. Additionally, the memory may store a set of user-selected points on the components of the robot, and the optimizer may modify the set of motor trajectories to retain trajectories of the user-selected points from the defined motion in the retargeted motion. In some cases, the set of user-selected points are on end effectors or rigid bodies of the robot.


In some preferred implementations of the system, the optimizer generates the retargeted motion by minimizing differences between locations of a set of tracked marker points attached to rigid bodies in the components of the robot in the defined motion and in the retargeted motion and by allowing vibrations in one or more of the components disposed between the set of rigid bodies. In such implementations, the minimization of differences is adapted to allow some amount of overshooting of target locations of the set of tracked marker points to reduce global error regarding relative positioning of the set of tracked marker points during the retargeted motion, by minimizing the error integrated over time.


In some cases, the components of the robot include tracked marker points, and the generating of the retargeted motion comprises retaining orientations of the tracked marker points in orientations in the defined motion of the input animation. In these and other cases, the generating of the retargeted motion includes retaining relative positions in global coordinates of pairs of neighboring ones of the rigid components. If the global coordinates of rigid bodies adjacent to a deformable body are tracked, the accumulation of vibrations in deformable components can be controlled. Additionally, the system may include a robot controller including the processor, and the robot controller is adapted to generate a set of control signals for a physical implementation of the robot (e.g., to control the physical robot) based on the retargeted motion generated by the optimizer.



FIG. 15 is a schematic or flowchart of one embodiment of vibration suppression 1500 that may be carried out, at least in part, by a controller of a robotic system (such as the controller of the robotic system of FIG. 14). The vibration suppression (or control method including vibration suppression) 1500 may be configured to use the computational vibration suppression provided by the simulator described above. To this end, the vibration suppression 1500 includes a differentiable simulation step 1520 that takes as input control parameters 1510, which may include unfiltered control parameters 1560 processed in an optimization step 1550. The simulation 1520 provides the state (over time) 1524 of the robotic actuators/components, and these are compared in a compare performance step 1540 with the target state 1534 provided by an input animation (or set of target motor trajectories). The optimization step 1550 takes the output of comparison step 1540 to modify the unfiltered or input control parameters 1560 to generate filtered control parameters or output 1570 with vibration suppression control. The target states 1534 provided by the input animation 1532 may be thought of as the training data 1530 for machine learning in the vibration suppression 1500.


As can be seen in the vibration suppression 1500 of FIG. 15, the computational vibration suppression discussed above can be used to generate pairs of unoptimized and optimized, time-varying motor values and corresponding simulation states. These create training data 1530 that provide learning algorithms with data for supervised learning. FIG. 16 illustrates data flow 1600 during supervised learning in a robot controller of this variant or embodiment of the present description. As shown, a neural network 1610, which may be performing learning algorithms, receives as input unfiltered control parameters 1630 and outputs filtered control parameters 1640, with processing or learning based on a set of training data 1620. Further, a loss function 1650 may be applied to measure the mean square error (MSE) between the optimized motor values the optimization produces with the filtered ones 1640 the network 1610 produces for given input values.


Because the simulation representation accurately predicts the dynamic behavior of the physical system, a combination of simulation and optimization can be used to generate a large body of realistic data 1530, without the need to run animations on the physical system. In a basic form, the neural network 1610 takes unfiltered time-varying motor values 1630 as input and produces filtered motor values 1640 as output. A loss function 1650 measures the means square error (MSE) for given input values. In a more advanced version, the network 1610 would additionally take state information (such as position, orientation, linear and/or angular velocities of assembly components, and the like) as input. During training, simulation data could be used as the training data 1620 while, after a deployment on a hardware system (e.g., a robot), sensory feedback could be used as training data 1620 to feed to the network 1610 instead.



FIG. 17 illustrates data flow 1700 during learning in a second variant or implementation of a robot controller of the present description. A neural network 1710, which may be performing learning algorithms (e.g., state and sequence data (or “history” of vibrations) used to do training), receives as input unfiltered control parameters 1720 and outputs filtered control parameters 1714. Kinematics 1730 (with no compliance) provide target data 1734 over time. Significantly, differential simulation 1712 is integrated as an explicit, last single-node layer of the neural network 1710 to process the filtered control parameters 1714 as input and output a simulation state 1740 of the robotic system over time. It is important to understand that this node does not have a weight assigned and is only used during training, but not during real-time vibration suppression. This enables the formulation of a loss function 1750 that depends on the time-varying simulation state 1740 of the assembly, such that it directly measures the performance of a candidate set of time-varying motor angles (e.g., in output control signals or control parameters 1714).


The use of the differential simulator as a node in the neural network 1710 is expected by the inventors to lead to higher sampling efficiency so that the training/data flow 1700 should require less training data. The differentiability of the simulator enables the treatment of the simulator as a normal node when using back propagation to train the network 1710 (e.g., as a node without a weight, only present during training). In many cases, the simulation node 1712 does not have any weights. The use of the differential simulator 1712 as the last node of a network 1710 fed with control inputs 1714 and outputting the time varying state 1740 enables the formulation of more meaningful loss functions 1750 that measure the effectiveness of the learned controller by comparing, for example, the differences in absolute positions or orientations of components to their target positions and orientations.


It will be understood by those skilled in the art that an additional figure or drawing could be provided to illustrate further how the network is used after training. For example, from FIGS. 16 and 17, one could extract the first block (1630, 1610, 1640) with the understanding that this represents the controller deployed to the robot and is evaluated in real-time.


With regard to either variant or embodiment for real-time vibration suppression control, the robustness of the learned control strategy can be further increased by perturbing material, damping, and mass property parameters (as well as other parameters). Evaluations of the neural network are fast, and a network can be deployed on custom hardware on the robot for tight integration (e.g., in a robotic system controller). With regard to the input (or generation and sampling of input animation data), the animation input can be generated by transferring a large set of artist-specified Maya or other animation with inverse kinematics onto a robotic assembly (e.g., for storage in its onboard memory). Alternatively, a task space of a robotic system can be sampled in position-orientation, velocity, and/or joint space with, for example, a correlated Gaussian process.


The neural networks may take a variety of forms to implement the vibration suppressing control described herein. The neural networks may include several layers of either 1D convolutional networks (e.g., U-net CNNs convolutional networks (1D)), 1D recurrent neural networks (e.g., RNNs or alternatives such as long short term memory (LSTM) networks or gated recurrent units (GRUs)), or combinations of the two. Standard regularization strategies may also be used such as recurrent dropout, while other neural networks for controllers taught herein may use regularization objectives that are co-optimized with the loss function. A U-net-like network with dilated convolution may also be used to reduce the number of parameters.


Although the invention has been described and illustrated with a certain degree of particularity, it is understood that the present disclosure has been made only by way of example, and that numerous changes in the combination and arrangement of parts can be resorted to by those skilled in the art without departing from the spirit and scope of the invention, as hereinafter claimed.


The inventive control method (and controllers implementing the method) retains the prediction accuracy of an accurate nonlinear simulator. It uses this simulator to learn to interactively predict vibration-suppressing, time-varying motor values. The control methods taught herein can be used for closed-loop, hardware-deployable vibration suppression on robotic systems that use sensory feedback, and, hence, the new control methods can adapt to wear. The control methods can also be very useful for interactive animation tasks as designers get feedback and input during the design process. The controller can be trained ahead of time (or before it is used to provide real-time control of a robot) by learning on a large or expanded machine using slower simulations (e.g., learn so that they can more easily be implemented in hardware).


From the above discussion, it should be clear that, in some preferred embodiments of vibration suppression, the system/method models not only the compliance in components but also the compliance in joints. For human-sized figures, for example, the compliance in actuators or joints is dominant, and the vibration suppression techniques take into account compliance in joints and/or actuators. Also, from the above discussion, it should be clear that the differentiable simulation (slow) is typically only used during training of the network and not during real-time evaluations. During training, it is a node without a weight or parameter, and its differentiability is used for backpropagation. During evaluations, this node is no longer present, and the control inputs are directly sent to the robot (fast).

Claims
  • 1. A robotic system configured for real-time vibration-suppressing control, comprising: a plurality of components connected by mechanical joints, wherein a subset of the components is modeled as rigid bodies and a subset is modeled as flexible bodies and wherein a subset or all of the mechanical joints is modeled as flexible joints;memory storing input comprising unfiltered control parameters specifying motion of the components over a time period;a plurality of actuators operable in response to control signals to impart the motion of the components over the time period; anda controller comprising: a processor communicatively linked to the memory;an optimizer provided by the processor running software, wherein the optimizer generates filtered control parameters defining a retargeted motion for the components by adjusting the defined motion to suppress vibrations, wherein the optimizer is trained via machine learning based on a set of training data prior to generating the retargeted motion, and wherein the controller generates the control signals for operating the actuators based on the filtered control parameters,wherein a first portion of the machine learning is performed prior to operations of the controller to generate the control signals and is halted during the operations to generate the control signals, wherein the first portion of the machine learning comprises comparisons of target states defined by a plurality of input animations defining motions for the components via operations of the actuators and states determined by a differentiable simulator, wherein the differentiable simulator performs a dynamic simulation of the robotic system performing the retargeted motions with the components, and wherein the dynamic simulation predicts the vibrations for the robotic system in performing the retargeted motion.
  • 2. The system of claim 1, further comprising a plurality of sensors monitoring operations of the robotic system and wherein training data for a second portion of the machine learning continued during operations of the plurality of actuators includes sensory feedback from the plurality of sensors.
  • 3. The system of claim 1, wherein the optimizer comprises a neural network configured for the machine learning and wherein the neural network comprises layers of at least one of one dimensional (1D) convolutional networks and 1D recurrent neural networks.
  • 4. The system of claim 1, wherein the portion of the vibrations that is suppressed comprises low-frequency, large-amplitude vibrations of one or more of the components of the robot, wherein the unfiltered control parameters include a set of motor trajectories, and wherein the optimizer modifies the set of motor trajectories to generate the retargeted motion for the components.
  • 5. The system of claim 1, wherein the optimizer comprises a neural network configured for the machine learning and to take as input the unfiltered control parameters and output the filtered control parameters.
  • 6. The system of claim 5, wherein the neural network includes a final node comprising the differentiable simulator, wherein the differentiable simulator performs the dynamic simulation of the robotic system performing the retargeted motions with the components.
  • 7. The system of claim 6, wherein the differentiable simulator outputs a time varying state of the robotic system and wherein the controller further comprises a loss function that measures, based on the time varying state, effectiveness of the learned controller by comparing differences in absolute positions or orientations of the components to their target positions or orientations.
  • 8. A robotic system configured for real-time vibration-suppressing control, comprising: a plurality of components;memory storing input comprising unfiltered control parameters specifying motion of the components over a time period;a plurality of motors operable to impart the motion of the components;a plurality of sensors monitoring operations of the robotic system; anda controller comprising: a processor communicatively linked to the memory;an optimizer provided by the processor running software, wherein the optimizer generates, based on the unfiltered control parameters, filtered control parameters defining a retargeted motion for the components by adjusting the defined motion to suppress vibrations of one or more of the components,wherein the optimizer is trained, prior to generating the retargeted motion, via machine learning based on a set of training data,wherein the vibrations that are suppressed consist of low-frequency, large-amplitude vibrations of one or more of the components of the robot,wherein the controller operates the actuators based on the filtered control parameters, andwherein the training data includes sensory feedback from the plurality of sensors.
  • 9. The system of claim 8, wherein the machine learning comprises comparisons of target states defined by a plurality of input animations defining motions for the plurality of components via operations of the actuators and states determined by a differentiable simulator, wherein the differentiable simulator performs a simulation of the robotic system performing the retargeted motions with the plurality of components, and wherein the dynamic simulation predicts vibrations for the robotic system in performing the retargeted motion.
  • 10. The system of claim 8, wherein the optimizer comprises a neural network configured for the machine learning and wherein the neural network comprises layers of at least one of 1D convolutional networks and 1D recurrent neural networks.
  • 11. The system of claim 8, wherein the unfiltered control parameters include a set of motor trajectories and wherein the optimizer modifies the set of motor trajectories to generate the retargeted motion for the components.
  • 12. The system of claim 8, wherein the optimizer comprises a neural network configured for the machine learning and to take as input the unfiltered control parameters and output the filtered control parameters.
  • 13. The system of claim 12, wherein the neural network includes a final node comprising a differentiable simulator, wherein the differentiable simulator performs a dynamic simulation of the robotic system performing the retargeted motions with the components, and wherein the dynamic simulation predicts vibrations for the robotic system in performing the retargeted motion.
  • 14. The system of claim 13, wherein the differentiable simulator outputs a time varying state of the robotic system and wherein the controller further comprises a loss function that measures, based on the time varying state, effectiveness of the learned controller by comparing differences in absolute positions or orientations of the components to their target positions or orientations.
  • 15. A robotic system configured for real-time vibration-suppressing control, comprising: a plurality of components;memory storing input comprising unfiltered control parameters specifying motion of the components over a time period; anda controller comprising: a processor communicatively linked to the memory;an optimizer provided by the processor running software, wherein the optimizer generates filtered control parameters defining a retargeted motion for the components by adjusting the defined motion to suppress vibrations of one or more of the components,wherein the optimizer comprises a neural network that is trained via machine learning based on a set of training data to suppress the vibrations while concurrently minimizing differences between the filtered control parameters and simulated control parameters in the set of training data, andwherein the neural network includes a final node comprising a differentiable simulator, wherein the differentiable simulator performs a dynamic simulation of the robotic system performing the retargeted motions with the plurality of components, and wherein the dynamic simulation predicts vibrations for the robotic system in performing the retargeted motion,wherein a first portion of the machine learning is performed prior to operations of the controller to generate control signals and is halted during the operations to generate the control signals.
  • 16. The system of claim 15, further comprising a plurality of sensors monitoring operations of the robotic system and wherein the set of the training data includes sensory feedback from the plurality of sensors.
  • 17. The system of claim 15, wherein the differentiable simulator outputs a time varying state of the robotic system and wherein the controller further comprises a loss function that measures, based on the time varying state, effectiveness of the learned controller by comparing differences in absolute positions or orientations of the components to their target positions or orientations.
  • 18. The system of claim 15, wherein the neural network comprises layers of at least one of 1D convolutional networks and 1D recurrent neural networks and wherein the portion of the vibrations that is suppressed comprises low-frequency, large-amplitude vibrations of one or more of the components of the robot.
US Referenced Citations (3)
Number Name Date Kind
10960549 Inagaki et al. Mar 2021 B2
20200338724 Hayashi et al. Oct 2020 A1
20220143820 Bashkirov May 2022 A1
Non-Patent Literature Citations (1)
Entry
Zhao Liu, et al. “Rigid-Flexible Coupling Simulation and Vibration Analysis of Flexible Robot”, 2017, IEEE (Year: 2017).
Related Publications (1)
Number Date Country
20220184802 A1 Jun 2022 US