xref: /petsc/src/tao/leastsquares/impls/brgn/brgn.c (revision c3b366b11f3ec31f57fee5376535cdadac340a0d)
1463fc0ecSAlp Dener #include <../src/tao/leastsquares/impls/brgn/brgn.h> /*I "petsctao.h" I*/
2737f463aSAlp Dener 
3470ec3f8SXiang Huang #define BRGN_REGULARIZATION_USER    0
4470ec3f8SXiang Huang #define BRGN_REGULARIZATION_L2PROX  1
5a1c74439SHansol Suh #define BRGN_REGULARIZATION_L2PURE  2
6a1c74439SHansol Suh #define BRGN_REGULARIZATION_L1DICT  3
7a1c74439SHansol Suh #define BRGN_REGULARIZATION_TYPES   4
8a3c390cfSAlp Dener 
970c34337SHansol Suh static const char *BRGN_REGULARIZATION_TABLE[64] = {"user","l2prox","l2pure","l1dict"};
10a3c390cfSAlp Dener 
110d71dc2bSXiang Huang static PetscErrorCode GNHessianProd(Mat H,Vec in,Vec out)
120d71dc2bSXiang Huang {
130d71dc2bSXiang Huang   TAO_BRGN              *gn;
140d71dc2bSXiang Huang   PetscErrorCode        ierr;
150d71dc2bSXiang Huang 
160d71dc2bSXiang Huang   PetscFunctionBegin;
170d71dc2bSXiang Huang   ierr = MatShellGetContext(H,&gn);CHKERRQ(ierr);
180d71dc2bSXiang Huang   ierr = MatMult(gn->subsolver->ls_jac,in,gn->r_work);CHKERRQ(ierr);
190d71dc2bSXiang Huang   ierr = MatMultTranspose(gn->subsolver->ls_jac,gn->r_work,out);CHKERRQ(ierr);
20a3c390cfSAlp Dener   switch (gn->reg_type) {
21470ec3f8SXiang Huang   case BRGN_REGULARIZATION_USER:
22a3c390cfSAlp Dener     ierr = MatMult(gn->Hreg,in,gn->x_work);CHKERRQ(ierr);
238ac80d48SXiang Huang     ierr = VecAXPY(out,gn->lambda,gn->x_work);CHKERRQ(ierr);
24a3c390cfSAlp Dener     break;
25a1c74439SHansol Suh   case BRGN_REGULARIZATION_L2PURE:
26a1c74439SHansol Suh     ierr = VecAXPY(out,gn->lambda,in);CHKERRQ(ierr);
27a1c74439SHansol Suh     break;
28470ec3f8SXiang Huang   case BRGN_REGULARIZATION_L2PROX:
29a3c390cfSAlp Dener     ierr = VecAXPY(out,gn->lambda,in);CHKERRQ(ierr);
30a3c390cfSAlp Dener     break;
31470ec3f8SXiang Huang   case BRGN_REGULARIZATION_L1DICT:
32a3c390cfSAlp Dener     /* out = out + lambda*D'*(diag.*(D*in)) */
33a3c390cfSAlp Dener     if (gn->D) {
34a3c390cfSAlp Dener       ierr = MatMult(gn->D,in,gn->y);CHKERRQ(ierr);/* y = D*in */
35a3c390cfSAlp Dener     } else {
36a3c390cfSAlp Dener       ierr = VecCopy(in,gn->y);CHKERRQ(ierr);
37a3c390cfSAlp Dener     }
38a3c390cfSAlp Dener     ierr = VecPointwiseMult(gn->y_work,gn->diag,gn->y);CHKERRQ(ierr);   /* y_work = diag.*(D*in), where diag = epsilon^2 ./ sqrt(x.^2+epsilon^2).^3 */
39a3c390cfSAlp Dener     if (gn->D) {
40a3c390cfSAlp Dener       ierr = MatMultTranspose(gn->D,gn->y_work,gn->x_work);CHKERRQ(ierr); /* x_work = D'*(diag.*(D*in)) */
41a3c390cfSAlp Dener     } else {
42a3c390cfSAlp Dener       ierr = VecCopy(gn->y_work,gn->x_work);CHKERRQ(ierr);
43a3c390cfSAlp Dener     }
44a3c390cfSAlp Dener     ierr = VecAXPY(out,gn->lambda,gn->x_work);CHKERRQ(ierr);
45a3c390cfSAlp Dener     break;
46a3c390cfSAlp Dener   }
470d71dc2bSXiang Huang   PetscFunctionReturn(0);
480d71dc2bSXiang Huang }
490d71dc2bSXiang Huang 
500d71dc2bSXiang Huang static PetscErrorCode GNObjectiveGradientEval(Tao tao,Vec X,PetscReal *fcn,Vec G,void *ptr)
510d71dc2bSXiang Huang {
520d71dc2bSXiang Huang   TAO_BRGN              *gn = (TAO_BRGN *)ptr;
538e85b1b3SXiang Huang   PetscInt              K;                    /* dimension of D*X */
547cea06e1SXiang Huang   PetscScalar           yESum;
550d71dc2bSXiang Huang   PetscErrorCode        ierr;
56a3c390cfSAlp Dener   PetscReal             f_reg;
570d71dc2bSXiang Huang 
580d71dc2bSXiang Huang   PetscFunctionBegin;
598e85b1b3SXiang Huang   /* compute objective *fcn*/
60a3c390cfSAlp Dener   /* compute first term 0.5*||ls_res||_2^2 */
610d71dc2bSXiang Huang   ierr = TaoComputeResidual(tao,X,tao->ls_res);CHKERRQ(ierr);
62a3c390cfSAlp Dener   ierr = VecDot(tao->ls_res,tao->ls_res,fcn);CHKERRQ(ierr);
63a3c390cfSAlp Dener   *fcn *= 0.5;
64a3c390cfSAlp Dener   /* compute gradient G */
65a3c390cfSAlp Dener   ierr = TaoComputeResidualJacobian(tao,X,tao->ls_jac,tao->ls_jac_pre);CHKERRQ(ierr);
66a3c390cfSAlp Dener   ierr = MatMultTranspose(tao->ls_jac,tao->ls_res,G);CHKERRQ(ierr);
67a3c390cfSAlp Dener   /* add the regularization contribution */
68a3c390cfSAlp Dener   switch (gn->reg_type) {
69470ec3f8SXiang Huang   case BRGN_REGULARIZATION_USER:
70a3c390cfSAlp Dener     ierr = (*gn->regularizerobjandgrad)(tao,X,&f_reg,gn->x_work,gn->reg_obj_ctx);CHKERRQ(ierr);
71a3c390cfSAlp Dener     *fcn += gn->lambda*f_reg;
72a3c390cfSAlp Dener     ierr = VecAXPY(G,gn->lambda,gn->x_work);CHKERRQ(ierr);
73a3c390cfSAlp Dener     break;
74a1c74439SHansol Suh   case BRGN_REGULARIZATION_L2PURE:
75a1c74439SHansol Suh     /* compute f = f + lambda*0.5*xk'*xk */
76a1c74439SHansol Suh     ierr = VecDot(X,X,&f_reg);CHKERRQ(ierr);
77a1c74439SHansol Suh     *fcn += gn->lambda*0.5*f_reg;
78a1c74439SHansol Suh     /* compute G = G + lambda*xk */
79a1c74439SHansol Suh     ierr = VecAXPY(G,gn->lambda,X);CHKERRQ(ierr);
80a1c74439SHansol Suh     break;
81470ec3f8SXiang Huang   case BRGN_REGULARIZATION_L2PROX:
821fc140a9SXiang Huang     /* compute f = f + lambda*0.5*(xk - xkm1)'*(xk - xkm1) */
831fc140a9SXiang Huang     ierr = VecAXPBYPCZ(gn->x_work,1.0,-1.0,0.0,X,gn->x_old);CHKERRQ(ierr);
84a3c390cfSAlp Dener     ierr = VecDot(gn->x_work,gn->x_work,&f_reg);CHKERRQ(ierr);
85a3c390cfSAlp Dener     *fcn += gn->lambda*0.5*f_reg;
86a3c390cfSAlp Dener     /* compute G = G + lambda*(xk - xkm1) */
87a3c390cfSAlp Dener     ierr = VecAXPBYPCZ(G,gn->lambda,-gn->lambda,1.0,X,gn->x_old);CHKERRQ(ierr);
88a3c390cfSAlp Dener     break;
89470ec3f8SXiang Huang   case BRGN_REGULARIZATION_L1DICT:
90a3c390cfSAlp Dener     /* compute f = f + lambda*sum(sqrt(y.^2+epsilon^2) - epsilon), where y = D*x*/
91a3c390cfSAlp Dener     if (gn->D) {
927cea06e1SXiang Huang       ierr = MatMult(gn->D,X,gn->y);CHKERRQ(ierr);/* y = D*x */
93a3c390cfSAlp Dener     } else {
94a3c390cfSAlp Dener       ierr = VecCopy(X,gn->y);CHKERRQ(ierr);
95a3c390cfSAlp Dener     }
967cea06e1SXiang Huang     ierr = VecPointwiseMult(gn->y_work,gn->y,gn->y);CHKERRQ(ierr);
977cea06e1SXiang Huang     ierr = VecShift(gn->y_work,gn->epsilon*gn->epsilon);CHKERRQ(ierr);
987cea06e1SXiang Huang     ierr = VecSqrtAbs(gn->y_work);CHKERRQ(ierr);  /* gn->y_work = sqrt(y.^2+epsilon^2) */
99*c3b366b1Sprj-     ierr = VecSum(gn->y_work,&yESum);CHKERRQ(ierr);
1008e85b1b3SXiang Huang     ierr = VecGetSize(gn->y,&K);CHKERRQ(ierr);
101a3c390cfSAlp Dener     *fcn += gn->lambda*(yESum - K*gn->epsilon);
1027cea06e1SXiang Huang     /* compute G = G + lambda*D'*(y./sqrt(y.^2+epsilon^2)),where y = D*x */
1037cea06e1SXiang Huang     ierr = VecPointwiseDivide(gn->y_work,gn->y,gn->y_work);CHKERRQ(ierr); /* reuse y_work = y./sqrt(y.^2+epsilon^2) */
104a3c390cfSAlp Dener     if (gn->D) {
1057cea06e1SXiang Huang       ierr = MatMultTranspose(gn->D,gn->y_work,gn->x_work);CHKERRQ(ierr);
106a3c390cfSAlp Dener     } else {
107a3c390cfSAlp Dener       ierr = VecCopy(gn->y_work,gn->x_work);CHKERRQ(ierr);
108a3c390cfSAlp Dener     }
1098ac80d48SXiang Huang     ierr = VecAXPY(G,gn->lambda,gn->x_work);CHKERRQ(ierr);
110a3c390cfSAlp Dener     break;
111a3c390cfSAlp Dener   }
1120d71dc2bSXiang Huang   PetscFunctionReturn(0);
1130d71dc2bSXiang Huang }
1140d71dc2bSXiang Huang 
115737f463aSAlp Dener static PetscErrorCode GNComputeHessian(Tao tao,Vec X,Mat H,Mat Hpre,void *ptr)
116737f463aSAlp Dener {
1178ac80d48SXiang Huang   TAO_BRGN              *gn = (TAO_BRGN *)ptr;
118737f463aSAlp Dener   PetscErrorCode ierr;
119737f463aSAlp Dener 
120737f463aSAlp Dener   PetscFunctionBegin;
121e1e80dc8SAlp Dener   ierr = TaoComputeResidualJacobian(tao,X,tao->ls_jac,tao->ls_jac_pre);CHKERRQ(ierr);
1220d71dc2bSXiang Huang 
123a3c390cfSAlp Dener   switch (gn->reg_type) {
124470ec3f8SXiang Huang   case BRGN_REGULARIZATION_USER:
125a3c390cfSAlp Dener     ierr = (*gn->regularizerhessian)(tao,X,gn->Hreg,gn->reg_hess_ctx);CHKERRQ(ierr);
126a3c390cfSAlp Dener     break;
127a1c74439SHansol Suh   case BRGN_REGULARIZATION_L2PURE:
128a1c74439SHansol Suh     break;
129470ec3f8SXiang Huang   case BRGN_REGULARIZATION_L2PROX:
130a3c390cfSAlp Dener     break;
131470ec3f8SXiang Huang   case BRGN_REGULARIZATION_L1DICT:
1327cea06e1SXiang Huang     /* calculate and store diagonal matrix as a vector: diag = epsilon^2 ./ sqrt(x.^2+epsilon^2).^3* --> diag = epsilon^2 ./ sqrt(y.^2+epsilon^2).^3,where y = D*x */
133a3c390cfSAlp Dener     if (gn->D) {
1347cea06e1SXiang Huang       ierr = MatMult(gn->D,X,gn->y);CHKERRQ(ierr);/* y = D*x */
135a3c390cfSAlp Dener     } else {
136a3c390cfSAlp Dener       ierr = VecCopy(X,gn->y);CHKERRQ(ierr);
137a3c390cfSAlp Dener     }
1387cea06e1SXiang Huang     ierr = VecPointwiseMult(gn->y_work,gn->y,gn->y);CHKERRQ(ierr);
1397cea06e1SXiang Huang     ierr = VecShift(gn->y_work,gn->epsilon*gn->epsilon);CHKERRQ(ierr);
1407cea06e1SXiang Huang     ierr = VecCopy(gn->y_work,gn->diag);CHKERRQ(ierr);                  /* gn->diag = y.^2+epsilon^2 */
1417cea06e1SXiang Huang     ierr = VecSqrtAbs(gn->y_work);CHKERRQ(ierr);                        /* gn->y_work = sqrt(y.^2+epsilon^2) */
1427cea06e1SXiang Huang     ierr = VecPointwiseMult(gn->diag,gn->y_work,gn->diag);CHKERRQ(ierr);/* gn->diag = sqrt(y.^2+epsilon^2).^3 */
1438ac80d48SXiang Huang     ierr = VecReciprocal(gn->diag);CHKERRQ(ierr);
1448ac80d48SXiang Huang     ierr = VecScale(gn->diag,gn->epsilon*gn->epsilon);CHKERRQ(ierr);
145a3c390cfSAlp Dener     break;
146a3c390cfSAlp Dener   }
147e1e80dc8SAlp Dener   PetscFunctionReturn(0);
148e1e80dc8SAlp Dener }
149e1e80dc8SAlp Dener 
1508fcddce6SStefano Zampini static PetscErrorCode GNHookFunction(Tao tao,PetscInt iter, void *ctx)
151e1e80dc8SAlp Dener {
1528fcddce6SStefano Zampini   TAO_BRGN              *gn = (TAO_BRGN *)ctx;
153e1e80dc8SAlp Dener   PetscErrorCode        ierr;
154e1e80dc8SAlp Dener 
155e1e80dc8SAlp Dener   PetscFunctionBegin;
156e1e80dc8SAlp Dener   /* Update basic tao information from the subsolver */
157e1e80dc8SAlp Dener   gn->parent->nfuncs = tao->nfuncs;
158e1e80dc8SAlp Dener   gn->parent->ngrads = tao->ngrads;
159e1e80dc8SAlp Dener   gn->parent->nfuncgrads = tao->nfuncgrads;
160e1e80dc8SAlp Dener   gn->parent->nhess = tao->nhess;
161e1e80dc8SAlp Dener   gn->parent->niter = tao->niter;
162e1e80dc8SAlp Dener   gn->parent->ksp_its = tao->ksp_its;
163e1e80dc8SAlp Dener   gn->parent->ksp_tot_its = tao->ksp_tot_its;
164e1e80dc8SAlp Dener   ierr = TaoGetConvergedReason(tao,&gn->parent->reason);CHKERRQ(ierr);
165e1e80dc8SAlp Dener   /* Update the solution vectors */
166e1e80dc8SAlp Dener   if (iter == 0) {
167e1e80dc8SAlp Dener     ierr = VecSet(gn->x_old,0.0);CHKERRQ(ierr);
168e1e80dc8SAlp Dener   } else {
169e1e80dc8SAlp Dener     ierr = VecCopy(tao->solution,gn->x_old);CHKERRQ(ierr);
170e1e80dc8SAlp Dener     ierr = VecCopy(tao->solution,gn->parent->solution);CHKERRQ(ierr);
171e1e80dc8SAlp Dener   }
172e1e80dc8SAlp Dener   /* Update the gradient */
173e1e80dc8SAlp Dener   ierr = VecCopy(tao->gradient,gn->parent->gradient);CHKERRQ(ierr);
174e1e80dc8SAlp Dener   /* Call general purpose update function */
175e1e80dc8SAlp Dener   if (gn->parent->ops->update) {
1768fcddce6SStefano Zampini     ierr = (*gn->parent->ops->update)(gn->parent,gn->parent->niter,gn->parent->user_update);CHKERRQ(ierr);
177737f463aSAlp Dener   }
178737f463aSAlp Dener   PetscFunctionReturn(0);
179737f463aSAlp Dener }
180737f463aSAlp Dener 
181737f463aSAlp Dener static PetscErrorCode TaoSolve_BRGN(Tao tao)
182737f463aSAlp Dener {
183737f463aSAlp Dener   TAO_BRGN              *gn = (TAO_BRGN *)tao->data;
184737f463aSAlp Dener   PetscErrorCode        ierr;
185737f463aSAlp Dener 
186737f463aSAlp Dener   PetscFunctionBegin;
187737f463aSAlp Dener   ierr = TaoSolve(gn->subsolver);CHKERRQ(ierr);
188e1e80dc8SAlp Dener   /* Update basic tao information from the subsolver */
189e1e80dc8SAlp Dener   tao->nfuncs = gn->subsolver->nfuncs;
190e1e80dc8SAlp Dener   tao->ngrads = gn->subsolver->ngrads;
191e1e80dc8SAlp Dener   tao->nfuncgrads = gn->subsolver->nfuncgrads;
192e1e80dc8SAlp Dener   tao->nhess = gn->subsolver->nhess;
193e1e80dc8SAlp Dener   tao->niter = gn->subsolver->niter;
194e1e80dc8SAlp Dener   tao->ksp_its = gn->subsolver->ksp_its;
195e1e80dc8SAlp Dener   tao->ksp_tot_its = gn->subsolver->ksp_tot_its;
196e1e80dc8SAlp Dener   ierr = TaoGetConvergedReason(gn->subsolver,&tao->reason);CHKERRQ(ierr);
197e1e80dc8SAlp Dener   /* Update vectors */
198e1e80dc8SAlp Dener   ierr = VecCopy(gn->subsolver->solution,tao->solution);CHKERRQ(ierr);
199e1e80dc8SAlp Dener   ierr = VecCopy(gn->subsolver->gradient,tao->gradient);CHKERRQ(ierr);
200737f463aSAlp Dener   PetscFunctionReturn(0);
201737f463aSAlp Dener }
202737f463aSAlp Dener 
203737f463aSAlp Dener static PetscErrorCode TaoSetFromOptions_BRGN(PetscOptionItems *PetscOptionsObject,Tao tao)
204737f463aSAlp Dener {
205737f463aSAlp Dener   TAO_BRGN              *gn = (TAO_BRGN *)tao->data;
206737f463aSAlp Dener   PetscErrorCode        ierr;
207737f463aSAlp Dener 
208737f463aSAlp Dener   PetscFunctionBegin;
209a3c390cfSAlp Dener   ierr = PetscOptionsHead(PetscOptionsObject,"least-squares problems with regularizer: ||f(x)||^2 + lambda*g(x), g(x) = ||xk-xkm1||^2 or ||Dx||_1 or user defined function.");CHKERRQ(ierr);
21088fa4459SAlp Dener   ierr = PetscOptionsReal("-tao_brgn_regularizer_weight","regularizer weight (default 1e-4)","",gn->lambda,&gn->lambda,NULL);CHKERRQ(ierr);
21188fa4459SAlp Dener   ierr = PetscOptionsReal("-tao_brgn_l1_smooth_epsilon","L1-norm smooth approximation parameter: ||x||_1 = sum(sqrt(x.^2+epsilon^2)-epsilon) (default 1e-6)","",gn->epsilon,&gn->epsilon,NULL);CHKERRQ(ierr);
212470ec3f8SXiang Huang   ierr = PetscOptionsEList("-tao_brgn_regularization_type","regularization type", "",BRGN_REGULARIZATION_TABLE,BRGN_REGULARIZATION_TYPES,BRGN_REGULARIZATION_TABLE[gn->reg_type],&gn->reg_type,NULL);CHKERRQ(ierr);
213737f463aSAlp Dener   ierr = PetscOptionsTail();CHKERRQ(ierr);
214737f463aSAlp Dener   ierr = TaoSetFromOptions(gn->subsolver);CHKERRQ(ierr);
215737f463aSAlp Dener   PetscFunctionReturn(0);
216737f463aSAlp Dener }
217737f463aSAlp Dener 
218737f463aSAlp Dener static PetscErrorCode TaoView_BRGN(Tao tao,PetscViewer viewer)
219737f463aSAlp Dener {
220737f463aSAlp Dener   TAO_BRGN              *gn = (TAO_BRGN *)tao->data;
221737f463aSAlp Dener   PetscErrorCode        ierr;
222737f463aSAlp Dener 
223737f463aSAlp Dener   PetscFunctionBegin;
224e1e80dc8SAlp Dener   ierr = PetscViewerASCIIPushTab(viewer);CHKERRQ(ierr);
225737f463aSAlp Dener   ierr = TaoView(gn->subsolver,viewer);CHKERRQ(ierr);
226e1e80dc8SAlp Dener   ierr = PetscViewerASCIIPopTab(viewer);CHKERRQ(ierr);
227737f463aSAlp Dener   PetscFunctionReturn(0);
228737f463aSAlp Dener }
229737f463aSAlp Dener 
230737f463aSAlp Dener static PetscErrorCode TaoSetUp_BRGN(Tao tao)
231737f463aSAlp Dener {
232737f463aSAlp Dener   TAO_BRGN              *gn = (TAO_BRGN *)tao->data;
233737f463aSAlp Dener   PetscErrorCode        ierr;
234737f463aSAlp Dener   PetscBool             is_bnls,is_bntr,is_bntl;
2358e85b1b3SXiang Huang   PetscInt              i,n,N,K; /* dict has size K*N*/
236737f463aSAlp Dener 
237737f463aSAlp Dener   PetscFunctionBegin;
238737f463aSAlp Dener   if (!tao->ls_res) SETERRQ(PetscObjectComm((PetscObject)tao),PETSC_ERR_ORDER,"TaoSetResidualRoutine() must be called before setup!");
239737f463aSAlp Dener   ierr = PetscObjectTypeCompare((PetscObject)gn->subsolver,TAOBNLS,&is_bnls);CHKERRQ(ierr);
240737f463aSAlp Dener   ierr = PetscObjectTypeCompare((PetscObject)gn->subsolver,TAOBNTR,&is_bntr);CHKERRQ(ierr);
241737f463aSAlp Dener   ierr = PetscObjectTypeCompare((PetscObject)gn->subsolver,TAOBNTL,&is_bntl);CHKERRQ(ierr);
242737f463aSAlp Dener   if ((is_bnls || is_bntr || is_bntl) && !tao->ls_jac) SETERRQ(PetscObjectComm((PetscObject)tao),PETSC_ERR_ORDER,"TaoSetResidualJacobianRoutine() must be called before setup!");
243e1e80dc8SAlp Dener   if (!tao->gradient) {
244e1e80dc8SAlp Dener     ierr = VecDuplicate(tao->solution,&tao->gradient);CHKERRQ(ierr);
245e1e80dc8SAlp Dener   }
246737f463aSAlp Dener   if (!gn->x_work) {
247737f463aSAlp Dener     ierr = VecDuplicate(tao->solution,&gn->x_work);CHKERRQ(ierr);
248737f463aSAlp Dener   }
249737f463aSAlp Dener   if (!gn->r_work) {
250737f463aSAlp Dener     ierr = VecDuplicate(tao->ls_res,&gn->r_work);CHKERRQ(ierr);
251737f463aSAlp Dener   }
252e1e80dc8SAlp Dener   if (!gn->x_old) {
253e1e80dc8SAlp Dener     ierr = VecDuplicate(tao->solution,&gn->x_old);CHKERRQ(ierr);
254e1e80dc8SAlp Dener     ierr = VecSet(gn->x_old,0.0);CHKERRQ(ierr);
255e1e80dc8SAlp Dener   }
2567cea06e1SXiang Huang 
257470ec3f8SXiang Huang   if (BRGN_REGULARIZATION_L1DICT == gn->reg_type) {
25830eeff36SXiang Huang     if (gn->D) {
25930eeff36SXiang Huang       ierr = MatGetSize(gn->D,&K,&N);CHKERRQ(ierr); /* Shell matrices still must have sizes defined. K = N for identity matrix, K=N-1 or N for gradient matrix */
26030eeff36SXiang Huang     } else {
26130eeff36SXiang Huang       ierr = VecGetSize(tao->solution,&K);CHKERRQ(ierr); /* If user does not setup dict matrix, use identiy matrix, K=N */
26230eeff36SXiang Huang     }
2637cea06e1SXiang Huang     if (!gn->y) {
2647cea06e1SXiang Huang       ierr = VecCreate(PETSC_COMM_SELF,&gn->y);CHKERRQ(ierr);
2658e85b1b3SXiang Huang       ierr = VecSetSizes(gn->y,PETSC_DECIDE,K);CHKERRQ(ierr);
2667cea06e1SXiang Huang       ierr = VecSetFromOptions(gn->y);CHKERRQ(ierr);
2677cea06e1SXiang Huang       ierr = VecSet(gn->y,0.0);CHKERRQ(ierr);
2687cea06e1SXiang Huang 
2697cea06e1SXiang Huang     }
2707cea06e1SXiang Huang     if (!gn->y_work) {
2717cea06e1SXiang Huang       ierr = VecDuplicate(gn->y,&gn->y_work);CHKERRQ(ierr);
2727cea06e1SXiang Huang     }
2738ac80d48SXiang Huang     if (!gn->diag) {
2747cea06e1SXiang Huang       ierr = VecDuplicate(gn->y,&gn->diag);CHKERRQ(ierr);
2758ac80d48SXiang Huang       ierr = VecSet(gn->diag,0.0);CHKERRQ(ierr);
2768ac80d48SXiang Huang     }
27730eeff36SXiang Huang   }
2780d71dc2bSXiang Huang 
279e1e80dc8SAlp Dener   if (!tao->setupcalled) {
280737f463aSAlp Dener     /* Hessian setup */
2818e85b1b3SXiang Huang     ierr = VecGetLocalSize(tao->solution,&n);CHKERRQ(ierr);
2828e85b1b3SXiang Huang     ierr = VecGetSize(tao->solution,&N);CHKERRQ(ierr);
2838e85b1b3SXiang Huang     ierr = MatSetSizes(gn->H,n,n,N,N);CHKERRQ(ierr);
284737f463aSAlp Dener     ierr = MatSetType(gn->H,MATSHELL);CHKERRQ(ierr);
285737f463aSAlp Dener     ierr = MatSetUp(gn->H);CHKERRQ(ierr);
286737f463aSAlp Dener     ierr = MatShellSetOperation(gn->H,MATOP_MULT,(void (*)(void))GNHessianProd);CHKERRQ(ierr);
287737f463aSAlp Dener     ierr = MatShellSetContext(gn->H,(void*)gn);CHKERRQ(ierr);
2888e85b1b3SXiang Huang     /* Subsolver setup,include initial vector and dicttionary D */
289e1e80dc8SAlp Dener     ierr = TaoSetUpdate(gn->subsolver,GNHookFunction,(void*)gn);CHKERRQ(ierr);
290737f463aSAlp Dener     ierr = TaoSetInitialVector(gn->subsolver,tao->solution);CHKERRQ(ierr);
291737f463aSAlp Dener     if (tao->bounded) {
292737f463aSAlp Dener       ierr = TaoSetVariableBounds(gn->subsolver,tao->XL,tao->XU);CHKERRQ(ierr);
293737f463aSAlp Dener     }
294737f463aSAlp Dener     ierr = TaoSetResidualRoutine(gn->subsolver,tao->ls_res,tao->ops->computeresidual,tao->user_lsresP);CHKERRQ(ierr);
2954ffbe8acSAlp Dener     ierr = TaoSetJacobianResidualRoutine(gn->subsolver,tao->ls_jac,tao->ls_jac,tao->ops->computeresidualjacobian,tao->user_lsjacP);CHKERRQ(ierr);
296737f463aSAlp Dener     ierr = TaoSetObjectiveAndGradientRoutine(gn->subsolver,GNObjectiveGradientEval,(void*)gn);CHKERRQ(ierr);
297737f463aSAlp Dener     ierr = TaoSetHessianRoutine(gn->subsolver,gn->H,gn->H,GNComputeHessian,(void*)gn);CHKERRQ(ierr);
298e1e80dc8SAlp Dener     /* Propagate some options down */
299e1e80dc8SAlp Dener     ierr = TaoSetTolerances(gn->subsolver,tao->gatol,tao->grtol,tao->gttol);CHKERRQ(ierr);
300e1e80dc8SAlp Dener     ierr = TaoSetMaximumIterations(gn->subsolver,tao->max_it);CHKERRQ(ierr);
301e1e80dc8SAlp Dener     ierr = TaoSetMaximumFunctionEvaluations(gn->subsolver,tao->max_funcs);CHKERRQ(ierr);
302737f463aSAlp Dener     for (i=0; i<tao->numbermonitors; ++i) {
303737f463aSAlp Dener       ierr = TaoSetMonitor(gn->subsolver,tao->monitor[i],tao->monitorcontext[i],tao->monitordestroy[i]);CHKERRQ(ierr);
304737f463aSAlp Dener       ierr = PetscObjectReference((PetscObject)(tao->monitorcontext[i]));CHKERRQ(ierr);
305737f463aSAlp Dener     }
306737f463aSAlp Dener     ierr = TaoSetUp(gn->subsolver);CHKERRQ(ierr);
307e1e80dc8SAlp Dener   }
308737f463aSAlp Dener   PetscFunctionReturn(0);
309737f463aSAlp Dener }
310737f463aSAlp Dener 
311737f463aSAlp Dener static PetscErrorCode TaoDestroy_BRGN(Tao tao)
312737f463aSAlp Dener {
313737f463aSAlp Dener   TAO_BRGN              *gn = (TAO_BRGN *)tao->data;
314737f463aSAlp Dener   PetscErrorCode        ierr;
315737f463aSAlp Dener 
316737f463aSAlp Dener   PetscFunctionBegin;
317737f463aSAlp Dener   if (tao->setupcalled) {
318e1e80dc8SAlp Dener     ierr = VecDestroy(&tao->gradient);CHKERRQ(ierr);
319737f463aSAlp Dener     ierr = VecDestroy(&gn->x_work);CHKERRQ(ierr);
320737f463aSAlp Dener     ierr = VecDestroy(&gn->r_work);CHKERRQ(ierr);
321e1e80dc8SAlp Dener     ierr = VecDestroy(&gn->x_old);CHKERRQ(ierr);
3228ac80d48SXiang Huang     ierr = VecDestroy(&gn->diag);CHKERRQ(ierr);
3237cea06e1SXiang Huang     ierr = VecDestroy(&gn->y);CHKERRQ(ierr);
3247cea06e1SXiang Huang     ierr = VecDestroy(&gn->y_work);CHKERRQ(ierr);
325737f463aSAlp Dener   }
326737f463aSAlp Dener   ierr = MatDestroy(&gn->H);CHKERRQ(ierr);
3277cea06e1SXiang Huang   ierr = MatDestroy(&gn->D);CHKERRQ(ierr);
328463fc0ecSAlp Dener   ierr = MatDestroy(&gn->Hreg);CHKERRQ(ierr);
329737f463aSAlp Dener   ierr = TaoDestroy(&gn->subsolver);CHKERRQ(ierr);
330e1e80dc8SAlp Dener   gn->parent = NULL;
331737f463aSAlp Dener   ierr = PetscFree(tao->data);CHKERRQ(ierr);
332737f463aSAlp Dener   PetscFunctionReturn(0);
333737f463aSAlp Dener }
334737f463aSAlp Dener 
3353850be85SAlp Dener /*MC
3363850be85SAlp Dener   TAOBRGN - Bounded Regularized Gauss-Newton method for solving nonlinear least-squares
3373850be85SAlp Dener             problems with bound constraints. This algorithm is a thin wrapper around TAOBNTL
338463fc0ecSAlp Dener             that constructs the Gauss-Newton problem with the user-provided least-squares
33960bb7533SHansol Suh             residual and Jacobian. The algorithm offers an L2-norm ("l2pure"), L2-norm proximal point ("l2prox")
34060bb7533SHansol Suh             regularizer, and L1-norm dictionary regularizer ("l1dict"), where we approximate the
34101b716f5SXiang Huang             L1-norm ||x||_1 by sum_i(sqrt(x_i^2+epsilon^2)-epsilon) with a small positive number epsilon.
34201b716f5SXiang Huang             The user can also provide own regularization function.
3433850be85SAlp Dener 
3443850be85SAlp Dener   Options Database Keys:
34560bb7533SHansol Suh + -tao_brgn_regularization_type - regularization type ("user", "l2prox", "l2pure", "l1dict") (default "l2prox")
346c061e8e2SXiang Huang . -tao_brgn_regularizer_weight  - regularizer weight (default 1e-4)
347c061e8e2SXiang Huang - -tao_brgn_l1_smooth_epsilon   - L1-norm smooth approximation parameter: ||x||_1 = sum(sqrt(x.^2+epsilon^2)-epsilon) (default 1e-6)
3483850be85SAlp Dener 
3493850be85SAlp Dener   Level: beginner
3503850be85SAlp Dener M*/
351737f463aSAlp Dener PETSC_EXTERN PetscErrorCode TaoCreate_BRGN(Tao tao)
352737f463aSAlp Dener {
353737f463aSAlp Dener   TAO_BRGN       *gn;
354737f463aSAlp Dener   PetscErrorCode ierr;
355737f463aSAlp Dener 
356737f463aSAlp Dener   PetscFunctionBegin;
357737f463aSAlp Dener   ierr = PetscNewLog(tao,&gn);CHKERRQ(ierr);
358737f463aSAlp Dener 
359737f463aSAlp Dener   tao->ops->destroy = TaoDestroy_BRGN;
360737f463aSAlp Dener   tao->ops->setup = TaoSetUp_BRGN;
361737f463aSAlp Dener   tao->ops->setfromoptions = TaoSetFromOptions_BRGN;
362737f463aSAlp Dener   tao->ops->view = TaoView_BRGN;
363737f463aSAlp Dener   tao->ops->solve = TaoSolve_BRGN;
364737f463aSAlp Dener 
365737f463aSAlp Dener   tao->data = (void*)gn;
366d8bf7057SXiang Huang   gn->reg_type = BRGN_REGULARIZATION_L2PROX;
367e1e80dc8SAlp Dener   gn->lambda = 1e-4;
3688ac80d48SXiang Huang   gn->epsilon = 1e-6;
369e1e80dc8SAlp Dener   gn->parent = tao;
370737f463aSAlp Dener 
371737f463aSAlp Dener   ierr = MatCreate(PetscObjectComm((PetscObject)tao),&gn->H);CHKERRQ(ierr);
372737f463aSAlp Dener   ierr = MatSetOptionsPrefix(gn->H,"tao_brgn_hessian_");CHKERRQ(ierr);
373737f463aSAlp Dener 
374737f463aSAlp Dener   ierr = TaoCreate(PetscObjectComm((PetscObject)tao),&gn->subsolver);CHKERRQ(ierr);
375737f463aSAlp Dener   ierr = TaoSetType(gn->subsolver,TAOBNLS);CHKERRQ(ierr);
376737f463aSAlp Dener   ierr = TaoSetOptionsPrefix(gn->subsolver,"tao_brgn_subsolver_");CHKERRQ(ierr);
377e1e80dc8SAlp Dener   PetscFunctionReturn(0);
378e1e80dc8SAlp Dener }
379e1e80dc8SAlp Dener 
380463fc0ecSAlp Dener /*@
381e1e80dc8SAlp Dener   TaoBRGNGetSubsolver - Get the pointer to the subsolver inside BRGN
382e1e80dc8SAlp Dener 
383e1e80dc8SAlp Dener   Collective on Tao
384e1e80dc8SAlp Dener 
385463fc0ecSAlp Dener   Level: advanced
386e1e80dc8SAlp Dener 
387e1e80dc8SAlp Dener   Input Parameters:
388e1e80dc8SAlp Dener +  tao - the Tao solver context
389e1e80dc8SAlp Dener -  subsolver - the Tao sub-solver context
390e1e80dc8SAlp Dener @*/
391e1e80dc8SAlp Dener PetscErrorCode TaoBRGNGetSubsolver(Tao tao,Tao *subsolver)
392e1e80dc8SAlp Dener {
393e1e80dc8SAlp Dener   TAO_BRGN       *gn = (TAO_BRGN *)tao->data;
394e1e80dc8SAlp Dener 
395e1e80dc8SAlp Dener   PetscFunctionBegin;
396e1e80dc8SAlp Dener   *subsolver = gn->subsolver;
397737f463aSAlp Dener   PetscFunctionReturn(0);
398737f463aSAlp Dener }
399737f463aSAlp Dener 
400463fc0ecSAlp Dener /*@
401463fc0ecSAlp Dener   TaoBRGNSetRegularizerWeight - Set the regularizer weight for the Gauss-Newton least-squares algorithm
402737f463aSAlp Dener 
403737f463aSAlp Dener   Collective on Tao
404737f463aSAlp Dener 
405737f463aSAlp Dener   Input Parameters:
406737f463aSAlp Dener +  tao - the Tao solver context
4078e85b1b3SXiang Huang -  lambda - L1-norm regularizer weight
408463fc0ecSAlp Dener 
409463fc0ecSAlp Dener   Level: beginner
410737f463aSAlp Dener @*/
411a3c390cfSAlp Dener PetscErrorCode TaoBRGNSetRegularizerWeight(Tao tao,PetscReal lambda)
412737f463aSAlp Dener {
413737f463aSAlp Dener   TAO_BRGN       *gn = (TAO_BRGN *)tao->data;
414737f463aSAlp Dener 
4158ac80d48SXiang Huang   /* Initialize lambda here */
4160d71dc2bSXiang Huang 
417737f463aSAlp Dener   PetscFunctionBegin;
418737f463aSAlp Dener   gn->lambda = lambda;
419737f463aSAlp Dener   PetscFunctionReturn(0);
420737f463aSAlp Dener }
4210d71dc2bSXiang Huang 
422463fc0ecSAlp Dener /*@
4238ac80d48SXiang Huang   TaoBRGNSetL1SmoothEpsilon - Set the L1-norm smooth approximation parameter for L1-regularized least-squares algorithm
4248ac80d48SXiang Huang 
4258ac80d48SXiang Huang   Collective on Tao
4268ac80d48SXiang Huang 
4278ac80d48SXiang Huang   Input Parameters:
4288ac80d48SXiang Huang +  tao - the Tao solver context
4298ac80d48SXiang Huang -  epsilon - L1-norm smooth approximation parameter
430463fc0ecSAlp Dener 
431463fc0ecSAlp Dener   Level: advanced
4328ac80d48SXiang Huang @*/
4338ac80d48SXiang Huang PetscErrorCode TaoBRGNSetL1SmoothEpsilon(Tao tao,PetscReal epsilon)
4348ac80d48SXiang Huang {
4358ac80d48SXiang Huang   TAO_BRGN       *gn = (TAO_BRGN *)tao->data;
4368ac80d48SXiang Huang 
4378ac80d48SXiang Huang   /* Initialize epsilon here */
4388ac80d48SXiang Huang 
4398ac80d48SXiang Huang   PetscFunctionBegin;
4408ac80d48SXiang Huang   gn->epsilon = epsilon;
4418ac80d48SXiang Huang   PetscFunctionReturn(0);
4428ac80d48SXiang Huang }
4438e85b1b3SXiang Huang 
444463fc0ecSAlp Dener /*@
4458e85b1b3SXiang Huang    TaoBRGNSetDictionaryMatrix - bind the dictionary matrix from user application context to gn->D, for compressed sensing (with least-squares problem)
4468e85b1b3SXiang Huang 
4478e85b1b3SXiang Huang    Input Parameters:
4488e85b1b3SXiang Huang +  tao  - the Tao context
449a2b725a8SWilliam Gropp -  dict - the user specified dictionary matrix.  We allow to set a null dictionary, which means identity matrix by default
4508e85b1b3SXiang Huang 
451463fc0ecSAlp Dener     Level: advanced
4528e85b1b3SXiang Huang @*/
4538e85b1b3SXiang Huang PetscErrorCode TaoBRGNSetDictionaryMatrix(Tao tao,Mat dict)
4548e85b1b3SXiang Huang {
4558e85b1b3SXiang Huang   TAO_BRGN       *gn = (TAO_BRGN *)tao->data;
4568e85b1b3SXiang Huang   PetscErrorCode ierr;
4578e85b1b3SXiang Huang   PetscFunctionBegin;
4588e85b1b3SXiang Huang   PetscValidHeaderSpecific(tao,TAO_CLASSID,1);
4598e85b1b3SXiang Huang   if (dict) {
4608e85b1b3SXiang Huang     PetscValidHeaderSpecific(dict,MAT_CLASSID,2);
461a3c390cfSAlp Dener     PetscCheckSameComm(tao,1,dict,2);
4628e85b1b3SXiang Huang     ierr = PetscObjectReference((PetscObject)dict);CHKERRQ(ierr);
4638e85b1b3SXiang Huang   }
4648e85b1b3SXiang Huang   ierr = MatDestroy(&gn->D);CHKERRQ(ierr);
4651fc140a9SXiang Huang   gn->D = dict;
4668e85b1b3SXiang Huang   PetscFunctionReturn(0);
4678e85b1b3SXiang Huang }
4688e85b1b3SXiang Huang 
469a3c390cfSAlp Dener /*@C
470463fc0ecSAlp Dener    TaoBRGNSetRegularizerObjectiveAndGradientRoutine - Sets the user-defined regularizer call-back
471463fc0ecSAlp Dener    function into the algorithm.
472463fc0ecSAlp Dener 
473463fc0ecSAlp Dener    Input Parameters:
474463fc0ecSAlp Dener    + tao - the Tao context
475463fc0ecSAlp Dener    . func - function pointer for the regularizer value and gradient evaluation
476463fc0ecSAlp Dener    - ctx - user context for the regularizer
477463fc0ecSAlp Dener 
478463fc0ecSAlp Dener    Level: advanced
479a3c390cfSAlp Dener @*/
480a3c390cfSAlp Dener PetscErrorCode TaoBRGNSetRegularizerObjectiveAndGradientRoutine(Tao tao,PetscErrorCode (*func)(Tao,Vec,PetscReal *,Vec,void*),void *ctx)
481a3c390cfSAlp Dener {
482a3c390cfSAlp Dener   TAO_BRGN       *gn = (TAO_BRGN *)tao->data;
483a3c390cfSAlp Dener 
484a3c390cfSAlp Dener   PetscFunctionBegin;
485a3c390cfSAlp Dener   PetscValidHeaderSpecific(tao,TAO_CLASSID,1);
486a3c390cfSAlp Dener   if (ctx) {
487a3c390cfSAlp Dener     gn->reg_obj_ctx = ctx;
488a3c390cfSAlp Dener   }
489a3c390cfSAlp Dener   if (func) {
490a3c390cfSAlp Dener     gn->regularizerobjandgrad = func;
491a3c390cfSAlp Dener   }
492a3c390cfSAlp Dener   PetscFunctionReturn(0);
493a3c390cfSAlp Dener }
494a3c390cfSAlp Dener 
495a3c390cfSAlp Dener /*@C
496463fc0ecSAlp Dener    TaoBRGNSetRegularizerHessianRoutine - Sets the user-defined regularizer call-back
497463fc0ecSAlp Dener    function into the algorithm.
498463fc0ecSAlp Dener 
499463fc0ecSAlp Dener    Input Parameters:
500463fc0ecSAlp Dener    + tao - the Tao context
501463fc0ecSAlp Dener    . Hreg - user-created matrix for the Hessian of the regularization term
502463fc0ecSAlp Dener    . func - function pointer for the regularizer Hessian evaluation
503463fc0ecSAlp Dener    - ctx - user context for the regularizer Hessian
504463fc0ecSAlp Dener 
505463fc0ecSAlp Dener    Level: advanced
506a3c390cfSAlp Dener @*/
507a3c390cfSAlp Dener PetscErrorCode TaoBRGNSetRegularizerHessianRoutine(Tao tao,Mat Hreg,PetscErrorCode (*func)(Tao,Vec,Mat,void*),void *ctx)
508a3c390cfSAlp Dener {
509a3c390cfSAlp Dener   TAO_BRGN       *gn = (TAO_BRGN *)tao->data;
510a3c390cfSAlp Dener   PetscErrorCode ierr;
511a3c390cfSAlp Dener 
512a3c390cfSAlp Dener   PetscFunctionBegin;
513a3c390cfSAlp Dener   PetscValidHeaderSpecific(tao,TAO_CLASSID,1);
514a3c390cfSAlp Dener   if (Hreg) {
515a3c390cfSAlp Dener     PetscValidHeaderSpecific(Hreg,MAT_CLASSID,2);
516a3c390cfSAlp Dener     PetscCheckSameComm(tao,1,Hreg,2);
51701b716f5SXiang Huang   } else SETERRQ(PetscObjectComm((PetscObject)tao),PETSC_ERR_ARG_WRONG,"NULL Hessian detected! User must provide valid Hessian for the regularizer.");
518a3c390cfSAlp Dener   if (ctx) {
519a3c390cfSAlp Dener     gn->reg_hess_ctx = ctx;
520a3c390cfSAlp Dener   }
521a3c390cfSAlp Dener   if (func) {
522a3c390cfSAlp Dener     gn->regularizerhessian = func;
523a3c390cfSAlp Dener   }
524a3c390cfSAlp Dener   if (Hreg) {
525a3c390cfSAlp Dener     ierr = PetscObjectReference((PetscObject)Hreg);CHKERRQ(ierr);
526a3c390cfSAlp Dener     ierr = MatDestroy(&gn->Hreg);CHKERRQ(ierr);
527a3c390cfSAlp Dener     gn->Hreg = Hreg;
528a3c390cfSAlp Dener   }
529a3c390cfSAlp Dener   PetscFunctionReturn(0);
530a3c390cfSAlp Dener }
5319275ad16SHansol Suh 
532