casadi_bilin.hpp
1 //
2 // MIT No Attribution
3 //
4 // Copyright (C) 2010-2023 Joel Andersson, Joris Gillis, Moritz Diehl, KU Leuven.
5 //
6 // Permission is hereby granted, free of charge, to any person obtaining a copy of this
7 // software and associated documentation files (the "Software"), to deal in the Software
8 // without restriction, including without limitation the rights to use, copy, modify,
9 // merge, publish, distribute, sublicense, and/or sell copies of the Software, and to
10 // permit persons to whom the Software is furnished to do so.
11 //
12 // THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED,
13 // INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A
14 // PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
15 // HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
16 // OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
17 // SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
18 //
19 
20 // SYMBOL "bilin"
21 template<typename T1>
22 T1 casadi_bilin(const T1* A, const casadi_int* sp_A, const T1* x, const T1* y) {
23  casadi_int ncol_A, cc, rr, el;
24  const casadi_int *colind_A, *row_A;
25  T1 ret;
26  // Get sparsities
27  ncol_A = sp_A[1];
28  colind_A = sp_A+2; row_A = sp_A + 2 + ncol_A+1;
29  // Return value
30  ret=0;
31  // Loop over the columns of A
32  for (cc=0; cc<ncol_A; ++cc) {
33  // Loop over the nonzeros of A
34  for (el=colind_A[cc]; el<colind_A[cc+1]; ++el) {
35  // Get the row
36  rr=row_A[el];
37  // Add contribution
38  ret += x[rr]*A[el]*y[cc];
39  }
40  }
41  return ret;
42 }