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