blob: 21ebd0af268bf2ad4faa9e898ec7a4fa7d67274c [file] [log] [blame]
Thomas Gleixnere62d9492019-05-20 19:07:58 +02001// SPDX-License-Identifier: GPL-2.0-or-later
Maciej Sosnowskie2fc4d12009-03-21 13:31:23 -07002/*
3 * Copyright(c) 2007 - 2009 Intel Corporation. All rights reserved.
Maciej Sosnowskie2fc4d12009-03-21 13:31:23 -07004 */
5
Shannon Nelson75896702007-10-16 01:27:41 -07006#include <linux/kernel.h>
7#include <linux/spinlock.h>
8#include <linux/device.h>
9#include <linux/idr.h>
10#include <linux/kdev_t.h>
11#include <linux/err.h>
12#include <linux/dca.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090013#include <linux/gfp.h>
Paul Gortmaker33824162011-07-10 12:15:51 -040014#include <linux/export.h>
Shannon Nelson75896702007-10-16 01:27:41 -070015
16static struct class *dca_class;
17static struct idr dca_idr;
18static spinlock_t dca_idr_lock;
19
20int dca_sysfs_add_req(struct dca_provider *dca, struct device *dev, int slot)
21{
Kay Sievers765cdb62008-02-08 15:00:49 -080022 struct device *cd;
Maciej Sosnowski7f1b3582008-07-22 17:30:57 -070023 static int req_count;
Shannon Nelson75896702007-10-16 01:27:41 -070024
Greg Kroah-Hartmana9b12612008-07-21 20:03:34 -070025 cd = device_create(dca_class, dca->cd, MKDEV(0, slot + 1), NULL,
26 "requester%d", req_count++);
Tang Bin05487452020-05-07 19:12:24 +080027 return PTR_ERR_OR_ZERO(cd);
Shannon Nelson75896702007-10-16 01:27:41 -070028}
29
30void dca_sysfs_remove_req(struct dca_provider *dca, int slot)
31{
Kay Sievers765cdb62008-02-08 15:00:49 -080032 device_destroy(dca_class, MKDEV(0, slot + 1));
Shannon Nelson75896702007-10-16 01:27:41 -070033}
34
35int dca_sysfs_add_provider(struct dca_provider *dca, struct device *dev)
36{
Kay Sievers765cdb62008-02-08 15:00:49 -080037 struct device *cd;
Tejun Heo615f2e52013-02-27 17:04:02 -080038 int ret;
Shannon Nelson75896702007-10-16 01:27:41 -070039
Tejun Heo615f2e52013-02-27 17:04:02 -080040 idr_preload(GFP_KERNEL);
Shannon Nelson75896702007-10-16 01:27:41 -070041 spin_lock(&dca_idr_lock);
Tejun Heo615f2e52013-02-27 17:04:02 -080042
43 ret = idr_alloc(&dca_idr, dca, 0, 0, GFP_NOWAIT);
44 if (ret >= 0)
45 dca->id = ret;
46
Shannon Nelson75896702007-10-16 01:27:41 -070047 spin_unlock(&dca_idr_lock);
Tejun Heo615f2e52013-02-27 17:04:02 -080048 idr_preload_end();
49 if (ret < 0)
50 return ret;
Shannon Nelson75896702007-10-16 01:27:41 -070051
Greg Kroah-Hartmana9b12612008-07-21 20:03:34 -070052 cd = device_create(dca_class, dev, MKDEV(0, 0), NULL, "dca%d", dca->id);
Shannon Nelson75896702007-10-16 01:27:41 -070053 if (IS_ERR(cd)) {
54 spin_lock(&dca_idr_lock);
55 idr_remove(&dca_idr, dca->id);
56 spin_unlock(&dca_idr_lock);
57 return PTR_ERR(cd);
58 }
59 dca->cd = cd;
60 return 0;
61}
62
63void dca_sysfs_remove_provider(struct dca_provider *dca)
64{
Kay Sievers765cdb62008-02-08 15:00:49 -080065 device_unregister(dca->cd);
Shannon Nelson75896702007-10-16 01:27:41 -070066 dca->cd = NULL;
67 spin_lock(&dca_idr_lock);
68 idr_remove(&dca_idr, dca->id);
69 spin_unlock(&dca_idr_lock);
70}
71
72int __init dca_sysfs_init(void)
73{
74 idr_init(&dca_idr);
75 spin_lock_init(&dca_idr_lock);
76
77 dca_class = class_create(THIS_MODULE, "dca");
78 if (IS_ERR(dca_class)) {
79 idr_destroy(&dca_idr);
80 return PTR_ERR(dca_class);
81 }
82 return 0;
83}
84
85void __exit dca_sysfs_exit(void)
86{
87 class_destroy(dca_class);
88 idr_destroy(&dca_idr);
89}
90