[mirror_ubuntu-hirsute-kernel.git] / block / blk-mq-sysfs.c

// SPDX-License-Identifier: GPL-2.0
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/backing-dev.h>
#include <linux/bio.h>
#include <linux/blkdev.h>
#include <linux/mm.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/workqueue.h>
#include <linux/smp.h>

#include <linux/blk-mq.h>
#include "blk.h"
#include "blk-mq.h"
#include "blk-mq-tag.h"

static void blk_mq_sysfs_release(struct kobject *kobj)
{
	struct blk_mq_ctxs *ctxs = container_of(kobj, struct blk_mq_ctxs, kobj);

	free_percpu(ctxs->queue_ctx);
	kfree(ctxs);
}

static void blk_mq_ctx_sysfs_release(struct kobject *kobj)
{
	struct blk_mq_ctx *ctx = container_of(kobj, struct blk_mq_ctx, kobj);

	/* ctx->ctxs won't be released until all ctx are freed */
	kobject_put(&ctx->ctxs->kobj);
}

static void blk_mq_hw_sysfs_release(struct kobject *kobj)
{
	struct blk_mq_hw_ctx *hctx = container_of(kobj, struct blk_mq_hw_ctx,
						  kobj);

	if (hctx->flags & BLK_MQ_F_BLOCKING)
		cleanup_srcu_struct(hctx->srcu);
	blk_free_flush_queue(hctx->fq);
	sbitmap_free(&hctx->ctx_map);
	free_cpumask_var(hctx->cpumask);
	kfree(hctx->ctxs);
	kfree(hctx);
}

struct blk_mq_ctx_sysfs_entry {
	struct attribute attr;
	ssize_t (*show)(struct blk_mq_ctx *, char *);
	ssize_t (*store)(struct blk_mq_ctx *, const char *, size_t);
};

struct blk_mq_hw_ctx_sysfs_entry {
	struct attribute attr;
	ssize_t (*show)(struct blk_mq_hw_ctx *, char *);
	ssize_t (*store)(struct blk_mq_hw_ctx *, const char *, size_t);
};

static ssize_t blk_mq_sysfs_show(struct kobject *kobj, struct attribute *attr,
				 char *page)
{
	struct blk_mq_ctx_sysfs_entry *entry;
	struct blk_mq_ctx *ctx;
	struct request_queue *q;
	ssize_t res;

	entry = container_of(attr, struct blk_mq_ctx_sysfs_entry, attr);
	ctx = container_of(kobj, struct blk_mq_ctx, kobj);
	q = ctx->queue;

	if (!entry->show)
		return -EIO;

	mutex_lock(&q->sysfs_lock);
	res = entry->show(ctx, page);
	mutex_unlock(&q->sysfs_lock);
	return res;
}

static ssize_t blk_mq_sysfs_store(struct kobject *kobj, struct attribute *attr,
				  const char *page, size_t length)
{
	struct blk_mq_ctx_sysfs_entry *entry;
	struct blk_mq_ctx *ctx;
	struct request_queue *q;
	ssize_t res;

	entry = container_of(attr, struct blk_mq_ctx_sysfs_entry, attr);
	ctx = container_of(kobj, struct blk_mq_ctx, kobj);
	q = ctx->queue;

	if (!entry->store)
		return -EIO;

	mutex_lock(&q->sysfs_lock);
	res = entry->store(ctx, page, length);
	mutex_unlock(&q->sysfs_lock);
	return res;
}

static ssize_t blk_mq_hw_sysfs_show(struct kobject *kobj,
				    struct attribute *attr, char *page)
{
	struct blk_mq_hw_ctx_sysfs_entry *entry;
	struct blk_mq_hw_ctx *hctx;
	struct request_queue *q;
	ssize_t res;

	entry = container_of(attr, struct blk_mq_hw_ctx_sysfs_entry, attr);
	hctx = container_of(kobj, struct blk_mq_hw_ctx, kobj);
	q = hctx->queue;

	if (!entry->show)
		return -EIO;

	mutex_lock(&q->sysfs_lock);
	res = entry->show(hctx, page);
	mutex_unlock(&q->sysfs_lock);
	return res;
}

