crush: pass weight vector size to map function
[platform/adaptation/renesas_rcar/renesas_kernel.git] / net / ceph / crush / mapper.c
1
2 #ifdef __KERNEL__
3 # include <linux/string.h>
4 # include <linux/slab.h>
5 # include <linux/bug.h>
6 # include <linux/kernel.h>
7 # ifndef dprintk
8 #  define dprintk(args...)
9 # endif
10 #else
11 # include <string.h>
12 # include <stdio.h>
13 # include <stdlib.h>
14 # include <assert.h>
15 # define BUG_ON(x) assert(!(x))
16 # define dprintk(args...) /* printf(args) */
17 # define kmalloc(x, f) malloc(x)
18 # define kfree(x) free(x)
19 #endif
20
21 #include <linux/crush/crush.h>
22 #include <linux/crush/hash.h>
23 #include <linux/crush/mapper.h>
24
25 /*
26  * Implement the core CRUSH mapping algorithm.
27  */
28
29 /**
30  * crush_find_rule - find a crush_rule id for a given ruleset, type, and size.
31  * @map: the crush_map
32  * @ruleset: the storage ruleset id (user defined)
33  * @type: storage ruleset type (user defined)
34  * @size: output set size
35  */
36 int crush_find_rule(const struct crush_map *map, int ruleset, int type, int size)
37 {
38         __u32 i;
39
40         for (i = 0; i < map->max_rules; i++) {
41                 if (map->rules[i] &&
42                     map->rules[i]->mask.ruleset == ruleset &&
43                     map->rules[i]->mask.type == type &&
44                     map->rules[i]->mask.min_size <= size &&
45                     map->rules[i]->mask.max_size >= size)
46                         return i;
47         }
48         return -1;
49 }
50
51
52 /*
53  * bucket choose methods
54  *
55  * For each bucket algorithm, we have a "choose" method that, given a
56  * crush input @x and replica position (usually, position in output set) @r,
57  * will produce an item in the bucket.
58  */
59
60 /*
61  * Choose based on a random permutation of the bucket.
62  *
63  * We used to use some prime number arithmetic to do this, but it
64  * wasn't very random, and had some other bad behaviors.  Instead, we
65  * calculate an actual random permutation of the bucket members.
66  * Since this is expensive, we optimize for the r=0 case, which
67  * captures the vast majority of calls.
68  */
69 static int bucket_perm_choose(struct crush_bucket *bucket,
70                               int x, int r)
71 {
72         unsigned int pr = r % bucket->size;
73         unsigned int i, s;
74
75         /* start a new permutation if @x has changed */
76         if (bucket->perm_x != (__u32)x || bucket->perm_n == 0) {
77                 dprintk("bucket %d new x=%d\n", bucket->id, x);
78                 bucket->perm_x = x;
79
80                 /* optimize common r=0 case */
81                 if (pr == 0) {
82                         s = crush_hash32_3(bucket->hash, x, bucket->id, 0) %
83                                 bucket->size;
84                         bucket->perm[0] = s;
85                         bucket->perm_n = 0xffff;   /* magic value, see below */
86                         goto out;
87                 }
88
89                 for (i = 0; i < bucket->size; i++)
90                         bucket->perm[i] = i;
91                 bucket->perm_n = 0;
92         } else if (bucket->perm_n == 0xffff) {
93                 /* clean up after the r=0 case above */
94                 for (i = 1; i < bucket->size; i++)
95                         bucket->perm[i] = i;
96                 bucket->perm[bucket->perm[0]] = 0;
97                 bucket->perm_n = 1;
98         }
99
100         /* calculate permutation up to pr */
101         for (i = 0; i < bucket->perm_n; i++)
102                 dprintk(" perm_choose have %d: %d\n", i, bucket->perm[i]);
103         while (bucket->perm_n <= pr) {
104                 unsigned int p = bucket->perm_n;
105                 /* no point in swapping the final entry */
106                 if (p < bucket->size - 1) {
107                         i = crush_hash32_3(bucket->hash, x, bucket->id, p) %
108                                 (bucket->size - p);
109                         if (i) {
110                                 unsigned int t = bucket->perm[p + i];
111                                 bucket->perm[p + i] = bucket->perm[p];
112                                 bucket->perm[p] = t;
113                         }
114                         dprintk(" perm_choose swap %d with %d\n", p, p+i);
115                 }
116                 bucket->perm_n++;
117         }
118         for (i = 0; i < bucket->size; i++)
119                 dprintk(" perm_choose  %d: %d\n", i, bucket->perm[i]);
120
121         s = bucket->perm[pr];
122 out:
123         dprintk(" perm_choose %d sz=%d x=%d r=%d (%d) s=%d\n", bucket->id,
124                 bucket->size, x, r, pr, s);
125         return bucket->items[s];
126 }
127
128 /* uniform */
129 static int bucket_uniform_choose(struct crush_bucket_uniform *bucket,
130                                  int x, int r)
131 {
132         return bucket_perm_choose(&bucket->h, x, r);
133 }
134
135 /* list */
136 static int bucket_list_choose(struct crush_bucket_list *bucket,
137                               int x, int r)
138 {
139         int i;
140
141         for (i = bucket->h.size-1; i >= 0; i--) {
142                 __u64 w = crush_hash32_4(bucket->h.hash,x, bucket->h.items[i],
143                                          r, bucket->h.id);
144                 w &= 0xffff;
145                 dprintk("list_choose i=%d x=%d r=%d item %d weight %x "
146                         "sw %x rand %llx",
147                         i, x, r, bucket->h.items[i], bucket->item_weights[i],
148                         bucket->sum_weights[i], w);
149                 w *= bucket->sum_weights[i];
150                 w = w >> 16;
151                 /*dprintk(" scaled %llx\n", w);*/
152                 if (w < bucket->item_weights[i])
153                         return bucket->h.items[i];
154         }
155
156         dprintk("bad list sums for bucket %d\n", bucket->h.id);
157         return bucket->h.items[0];
158 }
159
160
161 /* (binary) tree */
162 static int height(int n)
163 {
164         int h = 0;
165         while ((n & 1) == 0) {
166                 h++;
167                 n = n >> 1;
168         }
169         return h;
170 }
171
172 static int left(int x)
173 {
174         int h = height(x);
175         return x - (1 << (h-1));
176 }
177
178 static int right(int x)
179 {
180         int h = height(x);
181         return x + (1 << (h-1));
182 }
183
184 static int terminal(int x)
185 {
186         return x & 1;
187 }
188
189 static int bucket_tree_choose(struct crush_bucket_tree *bucket,
190                               int x, int r)
191 {
192         int n, l;
193         __u32 w;
194         __u64 t;
195
196         /* start at root */
197         n = bucket->num_nodes >> 1;
198
199         while (!terminal(n)) {
200                 /* pick point in [0, w) */
201                 w = bucket->node_weights[n];
202                 t = (__u64)crush_hash32_4(bucket->h.hash, x, n, r,
203                                           bucket->h.id) * (__u64)w;
204                 t = t >> 32;
205
206                 /* descend to the left or right? */
207                 l = left(n);
208                 if (t < bucket->node_weights[l])
209                         n = l;
210                 else
211                         n = right(n);
212         }
213
214         return bucket->h.items[n >> 1];
215 }
216
217
218 /* straw */
219
220 static int bucket_straw_choose(struct crush_bucket_straw *bucket,
221                                int x, int r)
222 {
223         __u32 i;
224         int high = 0;
225         __u64 high_draw = 0;
226         __u64 draw;
227
228         for (i = 0; i < bucket->h.size; i++) {
229                 draw = crush_hash32_3(bucket->h.hash, x, bucket->h.items[i], r);
230                 draw &= 0xffff;
231                 draw *= bucket->straws[i];
232                 if (i == 0 || draw > high_draw) {
233                         high = i;
234                         high_draw = draw;
235                 }
236         }
237         return bucket->h.items[high];
238 }
239
240 static int crush_bucket_choose(struct crush_bucket *in, int x, int r)
241 {
242         dprintk(" crush_bucket_choose %d x=%d r=%d\n", in->id, x, r);
243         BUG_ON(in->size == 0);
244         switch (in->alg) {
245         case CRUSH_BUCKET_UNIFORM:
246                 return bucket_uniform_choose((struct crush_bucket_uniform *)in,
247                                           x, r);
248         case CRUSH_BUCKET_LIST:
249                 return bucket_list_choose((struct crush_bucket_list *)in,
250                                           x, r);
251         case CRUSH_BUCKET_TREE:
252                 return bucket_tree_choose((struct crush_bucket_tree *)in,
253                                           x, r);
254         case CRUSH_BUCKET_STRAW:
255                 return bucket_straw_choose((struct crush_bucket_straw *)in,
256                                            x, r);
257         default:
258                 dprintk("unknown bucket %d alg %d\n", in->id, in->alg);
259                 return in->items[0];
260         }
261 }
262
263 /*
264  * true if device is marked "out" (failed, fully offloaded)
265  * of the cluster
266  */
267 static int is_out(const struct crush_map *map,
268                   const __u32 *weight, int weight_max,
269                   int item, int x)
270 {
271         if (item >= weight_max)
272                 return 1;
273         if (weight[item] >= 0x10000)
274                 return 0;
275         if (weight[item] == 0)
276                 return 1;
277         if ((crush_hash32_2(CRUSH_HASH_RJENKINS1, x, item) & 0xffff)
278             < weight[item])
279                 return 0;
280         return 1;
281 }
282
283 /**
284  * crush_choose - choose numrep distinct items of given type
285  * @map: the crush_map
286  * @bucket: the bucket we are choose an item from
287  * @x: crush input value
288  * @numrep: the number of items to choose
289  * @type: the type of item to choose
290  * @out: pointer to output vector
291  * @outpos: our position in that vector
292  * @firstn: true if choosing "first n" items, false if choosing "indep"
293  * @recurse_to_leaf: true if we want one device under each item of given type
294  * @descend_once: true if we should only try one descent before giving up
295  * @out2: second output vector for leaf items (if @recurse_to_leaf)
296  */
297 static int crush_choose(const struct crush_map *map,
298                         struct crush_bucket *bucket,
299                         const __u32 *weight, int weight_max,
300                         int x, int numrep, int type,
301                         int *out, int outpos,
302                         int firstn, int recurse_to_leaf,
303                         int descend_once, int *out2)
304 {
305         int rep;
306         unsigned int ftotal, flocal;
307         int retry_descent, retry_bucket, skip_rep;
308         struct crush_bucket *in = bucket;
309         int r;
310         int i;
311         int item = 0;
312         int itemtype;
313         int collide, reject;
314
315         dprintk("CHOOSE%s bucket %d x %d outpos %d numrep %d\n", recurse_to_leaf ? "_LEAF" : "",
316                 bucket->id, x, outpos, numrep);
317
318         for (rep = outpos; rep < numrep; rep++) {
319                 /* keep trying until we get a non-out, non-colliding item */
320                 ftotal = 0;
321                 skip_rep = 0;
322                 do {
323                         retry_descent = 0;
324                         in = bucket;               /* initial bucket */
325
326                         /* choose through intervening buckets */
327                         flocal = 0;
328                         do {
329                                 collide = 0;
330                                 retry_bucket = 0;
331                                 r = rep;
332                                 if (in->alg == CRUSH_BUCKET_UNIFORM) {
333                                         /* be careful */
334                                         if (firstn || (__u32)numrep >= in->size)
335                                                 /* r' = r + f_total */
336                                                 r += ftotal;
337                                         else if (in->size % numrep == 0)
338                                                 /* r'=r+(n+1)*f_local */
339                                                 r += (numrep+1) *
340                                                         (flocal+ftotal);
341                                         else
342                                                 /* r' = r + n*f_local */
343                                                 r += numrep * (flocal+ftotal);
344                                 } else {
345                                         if (firstn)
346                                                 /* r' = r + f_total */
347                                                 r += ftotal;
348                                         else
349                                                 /* r' = r + n*f_local */
350                                                 r += numrep * (flocal+ftotal);
351                                 }
352
353                                 /* bucket choose */
354                                 if (in->size == 0) {
355                                         reject = 1;
356                                         goto reject;
357                                 }
358                                 if (map->choose_local_fallback_tries > 0 &&
359                                     flocal >= (in->size>>1) &&
360                                     flocal > map->choose_local_fallback_tries)
361                                         item = bucket_perm_choose(in, x, r);
362                                 else
363                                         item = crush_bucket_choose(in, x, r);
364                                 if (item >= map->max_devices) {
365                                         dprintk("   bad item %d\n", item);
366                                         skip_rep = 1;
367                                         break;
368                                 }
369
370                                 /* desired type? */
371                                 if (item < 0)
372                                         itemtype = map->buckets[-1-item]->type;
373                                 else
374                                         itemtype = 0;
375                                 dprintk("  item %d type %d\n", item, itemtype);
376
377                                 /* keep going? */
378                                 if (itemtype != type) {
379                                         if (item >= 0 ||
380                                             (-1-item) >= map->max_buckets) {
381                                                 dprintk("   bad item type %d\n", type);
382                                                 skip_rep = 1;
383                                                 break;
384                                         }
385                                         in = map->buckets[-1-item];
386                                         retry_bucket = 1;
387                                         continue;
388                                 }
389
390                                 /* collision? */
391                                 for (i = 0; i < outpos; i++) {
392                                         if (out[i] == item) {
393                                                 collide = 1;
394                                                 break;
395                                         }
396                                 }
397
398                                 reject = 0;
399                                 if (!collide && recurse_to_leaf) {
400                                         if (item < 0) {
401                                                 if (crush_choose(map,
402                                                          map->buckets[-1-item],
403                                                          weight, weight_max,
404                                                          x, outpos+1, 0,
405                                                          out2, outpos,
406                                                          firstn, 0,
407                                                          map->chooseleaf_descend_once,
408                                                          NULL) <= outpos)
409                                                         /* didn't get leaf */
410                                                         reject = 1;
411                                         } else {
412                                                 /* we already have a leaf! */
413                                                 out2[outpos] = item;
414                                         }
415                                 }
416
417                                 if (!reject) {
418                                         /* out? */
419                                         if (itemtype == 0)
420                                                 reject = is_out(map, weight,
421                                                                 weight_max,
422                                                                 item, x);
423                                         else
424                                                 reject = 0;
425                                 }
426
427 reject:
428                                 if (reject || collide) {
429                                         ftotal++;
430                                         flocal++;
431
432                                         if (reject && descend_once)
433                                                 /* let outer call try again */
434                                                 skip_rep = 1;
435                                         else if (collide && flocal <= map->choose_local_tries)
436                                                 /* retry locally a few times */
437                                                 retry_bucket = 1;
438                                         else if (map->choose_local_fallback_tries > 0 &&
439                                                  flocal <= in->size + map->choose_local_fallback_tries)
440                                                 /* exhaustive bucket search */
441                                                 retry_bucket = 1;
442                                         else if (ftotal <= map->choose_total_tries)
443                                                 /* then retry descent */
444                                                 retry_descent = 1;
445                                         else
446                                                 /* else give up */
447                                                 skip_rep = 1;
448                                         dprintk("  reject %d  collide %d  "
449                                                 "ftotal %u  flocal %u\n",
450                                                 reject, collide, ftotal,
451                                                 flocal);
452                                 }
453                         } while (retry_bucket);
454                 } while (retry_descent);
455
456                 if (skip_rep) {
457                         dprintk("skip rep\n");
458                         continue;
459                 }
460
461                 dprintk("CHOOSE got %d\n", item);
462                 out[outpos] = item;
463                 outpos++;
464         }
465
466         dprintk("CHOOSE returns %d\n", outpos);
467         return outpos;
468 }
469
470
471 /**
472  * crush_do_rule - calculate a mapping with the given input and rule
473  * @map: the crush_map
474  * @ruleno: the rule id
475  * @x: hash input
476  * @result: pointer to result vector
477  * @result_max: maximum result size
478  * @weight: weight vector (for map leaves)
479  * @weight_max: size of weight vector
480  */
481 int crush_do_rule(const struct crush_map *map,
482                   int ruleno, int x, int *result, int result_max,
483                   const __u32 *weight, int weight_max)
484 {
485         int result_len;
486         int a[CRUSH_MAX_SET];
487         int b[CRUSH_MAX_SET];
488         int c[CRUSH_MAX_SET];
489         int recurse_to_leaf;
490         int *w;
491         int wsize = 0;
492         int *o;
493         int osize;
494         int *tmp;
495         struct crush_rule *rule;
496         __u32 step;
497         int i, j;
498         int numrep;
499         int firstn;
500         const int descend_once = 0;
501
502         if ((__u32)ruleno >= map->max_rules) {
503                 dprintk(" bad ruleno %d\n", ruleno);
504                 return 0;
505         }
506
507         rule = map->rules[ruleno];
508         result_len = 0;
509         w = a;
510         o = b;
511
512         for (step = 0; step < rule->len; step++) {
513                 struct crush_rule_step *curstep = &rule->steps[step];
514
515                 firstn = 0;
516                 switch (curstep->op) {
517                 case CRUSH_RULE_TAKE:
518                         w[0] = curstep->arg1;
519                         wsize = 1;
520                         break;
521
522                 case CRUSH_RULE_CHOOSE_LEAF_FIRSTN:
523                 case CRUSH_RULE_CHOOSE_FIRSTN:
524                         firstn = 1;
525                         /* fall through */
526                 case CRUSH_RULE_CHOOSE_LEAF_INDEP:
527                 case CRUSH_RULE_CHOOSE_INDEP:
528                         if (wsize == 0)
529                                 break;
530
531                         recurse_to_leaf =
532                                 curstep->op ==
533                                  CRUSH_RULE_CHOOSE_LEAF_FIRSTN ||
534                                 curstep->op ==
535                                 CRUSH_RULE_CHOOSE_LEAF_INDEP;
536
537                         /* reset output */
538                         osize = 0;
539
540                         for (i = 0; i < wsize; i++) {
541                                 /*
542                                  * see CRUSH_N, CRUSH_N_MINUS macros.
543                                  * basically, numrep <= 0 means relative to
544                                  * the provided result_max
545                                  */
546                                 numrep = curstep->arg1;
547                                 if (numrep <= 0) {
548                                         numrep += result_max;
549                                         if (numrep <= 0)
550                                                 continue;
551                                 }
552                                 j = 0;
553                                 osize += crush_choose(map,
554                                                       map->buckets[-1-w[i]],
555                                                       weight, weight_max,
556                                                       x, numrep,
557                                                       curstep->arg2,
558                                                       o+osize, j,
559                                                       firstn,
560                                                       recurse_to_leaf,
561                                                       descend_once, c+osize);
562                         }
563
564                         if (recurse_to_leaf)
565                                 /* copy final _leaf_ values to output set */
566                                 memcpy(o, c, osize*sizeof(*o));
567
568                         /* swap t and w arrays */
569                         tmp = o;
570                         o = w;
571                         w = tmp;
572                         wsize = osize;
573                         break;
574
575
576                 case CRUSH_RULE_EMIT:
577                         for (i = 0; i < wsize && result_len < result_max; i++) {
578                                 result[result_len] = w[i];
579                                 result_len++;
580                         }
581                         wsize = 0;
582                         break;
583
584                 default:
585                         dprintk(" unknown op %d at step %d\n",
586                                 curstep->op, step);
587                         break;
588                 }
589         }
590         return result_len;
591 }
592
593