|
| 1 | +/* |
| 2 | + * Matlab usage: x = sght(v, ind, s1, s2, num) |
| 3 | + */ |
| 4 | +#include <cstdio> |
| 5 | +#include <cstdlib> |
| 6 | +#include <algorithm> |
| 7 | +#include <cstring> |
| 8 | +#include <iostream> |
| 9 | +#include <cmath> |
| 10 | +#include <mex.h> |
| 11 | + |
| 12 | +using namespace std; |
| 13 | + |
| 14 | +int n, g; |
| 15 | +int flmt, glmt; |
| 16 | +double *v, *x, *num; |
| 17 | +int *vidx; |
| 18 | +int *gidx; |
| 19 | + |
| 20 | +// 1-based |
| 21 | +double ***d; |
| 22 | +int ***path; |
| 23 | +double **selection_value; |
| 24 | + |
| 25 | +bool cmp (int x, int y) { |
| 26 | + return fabs(v[x]) > fabs(v[y]) + 1e-9; |
| 27 | +} |
| 28 | + |
| 29 | +void dp_preprocess () { |
| 30 | + int i, j, k; |
| 31 | + |
| 32 | + d = (double ***)malloc((g + 1) * sizeof(double **)); |
| 33 | + path = (int ***)malloc((g + 1) * sizeof(int **)); |
| 34 | + for (i = 0; i <= g; ++i) { |
| 35 | + d[i] = (double **)malloc((glmt + 1) * sizeof(double *)); |
| 36 | + path[i] = (int **)malloc((glmt + 1) * sizeof(int *)); |
| 37 | + for (j = 0; j <= glmt; ++j) { |
| 38 | + d[i][j] = (double *)malloc((flmt + 1) * sizeof(double)); |
| 39 | + path[i][j] = (int *)malloc((flmt + 1) * sizeof(int)); |
| 40 | + for (k = 0; k <= flmt; ++k) { |
| 41 | + d[i][j][k] = .0; |
| 42 | + path[i][j][k] = 0; |
| 43 | + } |
| 44 | + } |
| 45 | + } |
| 46 | + int up = 0; |
| 47 | + for (i = 1; i <= g; ++i) |
| 48 | + up = max(up, gidx[i] - gidx[i-1]); |
| 49 | + |
| 50 | + selection_value = (double **)malloc((g + 1) * sizeof(double *)); |
| 51 | + for (i = 0; i <= g; ++i) |
| 52 | + selection_value[i] = (double *)malloc((up + 1) * sizeof(double)); |
| 53 | + |
| 54 | + vidx = (int *)malloc(n * sizeof(int)); |
| 55 | + for (i = 0; i < n; ++i) vidx[i] = i; |
| 56 | + |
| 57 | + for (i = 1; i <= g; ++i) { |
| 58 | + sort(vidx + gidx[i-1], vidx + gidx[i], cmp); |
| 59 | + selection_value[i][0] = .0; |
| 60 | + for (j = 1; j <= gidx[i] - gidx[i-1]; ++j) |
| 61 | + selection_value[i][j] = selection_value[i][j-1] + |
| 62 | + v[vidx[gidx[i-1]+j-1]] * v[vidx[gidx[i-1]+j-1]]; |
| 63 | + } |
| 64 | +} |
| 65 | + |
| 66 | +void dp () { |
| 67 | + int i, j, k, t; |
| 68 | + |
| 69 | + dp_preprocess (); |
| 70 | + |
| 71 | + for (i = 1; i <= g; ++i) { |
| 72 | + int upper = (int)num[i-1]; |
| 73 | + for (j = 1; j <= glmt; ++j) |
| 74 | + for (k = 1; k <= flmt; ++k) { |
| 75 | + d[i][j][k] = d[i-1][j][k]; |
| 76 | + |
| 77 | + // min(|G_i|, min(num_i, k)) |
| 78 | + int u = min(k, min(upper, gidx[i] - gidx[i-1])); |
| 79 | + |
| 80 | + int max_idx = 0; |
| 81 | + double best = d[i][j][k], v; |
| 82 | + for (t = 1; t <= u; ++t) { |
| 83 | + if ((v = d[i-1][j-1][k-t] + selection_value[i][t]) > best) { |
| 84 | + best = v; |
| 85 | + max_idx = t; |
| 86 | + } |
| 87 | + } |
| 88 | + d[i][j][k] = best; |
| 89 | + path[i][j][k] = max_idx; |
| 90 | + } |
| 91 | + } |
| 92 | +} |
| 93 | + |
| 94 | +void calc_sol () { |
| 95 | + int i, j, k; |
| 96 | + memset (x, 0, n * sizeof(double)); |
| 97 | + |
| 98 | + for (i = g, j = glmt, k = flmt; i >= 1; --i) { |
| 99 | + int num = path[i][j][k]; |
| 100 | + k -= num; |
| 101 | + if (num) --j; |
| 102 | + for (int t = 1; t <= num; ++t) |
| 103 | + x[vidx[gidx[i-1]+t-1]] = v[vidx[gidx[i-1]+t-1]]; |
| 104 | + } |
| 105 | +} |
| 106 | + |
| 107 | +void destruct () { |
| 108 | + int i, j; |
| 109 | + |
| 110 | +//free(v); v = NULL; |
| 111 | + free(vidx); vidx = NULL; |
| 112 | + free(gidx); gidx = NULL; |
| 113 | + for (i = 0; i <= g; ++i) { |
| 114 | + for (j = 0; j <= glmt; ++j) { |
| 115 | + free(d[i][j]); d[i][j] = NULL; |
| 116 | + free(path[i][j]); path[i][j] = NULL; |
| 117 | + } |
| 118 | + free(d[i]); d[i] = NULL; |
| 119 | + free(path[i]); path[i] = NULL; |
| 120 | + } |
| 121 | + free(d); d = NULL; |
| 122 | + free(path); path = NULL; |
| 123 | + |
| 124 | + for (i = 0; i <= g; ++i) { |
| 125 | + free(selection_value[i]); |
| 126 | + selection_value[i] = NULL; |
| 127 | + } |
| 128 | + free(selection_value); |
| 129 | + selection_value = NULL; |
| 130 | +} |
| 131 | + |
| 132 | +void mexFunction (int nlhs, mxArray* plhs[], |
| 133 | + int nrhs, const mxArray* prhs[]) |
| 134 | +{ |
| 135 | + v = mxGetPr(prhs[0]); |
| 136 | + double* gidx_double = mxGetPr(prhs[1]); |
| 137 | + |
| 138 | + n = mxGetNumberOfElements(prhs[0]); |
| 139 | + g = mxGetNumberOfElements(prhs[1]) - 1; |
| 140 | + |
| 141 | + gidx = (int *)malloc((g + 1) * sizeof(int)); |
| 142 | + for (int i = 0; i <= g; ++i) gidx[i] = (int)gidx_double[i]; |
| 143 | + |
| 144 | + flmt = mxGetScalar(prhs[2]); |
| 145 | + glmt = mxGetScalar(prhs[3]); |
| 146 | + |
| 147 | + num = mxGetPr(prhs[4]); |
| 148 | + |
| 149 | + double eps = 1e-7; |
| 150 | + |
| 151 | + plhs[0] = mxCreateDoubleMatrix(n, 1, mxREAL); |
| 152 | + x = mxGetPr(plhs[0]); |
| 153 | + |
| 154 | + dp (); |
| 155 | + calc_sol (); |
| 156 | +//mexPrintf ("sglt: Optimal solution is %.5lf\n", d[g][glmt][flmt]); |
| 157 | + |
| 158 | + destruct (); |
| 159 | +} |
| 160 | + |
0 commit comments