static ssize_t blk_mq_hw_sysfs_store(struct kobject *kobj,
				     struct attribute *attr, const char *page,
				     size_t length)
{
	struct blk_mq_hw_ctx_sysfs_entry *entry;
	struct blk_mq_hw_ctx *hctx;
	struct request_queue *q;
	ssize_t res;

	entry = container_of(attr, struct blk_mq_hw_ctx_sysfs_entry, attr);
	hctx = container_of(kobj, struct blk_mq_hw_ctx, kobj);
	q = hctx->queue;

	if (!entry->store)
		return -EIO;

	mutex_lock(&q->sysfs_lock);
	res = entry->store(hctx, page, length);
	mutex_unlock(&q->sysfs_lock);
	return res;
}

static ssize_t blk_mq_hw_sysfs_nr_tags_show(struct blk_mq_hw_ctx *hctx,
					    char *page)
{
	return sprintf(page, "%u\n", hctx->tags->nr_tags);
}

static ssize_t blk_mq_hw_sysfs_nr_reserved_tags_show(struct blk_mq_hw_ctx *hctx,
						     char *page)
{
	return sprintf(page, "%u\n", hctx->tags->nr_reserved_tags);
}

static ssize_t blk_mq_hw_sysfs_cpus_show(struct blk_mq_hw_ctx *hctx, char *page)
{
	const size_t size = PAGE_SIZE - 1;
	unsigned int i, first = 1;
	int ret = 0, pos = 0;

	for_each_cpu(i, hctx->cpumask) {
		if (first)
			ret = snprintf(pos + page, size - pos, "%u", i);
		else
			ret = snprintf(pos + page, size - pos, ", %u", i);

		if (ret >= size - pos)
			break;

		first = 0;
		pos += ret;
	}

	ret = snprintf(pos + page, size + 1 - pos, "\n");
	return pos + ret;
}

static struct blk_mq_hw_ctx_sysfs_entry blk_mq_hw_sysfs_nr_tags = {
	.attr = {.name = "nr_tags", .mode = 0444 },
	.show = blk_mq_hw_sysfs_nr_tags_show,
};
static struct blk_mq_hw_ctx_sysfs_entry blk_mq_hw_sysfs_nr_reserved_tags = {
	.attr = {.name = "nr_reserved_tags", .mode = 0444 },
	.show = blk_mq_hw_sysfs_nr_reserved_tags_show,
};
static struct blk_mq_hw_ctx_sysfs_entry blk_mq_hw_sysfs_cpus = {
	.attr = {.name = "cpu_list", .mode = 0444 },
	.show = blk_mq_hw_sysfs_cpus_show,
};

static struct attribute *default_hw_ctx_attrs[] = {
	&blk_mq_hw_sysfs_nr_tags.attr,
	&blk_mq_hw_sysfs_nr_reserved_tags.attr,
	&blk_mq_hw_sysfs_cpus.attr,
	NULL,
};
ATTRIBUTE_GROUPS(default_hw_ctx);

static const struct sysfs_ops blk_mq_sysfs_ops = {
	.show	= blk_mq_sysfs_show,
	.store	= blk_mq_sysfs_store,
};

static const struct sysfs_ops blk_mq_hw_sysfs_ops = {
	.show	= blk_mq_hw_sysfs_show,
	.store	= blk_mq_hw_sysfs_store,
};

static struct kobj_type blk_mq_ktype = {
	.sysfs_ops	= &blk_mq_sysfs_ops,
	.release	= blk_mq_sysfs_release,
};

static struct kobj_type blk_mq_ctx_ktype = {
	.sysfs_ops	= &blk_mq_sysfs_ops,
	.release	= blk_mq_ctx_sysfs_release,
};

static struct kobj_type blk_mq_hw_ktype = {
	.sysfs_ops	= &blk_mq_hw_sysfs_ops,
	.default_groups = default_hw_ctx_groups,
	.release	= blk_mq_hw_sysfs_release,
};

static void blk_mq_unregister_hctx(struct blk_mq_hw_ctx *hctx)
{
	struct blk_mq_ctx *ctx;
	int i;

	if (!hctx->nr_ctx)
		return;

	hctx_for_each_ctx(hctx, ctx, i)
		kobject_del(&ctx->kobj);

	kobject_del(&hctx->kobj);
}

