1 // SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
2 /* Copyright (c) 2018 Mellanox Technologies. All rights reserved */
3
4 #include <linux/module.h>
5 #include <linux/slab.h>
6 #include <linux/rhashtable.h>
7 #include <linux/idr.h>
8 #include <linux/list.h>
9 #include <linux/sort.h>
10 #include <linux/objagg.h>
11
12 #define CREATE_TRACE_POINTS
13 #include <trace/events/objagg.h>
14
15 struct objagg_hints {
16 struct rhashtable node_ht;
17 struct rhashtable_params ht_params;
18 struct list_head node_list;
19 unsigned int node_count;
20 unsigned int root_count;
21 unsigned int refcount;
22 const struct objagg_ops *ops;
23 };
24
25 struct objagg_hints_node {
26 struct rhash_head ht_node; /* member of objagg_hints->node_ht */
27 struct list_head list; /* member of objagg_hints->node_list */
28 struct objagg_hints_node *parent;
29 unsigned int root_id;
30 struct objagg_obj_stats_info stats_info;
31 unsigned long obj[];
32 };
33
34 static struct objagg_hints_node *
objagg_hints_lookup(struct objagg_hints * objagg_hints,void * obj)35 objagg_hints_lookup(struct objagg_hints *objagg_hints, void *obj)
36 {
37 if (!objagg_hints)
38 return NULL;
39 return rhashtable_lookup_fast(&objagg_hints->node_ht, obj,
40 objagg_hints->ht_params);
41 }
42
43 struct objagg {
44 const struct objagg_ops *ops;
45 void *priv;
46 struct rhashtable obj_ht;
47 struct rhashtable_params ht_params;
48 struct list_head obj_list;
49 unsigned int obj_count;
50 struct ida root_ida;
51 struct objagg_hints *hints;
52 };
53
54 struct objagg_obj {
55 struct rhash_head ht_node; /* member of objagg->obj_ht */
56 struct list_head list; /* member of objagg->obj_list */
57 struct objagg_obj *parent; /* if the object is nested, this
58 * holds pointer to parent, otherwise NULL
59 */
60 union {
61 void *delta_priv; /* user delta private */
62 void *root_priv; /* user root private */
63 };
64 unsigned int root_id;
65 unsigned int refcount; /* counts number of users of this object
66 * including nested objects
67 */
68 struct objagg_obj_stats stats;
69 unsigned long obj[];
70 };
71
objagg_obj_ref_inc(struct objagg_obj * objagg_obj)72 static unsigned int objagg_obj_ref_inc(struct objagg_obj *objagg_obj)
73 {
74 return ++objagg_obj->refcount;
75 }
76
objagg_obj_ref_dec(struct objagg_obj * objagg_obj)77 static unsigned int objagg_obj_ref_dec(struct objagg_obj *objagg_obj)
78 {
79 return --objagg_obj->refcount;
80 }
81
objagg_obj_stats_inc(struct objagg_obj * objagg_obj)82 static void objagg_obj_stats_inc(struct objagg_obj *objagg_obj)
83 {
84 objagg_obj->stats.user_count++;
85 objagg_obj->stats.delta_user_count++;
86 if (objagg_obj->parent)
87 objagg_obj->parent->stats.delta_user_count++;
88 }
89
objagg_obj_stats_dec(struct objagg_obj * objagg_obj)90 static void objagg_obj_stats_dec(struct objagg_obj *objagg_obj)
91 {
92 objagg_obj->stats.user_count--;
93 objagg_obj->stats.delta_user_count--;
94 if (objagg_obj->parent)
95 objagg_obj->parent->stats.delta_user_count--;
96 }
97
objagg_obj_is_root(const struct objagg_obj * objagg_obj)98 static bool objagg_obj_is_root(const struct objagg_obj *objagg_obj)
99 {
100 /* Nesting is not supported, so we can use ->parent
101 * to figure out if the object is root.
102 */
103 return !objagg_obj->parent;
104 }
105
106 /**
107 * objagg_obj_root_priv - obtains root private for an object
108 * @objagg_obj: objagg object instance
109 *
110 * Note: all locking must be provided by the caller.
111 *
112 * Either the object is root itself when the private is returned
113 * directly, or the parent is root and its private is returned
114 * instead.
115 *
116 * Returns a user private root pointer.
117 */
objagg_obj_root_priv(const struct objagg_obj * objagg_obj)118 const void *objagg_obj_root_priv(const struct objagg_obj *objagg_obj)
119 {
120 if (objagg_obj_is_root(objagg_obj))
121 return objagg_obj->root_priv;
122 WARN_ON(!objagg_obj_is_root(objagg_obj->parent));
123 return objagg_obj->parent->root_priv;
124 }
125 EXPORT_SYMBOL(objagg_obj_root_priv);
126
127 /**
128 * objagg_obj_delta_priv - obtains delta private for an object
129 * @objagg_obj: objagg object instance
130 *
131 * Note: all locking must be provided by the caller.
132 *
133 * Returns user private delta pointer or NULL in case the passed
134 * object is root.
135 */
objagg_obj_delta_priv(const struct objagg_obj * objagg_obj)136 const void *objagg_obj_delta_priv(const struct objagg_obj *objagg_obj)
137 {
138 if (objagg_obj_is_root(objagg_obj))
139 return NULL;
140 return objagg_obj->delta_priv;
141 }
142 EXPORT_SYMBOL(objagg_obj_delta_priv);
143
144 /**
145 * objagg_obj_raw - obtains object user private pointer
146 * @objagg_obj: objagg object instance
147 *
148 * Note: all locking must be provided by the caller.
149 *
150 * Returns user private pointer as was passed to objagg_obj_get() by "obj" arg.
151 */
objagg_obj_raw(const struct objagg_obj * objagg_obj)152 const void *objagg_obj_raw(const struct objagg_obj *objagg_obj)
153 {
154 return objagg_obj->obj;
155 }
156 EXPORT_SYMBOL(objagg_obj_raw);
157
objagg_obj_lookup(struct objagg * objagg,void * obj)158 static struct objagg_obj *objagg_obj_lookup(struct objagg *objagg, void *obj)
159 {
160 return rhashtable_lookup_fast(&objagg->obj_ht, obj, objagg->ht_params);
161 }
162
objagg_obj_parent_assign(struct objagg * objagg,struct objagg_obj * objagg_obj,struct objagg_obj * parent,bool take_parent_ref)163 static int objagg_obj_parent_assign(struct objagg *objagg,
164 struct objagg_obj *objagg_obj,
165 struct objagg_obj *parent,
166 bool take_parent_ref)
167 {
168 void *delta_priv;
169
170 delta_priv = objagg->ops->delta_create(objagg->priv, parent->obj,
171 objagg_obj->obj);
172 if (IS_ERR(delta_priv))
173 return PTR_ERR(delta_priv);
174
175 /* User returned a delta private, that means that
176 * our object can be aggregated into the parent.
177 */
178 objagg_obj->parent = parent;
179 objagg_obj->delta_priv = delta_priv;
180 if (take_parent_ref)
181 objagg_obj_ref_inc(objagg_obj->parent);
182 trace_objagg_obj_parent_assign(objagg, objagg_obj,
183 parent,
184 parent->refcount);
185 return 0;
186 }
187
objagg_obj_parent_lookup_assign(struct objagg * objagg,struct objagg_obj * objagg_obj)188 static int objagg_obj_parent_lookup_assign(struct objagg *objagg,
189 struct objagg_obj *objagg_obj)
190 {
191 struct objagg_obj *objagg_obj_cur;
192 int err;
193
194 list_for_each_entry(objagg_obj_cur, &objagg->obj_list, list) {
195 /* Nesting is not supported. In case the object
196 * is not root, it cannot be assigned as parent.
197 */
198 if (!objagg_obj_is_root(objagg_obj_cur))
199 continue;
200 err = objagg_obj_parent_assign(objagg, objagg_obj,
201 objagg_obj_cur, true);
202 if (!err)
203 return 0;
204 }
205 return -ENOENT;
206 }
207
208 static void __objagg_obj_put(struct objagg *objagg,
209 struct objagg_obj *objagg_obj);
210
objagg_obj_parent_unassign(struct objagg * objagg,struct objagg_obj * objagg_obj)211 static void objagg_obj_parent_unassign(struct objagg *objagg,
212 struct objagg_obj *objagg_obj)
213 {
214 trace_objagg_obj_parent_unassign(objagg, objagg_obj,
215 objagg_obj->parent,
216 objagg_obj->parent->refcount);
217 objagg->ops->delta_destroy(objagg->priv, objagg_obj->delta_priv);
218 __objagg_obj_put(objagg, objagg_obj->parent);
219 }
220
objagg_obj_root_id_alloc(struct objagg * objagg,struct objagg_obj * objagg_obj,struct objagg_hints_node * hnode)221 static int objagg_obj_root_id_alloc(struct objagg *objagg,
222 struct objagg_obj *objagg_obj,
223 struct objagg_hints_node *hnode)
224 {
225 unsigned int min, max;
226 int root_id;
227
228 /* In case there are no hints available, the root id is invalid. */
229 if (!objagg->hints) {
230 objagg_obj->root_id = OBJAGG_OBJ_ROOT_ID_INVALID;
231 return 0;
232 }
233
234 if (hnode) {
235 min = hnode->root_id;
236 max = hnode->root_id;
237 } else {
238 /* For objects with no hint, start after the last
239 * hinted root_id.
240 */
241 min = objagg->hints->root_count;
242 max = ~0;
243 }
244
245 root_id = ida_alloc_range(&objagg->root_ida, min, max, GFP_KERNEL);
246
247 if (root_id < 0)
248 return root_id;
249 objagg_obj->root_id = root_id;
250 return 0;
251 }
252
objagg_obj_root_id_free(struct objagg * objagg,struct objagg_obj * objagg_obj)253 static void objagg_obj_root_id_free(struct objagg *objagg,
254 struct objagg_obj *objagg_obj)
255 {
256 if (!objagg->hints)
257 return;
258 ida_free(&objagg->root_ida, objagg_obj->root_id);
259 }
260
objagg_obj_root_create(struct objagg * objagg,struct objagg_obj * objagg_obj,struct objagg_hints_node * hnode)261 static int objagg_obj_root_create(struct objagg *objagg,
262 struct objagg_obj *objagg_obj,
263 struct objagg_hints_node *hnode)
264 {
265 int err;
266
267 err = objagg_obj_root_id_alloc(objagg, objagg_obj, hnode);
268 if (err)
269 return err;
270 objagg_obj->root_priv = objagg->ops->root_create(objagg->priv,
271 objagg_obj->obj,
272 objagg_obj->root_id);
273 if (IS_ERR(objagg_obj->root_priv)) {
274 err = PTR_ERR(objagg_obj->root_priv);
275 goto err_root_create;
276 }
277 trace_objagg_obj_root_create(objagg, objagg_obj);
278 return 0;
279
280 err_root_create:
281 objagg_obj_root_id_free(objagg, objagg_obj);
282 return err;
283 }
284
objagg_obj_root_destroy(struct objagg * objagg,struct objagg_obj * objagg_obj)285 static void objagg_obj_root_destroy(struct objagg *objagg,
286 struct objagg_obj *objagg_obj)
287 {
288 trace_objagg_obj_root_destroy(objagg, objagg_obj);
289 objagg->ops->root_destroy(objagg->priv, objagg_obj->root_priv);
290 objagg_obj_root_id_free(objagg, objagg_obj);
291 }
292
293 static struct objagg_obj *__objagg_obj_get(struct objagg *objagg, void *obj);
294
objagg_obj_init_with_hints(struct objagg * objagg,struct objagg_obj * objagg_obj,bool * hint_found)295 static int objagg_obj_init_with_hints(struct objagg *objagg,
296 struct objagg_obj *objagg_obj,
297 bool *hint_found)
298 {
299 struct objagg_hints_node *hnode;
300 struct objagg_obj *parent;
301 int err;
302
303 hnode = objagg_hints_lookup(objagg->hints, objagg_obj->obj);
304 if (!hnode) {
305 *hint_found = false;
306 return 0;
307 }
308 *hint_found = true;
309
310 if (!hnode->parent)
311 return objagg_obj_root_create(objagg, objagg_obj, hnode);
312
313 parent = __objagg_obj_get(objagg, hnode->parent->obj);
314 if (IS_ERR(parent))
315 return PTR_ERR(parent);
316
317 err = objagg_obj_parent_assign(objagg, objagg_obj, parent, false);
318 if (err) {
319 *hint_found = false;
320 err = 0;
321 goto err_parent_assign;
322 }
323
324 return 0;
325
326 err_parent_assign:
327 objagg_obj_put(objagg, parent);
328 return err;
329 }
330
objagg_obj_init(struct objagg * objagg,struct objagg_obj * objagg_obj)331 static int objagg_obj_init(struct objagg *objagg,
332 struct objagg_obj *objagg_obj)
333 {
334 bool hint_found;
335 int err;
336
337 /* First, try to use hints if they are available and
338 * if they provide result.
339 */
340 err = objagg_obj_init_with_hints(objagg, objagg_obj, &hint_found);
341 if (err)
342 return err;
343
344 if (hint_found)
345 return 0;
346
347 /* Try to find if the object can be aggregated under an existing one. */
348 err = objagg_obj_parent_lookup_assign(objagg, objagg_obj);
349 if (!err)
350 return 0;
351 /* If aggregation is not possible, make the object a root. */
352 return objagg_obj_root_create(objagg, objagg_obj, NULL);
353 }
354
objagg_obj_fini(struct objagg * objagg,struct objagg_obj * objagg_obj)355 static void objagg_obj_fini(struct objagg *objagg,
356 struct objagg_obj *objagg_obj)
357 {
358 if (!objagg_obj_is_root(objagg_obj))
359 objagg_obj_parent_unassign(objagg, objagg_obj);
360 else
361 objagg_obj_root_destroy(objagg, objagg_obj);
362 }
363
objagg_obj_create(struct objagg * objagg,void * obj)364 static struct objagg_obj *objagg_obj_create(struct objagg *objagg, void *obj)
365 {
366 struct objagg_obj *objagg_obj;
367 int err;
368
369 objagg_obj = kzalloc(sizeof(*objagg_obj) + objagg->ops->obj_size,
370 GFP_KERNEL);
371 if (!objagg_obj)
372 return ERR_PTR(-ENOMEM);
373 objagg_obj_ref_inc(objagg_obj);
374 memcpy(objagg_obj->obj, obj, objagg->ops->obj_size);
375
376 err = objagg_obj_init(objagg, objagg_obj);
377 if (err)
378 goto err_obj_init;
379
380 err = rhashtable_insert_fast(&objagg->obj_ht, &objagg_obj->ht_node,
381 objagg->ht_params);
382 if (err)
383 goto err_ht_insert;
384 list_add(&objagg_obj->list, &objagg->obj_list);
385 objagg->obj_count++;
386 trace_objagg_obj_create(objagg, objagg_obj);
387
388 return objagg_obj;
389
390 err_ht_insert:
391 objagg_obj_fini(objagg, objagg_obj);
392 err_obj_init:
393 kfree(objagg_obj);
394 return ERR_PTR(err);
395 }
396
__objagg_obj_get(struct objagg * objagg,void * obj)397 static struct objagg_obj *__objagg_obj_get(struct objagg *objagg, void *obj)
398 {
399 struct objagg_obj *objagg_obj;
400
401 /* First, try to find the object exactly as user passed it,
402 * perhaps it is already in use.
403 */
404 objagg_obj = objagg_obj_lookup(objagg, obj);
405 if (objagg_obj) {
406 objagg_obj_ref_inc(objagg_obj);
407 return objagg_obj;
408 }
409
410 return objagg_obj_create(objagg, obj);
411 }
412
413 /**
414 * objagg_obj_get - gets an object within objagg instance
415 * @objagg: objagg instance
416 * @obj: user-specific private object pointer
417 *
418 * Note: all locking must be provided by the caller.
419 *
420 * Size of the "obj" memory is specified in "objagg->ops".
421 *
422 * There are 3 main options this function wraps:
423 * 1) The object according to "obj" already exist. In that case
424 * the reference counter is incrementes and the object is returned.
425 * 2) The object does not exist, but it can be aggregated within
426 * another object. In that case, user ops->delta_create() is called
427 * to obtain delta data and a new object is created with returned
428 * user-delta private pointer.
429 * 3) The object does not exist and cannot be aggregated into
430 * any of the existing objects. In that case, user ops->root_create()
431 * is called to create the root and a new object is created with
432 * returned user-root private pointer.
433 *
434 * Returns a pointer to objagg object instance in case of success,
435 * otherwise it returns pointer error using ERR_PTR macro.
436 */
objagg_obj_get(struct objagg * objagg,void * obj)437 struct objagg_obj *objagg_obj_get(struct objagg *objagg, void *obj)
438 {
439 struct objagg_obj *objagg_obj;
440
441 objagg_obj = __objagg_obj_get(objagg, obj);
442 if (IS_ERR(objagg_obj))
443 return objagg_obj;
444 objagg_obj_stats_inc(objagg_obj);
445 trace_objagg_obj_get(objagg, objagg_obj, objagg_obj->refcount);
446 return objagg_obj;
447 }
448 EXPORT_SYMBOL(objagg_obj_get);
449
objagg_obj_destroy(struct objagg * objagg,struct objagg_obj * objagg_obj)450 static void objagg_obj_destroy(struct objagg *objagg,
451 struct objagg_obj *objagg_obj)
452 {
453 trace_objagg_obj_destroy(objagg, objagg_obj);
454 --objagg->obj_count;
455 list_del(&objagg_obj->list);
456 rhashtable_remove_fast(&objagg->obj_ht, &objagg_obj->ht_node,
457 objagg->ht_params);
458 objagg_obj_fini(objagg, objagg_obj);
459 kfree(objagg_obj);
460 }
461
__objagg_obj_put(struct objagg * objagg,struct objagg_obj * objagg_obj)462 static void __objagg_obj_put(struct objagg *objagg,
463 struct objagg_obj *objagg_obj)
464 {
465 if (!objagg_obj_ref_dec(objagg_obj))
466 objagg_obj_destroy(objagg, objagg_obj);
467 }
468
469 /**
470 * objagg_obj_put - puts an object within objagg instance
471 * @objagg: objagg instance
472 * @objagg_obj: objagg object instance
473 *
474 * Note: all locking must be provided by the caller.
475 *
476 * Symmetric to objagg_obj_get().
477 */
objagg_obj_put(struct objagg * objagg,struct objagg_obj * objagg_obj)478 void objagg_obj_put(struct objagg *objagg, struct objagg_obj *objagg_obj)
479 {
480 trace_objagg_obj_put(objagg, objagg_obj, objagg_obj->refcount);
481 objagg_obj_stats_dec(objagg_obj);
482 __objagg_obj_put(objagg, objagg_obj);
483 }
484 EXPORT_SYMBOL(objagg_obj_put);
485
486 /**
487 * objagg_create - creates a new objagg instance
488 * @ops: user-specific callbacks
489 * @objagg_hints: hints, can be NULL
490 * @priv: pointer to a private data passed to the ops
491 *
492 * Note: all locking must be provided by the caller.
493 *
494 * The purpose of the library is to provide an infrastructure to
495 * aggregate user-specified objects. Library does not care about the type
496 * of the object. User fills-up ops which take care of the specific
497 * user object manipulation.
498 *
499 * As a very stupid example, consider integer numbers. For example
500 * number 8 as a root object. That can aggregate number 9 with delta 1,
501 * number 10 with delta 2, etc. This example is implemented as
502 * a part of a testing module in test_objagg.c file.
503 *
504 * Each objagg instance contains multiple trees. Each tree node is
505 * represented by "an object". In the current implementation there can be
506 * only roots and leafs nodes. Leaf nodes are called deltas.
507 * But in general, this can be easily extended for intermediate nodes.
508 * In that extension, a delta would be associated with all non-root
509 * nodes.
510 *
511 * Returns a pointer to newly created objagg instance in case of success,
512 * otherwise it returns pointer error using ERR_PTR macro.
513 */
objagg_create(const struct objagg_ops * ops,struct objagg_hints * objagg_hints,void * priv)514 struct objagg *objagg_create(const struct objagg_ops *ops,
515 struct objagg_hints *objagg_hints, void *priv)
516 {
517 struct objagg *objagg;
518 int err;
519
520 if (WARN_ON(!ops || !ops->root_create || !ops->root_destroy ||
521 !ops->delta_check || !ops->delta_create ||
522 !ops->delta_destroy))
523 return ERR_PTR(-EINVAL);
524
525 objagg = kzalloc(sizeof(*objagg), GFP_KERNEL);
526 if (!objagg)
527 return ERR_PTR(-ENOMEM);
528 objagg->ops = ops;
529 if (objagg_hints) {
530 objagg->hints = objagg_hints;
531 objagg_hints->refcount++;
532 }
533 objagg->priv = priv;
534 INIT_LIST_HEAD(&objagg->obj_list);
535
536 objagg->ht_params.key_len = ops->obj_size;
537 objagg->ht_params.key_offset = offsetof(struct objagg_obj, obj);
538 objagg->ht_params.head_offset = offsetof(struct objagg_obj, ht_node);
539
540 err = rhashtable_init(&objagg->obj_ht, &objagg->ht_params);
541 if (err)
542 goto err_rhashtable_init;
543
544 ida_init(&objagg->root_ida);
545
546 trace_objagg_create(objagg);
547 return objagg;
548
549 err_rhashtable_init:
550 kfree(objagg);
551 return ERR_PTR(err);
552 }
553 EXPORT_SYMBOL(objagg_create);
554
555 /**
556 * objagg_destroy - destroys a new objagg instance
557 * @objagg: objagg instance
558 *
559 * Note: all locking must be provided by the caller.
560 */
objagg_destroy(struct objagg * objagg)561 void objagg_destroy(struct objagg *objagg)
562 {
563 trace_objagg_destroy(objagg);
564 ida_destroy(&objagg->root_ida);
565 WARN_ON(!list_empty(&objagg->obj_list));
566 rhashtable_destroy(&objagg->obj_ht);
567 if (objagg->hints)
568 objagg_hints_put(objagg->hints);
569 kfree(objagg);
570 }
571 EXPORT_SYMBOL(objagg_destroy);
572
objagg_stats_info_sort_cmp_func(const void * a,const void * b)573 static int objagg_stats_info_sort_cmp_func(const void *a, const void *b)
574 {
575 const struct objagg_obj_stats_info *stats_info1 = a;
576 const struct objagg_obj_stats_info *stats_info2 = b;
577
578 if (stats_info1->is_root != stats_info2->is_root)
579 return stats_info2->is_root - stats_info1->is_root;
580 if (stats_info1->stats.delta_user_count !=
581 stats_info2->stats.delta_user_count)
582 return stats_info2->stats.delta_user_count -
583 stats_info1->stats.delta_user_count;
584 return stats_info2->stats.user_count - stats_info1->stats.user_count;
585 }
586
587 /**
588 * objagg_stats_get - obtains stats of the objagg instance
589 * @objagg: objagg instance
590 *
591 * Note: all locking must be provided by the caller.
592 *
593 * The returned structure contains statistics of all object
594 * currently in use, ordered by following rules:
595 * 1) Root objects are always on lower indexes than the rest.
596 * 2) Objects with higher delta user count are always on lower
597 * indexes.
598 * 3) In case more objects have the same delta user count,
599 * the objects are ordered by user count.
600 *
601 * Returns a pointer to stats instance in case of success,
602 * otherwise it returns pointer error using ERR_PTR macro.
603 */
objagg_stats_get(struct objagg * objagg)604 const struct objagg_stats *objagg_stats_get(struct objagg *objagg)
605 {
606 struct objagg_stats *objagg_stats;
607 struct objagg_obj *objagg_obj;
608 int i;
609
610 objagg_stats = kzalloc(struct_size(objagg_stats, stats_info,
611 objagg->obj_count), GFP_KERNEL);
612 if (!objagg_stats)
613 return ERR_PTR(-ENOMEM);
614
615 i = 0;
616 list_for_each_entry(objagg_obj, &objagg->obj_list, list) {
617 memcpy(&objagg_stats->stats_info[i].stats, &objagg_obj->stats,
618 sizeof(objagg_stats->stats_info[0].stats));
619 objagg_stats->stats_info[i].objagg_obj = objagg_obj;
620 objagg_stats->stats_info[i].is_root =
621 objagg_obj_is_root(objagg_obj);
622 if (objagg_stats->stats_info[i].is_root)
623 objagg_stats->root_count++;
624 i++;
625 }
626 objagg_stats->stats_info_count = i;
627
628 sort(objagg_stats->stats_info, objagg_stats->stats_info_count,
629 sizeof(struct objagg_obj_stats_info),
630 objagg_stats_info_sort_cmp_func, NULL);
631
632 return objagg_stats;
633 }
634 EXPORT_SYMBOL(objagg_stats_get);
635
636 /**
637 * objagg_stats_put - puts stats of the objagg instance
638 * @objagg_stats: objagg instance stats
639 *
640 * Note: all locking must be provided by the caller.
641 */
objagg_stats_put(const struct objagg_stats * objagg_stats)642 void objagg_stats_put(const struct objagg_stats *objagg_stats)
643 {
644 kfree(objagg_stats);
645 }
646 EXPORT_SYMBOL(objagg_stats_put);
647
648 static struct objagg_hints_node *
objagg_hints_node_create(struct objagg_hints * objagg_hints,struct objagg_obj * objagg_obj,size_t obj_size,struct objagg_hints_node * parent_hnode)649 objagg_hints_node_create(struct objagg_hints *objagg_hints,
650 struct objagg_obj *objagg_obj, size_t obj_size,
651 struct objagg_hints_node *parent_hnode)
652 {
653 unsigned int user_count = objagg_obj->stats.user_count;
654 struct objagg_hints_node *hnode;
655 int err;
656
657 hnode = kzalloc(sizeof(*hnode) + obj_size, GFP_KERNEL);
658 if (!hnode)
659 return ERR_PTR(-ENOMEM);
660 memcpy(hnode->obj, &objagg_obj->obj, obj_size);
661 hnode->stats_info.stats.user_count = user_count;
662 hnode->stats_info.stats.delta_user_count = user_count;
663 if (parent_hnode) {
664 parent_hnode->stats_info.stats.delta_user_count += user_count;
665 } else {
666 hnode->root_id = objagg_hints->root_count++;
667 hnode->stats_info.is_root = true;
668 }
669 hnode->stats_info.objagg_obj = objagg_obj;
670
671 err = rhashtable_insert_fast(&objagg_hints->node_ht, &hnode->ht_node,
672 objagg_hints->ht_params);
673 if (err)
674 goto err_ht_insert;
675
676 list_add(&hnode->list, &objagg_hints->node_list);
677 hnode->parent = parent_hnode;
678 objagg_hints->node_count++;
679
680 return hnode;
681
682 err_ht_insert:
683 kfree(hnode);
684 return ERR_PTR(err);
685 }
686
objagg_hints_flush(struct objagg_hints * objagg_hints)687 static void objagg_hints_flush(struct objagg_hints *objagg_hints)
688 {
689 struct objagg_hints_node *hnode, *tmp;
690
691 list_for_each_entry_safe(hnode, tmp, &objagg_hints->node_list, list) {
692 list_del(&hnode->list);
693 rhashtable_remove_fast(&objagg_hints->node_ht, &hnode->ht_node,
694 objagg_hints->ht_params);
695 kfree(hnode);
696 }
697 }
698
699 struct objagg_tmp_node {
700 struct objagg_obj *objagg_obj;
701 bool crossed_out;
702 };
703
704 struct objagg_tmp_graph {
705 struct objagg_tmp_node *nodes;
706 unsigned long nodes_count;
707 unsigned long *edges;
708 };
709
objagg_tmp_graph_edge_index(struct objagg_tmp_graph * graph,int parent_index,int index)710 static int objagg_tmp_graph_edge_index(struct objagg_tmp_graph *graph,
711 int parent_index, int index)
712 {
713 return index * graph->nodes_count + parent_index;
714 }
715
objagg_tmp_graph_edge_set(struct objagg_tmp_graph * graph,int parent_index,int index)716 static void objagg_tmp_graph_edge_set(struct objagg_tmp_graph *graph,
717 int parent_index, int index)
718 {
719 int edge_index = objagg_tmp_graph_edge_index(graph, index,
720 parent_index);
721
722 __set_bit(edge_index, graph->edges);
723 }
724
objagg_tmp_graph_is_edge(struct objagg_tmp_graph * graph,int parent_index,int index)725 static bool objagg_tmp_graph_is_edge(struct objagg_tmp_graph *graph,
726 int parent_index, int index)
727 {
728 int edge_index = objagg_tmp_graph_edge_index(graph, index,
729 parent_index);
730
731 return test_bit(edge_index, graph->edges);
732 }
733
objagg_tmp_graph_node_weight(struct objagg_tmp_graph * graph,unsigned int index)734 static unsigned int objagg_tmp_graph_node_weight(struct objagg_tmp_graph *graph,
735 unsigned int index)
736 {
737 struct objagg_tmp_node *node = &graph->nodes[index];
738 unsigned int weight = node->objagg_obj->stats.user_count;
739 int j;
740
741 /* Node weight is sum of node users and all other nodes users
742 * that this node can represent with delta.
743 */
744
745 for (j = 0; j < graph->nodes_count; j++) {
746 if (!objagg_tmp_graph_is_edge(graph, index, j))
747 continue;
748 node = &graph->nodes[j];
749 if (node->crossed_out)
750 continue;
751 weight += node->objagg_obj->stats.user_count;
752 }
753 return weight;
754 }
755
objagg_tmp_graph_node_max_weight(struct objagg_tmp_graph * graph)756 static int objagg_tmp_graph_node_max_weight(struct objagg_tmp_graph *graph)
757 {
758 struct objagg_tmp_node *node;
759 unsigned int max_weight = 0;
760 unsigned int weight;
761 int max_index = -1;
762 int i;
763
764 for (i = 0; i < graph->nodes_count; i++) {
765 node = &graph->nodes[i];
766 if (node->crossed_out)
767 continue;
768 weight = objagg_tmp_graph_node_weight(graph, i);
769 if (weight >= max_weight) {
770 max_weight = weight;
771 max_index = i;
772 }
773 }
774 return max_index;
775 }
776
objagg_tmp_graph_create(struct objagg * objagg)777 static struct objagg_tmp_graph *objagg_tmp_graph_create(struct objagg *objagg)
778 {
779 unsigned int nodes_count = objagg->obj_count;
780 struct objagg_tmp_graph *graph;
781 struct objagg_tmp_node *node;
782 struct objagg_tmp_node *pnode;
783 struct objagg_obj *objagg_obj;
784 int i, j;
785
786 graph = kzalloc(sizeof(*graph), GFP_KERNEL);
787 if (!graph)
788 return NULL;
789
790 graph->nodes = kcalloc(nodes_count, sizeof(*graph->nodes), GFP_KERNEL);
791 if (!graph->nodes)
792 goto err_nodes_alloc;
793 graph->nodes_count = nodes_count;
794
795 graph->edges = bitmap_zalloc(nodes_count * nodes_count, GFP_KERNEL);
796 if (!graph->edges)
797 goto err_edges_alloc;
798
799 i = 0;
800 list_for_each_entry(objagg_obj, &objagg->obj_list, list) {
801 node = &graph->nodes[i++];
802 node->objagg_obj = objagg_obj;
803 }
804
805 /* Assemble a temporary graph. Insert edge X->Y in case Y can be
806 * in delta of X.
807 */
808 for (i = 0; i < nodes_count; i++) {
809 for (j = 0; j < nodes_count; j++) {
810 if (i == j)
811 continue;
812 pnode = &graph->nodes[i];
813 node = &graph->nodes[j];
814 if (objagg->ops->delta_check(objagg->priv,
815 pnode->objagg_obj->obj,
816 node->objagg_obj->obj)) {
817 objagg_tmp_graph_edge_set(graph, i, j);
818
819 }
820 }
821 }
822 return graph;
823
824 err_edges_alloc:
825 kfree(graph->nodes);
826 err_nodes_alloc:
827 kfree(graph);
828 return NULL;
829 }
830
objagg_tmp_graph_destroy(struct objagg_tmp_graph * graph)831 static void objagg_tmp_graph_destroy(struct objagg_tmp_graph *graph)
832 {
833 bitmap_free(graph->edges);
834 kfree(graph->nodes);
835 kfree(graph);
836 }
837
838 static int
objagg_opt_simple_greedy_fillup_hints(struct objagg_hints * objagg_hints,struct objagg * objagg)839 objagg_opt_simple_greedy_fillup_hints(struct objagg_hints *objagg_hints,
840 struct objagg *objagg)
841 {
842 struct objagg_hints_node *hnode, *parent_hnode;
843 struct objagg_tmp_graph *graph;
844 struct objagg_tmp_node *node;
845 int index;
846 int j;
847 int err;
848
849 graph = objagg_tmp_graph_create(objagg);
850 if (!graph)
851 return -ENOMEM;
852
853 /* Find the nodes from the ones that can accommodate most users
854 * and cross them out of the graph. Save them to the hint list.
855 */
856 while ((index = objagg_tmp_graph_node_max_weight(graph)) != -1) {
857 node = &graph->nodes[index];
858 node->crossed_out = true;
859 hnode = objagg_hints_node_create(objagg_hints,
860 node->objagg_obj,
861 objagg->ops->obj_size,
862 NULL);
863 if (IS_ERR(hnode)) {
864 err = PTR_ERR(hnode);
865 goto out;
866 }
867 parent_hnode = hnode;
868 for (j = 0; j < graph->nodes_count; j++) {
869 if (!objagg_tmp_graph_is_edge(graph, index, j))
870 continue;
871 node = &graph->nodes[j];
872 if (node->crossed_out)
873 continue;
874 node->crossed_out = true;
875 hnode = objagg_hints_node_create(objagg_hints,
876 node->objagg_obj,
877 objagg->ops->obj_size,
878 parent_hnode);
879 if (IS_ERR(hnode)) {
880 err = PTR_ERR(hnode);
881 goto out;
882 }
883 }
884 }
885
886 err = 0;
887 out:
888 objagg_tmp_graph_destroy(graph);
889 return err;
890 }
891
892 struct objagg_opt_algo {
893 int (*fillup_hints)(struct objagg_hints *objagg_hints,
894 struct objagg *objagg);
895 };
896
897 static const struct objagg_opt_algo objagg_opt_simple_greedy = {
898 .fillup_hints = objagg_opt_simple_greedy_fillup_hints,
899 };
900
901
902 static const struct objagg_opt_algo *objagg_opt_algos[] = {
903 [OBJAGG_OPT_ALGO_SIMPLE_GREEDY] = &objagg_opt_simple_greedy,
904 };
905
objagg_hints_obj_cmp(struct rhashtable_compare_arg * arg,const void * obj)906 static int objagg_hints_obj_cmp(struct rhashtable_compare_arg *arg,
907 const void *obj)
908 {
909 struct rhashtable *ht = arg->ht;
910 struct objagg_hints *objagg_hints =
911 container_of(ht, struct objagg_hints, node_ht);
912 const struct objagg_ops *ops = objagg_hints->ops;
913 const char *ptr = obj;
914
915 ptr += ht->p.key_offset;
916 return ops->hints_obj_cmp ? ops->hints_obj_cmp(ptr, arg->key) :
917 memcmp(ptr, arg->key, ht->p.key_len);
918 }
919
920 /**
921 * objagg_hints_get - obtains hints instance
922 * @objagg: objagg instance
923 * @opt_algo_type: type of hints finding algorithm
924 *
925 * Note: all locking must be provided by the caller.
926 *
927 * According to the algo type, the existing objects of objagg instance
928 * are going to be went-through to assemble an optimal tree. We call this
929 * tree hints. These hints can be later on used for creation of
930 * a new objagg instance. There, the future object creations are going
931 * to be consulted with these hints in order to find out, where exactly
932 * the new object should be put as a root or delta.
933 *
934 * Returns a pointer to hints instance in case of success,
935 * otherwise it returns pointer error using ERR_PTR macro.
936 */
objagg_hints_get(struct objagg * objagg,enum objagg_opt_algo_type opt_algo_type)937 struct objagg_hints *objagg_hints_get(struct objagg *objagg,
938 enum objagg_opt_algo_type opt_algo_type)
939 {
940 const struct objagg_opt_algo *algo = objagg_opt_algos[opt_algo_type];
941 struct objagg_hints *objagg_hints;
942 int err;
943
944 objagg_hints = kzalloc(sizeof(*objagg_hints), GFP_KERNEL);
945 if (!objagg_hints)
946 return ERR_PTR(-ENOMEM);
947
948 objagg_hints->ops = objagg->ops;
949 objagg_hints->refcount = 1;
950
951 INIT_LIST_HEAD(&objagg_hints->node_list);
952
953 objagg_hints->ht_params.key_len = objagg->ops->obj_size;
954 objagg_hints->ht_params.key_offset =
955 offsetof(struct objagg_hints_node, obj);
956 objagg_hints->ht_params.head_offset =
957 offsetof(struct objagg_hints_node, ht_node);
958 objagg_hints->ht_params.obj_cmpfn = objagg_hints_obj_cmp;
959
960 err = rhashtable_init(&objagg_hints->node_ht, &objagg_hints->ht_params);
961 if (err)
962 goto err_rhashtable_init;
963
964 err = algo->fillup_hints(objagg_hints, objagg);
965 if (err)
966 goto err_fillup_hints;
967
968 if (WARN_ON(objagg_hints->node_count != objagg->obj_count)) {
969 err = -EINVAL;
970 goto err_node_count_check;
971 }
972
973 return objagg_hints;
974
975 err_node_count_check:
976 err_fillup_hints:
977 objagg_hints_flush(objagg_hints);
978 rhashtable_destroy(&objagg_hints->node_ht);
979 err_rhashtable_init:
980 kfree(objagg_hints);
981 return ERR_PTR(err);
982 }
983 EXPORT_SYMBOL(objagg_hints_get);
984
985 /**
986 * objagg_hints_put - puts hints instance
987 * @objagg_hints: objagg hints instance
988 *
989 * Note: all locking must be provided by the caller.
990 */
objagg_hints_put(struct objagg_hints * objagg_hints)991 void objagg_hints_put(struct objagg_hints *objagg_hints)
992 {
993 if (--objagg_hints->refcount)
994 return;
995 objagg_hints_flush(objagg_hints);
996 rhashtable_destroy(&objagg_hints->node_ht);
997 kfree(objagg_hints);
998 }
999 EXPORT_SYMBOL(objagg_hints_put);
1000
1001 /**
1002 * objagg_hints_stats_get - obtains stats of the hints instance
1003 * @objagg_hints: hints instance
1004 *
1005 * Note: all locking must be provided by the caller.
1006 *
1007 * The returned structure contains statistics of all objects
1008 * currently in use, ordered by following rules:
1009 * 1) Root objects are always on lower indexes than the rest.
1010 * 2) Objects with higher delta user count are always on lower
1011 * indexes.
1012 * 3) In case multiple objects have the same delta user count,
1013 * the objects are ordered by user count.
1014 *
1015 * Returns a pointer to stats instance in case of success,
1016 * otherwise it returns pointer error using ERR_PTR macro.
1017 */
1018 const struct objagg_stats *
objagg_hints_stats_get(struct objagg_hints * objagg_hints)1019 objagg_hints_stats_get(struct objagg_hints *objagg_hints)
1020 {
1021 struct objagg_stats *objagg_stats;
1022 struct objagg_hints_node *hnode;
1023 int i;
1024
1025 objagg_stats = kzalloc(struct_size(objagg_stats, stats_info,
1026 objagg_hints->node_count),
1027 GFP_KERNEL);
1028 if (!objagg_stats)
1029 return ERR_PTR(-ENOMEM);
1030
1031 i = 0;
1032 list_for_each_entry(hnode, &objagg_hints->node_list, list) {
1033 memcpy(&objagg_stats->stats_info[i], &hnode->stats_info,
1034 sizeof(objagg_stats->stats_info[0]));
1035 if (objagg_stats->stats_info[i].is_root)
1036 objagg_stats->root_count++;
1037 i++;
1038 }
1039 objagg_stats->stats_info_count = i;
1040
1041 sort(objagg_stats->stats_info, objagg_stats->stats_info_count,
1042 sizeof(struct objagg_obj_stats_info),
1043 objagg_stats_info_sort_cmp_func, NULL);
1044
1045 return objagg_stats;
1046 }
1047 EXPORT_SYMBOL(objagg_hints_stats_get);
1048
1049 MODULE_LICENSE("Dual BSD/GPL");
1050 MODULE_AUTHOR("Jiri Pirko <jiri@mellanox.com>");
1051 MODULE_DESCRIPTION("Object aggregation manager");
1052