JustOS/linux-6.13/drivers/soc/cirrus/soc-ep93xx.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * SoC driver for Cirrus EP93xx chips.
 * Copyright (C) 2022 Nikita Shubin <nikita.shubin@maquefel.me>
 *
 * Based on a rewrite of arch/arm/mach-ep93xx/core.c
 * Copyright (C) 2006 Lennert Buytenhek <buytenh@wantstofly.org>
 * Copyright (C) 2007 Herbert Valerio Riedel <hvr@gnu.org>
 *
 * Thanks go to Michael Burian and Ray Lehtiniemi for their key
 * role in the ep93xx Linux community.
 */

#include <linux/bits.h>
#include <linux/cleanup.h>
#include <linux/init.h>
#include <linux/mfd/syscon.h>
#include <linux/of.h>
#include <linux/of_fdt.h>
#include <linux/platform_device.h>
#include <linux/regmap.h>
#include <linux/slab.h>
#include <linux/spinlock.h>
#include <linux/sys_soc.h>

#include <linux/soc/cirrus/ep93xx.h>

#define EP93XX_SYSCON_DEVCFG		0x80

#define EP93XX_SWLOCK_MAGICK		0xaa
#define EP93XX_SYSCON_SWLOCK		0xc0
#define EP93XX_SYSCON_SYSCFG		0x9c
#define EP93XX_SYSCON_SYSCFG_REV_MASK	GENMASK(31, 28)
#define EP93XX_SYSCON_SYSCFG_REV_SHIFT	28

struct ep93xx_map_info {
	spinlock_t lock;
	void __iomem *base;
	struct regmap *map;
};

/*
 * EP93xx System Controller software locked register write
 *
 * Logic safeguards are included to condition the control signals for
 * power connection to the matrix to prevent part damage. In addition, a
 * software lock register is included that must be written with 0xAA
 * before each register write to change the values of the four switch
 * matrix control registers.
 */
static void ep93xx_regmap_write(struct regmap *map, spinlock_t *lock,
				 unsigned int reg, unsigned int val)
{
	guard(spinlock_irqsave)(lock);

	regmap_write(map, EP93XX_SYSCON_SWLOCK, EP93XX_SWLOCK_MAGICK);
	regmap_write(map, reg, val);
}

static void ep93xx_regmap_update_bits(struct regmap *map, spinlock_t *lock,
				      unsigned int reg, unsigned int mask,
				      unsigned int val)
{
	guard(spinlock_irqsave)(lock);

	regmap_write(map, EP93XX_SYSCON_SWLOCK, EP93XX_SWLOCK_MAGICK);
	/* force write is required to clear swlock if no changes are made */
	regmap_update_bits_base(map, reg, mask, val, NULL, false, true);
}

static void ep93xx_unregister_adev(void *_adev)
{
	struct auxiliary_device *adev = _adev;

	auxiliary_device_delete(adev);
	auxiliary_device_uninit(adev);
}

static void ep93xx_adev_release(struct device *dev)
{
	struct auxiliary_device *adev = to_auxiliary_dev(dev);
	struct ep93xx_regmap_adev *rdev = to_ep93xx_regmap_adev(adev);

	kfree(rdev);
}

static struct auxiliary_device __init *ep93xx_adev_alloc(struct device *parent,
							 const char *name,
							 struct ep93xx_map_info *info)
{
	struct ep93xx_regmap_adev *rdev __free(kfree) = NULL;
	struct auxiliary_device *adev;
	int ret;

	rdev = kzalloc(sizeof(*rdev), GFP_KERNEL);
	if (!rdev)
		return ERR_PTR(-ENOMEM);

	rdev->map = info->map;
	rdev->base = info->base;
	rdev->lock = &info->lock;
	rdev->write = ep93xx_regmap_write;
	rdev->update_bits = ep93xx_regmap_update_bits;

	adev = &rdev->adev;
	adev->name = name;
	adev->dev.parent = parent;
	adev->dev.release = ep93xx_adev_release;

	ret = auxiliary_device_init(adev);
	if (ret)
		return ERR_PTR(ret);

	return &no_free_ptr(rdev)->adev;
}

static int __init ep93xx_controller_register(struct device *parent, const char *name,
					     struct ep93xx_map_info *info)
{
	struct auxiliary_device *adev;
	int ret;

	adev = ep93xx_adev_alloc(parent, name, info);
	if (IS_ERR(adev))
		return PTR_ERR(adev);

	ret = auxiliary_device_add(adev);
	if (ret) {
		auxiliary_device_uninit(adev);
		return ret;
	}