static int blk_mq_register_hctx(struct blk_mq_hw_ctx *hctx)
{
	struct request_queue *q = hctx->queue;
	struct blk_mq_ctx *ctx;
	int i, ret;

	if (!hctx->nr_ctx)
		return 0;

	ret = kobject_add(&hctx->kobj, q->mq_kobj, "%u", hctx->queue_num);
	if (ret)
		return ret;

	hctx_for_each_ctx(hctx, ctx, i) {
		ret = kobject_add(&ctx->kobj, &hctx->kobj, "cpu%u", ctx->cpu);
		if (ret)
			break;
	}

	return ret;
}

void blk_mq_unregister_dev(struct device *dev, struct request_queue *q)
{
	struct blk_mq_hw_ctx *hctx;
	int i;

	lockdep_assert_held(&q->sysfs_dir_lock);

	queue_for_each_hw_ctx(q, hctx, i)
		blk_mq_unregister_hctx(hctx);

	kobject_uevent(q->mq_kobj, KOBJ_REMOVE);
	kobject_del(q->mq_kobj);
	kobject_put(&dev->kobj);

	q->mq_sysfs_init_done = false;
}

void blk_mq_hctx_kobj_init(struct blk_mq_hw_ctx *hctx)
{
	kobject_init(&hctx->kobj, &blk_mq_hw_ktype);
}

void blk_mq_sysfs_deinit(struct request_queue *q)
{
	struct blk_mq_ctx *ctx;
	int cpu;

	for_each_possible_cpu(cpu) {
		ctx = per_cpu_ptr(q->queue_ctx, cpu);
		kobject_put(&ctx->kobj);
	}
	kobject_put(q->mq_kobj);
}

void blk_mq_sysfs_init(struct request_queue *q)
{
	struct blk_mq_ctx *ctx;
	int cpu;

	kobject_init(q->mq_kobj, &blk_mq_ktype);

	for_each_possible_cpu(cpu) {
		ctx = per_cpu_ptr(q->queue_ctx, cpu);

		kobject_get(q->mq_kobj);
		kobject_init(&ctx->kobj, &blk_mq_ctx_ktype);
	}
}

int __blk_mq_register_dev(struct device *dev, struct request_queue *q)
{
	struct blk_mq_hw_ctx *hctx;
	int ret, i;

	WARN_ON_ONCE(!q->kobj.parent);
	lockdep_assert_held(&q->sysfs_dir_lock);

	ret = kobject_add(q->mq_kobj, kobject_get(&dev->kobj), "%s", "mq");
	if (ret < 0)
		goto out;

	kobject_uevent(q->mq_kobj, KOBJ_ADD);

	queue_for_each_hw_ctx(q, hctx, i) {
		ret = blk_mq_register_hctx(hctx);
		if (ret)
			goto unreg;
	}

	q->mq_sysfs_init_done = true;

out:
	return ret;

unreg:
	while (--i >= 0)
		blk_mq_unregister_hctx(q->queue_hw_ctx[i]);

	kobject_uevent(q->mq_kobj, KOBJ_REMOVE);
	kobject_del(q->mq_kobj);
	kobject_put(&dev->kobj);
	return ret;
}

void blk_mq_sysfs_unregister(struct request_queue *q)
{
	struct blk_mq_hw_ctx *hctx;
	int i;

	mutex_lock(&q->sysfs_dir_lock);
	if (!q->mq_sysfs_init_done)
		goto unlock;

	queue_for_each_hw_ctx(q, hctx, i)
		blk_mq_unregister_hctx(hctx);

unlock:
	mutex_unlock(&q->sysfs_dir_lock);
}

int blk_mq_sysfs_register(struct request_queue *q)
{
	struct blk_mq_hw_ctx *hctx;
	int i, ret = 0;

	mutex_lock(&q->sysfs_dir_lock);
	if (!q->mq_sysfs_init_done)
		goto unlock;

	queue_for_each_hw_ctx(q, hctx, i) {
		ret = blk_mq_register_hctx(hctx);
		if (ret)
			break;
	}

unlock:
	mutex_unlock(&q->sysfs_dir_lock);

	return ret;
}
Commit	Line	Data
3dcf60bc	1	// SPDX-License-Identifier: GPL-2.0
320ae51f JA	2	#include <linux/kernel.h>
	3	#include <linux/module.h>
	4	#include <linux/backing-dev.h>
	5	#include <linux/bio.h>
	6	#include <linux/blkdev.h>
	7	#include <linux/mm.h>
	8	#include <linux/init.h>
	9	#include <linux/slab.h>
	10	#include <linux/workqueue.h>
	11	#include <linux/smp.h>
	12
	13	#include <linux/blk-mq.h>
