Early prediction of an intention of a user's actions
11049010 · 2021-06-29
Assignee
Inventors
Cpc classification
B25J9/161
PERFORMING OPERATIONS; TRANSPORTING
B25J9/1664
PERFORMING OPERATIONS; TRANSPORTING
G06T7/277
PHYSICS
G06V40/28
PHYSICS
B25J9/0003
PERFORMING OPERATIONS; TRANSPORTING
International classification
G06T7/277
PHYSICS
Abstract
A computer-implemented method includes recording, with a three-dimensional camera, one or more demonstrations of a user performing one or more reaching tasks. Training data is computed to describe the one or more demonstrations. One or more weights of a neural network are learned based on the training data, where the neural network is configured to estimate a goal location of the one or more reaching tasks. A partial trajectory of a new reaching task is recorded. An estimated goal location is computed, by a computer processor, by applying the neural network to the partial trajectory of the new reaching task.
Claims
1. A computer-implemented method of training a learning system to predict intentions of reaching tasks of an arm of a user, wherein the learning system controls a robot to avoid collisions and redundant actions with the person, wherein the learning system including a training unit and an on-line learning unit, wherein the training unit trains a neural network (NN) based on training data derived from one or more user demonstrations of reaching tasks; and wherein the online learning unit predicts intentions for new reaching tasks and updates the NN in real time based on test data derived from the reaching tasks, and the method comprising the learning system: recording, with a camera of the learning system, one or more demonstrations of the user to capture data z.sub.t in three-dimensions, wherein each demonstration represents the user performing one or more reaching tasks via their arm, and wherein the captured data z.sub.t represents positions in three dimensions of arm joints of the user, including shoulder, elbow, wrist, and palm, to describe overall movement of the arm at a time step t, wherein the arm joint positions are recorded in a camera reference frame corresponding to a point in a reference frame of the robot; deriving, from the measurements obtained from the captured data z.sub.t at the time step t, a state x.sub.t, representing estimated positions, velocities and accelerations of the arm joints, wherein the state x.sub.t depends on both a previous value of the state, at a previous time step t, and an estimated reaching intention g for the arm joints of the user that define a new reaching task, and wherein the arm joint positions, velocities, and accelerations are estimated by applying a Kalman filter to the recorded data; associating each of the one or more demonstrations with corresponding recorded goal locations defined by a culmination of the reaching task, and training the NN based on the one or more demonstrations; computing training data describing the one or more demonstrations from the estimates of the joint positions and the recorded goal locations; learning one or more weights of the neural network based on the computed training data, the neural network being configured to derive an estimated goal location of the one or more reaching tasks, wherein the one or more weights make inferences that estimate the reaching intention g based on starting arm positions and motion trajectories; recording a partial trajectory of a new reaching task; and computing, by a computer processor, the estimated goal location, defining the estimated reaching intention g, of the new reaching task by applying the neural network to the partial trajectory of the new reaching task; wherein computing the estimated goal location comprises solving a parameter inference problem by way of an expectation-maximization (EM) algorithm, wherein the EM algorithm utilizes a nonlinear state transition model, representing a positional state of the robot over time, that is discretized using first-order Euler approximation, and wherein the learning system computes an error in the state x.sub.t, based on the state estimate and measurement of the state, and wherein the error is utilized to update the NN weights at a next time step.
2. The computer-implemented method of claim 1, further comprising executing an online learning algorithm to update the one or more weights of the neural network based at least in part on the estimated goal location of the new reaching task.
3. The computer-implemented method of claim 2, wherein the online learning algorithm is configured to adapt the neural network to varying initial positions of an arm performing one or more future reaching tasks.
4. The computer-implemented method of claim 1, wherein computing the estimated goal location comprises iteratively calculating the estimated goal location based on the neural network and a previous calculation of the estimated goal location.
5. The computer-implemented method of claim 1, further comprising identifying an object reached for in the new reaching task.
6. The computer-implemented method of claim 1, further comprising instructing a robot based on the estimated goal location.
7. A learning system configured for being trained to predict intentions of reaching tasks of an arm of a user, wherein the learning system controls a robot to avoid collisions and redundant actions with the person, wherein the learning system includes a training unit and an on-line learning unit, wherein the training unit trains a neural network (NN) based on training data derived from one or more user demonstrations of reaching tasks; and wherein the online learning unit predicts intentions for new reaching tasks and updates the NN in real time based on test data derived from the reaching tasks, and the system comprising: a memory having computer readable instructions; and one or more processors for executing the computer readable instructions, the computer readable instructions comprising: recording, with a camera of the learning system, one or more demonstrations of the user to capture data z.sub.t in three-dimensions, wherein each demonstration represents the user performing one or more reaching tasks via their arm, and wherein the captured data z.sub.t represents positions in three dimensions of arm joints of the user, including shoulder, elbow, wrist, and palm, to describe overall movement of the arm at a time step t, wherein the arm joint positions are recorded in a camera reference frame corresponding to a point in a reference frame of the robot; deriving, from the measurements obtained from the captured data z.sub.t at the time step t, a state x.sub.t, representing estimated positions, velocities and accelerations of the arm joints, wherein the state x.sub.t depends on both a previous value of the state, at a previous time step t, and an estimated reaching intention g for the arm joints of the user that define a new reaching task, and wherein the arm joint positions, velocities, and accelerations are estimated by applying a Kalman filter to the recorded data; associating each of the one or more demonstrations with corresponding recorded goal locations defined by a culmination of the reaching task, and training the NN based on the one or more demonstrations; computing training data describing the one or more demonstrations from the estimates of the joint positions and the recorded goal locations; learning one or more weights of the neural network based on the computed training data, the neural network being configured to derive an estimated goal location of the one or more reaching tasks, wherein the one or more weights make inferences that estimate the reaching intention g based on starting arm positions and motion trajectories; recording a partial trajectory of a new reaching task; and computing, by a computer processor, the estimated goal location, defining the estimated reaching intention g, of the new reaching task by applying the neural network to the partial trajectory of the new reaching task; wherein computing the estimated goal location comprises solving a parameter inference problem by way of an expectation-maximization (EM) algorithm, wherein the EM algorithm utilizes a nonlinear state transition model, representing a positional state of the robot over time, that is discretized using first-order Euler approximation, and wherein the learning system computes an error in the state x.sub.t, based on the state estimate and measurement of the state, and wherein the error is utilized to update the NN weights at a next time step.
8. The system of claim 7, the computer readable instructions further comprising executing an online learning algorithm to update the one or more weights of the neural network based at least in part on the estimated goal location of the new reaching task.
9. The system of claim 8, wherein the online learning algorithm is configured to adapt the neural network to varying initial positions of an arm performing one or more future reaching tasks.
10. The system of claim 7, wherein computing the estimated goal location comprises iteratively calculating the estimated goal location based on the neural network and a previous calculation of the estimated goal location.
11. The system of claim 7, the computer readable instructions further comprising identifying an object reached for in the new reaching task.
12. The system of claim 7, the computer readable instructions further comprising instructing a robot based on the estimated goal location.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) The subject matter regarded as the invention is particularly pointed out and distinctly claimed in the claims at the conclusion of the specification. The foregoing and other features and advantages of the invention are apparent from the following detailed description taken in conjunction with the accompanying drawings in which:
(2)
(3)
(4)
(5)
(6)
DETAILED DESCRIPTION
(7) Embodiments of a learning system described herein infer the intention of a user's movements, such as arm movements, based on observations from a three-dimensional (3D) camera. In some embodiments, the intention that is inferred is a goal, or future, location of an arm reaching task in 3D space.
(8) In some embodiments, the learning system models nonlinear motion dynamics of a user's arm using a nonlinear function, with intentions represented as parameters. A model for the motion may be learned through use of a neural network (NN). This model may be a state-space model, where the NN may be used to represent state propagation. Joint positions and velocities of a human skeletal structure of the user may be used as states, while intentions may be parameters of the state-space model.
(9) Based on the learned model, an approximate expectation-maximization (E-M) algorithm may be developed to infer human intentions. More specifically, by using a NN, intention inference may be solved as a parameter inference problem using an approximate expectation-maximization (EM) algorithm. The intention inference problem may handle three sources of uncertainty: uncertain system dynamics, sensor measurement noise, and unknown human intent. Further, in some embodiments, an identifier-based online model learning algorithm may adapt to variations in the motion dynamics, motion trajectory, goal locations, and initial conditions of varying human users.
(10)
(11) The learning system 100 may include a training unit 150 and an online learning unit 160, both of which may be hardware, software, or a combination of hardware and software. Generally, the training unit 150 may train a neural network (NN) 170 based on training data derived from one or more user demonstrations of reaching tasks; and the online learning unit 160 may predict intentions for new reaching tasks and may also update the NN 170 based on test data derived from these new reaching tasks.
(12) In some embodiments, the learning system 100 may be implemented on a computer system and may execute a training algorithm and an online learning algorithm, executed respectively by the training unit 150 and the online learning unit 160, as described below. Further, the learning system 100 may be in communication with a camera 180, such as Microsoft Kinect® for Windows® or some other camera capable of capturing data in three dimensions, which may record demonstrations of reaching tasks as well as new reaching tasks after initial training of the NN 170.
(13) For the purpose of this disclosure, there may be a set of intentions G={g.sub.1, g.sub.2, . . . , g.sub.3}, where each g.sub.i ∈ .sup.3 represents a goal location, which may be a location in 3D space of an object in the workspace. Each reaching task performed may be associated with an intention g ∈ G, which may be a location at which the reaching task culminates. For example, and not by way of limitation, G may represent a set of finite locations on a table. Although it is assumed throughout this disclosure that G includes a set of finite values, it will be understood that some embodiments may be extended to cover a continuous G.
(14) In some embodiments, a state x.sub.t may represent the various positions and velocities of selected points on a user's arm. For instance, x.sub.t ∈ .sup.24 may represent the positions and velocities of four points on the arm, specifically the shoulder, elbow, wrist, and palm, where these points describe overall movement of the arm at a given time step t. The variable z.sub.t ∈
.sup.24 may represent measurements obtained from the camera 180 at the time step t, where x.sub.t may be derived based in part on z.sub.t, as will be described further below. Evolution of the state x.sub.t over time may depend on both a previous value of the state (i.e., at a previous time step) as well as an estimated intention g.
(15)
(16) As shown, at block 205, the learning system 100 may record one or more demonstrations of a user performing reaching tasks. In some embodiments, each demonstration may include culmination of the reaching task at a corresponding goal location. Thus, each such demonstration may be associated with a corresponding goal location. As will be discussed further below, the NN 170 may be trained based on these demonstrations of reaching actions.
(17) At block 210, the learning system 100 obtain estimates of joint positions, velocities, and accelerations for the one or more demonstrations. Specifically, in some embodiments, the joint positions, velocities, and accelerations may be estimated by applying a Kalman filter to the data recorded at block 205, as described further below. Together, these estimates and the goal locations may be used as training data for the NN 170.
(18) In some embodiments, the joint positions may be recorded by the camera 180 in block 205, and may thus be obtained in the camera's frame of reference. Where p.sup.c=(x.sup.c, y.sup.c, z.sup.c).sup.T is a point in the camera's reference frame, and pr=(x.sup.r, y.sup.r, z.sup.r).sup.T is a point in the robot's reference frame, the points p.sup.c and p.sup.r are related by p.sup.c=R.sub.r.sup.cp.sup.r+T.sub.r.sup.c (hereinafter “Formula 1”). In Formula 1, R.sub.r.sup.c ∈ SO(3) and T.sub.r.sup.c ∈ .sup.3 are, respectively, a rotation matrix and a translation vector.
(19) The camera 180 may measure 3D positions of the user's joints, which may be used as raw positions. These raw positions may be input into a Kalman filter to obtain the velocity and acceleration estimates of the joints.
(20) In some embodiments, a measurement model may be represented in the generic form y.sub.t=h(x.sub.t)+v.sub.t, where measurement function h(x.sub.t)=H.sub.x.sub..sup.24×24 is a block diagonal matrix; and {v.sub.t}˜N(0, Σ.sub.z) ∈
.sup.24 is a zero-mean Gaussian noise with a covariance matrix Σ∈
.sup.24×24. The measurement noise {v.sub.t} may be assumed to be independent of the process noise {ω.sub.t} defined in Formula 2, provided below. Further, the measurement model of the shifted measurement vector z.sub.t=y.sub.t−b at time t may be given by z.sub.t=Hx.sub.t+v.sub.t.
(21) At block 215, the learning system 100 may generate training data based on the joint positions, velocities, and accelerations. For instance, in the training data, the joint positions, velocities, and accelerations for each reaching task may be associated with the corresponding goal location of that reaching task.
(22) At block 220, the learning system may learn the NN 170, based on the one or more demonstrations, specifically, based on the training data derived from the demonstrations. More specifically, learning the NN 170 may include learning the weights of the NN 170, as described in detail below.
(23) In some embodiments, a state transition model describes evolution of the state of the robot 120 over time. The state transition model may be described by the equation {dot over (x)}=f.sub.c*(x.sub.t, g)+ω.sub.t (hereinafter “Formula 2”). In this equation, {ω.sub.t}˜N(0, Q.sub.c) ∈ .sup.24 is a non-zero Gaussian random process with a covariance matrix Q.sub.c ∈
.sup.24×24; and f.sub.c*(x.sub.t, g):
.sup.24×
.sup.3.fwdarw.
.sup.24 is assumed to be an analytical function.
(24) The nonlinear function f.sub.c*(x.sub.t, g), of Formula 2, may be modeled using the NN 170 given by f.sub.c*(x.sub.t, g)=W.sup.tσ(U.sup.Ts.sub.t)+∈(s.sub.t), where s.sub.t=[[x.sub.t.sup.T, g.sup.T], 1].sup.T) ∈ .sup.28 is a vector input to the NN 170;
(25)
is a vector-sigmoid activation function; and (U.sup.Ts.sub.t).sub.i is the i.sup.th element of the vector (U.sup.Ts.sub.t); U ∈ .sup.28×n.sup.
.sup.n.sup.
.sup.24 is a function reconstruction error that goes to zero after the NN 170 is fully trained; and n.sub.h ∈
.sup.+ is the number of neurons in a hidden layer of the NN 170.
(26) The learning system 100 may train the NN using Bayesian regularization, a robust algorithm suitable for applications where training data is noisy and the sample size is small, as may be the case in some embodiments. In some embodiments, the NN 170 may be trained using Bayesian regularization with the objective function J(U, W)=K.sub.αE.sub.D+K.sub.βE.sub.W, where E.sub.D=Σ.sub.i(y.sub.i−a.sub.i).sup.2 is a sum of squared errors; y.sub.i is the target location; a.sub.i is the NN's output; E.sub.W is a sum of the squares of weights of the NN 170; and α and β are parameters of regularization that can be used, respectively to change emphasis between reducing reconstruction errors and reducing weight sizes.
(27)
(28) At block 325, the learning system 100 may record new measurements of a new reaching task being performed by a user. The user may or may not be a user who demonstrated reaching tasks incorporated into the training data. The new reaching task may be unfinished and may thus form only a partial trajectory toward the user's intended goal location. In some embodiments, these new measurements may be recorded by the camera 180.
(29) At block 330, the learning system 100 may generate new data from the recorded measurements, and that new data may include estimates of joint positions, velocities, and accelerations of the new reaching task. Again, the generation of this data may be performed through application of a Kalman filter, this time with respect to the new measurements. However, unlike the training data, this new data may exclude actual goal locations. This new data may be used as the value of Z.sub.T in the formulas presented below, where Z.sub.T refers to a set of measurements from an initial time instance to a current time t.
(30) At block 335, the learning system 100 may initialize various parameters and variables to be used in updating the NN 170 and in estimating an intention (i.e., an intended goal location) of the new reaching task. For example, and not by way of limitation, this may include initializing {circumflex over (x)}.sub.0, {circumflex over (P)}.sub.0, {circumflex over (x)}.sub.id.sub.
(31) At block 340, an iterative loop begins for determining the intention g of the new reaching task.
(32) The learning system 100 may iteratively infer an intention g of the new reaching task, as the new measurements become available. In other words, the intention may be generated repeatedly, thus becoming more refined. In some embodiments, the EM algorithm requires the state transition model to be in discrete form. As such, the state transition model defined in Formula 2 may be discretized using first-order Euler approximation, yielding x.sub.t=f(x.sub.t−1, g)+ω.sub.tT.sub.s (hereinafter “Formula 3”), where f(x.sub.t−1, g)=x.sub.t−1+W.sup.t.sub.σ(U.sup.TS.sub.t−1)T.sub.s and T.sub.s is the sampling period.
(33) To infer intention, the learning system 100 may aim to maximize the posterior probability of Z.sub.T, the new data, given the intention g, using a maximum-likelihood (ML) criterion, where Z.sub.T=z.sub.1:T is a set of observations from time t=1 to t=T, and where T can differ between the training data and the new data. In other words, Z.sub.T refers to a set of measurements from an initial time instance to the time T, while each z.sub.t refers to an isolated measurement at time t. Process noise of the discretized system in Formula 3 may be given by Q=T.sub.s.sup.2Q.sub.c. The log-likelihood function of the intention g, l(g), may be l(g)=log p(Z.sub.T|g) (hereinafter “Formula 4”), which can be obtained by marginalizing the joint distribution l(g)=log∫p(X.sub.T, Z.sub.T|g)dX.sub.T (hereinafter “Formula 5”). In Formula 5, X.sub.T=x.sub.1:T may be a collective representation of states from time t=1 to t=T.
(34) In some embodiments, the learning system 100 may use an approximate EM algorithm with modifications for handling state transition models trained using the NN 170. Using the fact that E.sub.X.sub.
log p(Z.sub.T|g)=E.sub.X.sub.
log p(Z.sub.T|g)=Q(g,ĝ.sub.t)−H(g,ĝ.sub.t)
(hereinafter “Formula 6” and “Formula 7,” respectively).
(35) In the above Formulas 6 and 7, where E.sub.X.sub.
(36) As described in more detail below, the learning system 100 may compute the auxiliary function Q(g, ĝ.sub.t) given the observations Z.sub.T and a current estimate of the intention ĝ.sub.t. The learning system 100 may also compute the next intention estimate ĝ.sub.t+1, after the current intention estimate, by finding a value of g that maximizes Q(g, ĝ.sub.t).
(37) At block 345, the learning system 100 may read a current measurement z.sub.t of the new reaching task.
(38) At block 350, based on the current NN 170 and the previous intention estimate ĝ.sub.t−1, the learning system 100 may compute {circumflex over (x)}.sub.t, {circumflex over (P)}.sub.t, and {circumflex over (P)}.sub.t,t−1, respectively a state estimate, the covariance of the state estimate, and the cross covariance of the state estimates at times t and t−1. This computation may be performed by using an extended Kalman function (EKF). This may be performed by computing the auxiliary function Q(g, ĝ.sub.t) given the observations Z.sub.T and a current estimate of the intention ĝ.sub.t.
(39) To this end, the learning system 100 may evaluate the expectation of the complete data log-likelihood given by Q(g, ĝ.sub.t)=E.sub.X.sub.
(40) In Formula 9, log [p(z.sub.t|x.sub.t, g)] is replaced by log [p(z.sub.t|x.sub.t)]. This is because, for the intention inference problem, the measurement z.sub.t need not depend on the intention g. When attempting to optimize Formula 9, a difficulty arises due to the nonlinearity of the state transition model. Thus, in some embodiments, the nonlinear state transition model may be represented by the NN. In order to compute the expectation of the log-likelihood in Formula 10, the expression inside the curly brackets of Formula 10 may be linearized about
(41) Where
(42)
(43) The derivatives of
(44)
(45) It is noted that
(46)
is the sub-matrix of the Jacobian of the NN that can be obtained by ignoring the matrix rows pertaining to
(47)
Thus, the Jacobian
(48)
can be derived by taking the first n columns of
(49)
where n is the number of states (i.e., the dimension of the state vector x.sub.t). The Hessian
(50)
can be derived in a similar fashion.
(51) Using Formulas 11 through 16, the expectation in Formula 8 can be written as
(52)
(53) In the above, {circumflex over (x)}.sub.t and {circumflex over (P)}.sub.t may be the state estimate and its covariance, respectively, while {circumflex over (x)}.sub.0 and {circumflex over (P)}.sub.0 may be their respective initial values; and {circumflex over (P)}.sub.t,t−1 may be the cross covariance of the state estimates at times t and t−1. The state estimate {circumflex over (x)}.sub.t and the covariances {circumflex over (P)}.sub.t and {circumflex over (P)}.sub.t,t−1 may be obtained using an EKF. To linearize the transition model for the EKF at a current time t, the learning system 100 may use the state estimate {circumflex over (x)}.sub.t−1 from a previous time as a point of linearization. Formula 17 can be written in an iterative form to calculate the value of the Q function at every iteration. Thus, Formula 17 may be solved iteratively, with one iteration performed at each time step, such that an estimate of the goal location may be obtained at each time step.
(54) At block 355, the learning system 100 may compute the intention estimate ĝ.sub.t, such as by finding a value of g that maximizes Q(g, ĝ.sub.t). In some embodiments, the learning system 100 may optimize Q(g, ĝ.sub.t) over g as described by ĝ.sub.t+1=arg max.sub.gQ(g, ĝ.sub.t). This may be executed in various ways, such as by numerical optimization or direct evaluation as described below.
(55) When using numerical evaluation of the Q function, Q(g, ĝ.sub.t), the learning system 100 may attempt to maximize the Q function through the use of a GradEM algorithm, where the first few iterations of the algorithm are used for this purpose. This technique may include optimizing the Q function over .sup.3. An update equation for ĝ.sub.t, through GradEM algorithm, may be given by ĝ.sub.k+1=ĝ.sub.k−
(Q).sup.−1Δ(Q) (hereinafter “Formula 18”), where ĝ.sub.k may be an estimate of g at the k.sup.th iteration of the optimization algorithm
(Q) and Δ(Q) are respectively the Hessian and Gradient of the Q function.
(56) In some embodiments, numerical optimization may be performed at each time step of the EM algorithm, where each time step is a point in time at which the intention is reevaluated based on available new data for the new reaching task. Further, in some embodiments, the number of iterations for the optimization in Formula 18 may be chosen based on computational capabilities, and the Hessian of the Q function may be numerically approximated.
(57) In contrast, when using direct evaluation of the Q function, the learning system 100 may infer g by evaluating the Q function for all possible g.sub.i (i.e., all possible goal locations) in G, so as to obtain ĝ.sub.t+1 as described by ĝ.sub.t+1=arg max.sub.g∈GQ(g, ĝ.sub.t). This technique of evaluating the Q function may be executable if all possible goal locations g.sub.i are known a priori and are finite. This need not an unusual case in the context of the described problem scenario. For instance, the learning system 100 may use the camera 180 along with image processing algorithms to detect objects on the workbench, and to extract the 3D positions of those objects. The learning system 100 may then assume that each reaching task has a goal location equivalent to one of these 3D positions.
(58) At block 360, instructions may be given to the robot 120, based in part on the estimated intention ĝ.sub.t, so as to enable the robot 120 to interact with the user performing the new reaching task. It will be understood that the robot's activities in interacting with the user may vary widely, depending on the task being performed by the robot 120, the user, or both. Thus, these instructions may be of various types, designed to perform these activities effectively. For example, and not by way of limitation, it may be determined that the estimated intention is a location that is the same as a position of the particular object in the workspace. In that case, the instructions to the robot 120 may avoid collision with a trajectory of the user's arm moving toward that particular object.
(59) At block 365, using the intention estimate ĝ.sub.t, computed at block 350, the learning system may compute a state identifier {circumflex over ({dot over (x)})}.sub.id.sub.
(60) In some embodiments, the learning system 100 may continue to update the NN 170 in real time, while predictions of goal locations are being made, by way of an online learning algorithm. The online learning algorithm may be used to update the weights of the NN 170. In some embodiments, this online learning of the NN weights may make inferences of g robust to variations in starting arm positions and various motion trajectories taken by different people. In other words, the learning system 100 may continue to generate good results regardless of which user is performing a reaching task, and regardless of an initial arm position of that user.
(61) Through application of the online learning algorithm, the NN weights may be updated iteratively as new data about the new reaching task becomes available. To this end, a state identifier may be used to compute an estimate of the state derivative based on current state estimates obtained from the EKF and the current NN weights. The learning system 100 may compute an error in the state identifier, based on the state estimate and measurement of the state. The error may be used to update the NN weights at the next time step. The state identifier may use a feedback term such as the robust integral of the sign of the error (RISE) to obtain asymptotic convergence of the state estimates and their derivatives to their true values.
(62) Equations used to update the NN weights may use Lyapunov-based stability analysis. For instance, the state identifier is given by {circumflex over ({dot over (x)})}.sub.idt=Ŵ.sub.t.sup.Tσ(.Math..sub.t.sup.Tŝ.sub.t)+μ.sub.t (hereinafter “Formula 19”), where .Math..sub.t ∈ .sup.28×n.sup.
.sup.n.sup.
.sup.28; ĝ.sub.t ∈
.sup.3 is the current estimate of g from the EM algorithm; {circumflex over (x)}.sub.idt ∈
.sup.24 is the current identifier state; and μ.sub.t ∈
.sup.24 is the RISE feedback term defined as μ.sub.t=k{tilde over (x)}.sub.0v.sub.t, where {tilde over (x)}.sub.t={circumflex over (x)}.sub.idt is the state identification error at time t; and v.sub.t ∈
.sup.24 is the Filippov generalized solution to the differential equation {dot over (v)}.sub.t=(kα+γ){tilde over (x)}.sub.t+β.sub.1sgn({tilde over (x)}.sub.t), for v.sub.0=0, where k, α, γ, β.sub.1 ∈
.sup.+ are positive constant control gains; and sgn( ) denotes a vector signum function.
(63) The learning system 100 may use weight update equations given by {circumflex over ({dot over (W)})}.sub.t=proj(Ŵ.sub.t, Γ.sub.w{circumflex over (σ)}′.Math..sub.x.sub.
(64)
is a projection operator where
(65)
In some embodiments, the projection operator ensures that the estimate {circumflex over (θ)} ∈ Ω.sub.δ ∀t≥0, where Ω.sub.δ={{circumflex over (θ)}|θ−δ≤{circumflex over (θ)}≤
(66) At block 370, the learning system 100 may update the NN 170 by changing the weights, such as according to Formula 20, which appears above. In some embodiments, the method 300 may then return to block 340 to begin calculation of a new estimated intention ĝ.sub.t at a new time step where the time step t is incremented. This iterative loop may continue as long as an estimated intention is desired for the new reaching task.
(67)
(68) At block 425, the learning system 100 may record new measurements of a new reaching task being performed by a user. At block 430, the learning system 100 may generate new data from the recorded measurements, and that new data may include estimates of joint positions, velocities, and accelerations of the new reaching task. At block 435, the learning system 100 may identify the number of goal locations and create a model for each goal location. At block 440, the learning system 100 may initialize one or more parameters and variables used to estimate intentions. At block 445, an iterative loop may begin for determining an intention of a new reaching task. At block 450, the learning system 100 may read a current measurement of the new reaching task. At block 455, the learning system may compute one or more mixing probabilities and may mix state estimates from previous iterations of the loop or, if this is the first iteration, from default parameters. At block 460, the learning system 100 may compute state estimates and covariances of the state estimates, and may model likelihoods based on values of the state estimates and covariances from previous iterations or, if this is the first iteration, from default parameters. At block 465, the learning system 100 may compute model probabilities and an estimate for the intention.
(69) At block 470, the learning system 100 may instruct the robot 120 based on the intention estimate. In some embodiments, the method 400 may then return to block 445 to begin calculation of a new estimated intention ĝ.sub.t at a new time step where the time step t is incremented. This iterative loop may continue as long as an estimated intention is desired for the new reaching task. Below follows a more detailed description of this method 400.
(70) Given a state variable x ∈ .sup.n, a set of D demonstrations {D.sub.i}.sub.i=1.sup.D are solutions to an underlying dynamics model governed by the following first-order differential equation {dot over (x)}(t)=f(x(t))+w(t) (hereinafter “Formula 21”), where f:
.sup.n.fwdarw.
.sup.n is a nonlinear, continuous, and continuously differentiable function, and w˜
(0, Q.sub.c) is a zero-mean Gaussian process with covariance Q.sub.c. Each demonstration may be associated with trajectories of a state {x(t)}.sub.t=0.sup.t=T and trajectories of the state derivative {{dot over (x)}(t)}.sub.t=0.sup.t=T from time t=0 to t=T. The nonlinear function f may be modeled using an artificial neural network (ANN), specifically f(x(t))=W.sup.Tσ(U.sup.Ts(t))+∈(s(t)). In this ANN description, s(t)=[x(t).sup.T, 1].sup.T ∈
.sup.n+1 is the input vector to the ANN;
(71)
is a vector-sigmoid activation function; (U.sup.Ts(t)).sub.i is the i.sup.th element of the vector (U.sup.Ts(t)); U ∈ .sup.n+1×n.sup.
.sup.n.sup.
.sup.n is a function reconstruction error that goes to zero after the ANN is fully trained; and n.sub.h is the number of hidden layers of the ANN.
(72) The learning system 100 may solve the following unconstrained optimization problem to train the ANN: {Ŵ, .Math.}=arg min.sub.W,U{αE.sub.D+βE.sub.w} (hereinafter “Formula 22”). In the above, E.sub.D=Σ.sub.i=1.sup.D[y.sub.i−a.sub.i].sup.T [y.sub.i−a.sub.i] is the sum of the squared error; y.sub.i ∈ .sup.n and a.sub.i ∈
.sup.n respectively represent the target and the network's output of the i.sup.th demonstration; E.sub.w is the sum of the squares of the ANN weights; α, β ∈
are scalar parameters of regularization.
(73) Technical effects and benefits of one or more embodiments include the ability to model human arm motion dynamics using a NN 170 and to infer human intentions using a NN-based approximate EM algorithm. Technical effects and benefits may further include the ability to use online learning to adapt to various initial arm configurations and to various users.
(74)
(75) In some embodiments, as shown in
(76) The I/O devices 540, 545 may further include devices that communicate both inputs and outputs, for instance disk and tape storage, a network interface card (NIC) or modulator/demodulator (for accessing other files, devices, systems, or a network), a radio frequency (RF) or other transceiver, a telephonic interface, a bridge, a router, and the like.
(77) The processor 505 is a hardware device for executing hardware instructions or software, particularly those stored in memory 510. The processor 505 may be a custom made or commercially available processor, a central processing unit (CPU), an auxiliary processor among several processors associated with the computer system 500, a semiconductor based microprocessor (in the form of a microchip or chip set), a microprocessor, or other device for executing instructions. The processor 505 includes a cache 570, which may include, but is not limited to, an instruction cache to speed up executable instruction fetch, a data cache to speed up data fetch and store, and a translation lookaside buffer (TLB) used to speed up virtual-to-physical address translation for both executable instructions and data. The cache 570 may be organized as a hierarchy of more cache levels (L1, L2, etc.).
(78) The memory 510 may include one or combinations of volatile memory elements (e.g., random access memory, RAM, such as DRAM, SRAM, SDRAM, etc.) and nonvolatile memory elements (e.g., ROM, erasable programmable read only memory (EPROM), electronically erasable programmable read only memory (EEPROM), programmable read only memory (PROM), tape, compact disc read only memory (CD-ROM), disk, diskette, cartridge, cassette or the like, etc.). Moreover, the memory 510 may incorporate electronic, magnetic, optical, or other types of storage media. Note that the memory 510 may have a distributed architecture, where various components are situated remote from one another but may be accessed by the processor 505.
(79) The instructions in memory 510 may include one or more separate programs, each of which comprises an ordered listing of executable instructions for implementing logical functions. In the example of
(80) Additional data, including, for example, instructions for the processor 505 or other retrievable information, may be stored in storage 520, which may be a storage device such as a hard disk drive or solid-state drive. The stored instructions in memory 510 or in storage 520 may include those enabling the processor to execute one or more aspects of the learning systems 100 and methods of this disclosure.
(81) The computer system 500 may further include a display controller 525 coupled to a display 530. In some embodiments, the computer system 500 may further include a network interface 560 for coupling to a network 565. The network 565 may be an IP-based network for communication between the computer system 500 and an external server, client and the like via a broadband connection. The network 565 transmits and receives data between the computer system 500 and external systems. In some embodiments, the network 565 may be a managed IP network administered by a service provider. The network 565 may be implemented in a wireless fashion, e.g., using wireless protocols and technologies, such as WiFi, WiMax, etc. The network 565 may also be a packet-switched network such as a local area network, wide area network, metropolitan area network, the Internet, or other similar type of network environment. The network 565 may be a fixed wireless network, a wireless local area network (LAN), a wireless wide area network (WAN) a personal area network (PAN), a virtual private network (VPN), intranet or other suitable network system and may include equipment for receiving and transmitting signals.
(82) Learning systems 100 and methods according to this disclosure may be embodied, in whole or in part, in computer program products or in computer systems 500, such as that illustrated in