1 | /* $Id: ClpHelperFunctions.cpp 1753 2011-06-19 16:27:26Z stefan $ */ |
2 | // Copyright (C) 2003, International Business Machines |
3 | // Corporation and others. All Rights Reserved. |
4 | // This code is licensed under the terms of the Eclipse Public License (EPL). |
5 | |
6 | /* |
7 | Note (JJF) I have added some operations on arrays even though they may |
8 | duplicate CoinDenseVector. I think the use of templates was a mistake |
9 | as I don't think inline generic code can take as much advantage of |
10 | parallelism or machine architectures or memory hierarchies. |
11 | |
12 | */ |
13 | #include <cfloat> |
14 | #include <cstdlib> |
15 | #include <cmath> |
16 | #include "CoinHelperFunctions.hpp" |
17 | #include "CoinTypes.hpp" |
18 | |
19 | double |
20 | maximumAbsElement(const double * region, int size) |
21 | { |
22 | int i; |
23 | double maxValue = 0.0; |
24 | for (i = 0; i < size; i++) |
25 | maxValue = CoinMax(maxValue, fabs(region[i])); |
26 | return maxValue; |
27 | } |
28 | void |
29 | setElements(double * region, int size, double value) |
30 | { |
31 | int i; |
32 | for (i = 0; i < size; i++) |
33 | region[i] = value; |
34 | } |
35 | void |
36 | multiplyAdd(const double * region1, int size, double multiplier1, |
37 | double * region2, double multiplier2) |
38 | { |
39 | int i; |
40 | if (multiplier1 == 1.0) { |
41 | if (multiplier2 == 1.0) { |
42 | for (i = 0; i < size; i++) |
43 | region2[i] = region1[i] + region2[i]; |
44 | } else if (multiplier2 == -1.0) { |
45 | for (i = 0; i < size; i++) |
46 | region2[i] = region1[i] - region2[i]; |
47 | } else if (multiplier2 == 0.0) { |
48 | for (i = 0; i < size; i++) |
49 | region2[i] = region1[i] ; |
50 | } else { |
51 | for (i = 0; i < size; i++) |
52 | region2[i] = region1[i] + multiplier2 * region2[i]; |
53 | } |
54 | } else if (multiplier1 == -1.0) { |
55 | if (multiplier2 == 1.0) { |
56 | for (i = 0; i < size; i++) |
57 | region2[i] = -region1[i] + region2[i]; |
58 | } else if (multiplier2 == -1.0) { |
59 | for (i = 0; i < size; i++) |
60 | region2[i] = -region1[i] - region2[i]; |
61 | } else if (multiplier2 == 0.0) { |
62 | for (i = 0; i < size; i++) |
63 | region2[i] = -region1[i] ; |
64 | } else { |
65 | for (i = 0; i < size; i++) |
66 | region2[i] = -region1[i] + multiplier2 * region2[i]; |
67 | } |
68 | } else if (multiplier1 == 0.0) { |
69 | if (multiplier2 == 1.0) { |
70 | // nothing to do |
71 | } else if (multiplier2 == -1.0) { |
72 | for (i = 0; i < size; i++) |
73 | region2[i] = -region2[i]; |
74 | } else if (multiplier2 == 0.0) { |
75 | for (i = 0; i < size; i++) |
76 | region2[i] = 0.0; |
77 | } else { |
78 | for (i = 0; i < size; i++) |
79 | region2[i] = multiplier2 * region2[i]; |
80 | } |
81 | } else { |
82 | if (multiplier2 == 1.0) { |
83 | for (i = 0; i < size; i++) |
84 | region2[i] = multiplier1 * region1[i] + region2[i]; |
85 | } else if (multiplier2 == -1.0) { |
86 | for (i = 0; i < size; i++) |
87 | region2[i] = multiplier1 * region1[i] - region2[i]; |
88 | } else if (multiplier2 == 0.0) { |
89 | for (i = 0; i < size; i++) |
90 | region2[i] = multiplier1 * region1[i] ; |
91 | } else { |
92 | for (i = 0; i < size; i++) |
93 | region2[i] = multiplier1 * region1[i] + multiplier2 * region2[i]; |
94 | } |
95 | } |
96 | } |
97 | double |
98 | innerProduct(const double * region1, int size, const double * region2) |
99 | { |
100 | int i; |
101 | double value = 0.0; |
102 | for (i = 0; i < size; i++) |
103 | value += region1[i] * region2[i]; |
104 | return value; |
105 | } |
106 | void |
107 | getNorms(const double * region, int size, double & norm1, double & norm2) |
108 | { |
109 | norm1 = 0.0; |
110 | norm2 = 0.0; |
111 | int i; |
112 | for (i = 0; i < size; i++) { |
113 | norm2 += region[i] * region[i]; |
114 | norm1 = CoinMax(norm1, fabs(region[i])); |
115 | } |
116 | } |
117 | #if COIN_LONG_WORK |
118 | // For long double versions |
119 | CoinWorkDouble |
120 | maximumAbsElement(const CoinWorkDouble * region, int size) |
121 | { |
122 | int i; |
123 | CoinWorkDouble maxValue = 0.0; |
124 | for (i = 0; i < size; i++) |
125 | maxValue = CoinMax(maxValue, CoinAbs(region[i])); |
126 | return maxValue; |
127 | } |
128 | void |
129 | setElements(CoinWorkDouble * region, int size, CoinWorkDouble value) |
130 | { |
131 | int i; |
132 | for (i = 0; i < size; i++) |
133 | region[i] = value; |
134 | } |
135 | void |
136 | multiplyAdd(const CoinWorkDouble * region1, int size, CoinWorkDouble multiplier1, |
137 | CoinWorkDouble * region2, CoinWorkDouble multiplier2) |
138 | { |
139 | int i; |
140 | if (multiplier1 == 1.0) { |
141 | if (multiplier2 == 1.0) { |
142 | for (i = 0; i < size; i++) |
143 | region2[i] = region1[i] + region2[i]; |
144 | } else if (multiplier2 == -1.0) { |
145 | for (i = 0; i < size; i++) |
146 | region2[i] = region1[i] - region2[i]; |
147 | } else if (multiplier2 == 0.0) { |
148 | for (i = 0; i < size; i++) |
149 | region2[i] = region1[i] ; |
150 | } else { |
151 | for (i = 0; i < size; i++) |
152 | region2[i] = region1[i] + multiplier2 * region2[i]; |
153 | } |
154 | } else if (multiplier1 == -1.0) { |
155 | if (multiplier2 == 1.0) { |
156 | for (i = 0; i < size; i++) |
157 | region2[i] = -region1[i] + region2[i]; |
158 | } else if (multiplier2 == -1.0) { |
159 | for (i = 0; i < size; i++) |
160 | region2[i] = -region1[i] - region2[i]; |
161 | } else if (multiplier2 == 0.0) { |
162 | for (i = 0; i < size; i++) |
163 | region2[i] = -region1[i] ; |
164 | } else { |
165 | for (i = 0; i < size; i++) |
166 | region2[i] = -region1[i] + multiplier2 * region2[i]; |
167 | } |
168 | } else if (multiplier1 == 0.0) { |
169 | if (multiplier2 == 1.0) { |
170 | // nothing to do |
171 | } else if (multiplier2 == -1.0) { |
172 | for (i = 0; i < size; i++) |
173 | region2[i] = -region2[i]; |
174 | } else if (multiplier2 == 0.0) { |
175 | for (i = 0; i < size; i++) |
176 | region2[i] = 0.0; |
177 | } else { |
178 | for (i = 0; i < size; i++) |
179 | region2[i] = multiplier2 * region2[i]; |
180 | } |
181 | } else { |
182 | if (multiplier2 == 1.0) { |
183 | for (i = 0; i < size; i++) |
184 | region2[i] = multiplier1 * region1[i] + region2[i]; |
185 | } else if (multiplier2 == -1.0) { |
186 | for (i = 0; i < size; i++) |
187 | region2[i] = multiplier1 * region1[i] - region2[i]; |
188 | } else if (multiplier2 == 0.0) { |
189 | for (i = 0; i < size; i++) |
190 | region2[i] = multiplier1 * region1[i] ; |
191 | } else { |
192 | for (i = 0; i < size; i++) |
193 | region2[i] = multiplier1 * region1[i] + multiplier2 * region2[i]; |
194 | } |
195 | } |
196 | } |
197 | CoinWorkDouble |
198 | innerProduct(const CoinWorkDouble * region1, int size, const CoinWorkDouble * region2) |
199 | { |
200 | int i; |
201 | CoinWorkDouble value = 0.0; |
202 | for (i = 0; i < size; i++) |
203 | value += region1[i] * region2[i]; |
204 | return value; |
205 | } |
206 | void |
207 | getNorms(const CoinWorkDouble * region, int size, CoinWorkDouble & norm1, CoinWorkDouble & norm2) |
208 | { |
209 | norm1 = 0.0; |
210 | norm2 = 0.0; |
211 | int i; |
212 | for (i = 0; i < size; i++) { |
213 | norm2 += region[i] * region[i]; |
214 | norm1 = CoinMax(norm1, CoinAbs(region[i])); |
215 | } |
216 | } |
217 | #endif |
218 | #ifdef DEBUG_MEMORY |
219 | #include <malloc.h> |
220 | #include <stdio.h> |
221 | #include <stdlib.h> |
222 | |
223 | typedef void (*NEW_HANDLER)(); |
224 | static NEW_HANDLER new_handler; // function to call if `new' fails (cf. ARM p. 281) |
225 | |
226 | // Allocate storage. |
227 | void * |
228 | operator new(size_t size) |
229 | { |
230 | void * p; |
231 | for (;;) { |
232 | p = malloc(size); |
233 | if (p) break; // success |
234 | else if (new_handler) new_handler(); // failure - try again (allow user to release some storage first) |
235 | else break; // failure - no retry |
236 | } |
237 | if (size > 1000000) |
238 | printf("Allocating memory of size %d\n" , size); |
239 | return p; |
240 | } |
241 | |
242 | // Deallocate storage. |
243 | void |
244 | operator delete(void *p) |
245 | { |
246 | free(p); |
247 | return; |
248 | } |
249 | void |
250 | operator delete [] (void *p) |
251 | { |
252 | free(p); |
253 | return; |
254 | } |
255 | #endif |
256 | |