c7e2d94b	14	#include "blk.h"
320ae51f JA	15	#include "blk-mq.h"
	16	#include "blk-mq-tag.h"
	17
	18	static void blk_mq_sysfs_release(struct kobject *kobj)
	19	{
1db4909e ML	20	struct blk_mq_ctxs *ctxs = container_of(kobj, struct blk_mq_ctxs, kobj);
	21
	22	free_percpu(ctxs->queue_ctx);
	23	kfree(ctxs);
	24	}
	25
	26	static void blk_mq_ctx_sysfs_release(struct kobject *kobj)
	27	{
	28	struct blk_mq_ctx *ctx = container_of(kobj, struct blk_mq_ctx, kobj);
	29
	30	/* ctx->ctxs won't be released until all ctx are freed */
	31	kobject_put(&ctx->ctxs->kobj);
320ae51f JA	32	}
320ae51f JA	33
6c8b232e ML	34	static void blk_mq_hw_sysfs_release(struct kobject *kobj)
	35	{
	36	struct blk_mq_hw_ctx *hctx = container_of(kobj, struct blk_mq_hw_ctx,
	37	kobj);
c7e2d94b ML	38
	39	if (hctx->flags & BLK_MQ_F_BLOCKING)
	40	cleanup_srcu_struct(hctx->srcu);
	41	blk_free_flush_queue(hctx->fq);
	42	sbitmap_free(&hctx->ctx_map);
01388df3	43	free_cpumask_var(hctx->cpumask);
6c8b232e ML	44	kfree(hctx->ctxs);
	45	kfree(hctx);
	46	}
	47
320ae51f JA	48	struct blk_mq_ctx_sysfs_entry {
	49	struct attribute attr;
	50	ssize_t (show)(struct blk_mq_ctx , char *);
	51	ssize_t (store)(struct blk_mq_ctx , const char *, size_t);
	52	};
	53
	54	struct blk_mq_hw_ctx_sysfs_entry {
	55	struct attribute attr;
	56	ssize_t (show)(struct blk_mq_hw_ctx , char *);
	57	ssize_t (store)(struct blk_mq_hw_ctx , const char *, size_t);
	58	};
	59
	60	static ssize_t blk_mq_sysfs_show(struct kobject kobj, struct attribute attr,
	61	char *page)
	62	{
	63	struct blk_mq_ctx_sysfs_entry *entry;
	64	struct blk_mq_ctx *ctx;
	65	struct request_queue *q;
	66	ssize_t res;
	67
	68	entry = container_of(attr, struct blk_mq_ctx_sysfs_entry, attr);
	69	ctx = container_of(kobj, struct blk_mq_ctx, kobj);
	70	q = ctx->queue;
	71
	72	if (!entry->show)
	73	return -EIO;
	74
320ae51f	75	mutex_lock(&q->sysfs_lock);
bae85c15	76	res = entry->show(ctx, page);
320ae51f JA	77	mutex_unlock(&q->sysfs_lock);
	78	return res;
	79	}
	80
	81	static ssize_t blk_mq_sysfs_store(struct kobject kobj, struct attribute attr,
	82	const char *page, size_t length)
	83	{
	84	struct blk_mq_ctx_sysfs_entry *entry;
	85	struct blk_mq_ctx *ctx;
	86	struct request_queue *q;
	87	ssize_t res;
	88
	89	entry = container_of(attr, struct blk_mq_ctx_sysfs_entry, attr);
	90	ctx = container_of(kobj, struct blk_mq_ctx, kobj);
	91	q = ctx->queue;
	92
	93	if (!entry->store)
	94	return -EIO;
	95
320ae51f	96	mutex_lock(&q->sysfs_lock);
bae85c15	97	res = entry->store(ctx, page, length);
320ae51f JA	98	mutex_unlock(&q->sysfs_lock);
	99	return res;
	100	}
	101
	102	static ssize_t blk_mq_hw_sysfs_show(struct kobject *kobj,
	103	struct attribute attr, char page)
	104	{
	105	struct blk_mq_hw_ctx_sysfs_entry *entry;
	106	struct blk_mq_hw_ctx *hctx;
	107	struct request_queue *q;
	108	ssize_t res;
	109
	110	entry = container_of(attr, struct blk_mq_hw_ctx_sysfs_entry, attr);
	111	hctx = container_of(kobj, struct blk_mq_hw_ctx, kobj);
	112	q = hctx->queue;
	113
	114	if (!entry->show)
	115	return -EIO;
	116
320ae51f	117	mutex_lock(&q->sysfs_lock);
bae85c15	118	res = entry->show(hctx, page);
320ae51f JA	119	mutex_unlock(&q->sysfs_lock);
	120	return res;
	121	}
	122
	123	static ssize_t blk_mq_hw_sysfs_store(struct kobject *kobj,
	124	struct attribute attr, const char page,
	125	size_t length)
	126	{
	127	struct blk_mq_hw_ctx_sysfs_entry *entry;
	128	struct blk_mq_hw_ctx *hctx;
	129	struct request_queue *q;
	130	ssize_t res;
	131
	132	entry = container_of(attr, struct blk_mq_hw_ctx_sysfs_entry, attr);
	133	hctx = container_of(kobj, struct blk_mq_hw_ctx, kobj);
	134	q = hctx->queue;
	135
	136	if (!entry->store)
	137	return -EIO;
	138
320ae51f	139	mutex_lock(&q->sysfs_lock);
bae85c15	140	res = entry->store(hctx, page, length);
320ae51f JA	141	mutex_unlock(&q->sysfs_lock);
	142	return res;
	143	}
	144