	return devm_add_action_or_reset(parent, ep93xx_unregister_adev, adev);
}

static unsigned int __init ep93xx_soc_revision(struct regmap *map)
{
	unsigned int val;

	regmap_read(map, EP93XX_SYSCON_SYSCFG, &val);
	val &= EP93XX_SYSCON_SYSCFG_REV_MASK;
	val >>= EP93XX_SYSCON_SYSCFG_REV_SHIFT;
	return val;
}

static const char __init *ep93xx_get_soc_rev(unsigned int rev)
{
	switch (rev) {
	case EP93XX_CHIP_REV_D0:
		return "D0";
	case EP93XX_CHIP_REV_D1:
		return "D1";
	case EP93XX_CHIP_REV_E0:
		return "E0";
	case EP93XX_CHIP_REV_E1:
		return "E1";
	case EP93XX_CHIP_REV_E2:
		return "E2";
	default:
		return "unknown";
	}
}

static const char *pinctrl_names[] __initconst = {
	"pinctrl-ep9301",	/* EP93XX_9301_SOC */
	"pinctrl-ep9307",	/* EP93XX_9307_SOC */
	"pinctrl-ep9312",	/* EP93XX_9312_SOC */
};

static int __init ep93xx_syscon_probe(struct platform_device *pdev)
{
	enum ep93xx_soc_model model;
	struct ep93xx_map_info *map_info;
	struct soc_device_attribute *attrs;
	struct soc_device *soc_dev;
	struct device *dev = &pdev->dev;
	struct regmap *map;
	void __iomem *base;
	unsigned int rev;
	int ret;

	model = (enum ep93xx_soc_model)(uintptr_t)device_get_match_data(dev);

	map = device_node_to_regmap(dev->of_node);
	if (IS_ERR(map))
		return PTR_ERR(map);

	base = devm_platform_ioremap_resource(pdev, 0);
	if (IS_ERR(base))
		return PTR_ERR(base);

	attrs = devm_kzalloc(dev, sizeof(*attrs), GFP_KERNEL);
	if (!attrs)
		return -ENOMEM;

	rev = ep93xx_soc_revision(map);

	attrs->machine = of_flat_dt_get_machine_name();
	attrs->family = "Cirrus Logic EP93xx";
	attrs->revision = ep93xx_get_soc_rev(rev);

	soc_dev = soc_device_register(attrs);
	if (IS_ERR(soc_dev))
		return PTR_ERR(soc_dev);

	map_info = devm_kzalloc(dev, sizeof(*map_info), GFP_KERNEL);
	if (!map_info)
		return -ENOMEM;

	spin_lock_init(&map_info->lock);
	map_info->map = map;
	map_info->base = base;

	ret = ep93xx_controller_register(dev, pinctrl_names[model], map_info);
	if (ret)
		dev_err(dev, "registering pinctrl controller failed\n");

	/*
	 * EP93xx SSP clock rate was doubled in version E2. For more information
	 * see section 6 "2x SSP (Synchronous Serial Port) Clock – Revision E2 only":
	 *     http://www.cirrus.com/en/pubs/appNote/AN273REV4.pdf
	 */
	if (rev == EP93XX_CHIP_REV_E2)
		ret = ep93xx_controller_register(dev, "clk-ep93xx.e2", map_info);
	else
		ret = ep93xx_controller_register(dev, "clk-ep93xx", map_info);
	if (ret)
		dev_err(dev, "registering clock controller failed\n");

	ret = ep93xx_controller_register(dev, "reset-ep93xx", map_info);
	if (ret)
		dev_err(dev, "registering reset controller failed\n");

	return 0;
}

static const struct of_device_id ep9301_syscon_of_device_ids[] = {
	{ .compatible	= "cirrus,ep9301-syscon", .data = (void *)EP93XX_9301_SOC },
	{ .compatible	= "cirrus,ep9302-syscon", .data = (void *)EP93XX_9301_SOC },
	{ .compatible	= "cirrus,ep9307-syscon", .data = (void *)EP93XX_9307_SOC },
	{ .compatible	= "cirrus,ep9312-syscon", .data = (void *)EP93XX_9312_SOC },
	{ .compatible	= "cirrus,ep9315-syscon", .data = (void *)EP93XX_9312_SOC },
	{ /* sentinel */ }
};

static struct platform_driver ep9301_syscon_driver = {
	.driver = {
		.name = "ep9301-syscon",
		.of_match_table = ep9301_syscon_of_device_ids,
	},
};
builtin_platform_driver_probe(ep9301_syscon_driver, ep93xx_syscon_probe);