diff --git a/block/Kconfig.iosched b/block/Kconfig.iosched index 27f11320b8d12..56afc425cc521 100644 --- a/block/Kconfig.iosched +++ b/block/Kconfig.iosched @@ -44,4 +44,12 @@ config BFQ_CGROUP_DEBUG Enable some debugging help. Currently it exports additional stat files in a cgroup which can be useful for debugging. +config IOSCHED_UFQ + tristate "UFQ I/O scheduler" + default y + help + The UFQ I/O scheduler is a programmable I/O scheduler. When + enabled, an out-of-kernel I/O scheduler based on eBPF can be + designed to interact with it, leveraging its customizable + hooks to redefine I/O scheduling policies. endmenu diff --git a/block/Makefile b/block/Makefile index 7dce2e44276c4..a58ea7384b7a0 100644 --- a/block/Makefile +++ b/block/Makefile @@ -24,6 +24,7 @@ obj-$(CONFIG_MQ_IOSCHED_DEADLINE) += mq-deadline.o obj-$(CONFIG_MQ_IOSCHED_KYBER) += kyber-iosched.o bfq-y := bfq-iosched.o bfq-wf2q.o bfq-cgroup.o obj-$(CONFIG_IOSCHED_BFQ) += bfq.o +obj-$(CONFIG_IOSCHED_UFQ) += ufq-iosched.o ufq-bpfops.o ufq-kfunc.o obj-$(CONFIG_BLK_DEV_INTEGRITY) += bio-integrity.o blk-integrity.o t10-pi.o \ bio-integrity-auto.o bio-integrity-fs.o diff --git a/block/blk-merge.c b/block/blk-merge.c index fcf09325b22e3..8bdc459ae6312 100644 --- a/block/blk-merge.c +++ b/block/blk-merge.c @@ -774,8 +774,8 @@ u8 bio_seg_gap(struct request_queue *q, struct bio *prev, struct bio *next, * For non-mq, this has to be called with the request spinlock acquired. * For mq with scheduling, the appropriate queue wide lock should be held. */ -static struct request *attempt_merge(struct request_queue *q, - struct request *req, struct request *next) +static struct request *attempt_merge(struct request_queue *q, struct request *req, + struct request *next, bool nohash) { if (!rq_mergeable(req) || !rq_mergeable(next)) return NULL; @@ -842,7 +842,7 @@ static struct request *attempt_merge(struct request_queue *q, req->__data_len += blk_rq_bytes(next); - if (!blk_discard_mergable(req)) + if (!nohash && !blk_discard_mergable(req)) elv_merge_requests(q, req, next); blk_crypto_rq_put_keyslot(next); @@ -868,7 +868,7 @@ static struct request *attempt_back_merge(struct request_queue *q, struct request *next = elv_latter_request(q, rq); if (next) - return attempt_merge(q, rq, next); + return attempt_merge(q, rq, next, false); return NULL; } @@ -879,11 +879,17 @@ static struct request *attempt_front_merge(struct request_queue *q, struct request *prev = elv_former_request(q, rq); if (prev) - return attempt_merge(q, prev, rq); + return attempt_merge(q, prev, rq, false); return NULL; } +struct request *bpf_attempt_merge(struct request_queue *q, struct request *rq, + struct request *next) +{ + return attempt_merge(q, rq, next, true); +} + /* * Try to merge 'next' into 'rq'. Return true if the merge happened, false * otherwise. The caller is responsible for freeing 'next' if the merge @@ -892,7 +898,7 @@ static struct request *attempt_front_merge(struct request_queue *q, bool blk_attempt_req_merge(struct request_queue *q, struct request *rq, struct request *next) { - return attempt_merge(q, rq, next); + return attempt_merge(q, rq, next, false); } bool blk_rq_merge_ok(struct request *rq, struct bio *bio) @@ -1169,3 +1175,34 @@ bool blk_mq_sched_try_merge(struct request_queue *q, struct bio *bio, } } EXPORT_SYMBOL_GPL(blk_mq_sched_try_merge); + +bool blk_mq_sched_merge_fn(struct request_queue *q, struct bio *bio, + unsigned int nr_segs, struct request **merged_request, + struct request *rq, enum elv_merge type, void (*fn) + (struct request_queue *, struct request *, enum elv_merge)) +{ + switch (type) { + case ELEVATOR_BACK_MERGE: + if (!blk_mq_sched_allow_merge(q, rq, bio)) + return false; + if (bio_attempt_back_merge(rq, bio, nr_segs) != BIO_MERGE_OK) + return false; + *merged_request = attempt_back_merge(q, rq); + if (!*merged_request) + fn(q, rq, ELEVATOR_BACK_MERGE); + return true; + case ELEVATOR_FRONT_MERGE: + if (!blk_mq_sched_allow_merge(q, rq, bio)) + return false; + if (bio_attempt_front_merge(rq, bio, nr_segs) != BIO_MERGE_OK) + return false; + *merged_request = attempt_front_merge(q, rq); + if (!*merged_request) + fn(q, rq, ELEVATOR_FRONT_MERGE); + return true; + case ELEVATOR_DISCARD_MERGE: + return bio_attempt_discard_merge(q, rq, bio) == BIO_MERGE_OK; + default: + return false; + } +} diff --git a/block/blk-mq-sched.h b/block/blk-mq-sched.h index 5678e15bd33c4..e5f7187044c49 100644 --- a/block/blk-mq-sched.h +++ b/block/blk-mq-sched.h @@ -7,6 +7,10 @@ #define MAX_SCHED_RQ (16 * BLKDEV_DEFAULT_RQ) +bool blk_mq_sched_merge_fn(struct request_queue *q, struct bio *bio, + unsigned int nr_segs, struct request **merged_request, + struct request *rq, enum elv_merge type, void (*fn) + (struct request_queue *, struct request *, enum elv_merge)); bool blk_mq_sched_try_merge(struct request_queue *q, struct bio *bio, unsigned int nr_segs, struct request **merged_request); bool blk_mq_sched_bio_merge(struct request_queue *q, struct bio *bio, diff --git a/block/blk-mq.c b/block/blk-mq.c index 4c5c16cce4f8f..bebc1306d8fd4 100644 --- a/block/blk-mq.c +++ b/block/blk-mq.c @@ -796,7 +796,7 @@ static void blk_mq_finish_request(struct request *rq) } } -static void __blk_mq_free_request(struct request *rq) +void __blk_mq_free_request(struct request *rq) { struct request_queue *q = rq->q; struct blk_mq_ctx *ctx = rq->mq_ctx; @@ -1844,6 +1844,12 @@ static bool dispatch_rq_from_ctx(struct sbitmap *sb, unsigned int bitnr, if (list_empty(&ctx->rq_lists[type])) sbitmap_clear_bit(sb, bitnr); } + + if (dispatch_data->rq) { + dispatch_data->rq->rq_flags |= RQF_STARTED; + if (hctx->queue->last_merge == dispatch_data->rq) + hctx->queue->last_merge = NULL; + } spin_unlock(&ctx->lock); return !dispatch_data->rq; diff --git a/block/blk-mq.h b/block/blk-mq.h index aa15d31aaae9b..3f85cae7bf57a 100644 --- a/block/blk-mq.h +++ b/block/blk-mq.h @@ -56,7 +56,7 @@ void blk_mq_flush_busy_ctxs(struct blk_mq_hw_ctx *hctx, struct list_head *list); struct request *blk_mq_dequeue_from_ctx(struct blk_mq_hw_ctx *hctx, struct blk_mq_ctx *start); void blk_mq_put_rq_ref(struct request *rq); - +void __blk_mq_free_request(struct request *rq); /* * Internal helpers for allocating/freeing the request map */ diff --git a/block/blk.h b/block/blk.h index ec4674cdf2ead..3ff1e384d2384 100644 --- a/block/blk.h +++ b/block/blk.h @@ -444,6 +444,8 @@ static inline unsigned get_max_segment_size(const struct queue_limits *lim, int ll_back_merge_fn(struct request *req, struct bio *bio, unsigned int nr_segs); +struct request *bpf_attempt_merge(struct request_queue *q, struct request *rq, + struct request *next); bool blk_attempt_req_merge(struct request_queue *q, struct request *rq, struct request *next); unsigned int blk_recalc_rq_segments(struct request *rq); diff --git a/block/ufq-bpfops.c b/block/ufq-bpfops.c new file mode 100644 index 0000000000000..c293ed834829d --- /dev/null +++ b/block/ufq-bpfops.c @@ -0,0 +1,213 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2026 KylinSoft Corporation. + * Copyright (c) 2026 Kaitao Cheng + */ +#include +#include +#include +#include +#include +#include +#include +#include "ufq-iosched.h" + +struct ufq_iosched_ops ufq_ops; + +static const struct bpf_func_proto * +bpf_ufq_get_func_proto(enum bpf_func_id func_id, const struct bpf_prog *prog) +{ + return bpf_base_func_proto(func_id, prog); +} + +static bool bpf_ufq_is_valid_access(int off, int size, + enum bpf_access_type type, + const struct bpf_prog *prog, + struct bpf_insn_access_aux *info) +{ + if (type != BPF_READ) + return false; + if (off < 0 || off >= sizeof(__u64) * MAX_BPF_FUNC_ARGS) + return false; + if (off % size != 0) + return false; + + /* + * merge_req's third argument is int *type. btf_ctx_access() treats + * pointers that are not "pointer to struct" as scalars (no reg_type), + * so loading the pointer from ctx leaves a SCALAR and *type stores + * fail verification. Model it as a read/write buffer of merge_type. + */ + if (off == 16 && size == sizeof(__u64) && + prog->aux->attach_func_name && + !strcmp(prog->aux->attach_func_name, "merge_req")) { + if (!btf_ctx_access(off, size, type, prog, info)) + return false; + info->reg_type = PTR_TO_BUF; + return true; + } + + return btf_ctx_access(off, size, type, prog, info); +} + +static const struct bpf_verifier_ops bpf_ufq_verifier_ops = { + .get_func_proto = bpf_ufq_get_func_proto, + .is_valid_access = bpf_ufq_is_valid_access, +}; + +static int bpf_ufq_init_member(const struct btf_type *t, + const struct btf_member *member, + void *kdata, const void *udata) +{ + const struct ufq_iosched_ops *uops = udata; + struct ufq_iosched_ops *ops = kdata; + u32 moff = __btf_member_bit_offset(t, member) / 8; + int ret; + + switch (moff) { + case offsetof(struct ufq_iosched_ops, name): + ret = bpf_obj_name_cpy(ops->name, uops->name, + sizeof(ops->name)); + if (ret < 0) + return ret; + if (ret == 0) + return -EINVAL; + return 1; + /* other var adding .... */ + } + + return 0; +} + +static int bpf_ufq_check_member(const struct btf_type *t, + const struct btf_member *member, + const struct bpf_prog *prog) +{ + return 0; +} + +static int bpf_ufq_enable(struct ufq_iosched_ops *ops) +{ + ufq_ops = *ops; + return 0; +} + +static void bpf_ufq_disable(struct ufq_iosched_ops *ops) +{ + memset(&ufq_ops, 0, sizeof(ufq_ops)); +} + +static int bpf_ufq_reg(void *kdata, struct bpf_link *link) +{ + return bpf_ufq_enable(kdata); +} + +static void bpf_ufq_unreg(void *kdata, struct bpf_link *link) +{ + bpf_ufq_disable(kdata); +} + +static int bpf_ufq_init(struct btf *btf) +{ + return 0; +} + +static int bpf_ufq_update(void *kdata, void *old_kdata, struct bpf_link *link) +{ + /* + * UFQ does not support live-updating an already-attached BPF scheduler: + * partial failure during callback setup (e.g. init_sched) would be hard + * to reason about, and update can race with unregister/teardown. + */ + return -EOPNOTSUPP; +} + +static int bpf_ufq_validate(void *kdata) +{ + return 0; +} + +static int init_sched_stub(struct request_queue *q) +{ + return -EPERM; +} + +static int exit_sched_stub(struct request_queue *q) +{ + return -EPERM; +} + +static int insert_req_stub(struct request_queue *q, struct request *rq, + blk_insert_t flags) +{ + return 0; +} + +static struct request *dispatch_req_stub(struct request_queue *q) +{ + return NULL; +} + +static bool has_req_stub(struct request_queue *q, int rqs_count) +{ + return rqs_count > 0; +} + +static void finish_req_stub(struct request *rq) +{ +} + +static struct request *former_req_stub(struct request_queue *q, struct request *rq) +{ + return NULL; +} + +static struct request *next_req_stub(struct request_queue *q, struct request *rq) +{ + return NULL; +} + +static struct request *merge_req_stub(struct request_queue *q, struct request *rq, + int *type) +{ + *type = ELEVATOR_NO_MERGE; + return NULL; +} + +static void req_merged_stub(struct request_queue *q, struct request *rq, + int type) +{ +} + +static struct ufq_iosched_ops __bpf_ops_ufq_ops = { + .init_sched = init_sched_stub, + .exit_sched = exit_sched_stub, + .insert_req = insert_req_stub, + .dispatch_req = dispatch_req_stub, + .has_req = has_req_stub, + .former_req = former_req_stub, + .next_req = next_req_stub, + .merge_req = merge_req_stub, + .req_merged = req_merged_stub, + .finish_req = finish_req_stub, +}; + +static struct bpf_struct_ops bpf_iosched_ufq_ops = { + .verifier_ops = &bpf_ufq_verifier_ops, + .reg = bpf_ufq_reg, + .unreg = bpf_ufq_unreg, + .check_member = bpf_ufq_check_member, + .init_member = bpf_ufq_init_member, + .init = bpf_ufq_init, + .update = bpf_ufq_update, + .validate = bpf_ufq_validate, + .name = "ufq_iosched_ops", + .owner = THIS_MODULE, + .cfi_stubs = &__bpf_ops_ufq_ops +}; + +int bpf_ufq_ops_init(void) +{ + return register_bpf_struct_ops(&bpf_iosched_ufq_ops, ufq_iosched_ops); +} + diff --git a/block/ufq-iosched.c b/block/ufq-iosched.c new file mode 100644 index 0000000000000..8c10e0d74b0ee --- /dev/null +++ b/block/ufq-iosched.c @@ -0,0 +1,526 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2026 KylinSoft Corporation. + * Copyright (c) 2026 Kaitao Cheng + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include + +#include "elevator.h" +#include "blk.h" +#include "blk-mq.h" +#include "blk-mq-sched.h" +#include "blk-mq-debugfs.h" +#include "ufq-iosched.h" + +/* For testing and debugging */ +struct ufq_ops_stats { + atomic_t dispatch_ok_count; + atomic64_t dispatch_ok_sectors; + atomic_t dispatch_null_count; + atomic_t insert_ok_count; + atomic64_t insert_ok_sectors; + atomic_t insert_err_count; + atomic_t merge_ok_count; + atomic64_t merge_ok_sectors; + atomic_t finish_ok_count; + atomic64_t finish_ok_sectors; +}; + +struct ufq_data { + struct request_queue *q; + u32 async_depth; + atomic_t rqs_count; + struct ufq_ops_stats ops_stats; +}; + +enum ufq_priv_state { + UFQ_PRIV_NOT_IN_SCHED = 0, + UFQ_PRIV_IN_BPF = 1, + UFQ_PRIV_IN_UFQ = 2, + UFQ_PRIV_IN_SCHED = 3, +}; + +static void ufq_request_merged(struct request_queue *q, struct request *req, + enum elv_merge type) +{ + if (ufq_ops.req_merged) + ufq_ops.req_merged(q, req, (int)type); +} + +static struct request *ufq_dispatch_request(struct blk_mq_hw_ctx *hctx) +{ + struct ufq_data *ufq = hctx->queue->elevator->elevator_data; + struct blk_mq_ctx *ctx; + struct request *rq = NULL; + unsigned short idx; + + if (ufq_ops.dispatch_req) { + rq = ufq_ops.dispatch_req(hctx->queue); + if (!rq) { + atomic_inc(&ufq->ops_stats.dispatch_null_count); + return NULL; + } + atomic_inc(&ufq->ops_stats.dispatch_ok_count); + atomic64_add(blk_rq_sectors(rq), &ufq->ops_stats.dispatch_ok_sectors); + + ctx = rq->mq_ctx; + spin_lock(&ctx->lock); + list_del_init(&rq->queuelist); + rq->rq_flags |= RQF_STARTED; + if (hctx->queue->last_merge == rq) + hctx->queue->last_merge = NULL; + if (list_empty(&ctx->rq_lists[rq->mq_hctx->type])) + sbitmap_clear_bit(&rq->mq_hctx->ctx_map, + ctx->index_hw[rq->mq_hctx->type]); + spin_unlock(&ctx->lock); + rq->elv.priv[0] = (void *)((uintptr_t)rq->elv.priv[0] + & ~UFQ_PRIV_IN_UFQ); + } else { + ctx = READ_ONCE(hctx->dispatch_from); + rq = blk_mq_dequeue_from_ctx(hctx, ctx); + if (rq) { + idx = rq->mq_ctx->index_hw[hctx->type]; + if (++idx == hctx->nr_ctx) + idx = 0; + WRITE_ONCE(hctx->dispatch_from, hctx->ctxs[idx]); + } + } + + if (rq) + atomic_dec(&ufq->rqs_count); + return rq; +} + +/* + * Called by __blk_mq_alloc_request(). The shallow_depth value set by this + * function is used by __blk_mq_get_tag(). + */ +static void ufq_limit_depth(blk_opf_t opf, struct blk_mq_alloc_data *data) +{ + struct ufq_data *ufq = data->q->elevator->elevator_data; + + /* Do not throttle synchronous reads. */ + if (op_is_sync(opf) && !op_is_write(opf)) + return; + + /* + * Throttle asynchronous requests and writes such that these requests + * do not block the allocation of synchronous requests. + */ + data->shallow_depth = ufq->async_depth; +} + +static void ufq_depth_updated(struct request_queue *q) +{ + struct ufq_data *ufq = q->elevator->elevator_data; + + ufq->async_depth = q->nr_requests; + q->async_depth = q->nr_requests; + blk_mq_set_min_shallow_depth(q, 1); +} + +static int ufq_init_sched(struct request_queue *q, struct elevator_queue *eq) +{ + struct ufq_data *ufq; + + ufq = kzalloc_node(sizeof(*ufq), GFP_KERNEL, q->node); + if (!ufq) + return -ENOMEM; + + eq->elevator_data = ufq; + ufq->q = q; + + blk_queue_flag_set(QUEUE_FLAG_SQ_SCHED, q); + q->elevator = eq; + + q->async_depth = q->nr_requests; + ufq->async_depth = q->nr_requests; + + if (ufq_ops.init_sched) + ufq_ops.init_sched(q); + + ufq_depth_updated(q); + return 0; +} + +static void ufq_exit_sched(struct elevator_queue *e) +{ + struct ufq_data *ufq = e->elevator_data; + + if (ufq_ops.exit_sched) + ufq_ops.exit_sched(ufq->q); + + WARN_ON_ONCE(atomic_read(&ufq->rqs_count)); + + kfree(ufq); +} + +static void ufq_merged_request(struct request_queue *q, struct request *rq, + enum elv_merge type) +{ + struct elevator_queue *e = q->elevator; + + if (e->type->ops.request_merged) + e->type->ops.request_merged(q, rq, type); + + q->last_merge = rq; +} + +static bool ufq_sched_try_merge(struct request_queue *q, struct bio *bio, + unsigned int nr_segs, struct request **merged_request) +{ + enum elv_merge type = ELEVATOR_NO_MERGE; + struct request *rq = NULL, *last; + bool ret; + + + /* + * Levels of merges: + * nomerges: No merges at all attempted + * noxmerges: Only simple one-hit cache try + * merges: All merge tries attempted + */ + if (blk_queue_nomerges(q) || !bio_mergeable(bio)) + return false; + + last = q->last_merge; + if (last) { + spin_lock(&last->mq_ctx->lock); + if (last == q->last_merge && elv_bio_merge_ok(last, bio)) { + type = blk_try_merge(last, bio); + if (type != ELEVATOR_NO_MERGE) { + rq = last; + goto merge; + } + } + spin_unlock(&last->mq_ctx->lock); + } + + if (blk_queue_noxmerges(q)) + return false; + + if (ufq_ops.find_req_from_sector) { + rq = ufq_ops.find_req_from_sector(q, bio->bi_iter.bi_sector, + bio_end_sector(bio)); + if (rq && elv_bio_merge_ok(rq, bio)) + type = blk_try_merge(rq, bio); + else + return false; + } + + if (!rq || type == ELEVATOR_NO_MERGE) + return false; + + spin_lock(&rq->mq_ctx->lock); +merge: + ret = blk_mq_sched_merge_fn(q, bio, nr_segs, merged_request, rq, + type, ufq_merged_request); + spin_unlock(&rq->mq_ctx->lock); + + return ret; +} + +/* + * Attempt to merge a bio into an existing request. This function is called + * before @bio is associated with a request. + */ +static bool ufq_bio_merge(struct request_queue *q, struct bio *bio, + unsigned int nr_segs) +{ + struct ufq_data *ufq = q->elevator->elevator_data; + struct request *free = NULL; + bool ret; + + ret = ufq_sched_try_merge(q, bio, nr_segs, &free); + + if (free) { + blk_mq_free_request(free); + atomic_dec(&ufq->rqs_count); + } + + return ret; +} + +static enum elv_merge ufq_try_insert_merge(struct request_queue *q, + struct request **new) +{ + struct request *target = NULL, *free = NULL, *last, *rq = *new; + struct ufq_data *ufq = q->elevator->elevator_data; + enum elv_merge type = ELEVATOR_NO_MERGE; + int merge_type = ELEVATOR_NO_MERGE; + + if (!rq_mergeable(rq)) + return ELEVATOR_NO_MERGE; + + if (blk_queue_nomerges(q)) + return ELEVATOR_NO_MERGE; + + last = q->last_merge; + if (last) { + spin_lock(&last->mq_ctx->lock); + if (last == q->last_merge && bpf_attempt_merge(q, last, rq)) { + spin_unlock(&last->mq_ctx->lock); + type = ELEVATOR_BACK_MERGE; + free = rq; + *new = NULL; + goto end; + } + spin_unlock(&last->mq_ctx->lock); + } + + if (blk_queue_noxmerges(q)) + return ELEVATOR_NO_MERGE; + + if (ufq_ops.merge_req) { + target = ufq_ops.merge_req(q, rq, &merge_type); + type = (enum elv_merge)merge_type; + } + + if (type == ELEVATOR_NO_MERGE || !target) { + return ELEVATOR_NO_MERGE; + } else if (type == ELEVATOR_FRONT_MERGE) { + spin_lock(&target->mq_ctx->lock); + free = bpf_attempt_merge(q, rq, target); + if (!free) { + spin_unlock(&target->mq_ctx->lock); + pr_err("ufq-iosched: front merge failed\n"); + return ELEVATOR_NO_MERGE; + } + rq->elv.priv[0] = (void *)((uintptr_t)rq->elv.priv[0] + | UFQ_PRIV_IN_UFQ); + list_replace_init(&target->queuelist, &rq->queuelist); + rq->fifo_time = target->fifo_time; + q->last_merge = rq; + } else if (type == ELEVATOR_BACK_MERGE) { + spin_lock(&target->mq_ctx->lock); + free = bpf_attempt_merge(q, target, rq); + if (!free) { + spin_unlock(&target->mq_ctx->lock); + pr_err("ufq-iosched: back merge failed\n"); + return ELEVATOR_NO_MERGE; + } + *new = target; + q->last_merge = target; + } + + spin_unlock(&target->mq_ctx->lock); +end: + atomic_inc(&ufq->ops_stats.merge_ok_count); + atomic64_add(blk_rq_sectors(free), &ufq->ops_stats.merge_ok_sectors); + blk_mq_free_request(free); + return type; +} + +static void ufq_insert_requests(struct blk_mq_hw_ctx *hctx, + struct list_head *list, + blk_insert_t flags) +{ + struct request_queue *q = hctx->queue; + struct ufq_data *ufq = q->elevator->elevator_data; + struct blk_mq_ctx *ctx; + enum elv_merge type; + int bit, ret = 0; + + while (!list_empty(list)) { + struct request *rq; + + rq = list_first_entry(list, struct request, queuelist); + list_del_init(&rq->queuelist); + + type = ufq_try_insert_merge(q, &rq); + if (type == ELEVATOR_NO_MERGE) { + rq->fifo_time = jiffies; + ctx = rq->mq_ctx; + rq->elv.priv[0] = (void *)((uintptr_t)rq->elv.priv[0] + | UFQ_PRIV_IN_UFQ); + spin_lock(&ctx->lock); + if (flags & BLK_MQ_INSERT_AT_HEAD) + list_add(&rq->queuelist, &ctx->rq_lists[hctx->type]); + else + list_add_tail(&rq->queuelist, + &ctx->rq_lists[hctx->type]); + + bit = ctx->index_hw[hctx->type]; + if (!sbitmap_test_bit(&hctx->ctx_map, bit)) + sbitmap_set_bit(&hctx->ctx_map, bit); + q->last_merge = rq; + spin_unlock(&ctx->lock); + atomic_inc(&ufq->rqs_count); + } + + if (rq && ufq_ops.insert_req) { + rq->elv.priv[0] = (void *)((uintptr_t)rq->elv.priv[0] + | UFQ_PRIV_IN_BPF); + ret = ufq_ops.insert_req(q, rq, flags); + if (ret) { + atomic_inc(&ufq->ops_stats.insert_err_count); + pr_err("ufq-iosched: bpf insert_req error (%d)\n", ret); + } else { + atomic_inc(&ufq->ops_stats.insert_ok_count); + atomic64_add(blk_rq_sectors(rq), &ufq->ops_stats.insert_ok_sectors); + } + } + } +} + +static void ufq_prepare_request(struct request *rq) +{ + rq->elv.priv[0] = (void *)(uintptr_t)UFQ_PRIV_NOT_IN_SCHED; +} + +static void ufq_finish_request(struct request *rq) +{ + struct ufq_data *ufq = rq->q->elevator->elevator_data; + + /* + * The block layer core may call ufq_finish_request() without having + * called ufq_insert_requests(). Skip requests that bypassed I/O + * scheduling. + */ + if (!((uintptr_t)rq->elv.priv[0] & UFQ_PRIV_IN_BPF)) + return; + + if (ufq_ops.finish_req) + ufq_ops.finish_req(rq); + + atomic_inc(&ufq->ops_stats.finish_ok_count); + atomic64_add(blk_rq_stats_sectors(rq), &ufq->ops_stats.finish_ok_sectors); +} + +static struct request *ufq_find_next_request(struct request_queue *q, struct request *rq) +{ + if (ufq_ops.next_req) + return ufq_ops.next_req(q, rq); + + return NULL; +} + +static struct request *ufq_find_former_request(struct request_queue *q, struct request *rq) +{ + if (ufq_ops.former_req) + return ufq_ops.former_req(q, rq); + + return NULL; +} + +static bool ufq_has_work(struct blk_mq_hw_ctx *hctx) +{ + struct ufq_data *ufq = hctx->queue->elevator->elevator_data; + int rqs_count = atomic_read(&ufq->rqs_count); + + WARN_ON_ONCE(rqs_count < 0); + if (ufq_ops.has_req) + return ufq_ops.has_req(hctx->queue, rqs_count); + + return rqs_count > 0; +} + +#ifdef CONFIG_BLK_DEBUG_FS +static int ufq_ops_stats_show(void *data, struct seq_file *m) +{ + struct request_queue *q = data; + struct ufq_data *ufq = q->elevator->elevator_data; + struct ufq_ops_stats *s = &ufq->ops_stats; + + /* for debug */ + seq_printf(m, "dispatch_ok_count %d\n", + atomic_read(&s->dispatch_ok_count)); + seq_printf(m, "dispatch_ok_sectors %lld\n", + (long long)atomic64_read(&s->dispatch_ok_sectors)); + seq_printf(m, "dispatch_null_count %d\n", + atomic_read(&s->dispatch_null_count)); + seq_printf(m, "insert_ok_count %d\n", + atomic_read(&s->insert_ok_count)); + seq_printf(m, "insert_ok_sectors %lld\n", + (long long)atomic64_read(&s->insert_ok_sectors)); + seq_printf(m, "insert_err_count %d\n", + atomic_read(&s->insert_err_count)); + seq_printf(m, "merge_ok_count %d\n", + atomic_read(&s->merge_ok_count)); + seq_printf(m, "merge_ok_sectors %lld\n", + (long long)atomic64_read(&s->merge_ok_sectors)); + seq_printf(m, "finish_ok_count %d\n", + atomic_read(&s->finish_ok_count)); + seq_printf(m, "finish_ok_sectors %lld\n", + (long long)atomic64_read(&s->finish_ok_sectors)); + return 0; +} + +static const struct blk_mq_debugfs_attr ufq_iosched_debugfs_attrs[] = { + {"ops_stats", 0400, ufq_ops_stats_show}, + {}, +}; +#endif + +static struct elevator_type ufq_iosched_mq = { + .ops = { + .depth_updated = ufq_depth_updated, + .limit_depth = ufq_limit_depth, + .insert_requests = ufq_insert_requests, + .dispatch_request = ufq_dispatch_request, + .prepare_request = ufq_prepare_request, + .finish_request = ufq_finish_request, + .next_request = ufq_find_next_request, + .former_request = ufq_find_former_request, + .bio_merge = ufq_bio_merge, + .request_merged = ufq_request_merged, + .has_work = ufq_has_work, + .init_sched = ufq_init_sched, + .exit_sched = ufq_exit_sched, + }, + +#ifdef CONFIG_BLK_DEBUG_FS + .queue_debugfs_attrs = ufq_iosched_debugfs_attrs, +#endif + .elevator_name = "ufq", + .elevator_alias = "ufq_iosched", + .elevator_owner = THIS_MODULE, +}; +MODULE_ALIAS("ufq-iosched"); + +static int __init ufq_init(void) +{ + int ret; + + ret = elv_register(&ufq_iosched_mq); + if (ret) + return ret; + + ret = bpf_ufq_kfunc_init(); + if (ret) { + pr_err("ufq-iosched: Failed to register kfunc sets (%d)\n", ret); + elv_unregister(&ufq_iosched_mq); + return ret; + } + + ret = bpf_ufq_ops_init(); + if (ret) { + pr_err("ufq-iosched: Failed to register struct_ops (%d)\n", ret); + elv_unregister(&ufq_iosched_mq); + return ret; + } + + return 0; +} + +static void __exit ufq_exit(void) +{ + elv_unregister(&ufq_iosched_mq); +} + +module_init(ufq_init); +module_exit(ufq_exit); + +MODULE_AUTHOR("Kaitao Cheng "); +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("User-programmable Flexible Queueing"); diff --git a/block/ufq-iosched.h b/block/ufq-iosched.h new file mode 100644 index 0000000000000..c717362eab31b --- /dev/null +++ b/block/ufq-iosched.h @@ -0,0 +1,38 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright (c) 2026 KylinSoft Corporation. + * Copyright (c) 2026 Kaitao Cheng + */ +#ifndef _BLOCK_UFQ_IOSCHED_H +#define _BLOCK_UFQ_IOSCHED_H + +#include "elevator.h" +#include "blk-mq.h" + +#ifndef BPF_IOSCHED_NAME_MAX +#define BPF_IOSCHED_NAME_MAX 16 +#endif + +struct ufq_iosched_ops { + int (*init_sched)(struct request_queue *q); + int (*insert_req)(struct request_queue *q, struct request *rq, + blk_insert_t flags); + int (*exit_sched)(struct request_queue *q); + bool (*has_req)(struct request_queue *q, int rqs_count); + void (*req_merged)(struct request_queue *q, struct request *rq, int type); + void (*finish_req)(struct request *rq); + struct request *(*merge_req)(struct request_queue *q, struct request *rq, + int *type); + struct request *(*find_req_from_sector)(struct request_queue *q, + sector_t start, sector_t end); + struct request *(*former_req)(struct request_queue *q, struct request *rq); + struct request *(*next_req)(struct request_queue *q, struct request *rq); + struct request *(*dispatch_req)(struct request_queue *q); + char name[BPF_IOSCHED_NAME_MAX]; +}; +extern struct ufq_iosched_ops ufq_ops; + +int bpf_ufq_ops_init(void); +int bpf_ufq_kfunc_init(void); + +#endif /* _BLOCK_UFQ_IOSCHED_H */ diff --git a/block/ufq-kfunc.c b/block/ufq-kfunc.c new file mode 100644 index 0000000000000..35acc98fd9794 --- /dev/null +++ b/block/ufq-kfunc.c @@ -0,0 +1,91 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2026 KylinSoft Corporation. + * Copyright (c) 2026 Kaitao Cheng + */ +#include +#include +#include +#include +#include +#include +#include +#include "blk.h" +#include "ufq-iosched.h" + +__bpf_kfunc_start_defs(); + +__bpf_kfunc struct request *bpf_request_from_id(struct request_queue *q, + sector_t offset) +{ + return elv_rqhash_find(q, offset); +} + +__bpf_kfunc struct request *bpf_request_acquire(struct request *rq) +{ + if (req_ref_inc_not_zero(rq)) + return rq; + return NULL; +} + +__bpf_kfunc bool bpf_request_put(struct request *rq) +{ + if (req_ref_put_and_test(rq)) + return false; + + return true; +} + +__bpf_kfunc void bpf_request_release(struct request *rq) +{ + if (req_ref_put_and_test(rq)) + __blk_mq_free_request(rq); +} + +__bpf_kfunc_end_defs(); + +#if defined(CONFIG_X86_KERNEL_IBT) +static const void * const __used __section(".discard.ibt_endbr_noseal") +__ibt_noseal_bpf_request_release = (void *)bpf_request_release; +#endif + +BTF_KFUNCS_START(ufq_kfunc_set_ops) +BTF_ID_FLAGS(func, bpf_request_from_id, KF_RET_NULL) +BTF_ID_FLAGS(func, bpf_request_acquire, KF_ACQUIRE | KF_RET_NULL) +BTF_ID_FLAGS(func, bpf_request_put) +BTF_ID_FLAGS(func, bpf_request_release, KF_RELEASE) +BTF_KFUNCS_END(ufq_kfunc_set_ops) + +static const struct btf_kfunc_id_set bpf_ufq_kfunc_set = { + .owner = THIS_MODULE, + .set = &ufq_kfunc_set_ops, +}; + +BTF_ID_LIST(bpf_ufq_dtor_kfunc_ids) +BTF_ID(struct, request) +BTF_ID(func, bpf_request_release) + +int bpf_ufq_kfunc_init(void) +{ + int ret; + const struct btf_id_dtor_kfunc bpf_ufq_dtor_kfunc[] = { + { + .btf_id = bpf_ufq_dtor_kfunc_ids[0], + .kfunc_btf_id = bpf_ufq_dtor_kfunc_ids[1] + }, + }; + + ret = register_btf_kfunc_id_set(BPF_PROG_TYPE_STRUCT_OPS, &bpf_ufq_kfunc_set); + if (ret) + return ret; + ret = register_btf_kfunc_id_set(BPF_PROG_TYPE_SYSCALL, &bpf_ufq_kfunc_set); + if (ret) + return ret; + ret = register_btf_id_dtor_kfuncs(bpf_ufq_dtor_kfunc, + ARRAY_SIZE(bpf_ufq_dtor_kfunc), + THIS_MODULE); + if (ret) + return ret; + + return 0; +} diff --git a/tools/ufq_iosched/.gitignore b/tools/ufq_iosched/.gitignore new file mode 100644 index 0000000000000..d6264fe1c8cdb --- /dev/null +++ b/tools/ufq_iosched/.gitignore @@ -0,0 +1,2 @@ +tools/ +build/ diff --git a/tools/ufq_iosched/Makefile b/tools/ufq_iosched/Makefile new file mode 100644 index 0000000000000..7dc37d9172aac --- /dev/null +++ b/tools/ufq_iosched/Makefile @@ -0,0 +1,262 @@ +# SPDX-License-Identifier: GPL-2.0 +# Copyright (c) 2026 KylinSoft Corporation. +# Copyright (c) 2026 Kaitao Cheng +include ../build/Build.include +include ../scripts/Makefile.arch +include ../scripts/Makefile.include + +all: all_targets + +ifneq ($(LLVM),) +ifneq ($(filter %/,$(LLVM)),) +LLVM_PREFIX := $(LLVM) +else ifneq ($(filter -%,$(LLVM)),) +LLVM_SUFFIX := $(LLVM) +endif + +CLANG_TARGET_FLAGS_arm := arm-linux-gnueabi +CLANG_TARGET_FLAGS_arm64 := aarch64-linux-gnu +CLANG_TARGET_FLAGS_hexagon := hexagon-linux-musl +CLANG_TARGET_FLAGS_m68k := m68k-linux-gnu +CLANG_TARGET_FLAGS_mips := mipsel-linux-gnu +CLANG_TARGET_FLAGS_powerpc := powerpc64le-linux-gnu +CLANG_TARGET_FLAGS_riscv := riscv64-linux-gnu +CLANG_TARGET_FLAGS_s390 := s390x-linux-gnu +CLANG_TARGET_FLAGS_x86 := x86_64-linux-gnu +CLANG_TARGET_FLAGS := $(CLANG_TARGET_FLAGS_$(ARCH)) + +ifeq ($(CROSS_COMPILE),) +ifeq ($(CLANG_TARGET_FLAGS),) +$(error Specify CROSS_COMPILE or add '--target=' option to lib.mk) +else +CLANG_FLAGS += --target=$(CLANG_TARGET_FLAGS) +endif # CLANG_TARGET_FLAGS +else +CLANG_FLAGS += --target=$(notdir $(CROSS_COMPILE:%-=%)) +endif # CROSS_COMPILE + +CC := $(LLVM_PREFIX)clang$(LLVM_SUFFIX) $(CLANG_FLAGS) -fintegrated-as +else +CC := $(CROSS_COMPILE)gcc +endif # LLVM + +CURDIR := $(abspath .) +TOOLSDIR := $(abspath ..) +LIBDIR := $(TOOLSDIR)/lib +BPFDIR := $(LIBDIR)/bpf +TOOLSINCDIR := $(TOOLSDIR)/include +BPFTOOLDIR := $(TOOLSDIR)/bpf/bpftool +APIDIR := $(TOOLSINCDIR)/uapi +GENDIR := $(abspath ../../include/generated) +GENHDR := $(GENDIR)/autoconf.h + +ifeq ($(O),) +OUTPUT_DIR := $(CURDIR)/build +else +OUTPUT_DIR := $(O)/build +endif # O +OBJ_DIR := $(OUTPUT_DIR)/obj +INCLUDE_DIR := $(OUTPUT_DIR)/include +BPFOBJ_DIR := $(OBJ_DIR)/libbpf +UFQOBJ_DIR := $(OBJ_DIR)/ufq_iosched +BINDIR := $(OUTPUT_DIR)/bin +BPFOBJ := $(BPFOBJ_DIR)/libbpf.a +ifneq ($(CROSS_COMPILE),) +HOST_BUILD_DIR := $(OBJ_DIR)/host/obj +HOST_OUTPUT_DIR := $(OBJ_DIR)/host +HOST_INCLUDE_DIR := $(HOST_OUTPUT_DIR)/include +else +HOST_BUILD_DIR := $(OBJ_DIR) +HOST_OUTPUT_DIR := $(OUTPUT_DIR) +HOST_INCLUDE_DIR := $(INCLUDE_DIR) +endif +HOST_BPFOBJ := $(HOST_BUILD_DIR)/libbpf/libbpf.a +RESOLVE_BTFIDS := $(HOST_BUILD_DIR)/resolve_btfids/resolve_btfids +DEFAULT_BPFTOOL := $(HOST_OUTPUT_DIR)/sbin/bpftool + +VMLINUX_BTF_PATHS ?= $(if $(O),$(O)/vmlinux) \ + $(if $(KBUILD_OUTPUT),$(KBUILD_OUTPUT)/vmlinux) \ + ../../vmlinux \ + /sys/kernel/btf/vmlinux \ + /boot/vmlinux-$(shell uname -r) +VMLINUX_BTF ?= $(abspath $(firstword $(wildcard $(VMLINUX_BTF_PATHS)))) +ifeq ($(VMLINUX_BTF),) +$(error Cannot find a vmlinux for VMLINUX_BTF at any of "$(VMLINUX_BTF_PATHS)") +endif + +BPFTOOL ?= $(DEFAULT_BPFTOOL) + +ifneq ($(wildcard $(GENHDR)),) + GENFLAGS := -DHAVE_GENHDR +endif + +CFLAGS += -g -O2 -rdynamic -pthread -Wall -Werror $(GENFLAGS) \ + -I$(INCLUDE_DIR) -I$(GENDIR) -I$(LIBDIR) \ + -I$(TOOLSINCDIR) -I$(APIDIR) -I$(CURDIR)/include + +# Silence some warnings when compiled with clang +ifneq ($(LLVM),) +CFLAGS += -Wno-unused-command-line-argument +endif + +LDFLAGS += -lelf -lz -lpthread + +IS_LITTLE_ENDIAN = $(shell $(CC) -dM -E - &1 \ + | sed -n '/<...> search starts here:/,/End of search list./{ s| \(/.*\)|-idirafter \1|p }') \ +$(shell $(1) -dM -E - $@ +else + $(call msg,CP,,$@) + $(Q)cp "$(VMLINUX_H)" $@ +endif + +$(UFQOBJ_DIR)/%.bpf.o: %.bpf.c $(INCLUDE_DIR)/vmlinux.h include/ufq/*.h \ + | $(BPFOBJ) $(UFQOBJ_DIR) + $(call msg,CLNG-BPF,,$(notdir $@)) + $(Q)$(CLANG) $(BPF_CFLAGS) -target bpf -c $< -o $@ + +$(INCLUDE_DIR)/%.bpf.skel.h: $(UFQOBJ_DIR)/%.bpf.o $(INCLUDE_DIR)/vmlinux.h $(BPFTOOL) + $(eval sched=$(notdir $@)) + $(call msg,GEN-SKEL,,$(sched)) + $(Q)$(BPFTOOL) gen object $(<:.o=.linked1.o) $< + $(Q)$(BPFTOOL) gen object $(<:.o=.linked2.o) $(<:.o=.linked1.o) + $(Q)$(BPFTOOL) gen object $(<:.o=.linked3.o) $(<:.o=.linked2.o) + $(Q)diff $(<:.o=.linked2.o) $(<:.o=.linked3.o) + $(Q)$(BPFTOOL) gen skeleton $(<:.o=.linked3.o) name $(subst .bpf.skel.h,,$(sched)) > $@ + $(Q)$(BPFTOOL) gen subskeleton $(<:.o=.linked3.o) name $(subst .bpf.skel.h,,$(sched)) > $(@:.skel.h=.subskel.h) + +UFQ_COMMON_DEPS := include/ufq/common.h include/ufq/simple_stat.h | $(BINDIR) + +c-sched-targets = ufq_simple + +$(addprefix $(BINDIR)/,$(c-sched-targets)): \ + $(BINDIR)/%: \ + $(filter-out %.bpf.c,%.c) \ + $(INCLUDE_DIR)/%.bpf.skel.h \ + $(UFQ_COMMON_DEPS) + $(eval sched=$(notdir $@)) + $(CC) $(CFLAGS) -c $(sched).c -o $(UFQOBJ_DIR)/$(sched).o + $(CC) -o $@ $(UFQOBJ_DIR)/$(sched).o $(BPFOBJ) $(LDFLAGS) + +$(c-sched-targets): %: $(BINDIR)/% + +install: all + $(Q)mkdir -p $(DESTDIR)/usr/local/bin/ + $(Q)cp $(BINDIR)/* $(DESTDIR)/usr/local/bin/ + +clean: + rm -rf $(OUTPUT_DIR) $(HOST_OUTPUT_DIR) + rm -f *.o *.bpf.o *.bpf.skel.h *.bpf.subskel.h + rm -f $(c-sched-targets) + +help: + @echo 'Building targets' + @echo '================' + @echo '' + @echo ' all - Compile all schedulers' + @echo '' + @echo 'Alternatively, you may compile individual schedulers:' + @echo '' + @printf ' %s\n' $(c-sched-targets) + @echo '' + @echo 'For any scheduler build target, you may specify an alternative' + @echo 'build output path with the O= environment variable. For example:' + @echo '' + @echo ' O=/tmp/ufq_iosched make all' + @echo '' + @echo 'will compile all schedulers, and emit the build artifacts to' + @echo '/tmp/ufq_iosched/build.' + @echo '' + @echo '' + @echo 'Installing targets' + @echo '==================' + @echo '' + @echo ' install - Compile and install all schedulers to /usr/bin.' + @echo ' You may specify the DESTDIR= environment variable' + @echo ' to indicate a prefix for /usr/bin. For example:' + @echo '' + @echo ' DESTDIR=/tmp/ufq_iosched make install' + @echo '' + @echo ' will build the schedulers in CWD/build, and' + @echo ' install the schedulers to /tmp/ufq_iosched/usr/bin.' + @echo '' + @echo '' + @echo 'Cleaning targets' + @echo '================' + @echo '' + @echo ' clean - Remove all generated files' + +all_targets: $(c-sched-targets) + +.PHONY: all all_targets $(c-sched-targets) clean help + +# delete failed targets +.DELETE_ON_ERROR: + +# keep intermediate (.bpf.skel.h, .bpf.o, etc) targets +.SECONDARY: diff --git a/tools/ufq_iosched/README.md b/tools/ufq_iosched/README.md new file mode 100644 index 0000000000000..d831bae7a326b --- /dev/null +++ b/tools/ufq_iosched/README.md @@ -0,0 +1,136 @@ +UFQ IOSCHED EXAMPLE SCHEDULERS +============================ + +# Introduction + +This directory contains a simple example of the ufq IO scheduler. It is meant +to illustrate the different kinds of IO schedulers you can build with ufq; +new schedulers will be added as the project evolves across releases. + +# Compiling the examples + +There are a few toolchain dependencies for compiling the example schedulers. + +## Toolchain dependencies + +1. clang >= 16.0.0 + +The schedulers are BPF programs, and therefore must be compiled with clang. gcc +is actively working on adding a BPF backend compiler as well, but are still +missing some features such as BTF type tags which are necessary for using +kptrs. + +2. pahole >= 1.25 + +You may need pahole in order to generate BTF from DWARF. + +3. rust >= 1.70.0 + +Rust schedulers uses features present in the rust toolchain >= 1.70.0. You +should be able to use the stable build from rustup, but if that doesn't +work, try using the rustup nightly build. + +There are other requirements as well, such as make, but these are the main / +non-trivial ones. + +## Compiling the kernel + +In order to run a ufq scheduler, you'll have to run a kernel compiled +with the patches in this repository, and with a minimum set of necessary +Kconfig options: + +``` +CONFIG_BPF=y +CONFIG_IOSCHED_UFQ=y +CONFIG_BPF_SYSCALL=y +CONFIG_BPF_JIT=y +CONFIG_DEBUG_INFO_BTF=y +``` + +It's also recommended that you also include the following Kconfig options: + +``` +CONFIG_BPF_JIT_ALWAYS_ON=y +CONFIG_BPF_JIT_DEFAULT_ON=y +CONFIG_PAHOLE_HAS_SPLIT_BTF=y +CONFIG_PAHOLE_HAS_BTF_TAG=y +``` + +There is a `Kconfig` file in this directory whose contents you can append to +your local `.config` file, as long as there are no conflicts with any existing +options in the file. + +## Getting a vmlinux.h file + +You may notice that most of the example schedulers include a "vmlinux.h" file. +This is a large, auto-generated header file that contains all of the types +defined in some vmlinux binary that was compiled with +[BTF](https://docs.kernel.org/bpf/btf.html) (i.e. with the BTF-related Kconfig +options specified above). + +The header file is created using `bpftool`, by passing it a vmlinux binary +compiled with BTF as follows: + +```bash +$ bpftool btf dump file /path/to/vmlinux format c > vmlinux.h +``` + +`bpftool` analyzes all of the BTF encodings in the binary, and produces a +header file that can be included by BPF programs to access those types. For +example, using vmlinux.h allows a scheduler to access fields defined directly +in vmlinux + +The scheduler build system will generate this vmlinux.h file as part of the +scheduler build pipeline. It looks for a vmlinux file in the following +dependency order: + +1. If the O= environment variable is defined, at `$O/vmlinux` +2. If the KBUILD_OUTPUT= environment variable is defined, at + `$KBUILD_OUTPUT/vmlinux` +3. At `../../vmlinux` (i.e. at the root of the kernel tree where you're + compiling the schedulers) +3. `/sys/kernel/btf/vmlinux` +4. `/boot/vmlinux-$(uname -r)` + +In other words, if you have compiled a kernel in your local repo, its vmlinux +file will be used to generate vmlinux.h. Otherwise, it will be the vmlinux of +the kernel you're currently running on. This means that if you're running on a +kernel with ufq support, you may not need to compile a local kernel at +all. + +### Aside on CO-RE + +One of the cooler features of BPF is that it supports +[CO-RE](https://nakryiko.com/posts/bpf-core-reference-guide/) (Compile Once Run +Everywhere). This feature allows you to reference fields inside of structs with +types defined internal to the kernel, and not have to recompile if you load the +BPF program on a different kernel with the field at a different offset. + +## Compiling the schedulers + +Once you have your toolchain setup, and a vmlinux that can be used to generate +a full vmlinux.h file, you can compile the schedulers using `make`: + +```bash +$ make -j($nproc) +``` + +## ufq_simple + +A simple IO scheduler that provides an example of a minimal ufq scheduler. +Populates commonly used kernel-exposed BPF interfaces for testing the UFQ +scheduler framework in the kernel. + +### llvm: [OFF] + +You may see the following output when building the schedulers: + +``` +Auto-detecting system features: +... clang-bpf-co-re: [ on ] +... llvm: [ OFF ] +... libcap: [ on ] +... libbfd: [ on ] +``` + +Seeing `llvm: [ OFF ]` here is not an issue. You can safely ignore. diff --git a/tools/ufq_iosched/include/bpf-compat/gnu/stubs.h b/tools/ufq_iosched/include/bpf-compat/gnu/stubs.h new file mode 100644 index 0000000000000..f200ac0f6ccd1 --- /dev/null +++ b/tools/ufq_iosched/include/bpf-compat/gnu/stubs.h @@ -0,0 +1,12 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Dummy gnu/stubs.h. clang can end up including /usr/include/gnu/stubs.h when + * compiling BPF files although its content doesn't play any role. The file in + * turn includes stubs-64.h or stubs-32.h depending on whether __x86_64__ is + * defined. When compiling a BPF source, __x86_64__ isn't set and thus + * stubs-32.h is selected. However, the file is not there if the system doesn't + * have 32bit glibc devel package installed leading to a build failure. + * + * The problem is worked around by making this file available in the include + * search paths before the system one when building BPF. + */ diff --git a/tools/ufq_iosched/include/ufq/common.bpf.h b/tools/ufq_iosched/include/ufq/common.bpf.h new file mode 100644 index 0000000000000..96832d317464f --- /dev/null +++ b/tools/ufq_iosched/include/ufq/common.bpf.h @@ -0,0 +1,73 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright (c) 2026 KylinSoft Corporation. + * Copyright (c) 2026 Kaitao Cheng + */ +#ifndef __UFQ_COMMON_BPF_H +#define __UFQ_COMMON_BPF_H + +#ifdef LSP +#define __bpf__ +#include "../vmlinux/vmlinux.h" +#else +#include "vmlinux.h" +#endif + +#include +#include +#include +#include +#include "simple_stat.h" + +#define BPF_STRUCT_OPS(name, args...) \ + SEC("struct_ops/" #name) BPF_PROG(name, ##args) + +/* Define struct ufq_iosched_ops for .struct_ops.link in the BPF object */ +#define UFQ_OPS_DEFINE(__name, ...) \ + SEC(".struct_ops.link") \ + struct ufq_iosched_ops __name = { \ + __VA_ARGS__, \ + } + +/* list and rbtree */ +#define __contains(name, node) __attribute__((btf_decl_tag("contains:" #name ":" #node))) + +struct request *bpf_request_acquire(struct request *rq) __ksym; +bool bpf_request_put(struct request *rq) __ksym; +void bpf_request_release(struct request *rq) __ksym; + +void *bpf_obj_new_impl(__u64 local_type_id, void *meta) __ksym; +void bpf_obj_drop_impl(void *kptr, void *meta) __ksym; + +#define bpf_obj_new(type) ((type *)bpf_obj_new_impl(bpf_core_type_id_local(type), NULL)) +#define bpf_obj_drop(kptr) bpf_obj_drop_impl(kptr, NULL) + +int bpf_list_push_front_impl(struct bpf_list_head *head, + struct bpf_list_node *node, + void *meta, __u64 off) __ksym; +#define bpf_list_push_front(head, node) bpf_list_push_front_impl(head, node, NULL, 0) + +int bpf_list_push_back_impl(struct bpf_list_head *head, + struct bpf_list_node *node, + void *meta, __u64 off) __ksym; +#define bpf_list_push_back(head, node) bpf_list_push_back_impl(head, node, NULL, 0) + +struct bpf_list_node *bpf_list_pop_front(struct bpf_list_head *head) __ksym; +struct bpf_list_node *bpf_list_pop_back(struct bpf_list_head *head) __ksym; +bool bpf_list_empty(struct bpf_list_head *head) __ksym; +struct bpf_list_node *bpf_list_del(struct bpf_list_head *head, + struct bpf_list_node *node) __ksym; + +struct bpf_rb_node *bpf_rbtree_remove(struct bpf_rb_root *root, + struct bpf_rb_node *node) __ksym; +int bpf_rbtree_add_impl(struct bpf_rb_root *root, struct bpf_rb_node *node, + bool (less)(struct bpf_rb_node *a, const struct bpf_rb_node *b), + void *meta, __u64 off) __ksym; +#define bpf_rbtree_add(head, node, less) bpf_rbtree_add_impl(head, node, less, NULL, 0) + +struct bpf_rb_node *bpf_rbtree_first(struct bpf_rb_root *root) __ksym; + +void *bpf_refcount_acquire_impl(void *kptr, void *meta) __ksym; +#define bpf_refcount_acquire(kptr) bpf_refcount_acquire_impl(kptr, NULL) + +#endif /* __UFQ_COMMON_BPF_H */ diff --git a/tools/ufq_iosched/include/ufq/common.h b/tools/ufq_iosched/include/ufq/common.h new file mode 100644 index 0000000000000..c537c9e34056c --- /dev/null +++ b/tools/ufq_iosched/include/ufq/common.h @@ -0,0 +1,91 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright (c) 2026 KylinSoft Corporation. + * Copyright (c) 2026 Kaitao Cheng + */ +#ifndef __UFQ_IOSCHED_COMMON_H +#define __UFQ_IOSCHED_COMMON_H + +#ifdef __KERNEL__ +#error "Should not be included by BPF programs" +#endif + +#include +#include +#include +#include +#include +#include +#include "simple_stat.h" + +typedef uint8_t u8; +typedef uint16_t u16; +typedef uint32_t u32; +typedef uint64_t u64; +typedef int8_t s8; +typedef int16_t s16; +typedef int32_t s32; +typedef int64_t s64; + +#define UFQ_ERR(__fmt, ...) \ + do { \ + fprintf(stderr, "[UFQ_ERR] %s:%d", __FILE__, __LINE__); \ + if (errno) \ + fprintf(stderr, " (%s)\n", strerror(errno)); \ + else \ + fprintf(stderr, "\n"); \ + fprintf(stderr, __fmt __VA_OPT__(,) __VA_ARGS__); \ + fprintf(stderr, "\n"); \ + \ + exit(EXIT_FAILURE); \ + } while (0) + +#define UFQ_ERR_IF(__cond, __fmt, ...) \ + do { \ + if (__cond) \ + UFQ_ERR((__fmt) __VA_OPT__(,) __VA_ARGS__); \ + } while (0) + +/* + * struct ufq_iosched_ops can grow over time. With common.bpf.h::UFQ_OPS_DEFINE() + * and UFQ_OPS_LOAD()/UFQ_OPS_ATTACH(), libbpf performs struct_ops attachment. + */ +#define UFQ_OPS_OPEN(__ops_name, __ufq_name) ({ \ + struct __ufq_name *__skel; \ + \ + __skel = __ufq_name##__open(); \ + UFQ_ERR_IF(!__skel, "Could not open " #__ufq_name); \ + (void)__skel->maps.__ops_name; \ + __skel; \ +}) + +#define UFQ_OPS_LOAD(__skel, __ops_name, __ufq_name) ({ \ + (void)(__skel)->maps.__ops_name; \ + UFQ_ERR_IF(__ufq_name##__load((__skel)), "Failed to load skel"); \ +}) + +/* + * New versions of bpftool emit additional link placeholders for BPF maps, + * and set up BPF skeleton so libbpf can auto-attach BPF maps (v1.5+). Old + * libbpf ignores those links. Disable autoattach on newer libbpf to avoid + * attaching twice when we attach struct_ops explicitly. + */ +#if LIBBPF_MAJOR_VERSION > 1 || \ + (LIBBPF_MAJOR_VERSION == 1 && LIBBPF_MINOR_VERSION >= 5) +#define __UFQ_OPS_DISABLE_AUTOATTACH(__skel, __ops_name) \ + bpf_map__set_autoattach((__skel)->maps.__ops_name, false) +#else +#define __UFQ_OPS_DISABLE_AUTOATTACH(__skel, __ops_name) do {} while (0) +#endif + +#define UFQ_OPS_ATTACH(__skel, __ops_name, __ufq_name) ({ \ + struct bpf_link *__link; \ + __UFQ_OPS_DISABLE_AUTOATTACH(__skel, __ops_name); \ + UFQ_ERR_IF(__ufq_name##__attach((__skel)), "Failed to attach skel"); \ + __link = bpf_map__attach_struct_ops((__skel)->maps.__ops_name); \ + UFQ_ERR_IF(!__link, "Failed to attach struct_ops"); \ + __link; \ +}) + +#endif /* __UFQ_IOSCHED_COMMON_H */ + diff --git a/tools/ufq_iosched/include/ufq/simple_stat.h b/tools/ufq_iosched/include/ufq/simple_stat.h new file mode 100644 index 0000000000000..286d5999a457a --- /dev/null +++ b/tools/ufq_iosched/include/ufq/simple_stat.h @@ -0,0 +1,21 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright (c) 2026 KylinSoft Corporation. + * Copyright (c) 2026 Kaitao Cheng + */ +#ifndef __UFQ_SIMPLE_STAT_H +#define __UFQ_SIMPLE_STAT_H + +enum ufq_simp_stat_index { + UFQ_SIMP_INSERT_CNT, + UFQ_SIMP_INSERT_SIZE, + UFQ_SIMP_DISPATCH_CNT, + UFQ_SIMP_DISPATCH_SIZE, + UFQ_SIMP_MERGE_CNT, + UFQ_SIMP_MERGE_SIZE, + UFQ_SIMP_FINISH_CNT, + UFQ_SIMP_FINISH_SIZE, + UFQ_SIMP_STAT_MAX, +}; + +#endif /* __UFQ_SIMPLE_STAT_H */ diff --git a/tools/ufq_iosched/ufq_simple.bpf.c b/tools/ufq_iosched/ufq_simple.bpf.c new file mode 100644 index 0000000000000..63edd77726009 --- /dev/null +++ b/tools/ufq_iosched/ufq_simple.bpf.c @@ -0,0 +1,445 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2026 KylinSoft Corporation. + * Copyright (c) 2026 Kaitao Cheng + */ +#include + +char _license[] SEC("license") = "GPL"; + +#define UFQ_DISK_SUM 20 +#define BLK_MQ_INSERT_AT_HEAD 0x01 +#define REQ_OP_MASK ((1 << 8) - 1) +#define SECTOR_SHIFT 9 + +struct { + __uint(type, BPF_MAP_TYPE_PERCPU_ARRAY); + __uint(key_size, sizeof(u32)); + __uint(value_size, sizeof(u64)); + __uint(max_entries, UFQ_SIMP_STAT_MAX); +} stats SEC(".maps"); + +enum ufq_simp_data_dir { + UFQ_SIMP_READ, + UFQ_SIMP_WRITE, + UFQ_SIMP_DIR_COUNT +}; + +struct queue_list_node { + struct bpf_list_node node; + struct request __kptr * req; +}; + +struct sort_tree_node { + struct bpf_refcount ref; + struct bpf_rb_node rb_node; + struct bpf_list_node list_node; + u64 key; + struct request __kptr * req; +}; + +struct ufq_simple_data { + struct bpf_spin_lock lock; + struct bpf_rb_root sort_tree_read __contains(sort_tree_node, rb_node); + struct bpf_rb_root sort_tree_write __contains(sort_tree_node, rb_node); + struct bpf_list_head dispatch __contains(queue_list_node, node); + struct bpf_list_head fifo_list __contains(sort_tree_node, list_node); +}; + +struct { + __uint(type, BPF_MAP_TYPE_HASH); + __uint(max_entries, UFQ_DISK_SUM); + __type(key, s32); + __type(value, struct ufq_simple_data); +} ufq_map SEC(".maps"); + +static void stat_add(u32 idx, u32 val) +{ + u64 *cnt_p = bpf_map_lookup_elem(&stats, &idx); + + if (cnt_p) + (*cnt_p) += val; +} + +static void stat_sub(u32 idx, u32 val) +{ + u64 *cnt_p = bpf_map_lookup_elem(&stats, &idx); + + if (cnt_p) + (*cnt_p) -= val; +} + +static bool sort_tree_less(struct bpf_rb_node *a, const struct bpf_rb_node *b) +{ + struct sort_tree_node *node_a, *node_b; + + node_a = container_of(a, struct sort_tree_node, rb_node); + node_b = container_of(b, struct sort_tree_node, rb_node); + + return node_a->key < node_b->key; +} + +static struct ufq_simple_data *dd_init_sched(struct request_queue *q) +{ + struct ufq_simple_data ufq_sd = {}, *ufq_sp; + int ret, id = q->id; + + bpf_printk("ufq_simple init sched!"); + ret = bpf_map_update_elem(&ufq_map, &id, &ufq_sd, BPF_NOEXIST); + if (ret) { + bpf_printk("ufq_simple/init_sched: update ufq_map err %d", ret); + return NULL; + } + + ufq_sp = bpf_map_lookup_elem(&ufq_map, &id); + if (!ufq_sp) { + bpf_printk("ufq_simple/init_sched: lookup queue id %d in ufq_map failed", id); + return NULL; + } + + return ufq_sp; +} + +int BPF_STRUCT_OPS(ufq_simple_init_sched, struct request_queue *q) +{ + if (dd_init_sched(q)) + return 0; + else + return -EPERM; +} + +int BPF_STRUCT_OPS(ufq_simple_exit_sched, struct request_queue *q) +{ + int id = q->id; + + bpf_printk("ufq_simple exit sched!"); + bpf_map_delete_elem(&ufq_map, &id); + return 0; +} + +int BPF_STRUCT_OPS(ufq_simple_insert_req, struct request_queue *q, + struct request *rq, blk_insert_t flags, + struct list_head *freeq) +{ + struct ufq_simple_data *ufq_sd; + struct queue_list_node *qnode; + struct sort_tree_node *snode, *lnode; + int id = q->id, ret = 0; + struct request *acquired, *old; + enum ufq_simp_data_dir dir = ((rq->cmd_flags & REQ_OP_MASK) & 1) ? + UFQ_SIMP_WRITE : UFQ_SIMP_READ; + + ufq_sd = bpf_map_lookup_elem(&ufq_map, &id); + if (!ufq_sd) { + ufq_sd = dd_init_sched(q); + if (!ufq_sd) { + bpf_printk("ufq_simple/insert_req: dd_init_sched failed"); + return -EPERM; + } + } + + if (flags & BLK_MQ_INSERT_AT_HEAD) { + /* create queue_list_node */ + qnode = bpf_obj_new(typeof(*qnode)); + if (!qnode) { + bpf_printk("ufq_simple/insert_req: qnode alloc failed"); + return -ENOMEM; + } + + acquired = bpf_request_acquire(rq); + if (!acquired) { + bpf_obj_drop(qnode); + bpf_printk("ufq_simple/head-insert_req: request_acquire failed"); + return -EPERM; + } + + /* Set request for queue_list_node */ + old = bpf_kptr_xchg(&qnode->req, acquired); + if (old) + bpf_request_release(old); + + /* Add queue_list_node to dispatch list */ + bpf_spin_lock(&ufq_sd->lock); + ret = bpf_list_push_back(&ufq_sd->dispatch, &qnode->node); + bpf_spin_unlock(&ufq_sd->lock); + } else { + /* create sort_tree_node */ + snode = bpf_obj_new(typeof(*snode)); + if (!snode) { + bpf_printk("ufq_simple/insert_req: sort_tree_node alloc failed"); + return -ENOMEM; + } + + /* Use request's starting sector as sort key */ + snode->key = rq->__sector; + + /* + * Acquire request reference again for sort_tree_node (each node + * needs independent reference) + */ + acquired = bpf_request_acquire(rq); + if (!acquired) { + bpf_obj_drop(snode); + bpf_printk("ufq_simple/insert_req: bpf_request_acquire failed"); + return -EPERM; + } + + /* Set request for sort_tree_node */ + old = bpf_kptr_xchg(&snode->req, acquired); + if (old) + bpf_request_release(old); + + /* Add sort_tree_node to red-black tree and list_node to fifo_list */ + bpf_spin_lock(&ufq_sd->lock); + if (dir == UFQ_SIMP_READ) + bpf_rbtree_add(&ufq_sd->sort_tree_read, &snode->rb_node, sort_tree_less); + else + bpf_rbtree_add(&ufq_sd->sort_tree_write, &snode->rb_node, sort_tree_less); + + /* Acquire reference count since the node is also added to fifo_list */ + lnode = bpf_refcount_acquire(snode); + if (!lnode) { + struct bpf_rb_root *tree = (dir == UFQ_SIMP_READ) ? + &ufq_sd->sort_tree_read : &ufq_sd->sort_tree_write; + struct bpf_rb_node *rb_node; + + rb_node = bpf_rbtree_remove(tree, &snode->rb_node); + bpf_spin_unlock(&ufq_sd->lock); + if (rb_node) + bpf_obj_drop(container_of(rb_node, struct sort_tree_node, rb_node)); + bpf_printk("ufq_simple/insert_req: bpf_refcount_acquire failed"); + return -EPERM; + } + + ret = bpf_list_push_back(&ufq_sd->fifo_list, &lnode->list_node); + bpf_spin_unlock(&ufq_sd->lock); + } + + if (!ret) { + stat_add(UFQ_SIMP_INSERT_CNT, 1); + stat_add(UFQ_SIMP_INSERT_SIZE, rq->__data_len); + } + return ret; +} + +struct request *BPF_STRUCT_OPS(ufq_simple_dispatch_req, struct request_queue *q) +{ + struct request *rq = NULL; + struct bpf_list_node *list_node; + struct bpf_rb_node *rb_node = NULL; + struct queue_list_node *qnode; + struct sort_tree_node *snode, *lnode; + struct ufq_simple_data *ufq_sd; + int id = q->id; + + ufq_sd = bpf_map_lookup_elem(&ufq_map, &id); + if (!ufq_sd) { + bpf_printk("ufq_simple/dispatch_req: ufq_map lookup %d failed", id); + return NULL; + } + + bpf_spin_lock(&ufq_sd->lock); + list_node = bpf_list_pop_front(&ufq_sd->dispatch); + + if (list_node) { + qnode = container_of(list_node, struct queue_list_node, node); + rq = bpf_kptr_xchg(&qnode->req, NULL); + bpf_spin_unlock(&ufq_sd->lock); + bpf_obj_drop(qnode); + } else { + rb_node = bpf_rbtree_first(&ufq_sd->sort_tree_read); + if (rb_node) { + rb_node = bpf_rbtree_remove(&ufq_sd->sort_tree_read, rb_node); + } else { + rb_node = bpf_rbtree_first(&ufq_sd->sort_tree_write); + if (rb_node) + rb_node = bpf_rbtree_remove(&ufq_sd->sort_tree_write, rb_node); + } + + if (!rb_node) { + bpf_spin_unlock(&ufq_sd->lock); + goto out; + } + + snode = container_of(rb_node, struct sort_tree_node, rb_node); + + /* Get request from sort_tree_node (this will be returned) */ + rq = bpf_kptr_xchg(&snode->req, NULL); + + /* Remove list_node from fifo_list (must be done while holding lock) */ + list_node = bpf_list_del(&ufq_sd->fifo_list, &snode->list_node); + bpf_spin_unlock(&ufq_sd->lock); + + if (list_node) { + lnode = container_of(list_node, struct sort_tree_node, list_node); + bpf_obj_drop(lnode); + } + bpf_obj_drop(snode); + } + if (!rq) + bpf_printk("ufq_simple/dispatch_req: no request to dispatch"); + +out: + if (rq) { + stat_add(UFQ_SIMP_DISPATCH_CNT, 1); + stat_add(UFQ_SIMP_DISPATCH_SIZE, rq->__data_len); + } + + return rq; +} + +bool BPF_STRUCT_OPS(ufq_simple_has_req, struct request_queue *q, int rqs_count) +{ + struct ufq_simple_data *ufq_sd; + bool has; + int id = q->id; + + ufq_sd = bpf_map_lookup_elem(&ufq_map, &id); + if (!ufq_sd) { + bpf_printk("ufq_simple/has_req: ufq_map lookup %d failed", id); + return false; + } + + bpf_spin_lock(&ufq_sd->lock); + has = !bpf_list_empty(&ufq_sd->dispatch) || + bpf_rbtree_root(&ufq_sd->sort_tree_read) || + bpf_rbtree_root(&ufq_sd->sort_tree_write); + bpf_spin_unlock(&ufq_sd->lock); + + return has; +} + +void BPF_STRUCT_OPS(ufq_simple_finish_req, struct request *rq) +{ + if (rq) { + stat_add(UFQ_SIMP_FINISH_CNT, 1); + stat_add(UFQ_SIMP_FINISH_SIZE, rq->__data_len); + bpf_request_put(rq); + } +} + +struct request *BPF_STRUCT_OPS(ufq_simple_next_req, struct request_queue *q, + struct request *rq) +{ + return NULL; +} + +struct request *BPF_STRUCT_OPS(ufq_simple_former_req, struct request_queue *q, + struct request *rq) +{ + return NULL; +} + +struct request *BPF_STRUCT_OPS(ufq_simple_merge_req, struct request_queue *q, + struct request *rq, int *type) +{ + struct sort_tree_node *snode = NULL, *lnode = NULL; + sector_t rq_start, rq_end, other_start, other_end; + enum elv_merge mt = ELEVATOR_NO_MERGE; + struct bpf_list_node *list_node = NULL; + struct bpf_rb_node *rb_node = NULL; + struct ufq_simple_data *ufq_sd; + struct request *targ = NULL; + enum ufq_simp_data_dir dir; + struct bpf_rb_root *tree; + int id = q->id; + int count = 0; + + *type = ELEVATOR_NO_MERGE; + dir = ((rq->cmd_flags & REQ_OP_MASK) & 1) ? UFQ_SIMP_WRITE : UFQ_SIMP_READ; + ufq_sd = bpf_map_lookup_elem(&ufq_map, &id); + if (!ufq_sd) + return NULL; + + /* Calculate current request position and end */ + rq_start = rq->__sector; + rq_end = rq_start + (rq->__data_len >> SECTOR_SHIFT); + + if (dir == UFQ_SIMP_READ) + tree = &ufq_sd->sort_tree_read; + else + tree = &ufq_sd->sort_tree_write; + + bpf_spin_lock(&ufq_sd->lock); + rb_node = bpf_rbtree_root(tree); + if (!rb_node) { + bpf_spin_unlock(&ufq_sd->lock); + return NULL; + } + + while (mt == ELEVATOR_NO_MERGE && rb_node && count < 100) { + count++; + snode = container_of(rb_node, struct sort_tree_node, rb_node); + targ = bpf_kptr_xchg(&snode->req, NULL); + if (!targ) + break; + + other_start = targ->__sector; + other_end = other_start + (targ->__data_len >> SECTOR_SHIFT); + + targ = bpf_kptr_xchg(&snode->req, targ); + if (targ) { + bpf_spin_unlock(&ufq_sd->lock); + bpf_request_release(targ); + return NULL; + } + + if (rq_start > other_end) + rb_node = bpf_rbtree_right(tree, rb_node); + else if (rq_end < other_start) + rb_node = bpf_rbtree_left(tree, rb_node); + else if (rq_end == other_start) + mt = ELEVATOR_FRONT_MERGE; + else if (other_end == rq_start) + mt = ELEVATOR_BACK_MERGE; + else + break; + + if (mt) { + rb_node = bpf_rbtree_remove(tree, rb_node); + if (rb_node) { + snode = container_of(rb_node, + struct sort_tree_node, rb_node); + targ = bpf_kptr_xchg(&snode->req, NULL); + + list_node = bpf_list_del(&ufq_sd->fifo_list, + &snode->list_node); + bpf_spin_unlock(&ufq_sd->lock); + if (targ) { + *type = mt; + stat_add(UFQ_SIMP_MERGE_CNT, 1); + stat_add(UFQ_SIMP_MERGE_SIZE, targ->__data_len); + stat_sub(UFQ_SIMP_INSERT_CNT, 1); + stat_sub(UFQ_SIMP_INSERT_SIZE, targ->__data_len); + } + + if (list_node) { + lnode = container_of(list_node, + struct sort_tree_node, list_node); + bpf_obj_drop(lnode); + } + + bpf_obj_drop(snode); + } else { + bpf_spin_unlock(&ufq_sd->lock); + *type = ELEVATOR_NO_MERGE; + } + return targ; + } + } + bpf_spin_unlock(&ufq_sd->lock); + + return NULL; +} + +UFQ_OPS_DEFINE(ufq_simple_ops, + .init_sched = (void *)ufq_simple_init_sched, + .exit_sched = (void *)ufq_simple_exit_sched, + .insert_req = (void *)ufq_simple_insert_req, + .dispatch_req = (void *)ufq_simple_dispatch_req, + .has_req = (void *)ufq_simple_has_req, + .finish_req = (void *)ufq_simple_finish_req, + .next_req = (void *)ufq_simple_next_req, + .former_req = (void *)ufq_simple_former_req, + .merge_req = (void *)ufq_simple_merge_req, + .name = "ufq_simple"); diff --git a/tools/ufq_iosched/ufq_simple.c b/tools/ufq_iosched/ufq_simple.c new file mode 100644 index 0000000000000..3e043e4754614 --- /dev/null +++ b/tools/ufq_iosched/ufq_simple.c @@ -0,0 +1,118 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2026 KylinSoft Corporation. + * Copyright (c) 2026 Kaitao Cheng + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include "ufq_simple.bpf.skel.h" + +const char help_fmt[] = +"A simple ufq scheduler.\n" +"\n" +"Usage: %s [-v] [-d] [-h]\n" +"\n" +" -v Print version\n" +" -d Print libbpf debug messages\n" +" -h Display this help and exit\n"; + +#define UFQ_SIMPLE_VERSION "0.1.0" +#define TIME_INTERVAL 3 +static bool verbose; +static volatile int exit_req; +__u64 old_stats[UFQ_SIMP_STAT_MAX]; + +static int libbpf_print_fn(enum libbpf_print_level level, const char *format, va_list args) +{ + if (level == LIBBPF_DEBUG && !verbose) + return 0; + return vfprintf(stderr, format, args); +} + +static void sigint_handler(int simple) +{ + exit_req = 1; +} + +static void read_stats(struct ufq_simple *skel, __u64 *stats) +{ + int nr_cpus = libbpf_num_possible_cpus(); + __u64 cnts[UFQ_SIMP_STAT_MAX][nr_cpus]; + __u32 idx; + + memset(stats, 0, sizeof(stats[0]) * UFQ_SIMP_STAT_MAX); + + for (idx = 0; idx < UFQ_SIMP_STAT_MAX; idx++) { + int ret, cpu; + + ret = bpf_map_lookup_elem(bpf_map__fd(skel->maps.stats), + &idx, cnts[idx]); + if (ret < 0) + continue; + for (cpu = 0; cpu < nr_cpus; cpu++) + stats[idx] += cnts[idx][cpu]; + } +} + +int main(int argc, char **argv) +{ + struct ufq_simple *skel; + struct bpf_link *link; + __u32 opt; + + libbpf_set_print(libbpf_print_fn); + signal(SIGINT, sigint_handler); + signal(SIGTERM, sigint_handler); + + skel = UFQ_OPS_OPEN(ufq_simple_ops, ufq_simple); + + while ((opt = getopt(argc, argv, "vdh")) != -1) { + switch (opt) { + case 'v': + printf("ufq_simple version: %s\n", UFQ_SIMPLE_VERSION); + return 0; + case 'd': + verbose = true; + break; + default: + fprintf(stderr, help_fmt, basename(argv[0])); + return opt != 'h'; + } + } + + UFQ_OPS_LOAD(skel, ufq_simple_ops, ufq_simple); + link = UFQ_OPS_ATTACH(skel, ufq_simple_ops, ufq_simple); + + printf("ufq_simple loop ...\n"); + while (!exit_req) { + __u64 stats[UFQ_SIMP_STAT_MAX]; + + printf("--------------------------------\n"); + read_stats(skel, stats); + printf("bps:%lluk iops:%llu\n", + (stats[UFQ_SIMP_FINISH_SIZE] - + old_stats[UFQ_SIMP_FINISH_SIZE]) / 1024 / TIME_INTERVAL, + (stats[UFQ_SIMP_FINISH_CNT] - + old_stats[UFQ_SIMP_FINISH_CNT]) / TIME_INTERVAL); + printf("(insert: cnt=%llu size=%llu) (merge: cnt=%llu size=%llu)\n", + stats[UFQ_SIMP_INSERT_CNT], stats[UFQ_SIMP_INSERT_SIZE], + stats[UFQ_SIMP_MERGE_CNT], stats[UFQ_SIMP_MERGE_SIZE]); + printf("(dispatch: cnt=%llu size=%llu) (finish: cnt=%llu size=%llu)\n", + stats[UFQ_SIMP_DISPATCH_CNT], stats[UFQ_SIMP_DISPATCH_SIZE], + stats[UFQ_SIMP_FINISH_CNT], stats[UFQ_SIMP_FINISH_SIZE]); + memcpy(old_stats, stats, sizeof(old_stats)); + sleep(TIME_INTERVAL); + } + + printf("ufq_simple loop exit ...\n"); + bpf_link__destroy(link); + ufq_simple__destroy(skel); + + return 0; +}