d96b37c0 OS	145	static ssize_t blk_mq_hw_sysfs_nr_tags_show(struct blk_mq_hw_ctx *hctx,
d96b37c0 OS	146	char *page)
bd166ef1	147	{
d96b37c0	148	return sprintf(page, "%u\n", hctx->tags->nr_tags);
bd166ef1 JA	149	}
bd166ef1 JA	150
d96b37c0 OS	151	static ssize_t blk_mq_hw_sysfs_nr_reserved_tags_show(struct blk_mq_hw_ctx *hctx,
d96b37c0 OS	152	char *page)
320ae51f	153	{
d96b37c0	154	return sprintf(page, "%u\n", hctx->tags->nr_reserved_tags);
320ae51f JA	155	}
320ae51f JA	156
676141e4 JA	157	static ssize_t blk_mq_hw_sysfs_cpus_show(struct blk_mq_hw_ctx hctx, char page)
676141e4 JA	158	{
8962842c	159	const size_t size = PAGE_SIZE - 1;
cb2da43e	160	unsigned int i, first = 1;
8962842c	161	int ret = 0, pos = 0;
676141e4	162
cb2da43e	163	for_each_cpu(i, hctx->cpumask) {
676141e4	164	if (first)
8962842c	165	ret = snprintf(pos + page, size - pos, "%u", i);
676141e4	166	else
8962842c ML	167	ret = snprintf(pos + page, size - pos, ", %u", i);
	168
	169	if (ret >= size - pos)
	170	break;
676141e4 JA	171
676141e4 JA	172	first = 0;
8962842c	173	pos += ret;
676141e4 JA	174	}
676141e4 JA	175
d2c9be89	176	ret = snprintf(pos + page, size + 1 - pos, "\n");
8962842c	177	return pos + ret;
676141e4 JA	178	}
676141e4 JA	179
d96b37c0	180	static struct blk_mq_hw_ctx_sysfs_entry blk_mq_hw_sysfs_nr_tags = {
5657a819	181	.attr = {.name = "nr_tags", .mode = 0444 },
d96b37c0 OS	182	.show = blk_mq_hw_sysfs_nr_tags_show,
	183	};
	184	static struct blk_mq_hw_ctx_sysfs_entry blk_mq_hw_sysfs_nr_reserved_tags = {
5657a819	185	.attr = {.name = "nr_reserved_tags", .mode = 0444 },
d96b37c0 OS	186	.show = blk_mq_hw_sysfs_nr_reserved_tags_show,
d96b37c0 OS	187	};
676141e4	188	static struct blk_mq_hw_ctx_sysfs_entry blk_mq_hw_sysfs_cpus = {
5657a819	189	.attr = {.name = "cpu_list", .mode = 0444 },
676141e4 JA	190	.show = blk_mq_hw_sysfs_cpus_show,
676141e4 JA	191	};
320ae51f JA	192
320ae51f JA	193	static struct attribute *default_hw_ctx_attrs[] = {
d96b37c0 OS	194	&blk_mq_hw_sysfs_nr_tags.attr,
d96b37c0 OS	195	&blk_mq_hw_sysfs_nr_reserved_tags.attr,
676141e4	196	&blk_mq_hw_sysfs_cpus.attr,
320ae51f JA	197	NULL,
320ae51f JA	198	};
800f5aa1	199	ATTRIBUTE_GROUPS(default_hw_ctx);
320ae51f JA	200
	201	static const struct sysfs_ops blk_mq_sysfs_ops = {
	202	.show = blk_mq_sysfs_show,
	203	.store = blk_mq_sysfs_store,
	204	};
	205
	206	static const struct sysfs_ops blk_mq_hw_sysfs_ops = {
	207	.show = blk_mq_hw_sysfs_show,
	208	.store = blk_mq_hw_sysfs_store,
	209	};
	210
	211	static struct kobj_type blk_mq_ktype = {
	212	.sysfs_ops = &blk_mq_sysfs_ops,
	213	.release = blk_mq_sysfs_release,
	214	};
	215
	216	static struct kobj_type blk_mq_ctx_ktype = {
	217	.sysfs_ops = &blk_mq_sysfs_ops,
1db4909e	218	.release = blk_mq_ctx_sysfs_release,
320ae51f JA	219	};
	220
	221	static struct kobj_type blk_mq_hw_ktype = {
	222	.sysfs_ops = &blk_mq_hw_sysfs_ops,
800f5aa1	223	.default_groups = default_hw_ctx_groups,
6c8b232e	224	.release = blk_mq_hw_sysfs_release,
320ae51f JA	225	};
320ae51f JA	226
ee3c5db0	227	static void blk_mq_unregister_hctx(struct blk_mq_hw_ctx *hctx)
67aec14c JA	228	{
	229	struct blk_mq_ctx *ctx;
	230	int i;
	231
4593fdbe	232	if (!hctx->nr_ctx)
67aec14c JA	233	return;
	234
	235	hctx_for_each_ctx(hctx, ctx, i)
	236	kobject_del(&ctx->kobj);
	237
	238	kobject_del(&hctx->kobj);
	239	}
	240
