Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux

reset: amlogic: split the device core and platform probe

To prepare the addition of the auxiliary device support, split
out the device coomon functions from the probe of the platform device.

The device core function will be common to both the platform and auxiliary
driver.

Signed-off-by: Jerome Brunet <jbrunet@baylibre.com>
Reviewed-by: Neil Armstrong <neil.armstrong@linaro.org>
Reviewed-by: Philipp Zabel <p.zabel@pengutronix.de>
Link: https://lore.kernel.org/r/20240910-meson-rst-aux-v5-8-60be62635d3e@baylibre.com
Signed-off-by: Philipp Zabel <p.zabel@pengutronix.de>

authored by

Jerome Brunet and committed by
Philipp Zabel
c38ae95c 2c138ee3

+167 -108
+6 -1
drivers/reset/amlogic/Kconfig
··· 1 + config RESET_MESON_COMMON 2 + tristate 3 + select REGMAP 4 + 1 5 config RESET_MESON 2 6 tristate "Meson Reset Driver" 3 7 depends on ARCH_MESON || COMPILE_TEST 4 8 default ARCH_MESON 5 9 select REGMAP_MMIO 10 + select RESET_MESON_COMMON 6 11 help 7 - This enables the reset driver for Amlogic Meson SoCs. 12 + This enables the reset driver for Amlogic SoCs. 8 13 9 14 config RESET_MESON_AUDIO_ARB 10 15 tristate "Meson Audio Memory Arbiter Reset Driver"
+1
drivers/reset/amlogic/Makefile
··· 1 1 obj-$(CONFIG_RESET_MESON) += reset-meson.o 2 + obj-$(CONFIG_RESET_MESON_COMMON) += reset-meson-common.o 2 3 obj-$(CONFIG_RESET_MESON_AUDIO_ARB) += reset-meson-audio-arb.o
+121
drivers/reset/amlogic/reset-meson-common.c
··· 1 + // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause 2 + /* 3 + * Amlogic Meson Reset core functions 4 + * 5 + * Copyright (c) 2016-2024 BayLibre, SAS. 6 + * Authors: Neil Armstrong <narmstrong@baylibre.com> 7 + * Jerome Brunet <jbrunet@baylibre.com> 8 + */ 9 + 10 + #include <linux/device.h> 11 + #include <linux/module.h> 12 + #include <linux/regmap.h> 13 + #include <linux/reset-controller.h> 14 + 15 + #include "reset-meson.h" 16 + 17 + struct meson_reset { 18 + const struct meson_reset_param *param; 19 + struct reset_controller_dev rcdev; 20 + struct regmap *map; 21 + }; 22 + 23 + static void meson_reset_offset_and_bit(struct meson_reset *data, 24 + unsigned long id, 25 + unsigned int *offset, 26 + unsigned int *bit) 27 + { 28 + unsigned int stride = regmap_get_reg_stride(data->map); 29 + 30 + *offset = (id / (stride * BITS_PER_BYTE)) * stride; 31 + *bit = id % (stride * BITS_PER_BYTE); 32 + } 33 + 34 + static int meson_reset_reset(struct reset_controller_dev *rcdev, 35 + unsigned long id) 36 + { 37 + struct meson_reset *data = 38 + container_of(rcdev, struct meson_reset, rcdev); 39 + unsigned int offset, bit; 40 + 41 + meson_reset_offset_and_bit(data, id, &offset, &bit); 42 + offset += data->param->reset_offset; 43 + 44 + return regmap_write(data->map, offset, BIT(bit)); 45 + } 46 + 47 + static int meson_reset_level(struct reset_controller_dev *rcdev, 48 + unsigned long id, bool assert) 49 + { 50 + struct meson_reset *data = 51 + container_of(rcdev, struct meson_reset, rcdev); 52 + unsigned int offset, bit; 53 + 54 + meson_reset_offset_and_bit(data, id, &offset, &bit); 55 + offset += data->param->level_offset; 56 + assert ^= data->param->level_low_reset; 57 + 58 + return regmap_update_bits(data->map, offset, 59 + BIT(bit), assert ? BIT(bit) : 0); 60 + } 61 + 62 + static int meson_reset_status(struct reset_controller_dev *rcdev, 63 + unsigned long id) 64 + { 65 + struct meson_reset *data = 66 + container_of(rcdev, struct meson_reset, rcdev); 67 + unsigned int val, offset, bit; 68 + 69 + meson_reset_offset_and_bit(data, id, &offset, &bit); 70 + offset += data->param->level_offset; 71 + 72 + regmap_read(data->map, offset, &val); 73 + val = !!(BIT(bit) & val); 74 + 75 + return val ^ data->param->level_low_reset; 76 + } 77 + 78 + static int meson_reset_assert(struct reset_controller_dev *rcdev, 79 + unsigned long id) 80 + { 81 + return meson_reset_level(rcdev, id, true); 82 + } 83 + 84 + static int meson_reset_deassert(struct reset_controller_dev *rcdev, 85 + unsigned long id) 86 + { 87 + return meson_reset_level(rcdev, id, false); 88 + } 89 + 90 + static const struct reset_control_ops meson_reset_ops = { 91 + .reset = meson_reset_reset, 92 + .assert = meson_reset_assert, 93 + .deassert = meson_reset_deassert, 94 + .status = meson_reset_status, 95 + }; 96 + 97 + int meson_reset_controller_register(struct device *dev, struct regmap *map, 98 + const struct meson_reset_param *param) 99 + { 100 + struct meson_reset *data; 101 + 102 + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); 103 + if (!data) 104 + return -ENOMEM; 105 + 106 + data->param = param; 107 + data->map = map; 108 + data->rcdev.owner = dev->driver->owner; 109 + data->rcdev.nr_resets = param->reset_num; 110 + data->rcdev.ops = &meson_reset_ops; 111 + data->rcdev.of_node = dev->of_node; 112 + 113 + return devm_reset_controller_register(dev, &data->rcdev); 114 + } 115 + EXPORT_SYMBOL_NS_GPL(meson_reset_controller_register, MESON_RESET); 116 + 117 + MODULE_DESCRIPTION("Amlogic Meson Reset Core function"); 118 + MODULE_AUTHOR("Neil Armstrong <narmstrong@baylibre.com>"); 119 + MODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>"); 120 + MODULE_LICENSE("Dual BSD/GPL"); 121 + MODULE_IMPORT_NS(MESON_RESET);
+15 -107
drivers/reset/amlogic/reset-meson.c
··· 2 2 /* 3 3 * Amlogic Meson Reset Controller driver 4 4 * 5 - * Copyright (c) 2016 BayLibre, SAS. 6 - * Author: Neil Armstrong <narmstrong@baylibre.com> 5 + * Copyright (c) 2016-2024 BayLibre, SAS. 6 + * Authors: Neil Armstrong <narmstrong@baylibre.com> 7 + * Jerome Brunet <jbrunet@baylibre.com> 7 8 */ 9 + 8 10 #include <linux/err.h> 9 - #include <linux/init.h> 10 11 #include <linux/io.h> 11 12 #include <linux/of.h> 12 13 #include <linux/module.h> 13 14 #include <linux/platform_device.h> 14 15 #include <linux/regmap.h> 15 16 #include <linux/reset-controller.h> 16 - #include <linux/slab.h> 17 - #include <linux/types.h> 18 17 19 - struct meson_reset_param { 20 - unsigned int reset_num; 21 - unsigned int reset_offset; 22 - unsigned int level_offset; 23 - bool level_low_reset; 24 - }; 25 - 26 - struct meson_reset { 27 - const struct meson_reset_param *param; 28 - struct reset_controller_dev rcdev; 29 - struct regmap *map; 30 - }; 31 - 32 - static void meson_reset_offset_and_bit(struct meson_reset *data, 33 - unsigned long id, 34 - unsigned int *offset, 35 - unsigned int *bit) 36 - { 37 - unsigned int stride = regmap_get_reg_stride(data->map); 38 - 39 - *offset = (id / (stride * BITS_PER_BYTE)) * stride; 40 - *bit = id % (stride * BITS_PER_BYTE); 41 - } 42 - 43 - static int meson_reset_reset(struct reset_controller_dev *rcdev, 44 - unsigned long id) 45 - { 46 - struct meson_reset *data = 47 - container_of(rcdev, struct meson_reset, rcdev); 48 - unsigned int offset, bit; 49 - 50 - meson_reset_offset_and_bit(data, id, &offset, &bit); 51 - offset += data->param->reset_offset; 52 - 53 - return regmap_write(data->map, offset, BIT(bit)); 54 - } 55 - 56 - static int meson_reset_level(struct reset_controller_dev *rcdev, 57 - unsigned long id, bool assert) 58 - { 59 - struct meson_reset *data = 60 - container_of(rcdev, struct meson_reset, rcdev); 61 - unsigned int offset, bit; 62 - 63 - meson_reset_offset_and_bit(data, id, &offset, &bit); 64 - offset += data->param->level_offset; 65 - assert ^= data->param->level_low_reset; 66 - 67 - return regmap_update_bits(data->map, offset, 68 - BIT(bit), assert ? BIT(bit) : 0); 69 - } 70 - 71 - static int meson_reset_status(struct reset_controller_dev *rcdev, 72 - unsigned long id) 73 - { 74 - struct meson_reset *data = 75 - container_of(rcdev, struct meson_reset, rcdev); 76 - unsigned int val, offset, bit; 77 - 78 - meson_reset_offset_and_bit(data, id, &offset, &bit); 79 - offset += data->param->level_offset; 80 - 81 - regmap_read(data->map, offset, &val); 82 - val = !!(BIT(bit) & val); 83 - 84 - return val ^ data->param->level_low_reset; 85 - } 86 - 87 - static int meson_reset_assert(struct reset_controller_dev *rcdev, 88 - unsigned long id) 89 - { 90 - return meson_reset_level(rcdev, id, true); 91 - } 92 - 93 - static int meson_reset_deassert(struct reset_controller_dev *rcdev, 94 - unsigned long id) 95 - { 96 - return meson_reset_level(rcdev, id, false); 97 - } 98 - 99 - static const struct reset_control_ops meson_reset_ops = { 100 - .reset = meson_reset_reset, 101 - .assert = meson_reset_assert, 102 - .deassert = meson_reset_deassert, 103 - .status = meson_reset_status, 104 - }; 18 + #include "reset-meson.h" 105 19 106 20 static const struct meson_reset_param meson8b_param = { 107 21 .reset_num = 256, ··· 65 151 66 152 static int meson_reset_probe(struct platform_device *pdev) 67 153 { 154 + const struct meson_reset_param *param; 68 155 struct device *dev = &pdev->dev; 69 - struct meson_reset *data; 156 + struct regmap *map; 70 157 void __iomem *base; 71 - 72 - data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); 73 - if (!data) 74 - return -ENOMEM; 75 158 76 159 base = devm_platform_ioremap_resource(pdev, 0); 77 160 if (IS_ERR(base)) 78 161 return PTR_ERR(base); 79 162 80 - data->param = device_get_match_data(dev); 81 - if (!data->param) 163 + param = device_get_match_data(dev); 164 + if (!param) 82 165 return -ENODEV; 83 166 84 - data->map = devm_regmap_init_mmio(dev, base, &regmap_config); 85 - if (IS_ERR(data->map)) 86 - return dev_err_probe(dev, PTR_ERR(data->map), 167 + map = devm_regmap_init_mmio(dev, base, &regmap_config); 168 + if (IS_ERR(map)) 169 + return dev_err_probe(dev, PTR_ERR(map), 87 170 "can't init regmap mmio region\n"); 88 171 89 - data->rcdev.owner = THIS_MODULE; 90 - data->rcdev.nr_resets = data->param->reset_num; 91 - data->rcdev.ops = &meson_reset_ops; 92 - data->rcdev.of_node = dev->of_node; 93 - 94 - return devm_reset_controller_register(dev, &data->rcdev); 172 + return meson_reset_controller_register(dev, map, param); 95 173 } 96 174 97 175 static struct platform_driver meson_reset_driver = { ··· 97 191 98 192 MODULE_DESCRIPTION("Amlogic Meson Reset Controller driver"); 99 193 MODULE_AUTHOR("Neil Armstrong <narmstrong@baylibre.com>"); 194 + MODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>"); 100 195 MODULE_LICENSE("Dual BSD/GPL"); 196 + MODULE_IMPORT_NS(MESON_RESET);
+24
drivers/reset/amlogic/reset-meson.h
··· 1 + /* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ 2 + /* 3 + * Copyright (c) 2024 BayLibre, SAS. 4 + * Author: Jerome Brunet <jbrunet@baylibre.com> 5 + */ 6 + 7 + #ifndef __MESON_RESET_H 8 + #define __MESON_RESET_H 9 + 10 + #include <linux/module.h> 11 + #include <linux/regmap.h> 12 + #include <linux/reset-controller.h> 13 + 14 + struct meson_reset_param { 15 + unsigned int reset_num; 16 + unsigned int reset_offset; 17 + unsigned int level_offset; 18 + bool level_low_reset; 19 + }; 20 + 21 + int meson_reset_controller_register(struct device *dev, struct regmap *map, 22 + const struct meson_reset_param *param); 23 + 24 + #endif /* __MESON_RESET_H */