linux_driver/power_management/regulator_test.c
2024-11-19 11:37:38 +08:00

104 lines
2.4 KiB
C

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/err.h>
#include <linux/export.h>
#include <linux/platform_device.h>
#include <linux/regulator/driver.h>
#include <linux/regulator/machine.h>
static struct regulator_dev *my_regulator_test_rdev;
static struct regulator_consumer_supply relate={
.dev_name = "my_consumer",
.supply = "VCC",
};
static struct regulator_init_data my_regulator_initdata = {
.constraints = {
.name ="my_regulator",
.always_on = 0,
.min_uV = 500000,
.max_uV = 1350000,
.valid_ops_mask = REGULATOR_CHANGE_VOLTAGE,
.valid_modes_mask = REGULATOR_MODE_NORMAL,
},
.num_consumer_supplies = 1,
.consumer_supplies = &relate,
};
static struct regulator_ops my_regulator_ops;
static struct regulator_desc my_regulator_desc = {
.name = "my_regulator_test",
.id = -1,
.n_voltages = 16,
.type = REGULATOR_VOLTAGE,
.owner = THIS_MODULE,
.ops = &my_regulator_ops,
};
static int regulator_driver_probe(struct platform_device *pdev)
{
struct regulator_config config = { };
int ret;
config.dev = &pdev->dev;
config.init_data = &my_regulator_initdata;
my_regulator_test_rdev = regulator_register(&my_regulator_desc, &config);
if (IS_ERR(my_regulator_test_rdev)) {
ret = PTR_ERR(my_regulator_test_rdev);
pr_err("Failed to register regulator: %d\n", ret);
return ret;
}
return 0;
}
static struct platform_driver my_regulator_driver = {
.probe = regulator_driver_probe,
.driver = {
.name = "my_regulator",
.owner = THIS_MODULE,
},
};
static struct platform_device *regulator_pdev;
static int my_regulator_test_init(void)
{
int ret;
regulator_pdev = platform_device_alloc("my_regulator", -1);
if (!regulator_pdev) {
pr_err("Failed to allocate dummy regulator device\n");
return -1;
}
ret = platform_device_add(regulator_pdev);
if (ret != 0) {
pr_err("Failed to register dummy regulator device: %d\n", ret);
platform_device_put(regulator_pdev);
return -1;
}
ret = platform_driver_register(&my_regulator_driver);
if (ret != 0) {
pr_err("Failed to register dummy regulator driver: %d\n", ret);
platform_device_unregister(regulator_pdev);
return -1;
}
return 0;
}
static void my_regulator_test_exit(void)
{
regulator_unregister(my_regulator_test_rdev);
platform_device_unregister(regulator_pdev);
platform_driver_unregister(&my_regulator_driver);
}
module_init(my_regulator_test_init);
module_exit(my_regulator_test_exit);
MODULE_LICENSE("GPL");