ee3c5db0	241	static int blk_mq_register_hctx(struct blk_mq_hw_ctx *hctx)
67aec14c JA	242	{
	243	struct request_queue *q = hctx->queue;
	244	struct blk_mq_ctx *ctx;
	245	int i, ret;
	246
4593fdbe	247	if (!hctx->nr_ctx)
67aec14c JA	248	return 0;
67aec14c JA	249
1db4909e	250	ret = kobject_add(&hctx->kobj, q->mq_kobj, "%u", hctx->queue_num);
67aec14c JA	251	if (ret)
	252	return ret;
	253
	254	hctx_for_each_ctx(hctx, ctx, i) {
	255	ret = kobject_add(&ctx->kobj, &hctx->kobj, "cpu%u", ctx->cpu);
	256	if (ret)
	257	break;
	258	}
	259
	260	return ret;
	261	}
	262
667257e8	263	void blk_mq_unregister_dev(struct device dev, struct request_queue q)
320ae51f	264	{
85157366	265	struct blk_mq_hw_ctx *hctx;
7ea5fe31	266	int i;
85157366	267
cecf5d87	268	lockdep_assert_held(&q->sysfs_dir_lock);
2d0364c8	269
6c8b232e	270	queue_for_each_hw_ctx(q, hctx, i)
67aec14c JA	271	blk_mq_unregister_hctx(hctx);
67aec14c JA	272
1db4909e ML	273	kobject_uevent(q->mq_kobj, KOBJ_REMOVE);
1db4909e ML	274	kobject_del(q->mq_kobj);
b21d5b30	275	kobject_put(&dev->kobj);
4593fdbe AM	276
4593fdbe AM	277	q->mq_sysfs_init_done = false;
c0f3fd2b JA	278	}
c0f3fd2b JA	279
868f2f0b KB	280	void blk_mq_hctx_kobj_init(struct blk_mq_hw_ctx *hctx)
	281	{
	282	kobject_init(&hctx->kobj, &blk_mq_hw_ktype);
	283	}
	284
