1/*
 2 * module.c - module sysfs fun for drivers
 3 *
 4 * This file is released under the GPLv2
 5 *
 6 */
 7#include <linux/device.h>
 8#include <linux/module.h>
 9#include <linux/errno.h>
10#include <linux/slab.h>
11#include <linux/string.h>
12#include "base.h"
13
14static char *make_driver_name(struct device_driver *drv)
15{
16	char *driver_name;
17
18	driver_name = kasprintf(GFP_KERNEL, "%s:%s", drv->bus->name, drv->name);
19	if (!driver_name)
20		return NULL;
21
22	return driver_name;
23}
24
25static void module_create_drivers_dir(struct module_kobject *mk)
26{
27	if (!mk || mk->drivers_dir)
28		return;
29
30	mk->drivers_dir = kobject_create_and_add("drivers", &mk->kobj);
 
 
 
31}
32
33void module_add_driver(struct module *mod, struct device_driver *drv)
34{
35	char *driver_name;
36	int no_warn;
37	struct module_kobject *mk = NULL;
 
38
39	if (!drv)
40		return;
41
42	if (mod)
43		mk = &mod->mkobj;
44	else if (drv->mod_name) {
45		struct kobject *mkobj;
46
47		/* Lookup built-in module entry in /sys/modules */
48		mkobj = kset_find_obj(module_kset, drv->mod_name);
49		if (mkobj) {
50			mk = container_of(mkobj, struct module_kobject, kobj);
51			/* remember our module structure */
52			drv->p->mkobj = mk;
53			/* kset_find_obj took a reference */
54			kobject_put(mkobj);
55		}
56	}
57
58	if (!mk)
59		return;
 
 
 
 
60
61	/* Don't check return codes; these calls are idempotent */
62	no_warn = sysfs_create_link(&drv->p->kobj, &mk->kobj, "module");
63	driver_name = make_driver_name(drv);
64	if (driver_name) {
65		module_create_drivers_dir(mk);
66		no_warn = sysfs_create_link(mk->drivers_dir, &drv->p->kobj,
67					    driver_name);
68		kfree(driver_name);
 
 
 
 
69	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
70}
71
72void module_remove_driver(struct device_driver *drv)
73{
74	struct module_kobject *mk = NULL;
75	char *driver_name;
76
77	if (!drv)
78		return;
79
80	sysfs_remove_link(&drv->p->kobj, "module");
81
82	if (drv->owner)
83		mk = &drv->owner->mkobj;
84	else if (drv->p->mkobj)
85		mk = drv->p->mkobj;
86	if (mk && mk->drivers_dir) {
87		driver_name = make_driver_name(drv);
88		if (driver_name) {
89			sysfs_remove_link(mk->drivers_dir, driver_name);
90			kfree(driver_name);
91		}
92	}
93}

  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * module.c - module sysfs fun for drivers
 
 
 
  4 */
  5#include <linux/device.h>
  6#include <linux/module.h>
  7#include <linux/errno.h>
  8#include <linux/slab.h>
  9#include <linux/string.h>
 10#include "base.h"
 11
 12static char *make_driver_name(const struct device_driver *drv)
 13{
 14	char *driver_name;
 15
 16	driver_name = kasprintf(GFP_KERNEL, "%s:%s", drv->bus->name, drv->name);
 17	if (!driver_name)
 18		return NULL;
 19
 20	return driver_name;
 21}
 22
 23static void module_create_drivers_dir(struct module_kobject *mk)
 24{
 25	static DEFINE_MUTEX(drivers_dir_mutex);
 
 26
 27	mutex_lock(&drivers_dir_mutex);
 28	if (mk && !mk->drivers_dir)
 29		mk->drivers_dir = kobject_create_and_add("drivers", &mk->kobj);
 30	mutex_unlock(&drivers_dir_mutex);
 31}
 32
 33int module_add_driver(struct module *mod, const struct device_driver *drv)
 34{
 35	char *driver_name;
 
 36	struct module_kobject *mk = NULL;
 37	int ret;
 38
 39	if (!drv)
 40		return 0;
 41
 42	if (mod)
 43		mk = &mod->mkobj;
 44	else if (drv->mod_name) {
 45		struct kobject *mkobj;
 46
 47		/* Lookup built-in module entry in /sys/modules */
 48		mkobj = kset_find_obj(module_kset, drv->mod_name);
 49		if (mkobj) {
 50			mk = container_of(mkobj, struct module_kobject, kobj);
 51			/* remember our module structure */
 52			drv->p->mkobj = mk;
 53			/* kset_find_obj took a reference */
 54			kobject_put(mkobj);
 55		}
 56	}
 57
 58	if (!mk)
 59		return 0;
 60
 61	ret = sysfs_create_link(&drv->p->kobj, &mk->kobj, "module");
 62	if (ret)
 63		return ret;
 64
 
 
 65	driver_name = make_driver_name(drv);
 66	if (!driver_name) {
 67		ret = -ENOMEM;
 68		goto out_remove_kobj;
 69	}
 70
 71	module_create_drivers_dir(mk);
 72	if (!mk->drivers_dir) {
 73		ret = -EINVAL;
 74		goto out_free_driver_name;
 75	}
 76
 77	ret = sysfs_create_link(mk->drivers_dir, &drv->p->kobj, driver_name);
 78	if (ret)
 79		goto out_remove_drivers_dir;
 80
 81	kfree(driver_name);
 82
 83	return 0;
 84
 85out_remove_drivers_dir:
 86	sysfs_remove_link(mk->drivers_dir, driver_name);
 87
 88out_free_driver_name:
 89	kfree(driver_name);
 90
 91out_remove_kobj:
 92	sysfs_remove_link(&drv->p->kobj, "module");
 93	return ret;
 94}
 95
 96void module_remove_driver(const struct device_driver *drv)
 97{
 98	struct module_kobject *mk = NULL;
 99	char *driver_name;
100
101	if (!drv)
102		return;
103
104	sysfs_remove_link(&drv->p->kobj, "module");
105
106	if (drv->owner)
107		mk = &drv->owner->mkobj;
108	else if (drv->p->mkobj)
109		mk = drv->p->mkobj;
110	if (mk && mk->drivers_dir) {
111		driver_name = make_driver_name(drv);
112		if (driver_name) {
113			sysfs_remove_link(mk->drivers_dir, driver_name);
114			kfree(driver_name);
115		}
116	}
117}