From patchwork Tue Nov 8 07:14:40 2022 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: "wuqiang.matt" X-Patchwork-Id: 16894 Return-Path: Delivered-To: ouuuleilei@gmail.com Received: by 2002:a5d:6687:0:0:0:0:0 with SMTP id l7csp2537466wru; Mon, 7 Nov 2022 23:18:37 -0800 (PST) X-Google-Smtp-Source: AMsMyM6Y6NO3ff5wz92CCEnDzvFqYFTaY4b6He6R4Oq9XfxpFO2/zu0LG/0WWUMRQUCnpnHZ1pIW X-Received: by 2002:a63:cf01:0:b0:46f:f112:c6ce with SMTP id j1-20020a63cf01000000b0046ff112c6cemr32108223pgg.613.1667891916950; Mon, 07 Nov 2022 23:18:36 -0800 (PST) ARC-Seal: i=1; a=rsa-sha256; t=1667891916; cv=none; d=google.com; s=arc-20160816; b=ga35nDdszcIxKkh34+iQ3hxm0eqdNR84OI3hbLu3tMw0iFW9vXRse4f8i9oJ6qPqkr 8fuby1uTpan84D6Kr2y1LvRrwVnJN6ZqmtE9gknfAvkq1KmhaPPByn4zO1g4/M1szBD9 T8MVoB/FdE4n31FhIpBxJ1Nvkvkp1UKHgR7ZheVko4QsthH3wYNoaVWNcpL6odPmfIOD U0na0bqqMaZrNS8pOG2Uw+aT02udxsDPB2uhMBaG3F338NKeCiWSmjON2WNsfpC+b2vD 4Tw7gSmPfJJHCh3rXlZRoHrlQvtRFY0D5A9gCf8rbraEDR3Xhe7KRNo9+PDU5EAYsLVk 8V8Q== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:content-transfer-encoding:mime-version :references:in-reply-to:message-id:date:subject:cc:to:from :dkim-signature; bh=xszPtK2rFiBxjpS/yN+zdbsWdsINfhYhcybtrW5Ph3c=; b=c2kIKbBFbWWUjDw5aIv5K2Y0/AeBahC/32Bcug1lpBF8bWRDT7arkT5ZvbwHLVJCbA xCywciATQeDsZ4O0tfsE0iZfS4N4PbJmE2voLVICmlnSmS2GGF/KMoaySE+oE7IWsnZg wljO5EWLZJbb3D3tcev8QpoJTLXbfoJY86fWgSiwdTjyVEJH2m+fD9UYFKczjV6iV00W vEelMwLzBPrJ2Uiwk1INd0+EGrTRbiBop7CTqTI2wkF31+x3imRhoQ9O5LmZNjrKOOrB ZBNbIOntzJgK/wdhqybWln8gGSCBKbT2LV7YWf9XhF/6oFuWfNB3SclOUcBIVeHncHMH RhwA== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@bytedance-com.20210112.gappssmtp.com header.s=20210112 header.b="q/L2lxkK"; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=fail (p=NONE sp=NONE dis=NONE) header.from=bytedance.com Received: from out1.vger.email (out1.vger.email. [2620:137:e000::1:20]) by mx.google.com with ESMTP id g13-20020a63f40d000000b0045ce0eba525si12561104pgi.130.2022.11.07.23.18.24; Mon, 07 Nov 2022 23:18:36 -0800 (PST) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20; Authentication-Results: mx.google.com; dkim=pass header.i=@bytedance-com.20210112.gappssmtp.com header.s=20210112 header.b="q/L2lxkK"; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=fail (p=NONE sp=NONE dis=NONE) header.from=bytedance.com Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S233295AbiKHHPu (ORCPT + 99 others); Tue, 8 Nov 2022 02:15:50 -0500 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:57238 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S233284AbiKHHPr (ORCPT ); Tue, 8 Nov 2022 02:15:47 -0500 Received: from mail-pf1-x42f.google.com (mail-pf1-x42f.google.com [IPv6:2607:f8b0:4864:20::42f]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 2B54512634 for ; Mon, 7 Nov 2022 23:15:43 -0800 (PST) Received: by mail-pf1-x42f.google.com with SMTP id m6so13064826pfb.0 for ; Mon, 07 Nov 2022 23:15:43 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=bytedance-com.20210112.gappssmtp.com; s=20210112; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:from:to:cc:subject:date :message-id:reply-to; bh=xszPtK2rFiBxjpS/yN+zdbsWdsINfhYhcybtrW5Ph3c=; b=q/L2lxkKfxYLJorMNZgHBfCPDe10Viias7gObaamwDO3suJcOpoCERADYeXvTlchlE /fVkfxHs/qADRwLsx5erVWOHUTpBEph9r16xFASs1HfwMgyPFCs4t/nWRYN58WPOU35+ v9XZqpnpTdRmh2l3qLL894QEKzOoYgDp426nZBVDFCH/JPsQ0v+vNWqo9W/hsYAfiZ3T 3IidGd7qDFZryKoh2+tahtKh+DbvR5oymDYR9P5TmZ3wvQ/D4NJPc1ZJRcOaBmqRZeI+ 3VHwqi/Hnz9AENdG6dLcJrAkyi2dtUHYp+R7rgkQ7Fky0UkTn0kF06EGrXR7H04b6eCH e09w== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20210112; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=xszPtK2rFiBxjpS/yN+zdbsWdsINfhYhcybtrW5Ph3c=; b=osOxgy0V6+IBp14l3OaoG2ExcAzwWlv+qRUnJplUp4O0fIVfD1as36L+L7RU2xXLDx W0Gjn50nS5GkGKr4mPOcrnZsX6UbUTbrZ/byUfX0pYWIi6qECVKUh6mLWh+lBhmycj9F Im1Zqogf3IG9Hw+P4AcOD32OLq3rBreX+VHrS90nHH7LhzrSLvZ7jA5i8WKn9ol7Roxj cR2uTq2/Vp9rfDhW+UQ5NxAtuV8965f5+HPuZydhoXzIlwYJ6tYM/Uh2ODovPPPaVCee 6jlAb/1lnXbhfWaBFt9pZb/EbyXTvSrU6A+L4MfsARYCCKTptN+f1DS2ekklsKfvN+OA x0Iw== X-Gm-Message-State: ACrzQf1KQW694grwcA/vdu2I4pS38O02DSicumYyhpErUbFtnKdISK7R bbsLEFxCMP4vVLSSUadNxDa5Wg== X-Received: by 2002:a63:ba46:0:b0:470:30c2:c748 with SMTP id l6-20020a63ba46000000b0047030c2c748mr21003087pgu.204.1667891742458; Mon, 07 Nov 2022 23:15:42 -0800 (PST) Received: from devtp.bytedance.net ([139.177.225.243]) by smtp.gmail.com with ESMTPSA id l12-20020a170902f68c00b0017f592a7eccsm6123918plg.298.2022.11.07.23.15.36 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Mon, 07 Nov 2022 23:15:42 -0800 (PST) From: wuqiang To: mhiramat@kernel.org, davem@davemloft.net, anil.s.keshavamurthy@intel.com, naveen.n.rao@linux.ibm.com, rostedt@goodmis.org, peterz@infradead.org, akpm@linux-foundation.org, sander@svanheule.net, ebiggers@google.com, dan.j.williams@intel.com, jpoimboe@kernel.org Cc: linux-kernel@vger.kernel.org, lkp@intel.com, mattwu@163.com, wuqiang Subject: [PATCH v6 1/4] lib: objpool added: ring-array based lockless MPMC queue Date: Tue, 8 Nov 2022 15:14:40 +0800 Message-Id: <20221108071443.258794-2-wuqiang.matt@bytedance.com> X-Mailer: git-send-email 2.34.1 In-Reply-To: <20221108071443.258794-1-wuqiang.matt@bytedance.com> References: <20221102023012.6362-1-wuqiang.matt@bytedance.com> <20221108071443.258794-1-wuqiang.matt@bytedance.com> MIME-Version: 1.0 X-Spam-Status: No, score=-1.9 required=5.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,RCVD_IN_DNSWL_NONE,SPF_HELO_NONE,SPF_PASS autolearn=ham autolearn_force=no version=3.4.6 X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on lindbergh.monkeyblade.net Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org X-getmail-retrieved-from-mailbox: =?utf-8?q?INBOX?= X-GMAIL-THRID: =?utf-8?q?1748723839689517638?= X-GMAIL-MSGID: =?utf-8?q?1748911434940166929?= The object pool is a scalable implementaion of high performance queue for objects allocation and reclamation, such as kretprobe instances. With leveraging per-cpu ring-array to mitigate the hot spots of memory contention, it could deliver near-linear scalability for high parallel scenarios. The ring-array is compactly managed in a single cache-line to benefit from warmed L1 cache for most cases (<= 4 objects per-core). The body of pre-allocated objects is stored in continuous cache-lines just after the ring-array. The object pool is interrupt safe. Both allocation and reclamation (object pop and push operations) can be preemptible or interruptable. It's best suited for following cases: 1) Memory allocation or reclamation are prohibited or too expensive 2) Consumers are of different priorities, such as irqs and threads Limitations: 1) Maximum objects (capacity) is determined during pool initializing 2) The memory of objects won't be freed until the poll is finalized 3) Object allocation (pop) may fail after trying all cpu slots 4) Object reclamation (push) won't fail but may take long time to finish for imbalanced scenarios. You can try larger max_entries to mitigate, or ( >= CPUS * nr_objs) to avoid Signed-off-by: wuqiang --- include/linux/objpool.h | 153 +++++++++++++ lib/Makefile | 2 +- lib/objpool.c | 487 ++++++++++++++++++++++++++++++++++++++++ 3 files changed, 641 insertions(+), 1 deletion(-) create mode 100644 include/linux/objpool.h create mode 100644 lib/objpool.c diff --git a/include/linux/objpool.h b/include/linux/objpool.h new file mode 100644 index 000000000000..7899b054b50c --- /dev/null +++ b/include/linux/objpool.h @@ -0,0 +1,153 @@ +/* SPDX-License-Identifier: GPL-2.0 */ + +#ifndef _LINUX_OBJPOOL_H +#define _LINUX_OBJPOOL_H + +#include + +/* + * objpool: ring-array based lockless MPMC queue + * + * Copyright: wuqiang.matt@bytedance.com + * + * The object pool is a scalable implementaion of high performance queue + * for objects allocation and reclamation, such as kretprobe instances. + * + * With leveraging per-cpu ring-array to mitigate the hot spots of memory + * contention, it could deliver near-linear scalability for high parallel + * scenarios. The ring-array is compactly managed in a single cache-line + * to benefit from warmed L1 cache for most cases (<= 4 objects per-core). + * The body of pre-allocated objects is stored in continuous cache-lines + * just after the ring-array. + * + * The object pool is interrupt safe. Both allocation and reclamation + * (object pop and push operations) can be preemptible or interruptable. + * + * It's best suited for following cases: + * 1) Memory allocation or reclamation are prohibited or too expensive + * 2) Consumers are of different priorities, such as irqs and threads + * + * Limitations: + * 1) Maximum objects (capacity) is determined during pool initializing + * 2) The memory of objects won't be freed until the poll is finalized + * 3) Object allocation (pop) may fail after trying all cpu slots + * 4) Object reclamation (push) won't fail but may take long time to + * finish for imbalanced scenarios. You can try larger max_entries + * to mitigate, or ( >= CPUS * nr_objs) to avoid + */ + +/* + * objpool_slot: per-cpu ring array + * + * Represents a cpu-local array-based ring buffer, its size is specialized + * during initialization of object pool. + * + * The objpool_slot is allocated from local memory for NUMA system, and to + * be kept compact in a single cacheline. ages[] is stored just after the + * body of objpool_slot, and then entries[]. The Array of ages[] describes + * revision of each item, solely used to avoid ABA. And array of entries[] + * contains the pointers of objects. + * + * The default size of objpool_slot is a single cache-line, aka. 64 bytes. + * + * 64bit: + * 4 8 12 16 32 64 + * | head | tail | size | mask | ages[4] | ents[4]: (8 * 4) | objects + * + * 32bit: + * 4 8 12 16 32 48 64 + * | head | tail | size | mask | ages[4] | ents[4] | unused | objects + * + */ + +struct objpool_slot { + uint32_t head; /* head of ring array */ + uint32_t tail; /* tail of ring array */ + uint32_t size; /* array size, pow of 2 */ + uint32_t mask; /* size - 1 */ +} __attribute__((packed)); + +/* caller-specified object initial callback to setup each object, only called once */ +typedef int (*objpool_init_obj_cb)(void *context, void *obj); + +/* caller-specified cleanup callback for private objects/pool/context */ +typedef int (*objpool_release_cb)(void *context, void *ptr, uint32_t flags); + +/* called for object releasing: ptr points to an object */ +#define OBJPOOL_FLAG_NODE (0x00000001) +/* for user pool and context releasing, ptr could be NULL */ +#define OBJPOOL_FLAG_POOL (0x00001000) +/* the object or pool to be released is user-managed */ +#define OBJPOOL_FLAG_USER (0x00008000) + +/* + * objpool_head: object pooling metadata + */ + +struct objpool_head { + unsigned int obj_size; /* object & element size */ + unsigned int nr_objs; /* total objs (to be pre-allocated) */ + unsigned int nr_cpus; /* num of possible cpus */ + unsigned int capacity; /* max objects per cpuslot */ + unsigned long flags; /* flags for objpool management */ + gfp_t gfp; /* gfp flags for kmalloc & vmalloc */ + unsigned int pool_size; /* user pool size in byes */ + void *pool; /* user managed memory pool */ + struct objpool_slot **cpu_slots; /* array of percpu slots */ + unsigned int *slot_sizes; /* size in bytes of slots */ + objpool_release_cb release; /* resource cleanup callback */ + void *context; /* caller-provided context */ +}; + +#define OBJPOOL_FROM_VMALLOC (0x800000000) /* objpool allocated from vmalloc area */ +#define OBJPOOL_HAVE_OBJECTS (0x400000000) /* objects allocated along with objpool */ + +/* initialize object pool and pre-allocate objects */ +int objpool_init(struct objpool_head *head, unsigned int nr_objs, + unsigned int max_objs, unsigned int object_size, + gfp_t gfp, void *context, objpool_init_obj_cb objinit, + objpool_release_cb release); + +/* add objects in batch from user provided pool */ +int objpool_populate(struct objpool_head *head, void *pool, + unsigned int size, unsigned int object_size, + void *context, objpool_init_obj_cb objinit); + +/* add pre-allocated object (managed by user) to objpool */ +int objpool_add(void *obj, struct objpool_head *head); + +/* allocate an object from objects pool */ +void *objpool_pop(struct objpool_head *head); + +/* reclaim an object to objects pool */ +int objpool_push(void *node, struct objpool_head *head); + +/* cleanup the whole object pool (objects including) */ +void objpool_fini(struct objpool_head *head); + +/* whether the object is pre-allocated with percpu slots */ +static inline int objpool_is_inslot(void *obj, struct objpool_head *head) +{ + void *slot; + int i; + + if (!obj || !(head->flags & OBJPOOL_HAVE_OBJECTS)) + return 0; + + for (i = 0; i < head->nr_cpus; i++) { + slot = head->cpu_slots[i]; + if (obj >= slot && obj < slot + head->slot_sizes[i]) + return 1; + } + + return 0; +} + +/* whether the object is from user pool (batched adding) */ +static inline int objpool_is_inpool(void *obj, struct objpool_head *head) +{ + return (obj && head->pool && obj >= head->pool && + obj < head->pool + head->pool_size); +} + +#endif /* _LINUX_OBJPOOL_H */ diff --git a/lib/Makefile b/lib/Makefile index 161d6a724ff7..e938703a321f 100644 --- a/lib/Makefile +++ b/lib/Makefile @@ -34,7 +34,7 @@ lib-y := ctype.o string.o vsprintf.o cmdline.o \ is_single_threaded.o plist.o decompress.o kobject_uevent.o \ earlycpio.o seq_buf.o siphash.o dec_and_lock.o \ nmi_backtrace.o win_minmax.o memcat_p.o \ - buildid.o + buildid.o objpool.o lib-$(CONFIG_PRINTK) += dump_stack.o lib-$(CONFIG_SMP) += cpumask.o diff --git a/lib/objpool.c b/lib/objpool.c new file mode 100644 index 000000000000..ecffa0795f3d --- /dev/null +++ b/lib/objpool.c @@ -0,0 +1,487 @@ +// SPDX-License-Identifier: GPL-2.0 + +#include +#include +#include +#include +#include + +/* + * objpool: ring-array based lockless MPMC/FIFO queues + * + * Copyright: wuqiang.matt@bytedance.com + */ + +/* compute the suitable num of objects to be managed by slot */ +static inline unsigned int __objpool_num_of_objs(unsigned int size) +{ + return rounddown_pow_of_two((size - sizeof(struct objpool_slot)) / + (sizeof(uint32_t) + sizeof(void *))); +} + +#define SLOT_AGES(s) ((uint32_t *)((char *)(s) + sizeof(struct objpool_slot))) +#define SLOT_ENTS(s) ((void **)((char *)(s) + sizeof(struct objpool_slot) + \ + sizeof(uint32_t) * (s)->size)) +#define SLOT_OBJS(s) ((void *)((char *)(s) + sizeof(struct objpool_slot) + \ + (sizeof(uint32_t) + sizeof(void *)) * (s)->size)) + +/* allocate and initialize percpu slots */ +static inline int +__objpool_init_percpu_slots(struct objpool_head *head, unsigned int nobjs, + void *context, objpool_init_obj_cb objinit) +{ + unsigned int i, j, n, size, objsz, nents = head->capacity; + + /* aligned object size by sizeof(void *) */ + objsz = ALIGN(head->obj_size, sizeof(void *)); + /* shall we allocate objects along with objpool_slot */ + if (objsz) + head->flags |= OBJPOOL_HAVE_OBJECTS; + + for (i = 0; i < head->nr_cpus; i++) { + struct objpool_slot *os; + + /* compute how many objects to be managed by this slot */ + n = nobjs / head->nr_cpus; + if (i < (nobjs % head->nr_cpus)) + n++; + size = sizeof(struct objpool_slot) + sizeof(void *) * nents + + sizeof(uint32_t) * nents + objsz * n; + + /* decide memory area for cpu-slot allocation */ + if (!i && !(head->gfp & GFP_ATOMIC) && size > PAGE_SIZE / 2) + head->flags |= OBJPOOL_FROM_VMALLOC; + + /* allocate percpu slot & objects from local memory */ + if (head->flags & OBJPOOL_FROM_VMALLOC) + os = __vmalloc_node(size, sizeof(void *), head->gfp, + cpu_to_node(i), __builtin_return_address(0)); + else + os = kmalloc_node(size, head->gfp, cpu_to_node(i)); + if (!os) + return -ENOMEM; + + /* initialize percpu slot for the i-th cpu */ + memset(os, 0, size); + os->size = head->capacity; + os->mask = os->size - 1; + head->cpu_slots[i] = os; + head->slot_sizes[i] = size; + + /* + * start from 2nd round to avoid conflict of 1st item. + * we assume that the head item is ready for retrieval + * iff head is equal to ages[head & mask]. but ages is + * initialized as 0, so in view of the caller of pop(), + * the 1st item (0th) is always ready, but fact could + * be: push() is stalled before the final update, thus + * the item being inserted will be lost forever. + */ + os->head = os->tail = head->capacity; + + if (!objsz) + continue; + + for (j = 0; j < n; j++) { + uint32_t *ages = SLOT_AGES(os); + void **ents = SLOT_ENTS(os); + void *obj = SLOT_OBJS(os) + j * objsz; + uint32_t ie = os->tail & os->mask; + + /* perform object initialization */ + if (objinit) { + int rc = objinit(context, obj); + if (rc) + return rc; + } + + /* add obj into the ring array */ + ents[ie] = obj; + ages[ie] = os->tail; + os->tail++; + head->nr_objs++; + } + } + + return 0; +} + +/* cleanup all percpu slots of the object pool */ +static inline void __objpool_fini_percpu_slots(struct objpool_head *head) +{ + unsigned int i; + + if (!head->cpu_slots) + return; + + for (i = 0; i < head->nr_cpus; i++) { + if (!head->cpu_slots[i]) + continue; + if (head->flags & OBJPOOL_FROM_VMALLOC) + vfree(head->cpu_slots[i]); + else + kfree(head->cpu_slots[i]); + } + kfree(head->cpu_slots); + head->cpu_slots = NULL; + head->slot_sizes = NULL; +} + +/** + * objpool_init: initialize object pool and pre-allocate objects + * + * args: + * @head: the object pool to be initialized, declared by caller + * @nr_objs: total objects to be pre-allocated by this object pool + * @max_objs: max entries (object pool capacity), use nr_objs if 0 + * @object_size: size of an object, no objects pre-allocated if 0 + * @gfp: flags for memory allocation (via kmalloc or vmalloc) + * @context: user context for object initialization callback + * @objinit: object initialization callback for extra setting-up + * @release: cleanup callback for private objects/pool/context + * + * return: + * 0 for success, otherwise error code + * + * All pre-allocated objects are to be zeroed. Caller could do extra + * initialization in objinit callback. The objinit callback will be + * called once and only once after the slot allocation. Then objpool + * won't touch any content of the objects since then. It's caller's + * duty to perform reinitialization after object allocation (pop) or + * clearance before object reclamation (push) if required. + */ +int objpool_init(struct objpool_head *head, unsigned int nr_objs, + unsigned int max_objs, unsigned int object_size, + gfp_t gfp, void *context, objpool_init_obj_cb objinit, + objpool_release_cb release) +{ + unsigned int nents, ncpus = num_possible_cpus(); + int rc; + + /* calculate percpu slot size (rounded to pow of 2) */ + if (max_objs < nr_objs) + max_objs = nr_objs; + nents = max_objs / ncpus; + if (nents < __objpool_num_of_objs(L1_CACHE_BYTES)) + nents = __objpool_num_of_objs(L1_CACHE_BYTES); + nents = roundup_pow_of_two(nents); + while (nents * ncpus < nr_objs) + nents = nents << 1; + + memset(head, 0, sizeof(struct objpool_head)); + head->nr_cpus = ncpus; + head->obj_size = object_size; + head->capacity = nents; + head->gfp = gfp & ~__GFP_ZERO; + head->context = context; + head->release = release; + + /* allocate array for percpu slots */ + head->cpu_slots = kzalloc(head->nr_cpus * sizeof(void *) + + head->nr_cpus * sizeof(uint32_t), head->gfp); + if (!head->cpu_slots) + return -ENOMEM; + head->slot_sizes = (uint32_t *)&head->cpu_slots[head->nr_cpus]; + + /* initialize per-cpu slots */ + rc = __objpool_init_percpu_slots(head, nr_objs, context, objinit); + if (rc) + __objpool_fini_percpu_slots(head); + + return rc; +} +EXPORT_SYMBOL_GPL(objpool_init); + +/* adding object to slot tail, the given slot must NOT be full */ +static inline int __objpool_add_slot(void *obj, struct objpool_slot *os) +{ + uint32_t *ages = SLOT_AGES(os); + void **ents = SLOT_ENTS(os); + uint32_t tail = atomic_inc_return((atomic_t *)&os->tail) - 1; + + WRITE_ONCE(ents[tail & os->mask], obj); + + /* order matters: obj must be updated before tail updating */ + smp_store_release(&ages[tail & os->mask], tail); + return 0; +} + +/* adding object to slot, abort if the slot was already full */ +static inline int __objpool_try_add_slot(void *obj, struct objpool_slot *os) +{ + uint32_t *ages = SLOT_AGES(os); + void **ents = SLOT_ENTS(os); + uint32_t head, tail; + + do { + /* perform memory loading for both head and tail */ + head = READ_ONCE(os->head); + tail = READ_ONCE(os->tail); + /* just abort if slot is full */ + if (tail >= head + os->size) + return -ENOENT; + /* try to extend tail by 1 using CAS to avoid races */ + if (try_cmpxchg_acquire(&os->tail, &tail, tail + 1)) + break; + } while (1); + + /* the tail-th of slot is reserved for the given obj */ + WRITE_ONCE(ents[tail & os->mask], obj); + /* update epoch id to make this object available for pop() */ + smp_store_release(&ages[tail & os->mask], tail); + return 0; +} + +/** + * objpool_populate: add objects from user provided pool in batch + * + * args: + * @head: object pool + * @pool: user buffer for pre-allocated objects + * @size: size of user buffer + * @object_size: size of object & element + * @context: user context for objinit callback + * @objinit: object initialization callback + * + * return: 0 or error code + */ +int objpool_populate(struct objpool_head *head, void *pool, + unsigned int size, unsigned int object_size, + void *context, objpool_init_obj_cb objinit) +{ + unsigned int n = head->nr_objs, used = 0, i; + + if (head->pool || !pool || size < object_size) + return -EINVAL; + if (head->obj_size && head->obj_size != object_size) + return -EINVAL; + if (head->context && context && head->context != context) + return -EINVAL; + if (head->nr_objs >= head->nr_cpus * head->capacity) + return -ENOENT; + + WARN_ON_ONCE(((unsigned long)pool) & (sizeof(void *) - 1)); + WARN_ON_ONCE(((uint32_t)object_size) & (sizeof(void *) - 1)); + + /* align object size by sizeof(void *) */ + head->obj_size = object_size; + object_size = ALIGN(object_size, sizeof(void *)); + if (object_size == 0) + return -EINVAL; + + while (used + object_size <= size) { + void *obj = pool + used; + + /* perform object initialization */ + if (objinit) { + int rc = objinit(context, obj); + if (rc) + return rc; + } + + /* insert obj to its corresponding objpool slot */ + i = (n + used * head->nr_cpus/size) % head->nr_cpus; + if (!__objpool_try_add_slot(obj, head->cpu_slots[i])) + head->nr_objs++; + + used += object_size; + } + + if (!used) + return -ENOENT; + + head->context = context; + head->pool = pool; + head->pool_size = size; + + return 0; +} +EXPORT_SYMBOL_GPL(objpool_populate); + +/** + * objpool_add: add pre-allocated object to objpool during pool + * initialization + * + * args: + * @obj: object pointer to be added to objpool + * @head: object pool to be inserted into + * + * return: + * 0 or error code + * + * objpool_add_node doesn't handle race conditions, can only be + * called during objpool initialization + */ +int objpool_add(void *obj, struct objpool_head *head) +{ + unsigned int i, cpu; + + if (!obj) + return -EINVAL; + if (head->nr_objs >= head->nr_cpus * head->capacity) + return -ENOENT; + + cpu = head->nr_objs % head->nr_cpus; + for (i = 0; i < head->nr_cpus; i++) { + if (!__objpool_try_add_slot(obj, head->cpu_slots[cpu])) { + head->nr_objs++; + return 0; + } + + if (++cpu >= head->nr_cpus) + cpu = 0; + } + + return -ENOENT; +} +EXPORT_SYMBOL_GPL(objpool_add); + +/** + * objpool_push: reclaim the object and return back to objects pool + * + * args: + * @obj: object pointer to be pushed to object pool + * @head: object pool + * + * return: + * 0 or error code: it fails only when objects pool are full + * + * objpool_push is non-blockable, and can be nested + */ +int objpool_push(void *obj, struct objpool_head *head) +{ + unsigned int cpu = raw_smp_processor_id() % head->nr_cpus; + + do { + if (head->nr_objs > head->capacity) { + if (!__objpool_try_add_slot(obj, head->cpu_slots[cpu])) + return 0; + } else { + if (!__objpool_add_slot(obj, head->cpu_slots[cpu])) + return 0; + } + if (++cpu >= head->nr_cpus) + cpu = 0; + } while (1); + + return -ENOENT; +} +EXPORT_SYMBOL_GPL(objpool_push); + +/* try to retrieve object from slot */ +static inline void *__objpool_try_get_slot(struct objpool_slot *os) +{ + uint32_t *ages = SLOT_AGES(os); + void **ents = SLOT_ENTS(os); + /* do memory load of head to local head */ + uint32_t head = smp_load_acquire(&os->head); + + /* loop if slot isn't empty */ + while (head != READ_ONCE(os->tail)) { + uint32_t id = head & os->mask, prev = head; + + /* do prefetching of object ents */ + prefetch(&ents[id]); + + /* + * check whether this item was ready for retrieval ? There's + * possibility * in theory * we might retrieve wrong object, + * in case ages[id] overflows when current task is sleeping, + * but it will take very very long to overflow an uint32_t + */ + if (smp_load_acquire(&ages[id]) == head) { + /* node must have been udpated by push() */ + void *node = READ_ONCE(ents[id]); + /* commit and move forward head of the slot */ + if (try_cmpxchg_release(&os->head, &head, head + 1)) + return node; + } + + /* re-load head from memory continue trying */ + head = READ_ONCE(os->head); + /* + * head stays unchanged, so it's very likely current pop() + * just preempted/interrupted an ongoing push() operation + */ + if (head == prev) + break; + } + + return NULL; +} + +/** + * objpool_pop: allocate an object from objects pool + * + * args: + * @oh: object pool + * + * return: + * object: NULL if failed (object pool is empty) + * + * objpool_pop can be nested, so can be used in any context. + */ +void *objpool_pop(struct objpool_head *head) +{ + unsigned int i, cpu; + void *obj = NULL; + + cpu = raw_smp_processor_id() % head->nr_cpus; + for (i = 0; i < head->nr_cpus; i++) { + struct objpool_slot *slot = head->cpu_slots[cpu]; + obj = __objpool_try_get_slot(slot); + if (obj) + break; + if (++cpu >= head->nr_cpus) + cpu = 0; + } + + return obj; +} +EXPORT_SYMBOL_GPL(objpool_pop); + +/** + * objpool_fini: cleanup the whole object pool (releasing all objects) + * + * args: + * @head: object pool to be released + * + */ +void objpool_fini(struct objpool_head *head) +{ + uint32_t i, flags; + + if (!head->cpu_slots) + return; + + if (!head->release) { + __objpool_fini_percpu_slots(head); + return; + } + + /* cleanup all objects remained in objpool */ + for (i = 0; i < head->nr_cpus; i++) { + void *obj; + do { + flags = OBJPOOL_FLAG_NODE; + obj = __objpool_try_get_slot(head->cpu_slots[i]); + if (!obj) + break; + if (!objpool_is_inpool(obj, head) && + !objpool_is_inslot(obj, head)) { + flags |= OBJPOOL_FLAG_USER; + } + head->release(head->context, obj, flags); + } while (obj); + } + + /* release percpu slots */ + __objpool_fini_percpu_slots(head); + + /* cleanup user private pool and related context */ + flags = OBJPOOL_FLAG_POOL; + if (head->pool) + flags |= OBJPOOL_FLAG_USER; + head->release(head->context, head->pool, flags); +} +EXPORT_SYMBOL_GPL(objpool_fini);