7ea5fe31 ML	285	void blk_mq_sysfs_deinit(struct request_queue *q)
	286	{
	287	struct blk_mq_ctx *ctx;
	288	int cpu;
	289
	290	for_each_possible_cpu(cpu) {
	291	ctx = per_cpu_ptr(q->queue_ctx, cpu);
	292	kobject_put(&ctx->kobj);
	293	}
1db4909e	294	kobject_put(q->mq_kobj);
7ea5fe31 ML	295	}
7ea5fe31 ML	296
737f98cf	297	void blk_mq_sysfs_init(struct request_queue *q)
67aec14c	298	{
67aec14c	299	struct blk_mq_ctx *ctx;
897bb0c7	300	int cpu;
67aec14c	301
1db4909e	302	kobject_init(q->mq_kobj, &blk_mq_ktype);
67aec14c	303
897bb0c7 TG	304	for_each_possible_cpu(cpu) {
897bb0c7 TG	305	ctx = per_cpu_ptr(q->queue_ctx, cpu);
1db4909e ML	306
1db4909e ML	307	kobject_get(q->mq_kobj);
06a41a99	308	kobject_init(&ctx->kobj, &blk_mq_ctx_ktype);
897bb0c7	309	}
67aec14c JA	310	}
67aec14c JA	311
2d0364c8	312	int __blk_mq_register_dev(struct device dev, struct request_queue q)
320ae51f	313	{
320ae51f	314	struct blk_mq_hw_ctx *hctx;
67aec14c	315	int ret, i;
320ae51f	316
2d0364c8	317	WARN_ON_ONCE(!q->kobj.parent);
cecf5d87	318	lockdep_assert_held(&q->sysfs_dir_lock);
4593fdbe	319
1db4909e	320	ret = kobject_add(q->mq_kobj, kobject_get(&dev->kobj), "%s", "mq");
320ae51f	321	if (ret < 0)
4593fdbe	322	goto out;
320ae51f	323
1db4909e	324	kobject_uevent(q->mq_kobj, KOBJ_ADD);
320ae51f JA	325
320ae51f JA	326	queue_for_each_hw_ctx(q, hctx, i) {
67aec14c	327	ret = blk_mq_register_hctx(hctx);
320ae51f	328	if (ret)
f05d1ba7	329	goto unreg;
320ae51f JA	330	}
320ae51f JA	331
f05d1ba7	332	q->mq_sysfs_init_done = true;
2d0364c8	333
4593fdbe	334	out:
2d0364c8	335	return ret;
f05d1ba7 BVA	336
	337	unreg:
	338	while (--i >= 0)
	339	blk_mq_unregister_hctx(q->queue_hw_ctx[i]);
	340
1db4909e ML	341	kobject_uevent(q->mq_kobj, KOBJ_REMOVE);
1db4909e ML	342	kobject_del(q->mq_kobj);
f05d1ba7 BVA	343	kobject_put(&dev->kobj);
f05d1ba7 BVA	344	return ret;
2d0364c8 BVA	345	}
2d0364c8 BVA	346
67aec14c JA	347	void blk_mq_sysfs_unregister(struct request_queue *q)
	348	{
	349	struct blk_mq_hw_ctx *hctx;
	350	int i;
	351
cecf5d87	352	mutex_lock(&q->sysfs_dir_lock);
4593fdbe	353	if (!q->mq_sysfs_init_done)
2d0364c8	354	goto unlock;
4593fdbe	355
67aec14c JA	356	queue_for_each_hw_ctx(q, hctx, i)
67aec14c JA	357	blk_mq_unregister_hctx(hctx);
2d0364c8 BVA	358
2d0364c8 BVA	359	unlock:
cecf5d87	360	mutex_unlock(&q->sysfs_dir_lock);
67aec14c JA	361	}
	362
	363	int blk_mq_sysfs_register(struct request_queue *q)
	364	{
	365	struct blk_mq_hw_ctx *hctx;
	366	int i, ret = 0;
	367
cecf5d87	368	mutex_lock(&q->sysfs_dir_lock);
4593fdbe	369	if (!q->mq_sysfs_init_done)
2d0364c8	370	goto unlock;
4593fdbe	371
67aec14c JA	372	queue_for_each_hw_ctx(q, hctx, i) {
	373	ret = blk_mq_register_hctx(hctx);
	374	if (ret)
	375	break;
	376	}
	377
2d0364c8	378	unlock:
cecf5d87	379	mutex_unlock(&q->sysfs_dir_lock);
2d0364c8	380
67aec14c JA	381	return ret;
67aec14c JA	382	}