162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * module.c - module sysfs fun for drivers
462306a36Sopenharmony_ci */
562306a36Sopenharmony_ci#include <linux/device.h>
662306a36Sopenharmony_ci#include <linux/module.h>
762306a36Sopenharmony_ci#include <linux/errno.h>
862306a36Sopenharmony_ci#include <linux/slab.h>
962306a36Sopenharmony_ci#include <linux/string.h>
1062306a36Sopenharmony_ci#include "base.h"
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_cistatic char *make_driver_name(struct device_driver *drv)
1362306a36Sopenharmony_ci{
1462306a36Sopenharmony_ci	char *driver_name;
1562306a36Sopenharmony_ci
1662306a36Sopenharmony_ci	driver_name = kasprintf(GFP_KERNEL, "%s:%s", drv->bus->name, drv->name);
1762306a36Sopenharmony_ci	if (!driver_name)
1862306a36Sopenharmony_ci		return NULL;
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_ci	return driver_name;
2162306a36Sopenharmony_ci}
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_cistatic void module_create_drivers_dir(struct module_kobject *mk)
2462306a36Sopenharmony_ci{
2562306a36Sopenharmony_ci	static DEFINE_MUTEX(drivers_dir_mutex);
2662306a36Sopenharmony_ci
2762306a36Sopenharmony_ci	mutex_lock(&drivers_dir_mutex);
2862306a36Sopenharmony_ci	if (mk && !mk->drivers_dir)
2962306a36Sopenharmony_ci		mk->drivers_dir = kobject_create_and_add("drivers", &mk->kobj);
3062306a36Sopenharmony_ci	mutex_unlock(&drivers_dir_mutex);
3162306a36Sopenharmony_ci}
3262306a36Sopenharmony_ci
3362306a36Sopenharmony_civoid module_add_driver(struct module *mod, struct device_driver *drv)
3462306a36Sopenharmony_ci{
3562306a36Sopenharmony_ci	char *driver_name;
3662306a36Sopenharmony_ci	int no_warn;
3762306a36Sopenharmony_ci	struct module_kobject *mk = NULL;
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci	if (!drv)
4062306a36Sopenharmony_ci		return;
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_ci	if (mod)
4362306a36Sopenharmony_ci		mk = &mod->mkobj;
4462306a36Sopenharmony_ci	else if (drv->mod_name) {
4562306a36Sopenharmony_ci		struct kobject *mkobj;
4662306a36Sopenharmony_ci
4762306a36Sopenharmony_ci		/* Lookup built-in module entry in /sys/modules */
4862306a36Sopenharmony_ci		mkobj = kset_find_obj(module_kset, drv->mod_name);
4962306a36Sopenharmony_ci		if (mkobj) {
5062306a36Sopenharmony_ci			mk = container_of(mkobj, struct module_kobject, kobj);
5162306a36Sopenharmony_ci			/* remember our module structure */
5262306a36Sopenharmony_ci			drv->p->mkobj = mk;
5362306a36Sopenharmony_ci			/* kset_find_obj took a reference */
5462306a36Sopenharmony_ci			kobject_put(mkobj);
5562306a36Sopenharmony_ci		}
5662306a36Sopenharmony_ci	}
5762306a36Sopenharmony_ci
5862306a36Sopenharmony_ci	if (!mk)
5962306a36Sopenharmony_ci		return;
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_ci	/* Don't check return codes; these calls are idempotent */
6262306a36Sopenharmony_ci	no_warn = sysfs_create_link(&drv->p->kobj, &mk->kobj, "module");
6362306a36Sopenharmony_ci	driver_name = make_driver_name(drv);
6462306a36Sopenharmony_ci	if (driver_name) {
6562306a36Sopenharmony_ci		module_create_drivers_dir(mk);
6662306a36Sopenharmony_ci		no_warn = sysfs_create_link(mk->drivers_dir, &drv->p->kobj,
6762306a36Sopenharmony_ci					    driver_name);
6862306a36Sopenharmony_ci		kfree(driver_name);
6962306a36Sopenharmony_ci	}
7062306a36Sopenharmony_ci}
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_civoid module_remove_driver(struct device_driver *drv)
7362306a36Sopenharmony_ci{
7462306a36Sopenharmony_ci	struct module_kobject *mk = NULL;
7562306a36Sopenharmony_ci	char *driver_name;
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_ci	if (!drv)
7862306a36Sopenharmony_ci		return;
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_ci	sysfs_remove_link(&drv->p->kobj, "module");
8162306a36Sopenharmony_ci
8262306a36Sopenharmony_ci	if (drv->owner)
8362306a36Sopenharmony_ci		mk = &drv->owner->mkobj;
8462306a36Sopenharmony_ci	else if (drv->p->mkobj)
8562306a36Sopenharmony_ci		mk = drv->p->mkobj;
8662306a36Sopenharmony_ci	if (mk && mk->drivers_dir) {
8762306a36Sopenharmony_ci		driver_name = make_driver_name(drv);
8862306a36Sopenharmony_ci		if (driver_name) {
8962306a36Sopenharmony_ci			sysfs_remove_link(mk->drivers_dir, driver_name);
9062306a36Sopenharmony_ci			kfree(driver_name);
9162306a36Sopenharmony_ci		}
9262306a36Sopenharmony_ci	}
9362306a36Sopenharmony_ci}
94