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