Squashed 'third_party/blasfeo/' content from commit 2a828ca
Change-Id: If1c3caa4799b2d4eb287ef83fa17043587ef07a3
git-subtree-dir: third_party/blasfeo
git-subtree-split: 2a828ca5442108c4c58e4b42b061a0469043f6ea
diff --git a/blas/x_blas2_diag_lib.c b/blas/x_blas2_diag_lib.c
new file mode 100644
index 0000000..e90cbd6
--- /dev/null
+++ b/blas/x_blas2_diag_lib.c
@@ -0,0 +1,51 @@
+/**************************************************************************************************
+* *
+* This file is part of BLASFEO. *
+* *
+* BLASFEO -- BLAS For Embedded Optimization. *
+* Copyright (C) 2016-2017 by Gianluca Frison. *
+* Developed at IMTEK (University of Freiburg) under the supervision of Moritz Diehl. *
+* All rights reserved. *
+* *
+* HPMPC is free software; you can redistribute it and/or *
+* modify it under the terms of the GNU Lesser General Public *
+* License as published by the Free Software Foundation; either *
+* version 2.1 of the License, or (at your option) any later version. *
+* *
+* HPMPC is distributed in the hope that it will be useful, *
+* but WITHOUT ANY WARRANTY; without even the implied warranty of *
+* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. *
+* See the GNU Lesser General Public License for more details. *
+* *
+* You should have received a copy of the GNU Lesser General Public *
+* License along with HPMPC; if not, write to the Free Software *
+* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA *
+* *
+* Author: Gianluca Frison, giaf (at) dtu.dk *
+* gianluca.frison (at) imtek.uni-freiburg.de *
+* *
+**************************************************************************************************/
+
+void GEMV_DIAG_LIBSTR(int m, REAL alpha, struct STRVEC *sA, int ai, struct STRVEC *sx, int xi, REAL beta, struct STRVEC *sy, int yi, struct STRVEC *sz, int zi)
+ {
+ if(m<=0)
+ return;
+ int ii;
+ REAL *a = sA->pa + ai;
+ REAL *x = sx->pa + xi;
+ REAL *y = sy->pa + yi;
+ REAL *z = sz->pa + zi;
+ if(alpha==1.0 & beta==1.0)
+ {
+ for(ii=0; ii<m; ii++)
+ z[ii] = a[ii]*x[ii] + y[ii];
+ }
+ else
+ {
+ for(ii=0; ii<m; ii++)
+ z[ii] = alpha*a[ii]*x[ii] + beta*y[ii];
+ }
+
+ return;
+
+ }