Quelle  reset-ma35d1.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (C) 2023 Nuvoton Technology Corp.
 * Author: Chi-Fang Li <cfli0@nuvoton.com>
 */

#include <linux/bits.h>
#include <linux/container_of.h>
#include <linux/device.h>
#include <linux/err.h>
#include <linux/io.h>
#include <linux/kernel.h>
#include <linux/of.h>
#include <linux/platform_device.h>
#include <linux/reboot.h>
#include <linux/reset-controller.h>
#include <linux/spinlock.h>
#include <dt-bindings/reset/nuvoton,ma35d1-reset.h>

struct ma35d1_reset_data {
 struct reset_controller_dev rcdev;
 struct notifier_block restart_handler;
 void __iomem *base;
 /* protect registers against concurrent read-modify-write */
 spinlock_t lock;
};

static const struct {
 u32 reg_ofs;
 u32 bit;
} ma35d1_reset_map[] = {
 [MA35D1_RESET_CHIP] =    {0x20, 0},
 [MA35D1_RESET_CA35CR0] = {0x20, 1},
 [MA35D1_RESET_CA35CR1] = {0x20, 2},
 [MA35D1_RESET_CM4] =     {0x20, 3},
 [MA35D1_RESET_PDMA0] =   {0x20, 4},
 [MA35D1_RESET_PDMA1] =   {0x20, 5},
 [MA35D1_RESET_PDMA2] =   {0x20, 6},
 [MA35D1_RESET_PDMA3] =   {0x20, 7},
 [MA35D1_RESET_DISP] =    {0x20, 9},
 [MA35D1_RESET_VCAP0] =   {0x20, 10},
 [MA35D1_RESET_VCAP1] =   {0x20, 11},
 [MA35D1_RESET_GFX] =     {0x20, 12},
 [MA35D1_RESET_VDEC] =    {0x20, 13},
 [MA35D1_RESET_WHC0] =    {0x20, 14},
 [MA35D1_RESET_WHC1] =    {0x20, 15},
 [MA35D1_RESET_GMAC0] =   {0x20, 16},
 [MA35D1_RESET_GMAC1] =   {0x20, 17},
 [MA35D1_RESET_HWSEM] =   {0x20, 18},
 [MA35D1_RESET_EBI] =     {0x20, 19},
 [MA35D1_RESET_HSUSBH0] = {0x20, 20},
 [MA35D1_RESET_HSUSBH1] = {0x20, 21},
 [MA35D1_RESET_HSUSBD] =  {0x20, 22},
 [MA35D1_RESET_USBHL] =   {0x20, 23},
 [MA35D1_RESET_SDH0] =    {0x20, 24},
 [MA35D1_RESET_SDH1] =    {0x20, 25},
 [MA35D1_RESET_NAND] =    {0x20, 26},
 [MA35D1_RESET_GPIO] =    {0x20, 27},
 [MA35D1_RESET_MCTLP] =   {0x20, 28},
 [MA35D1_RESET_MCTLC] =   {0x20, 29},
 [MA35D1_RESET_DDRPUB] =  {0x20, 30},
 [MA35D1_RESET_TMR0] =    {0x24, 2},
 [MA35D1_RESET_TMR1] =    {0x24, 3},
 [MA35D1_RESET_TMR2] =    {0x24, 4},
 [MA35D1_RESET_TMR3] =    {0x24, 5},
 [MA35D1_RESET_I2C0] =    {0x24, 8},
 [MA35D1_RESET_I2C1] =    {0x24, 9},
 [MA35D1_RESET_I2C2] =    {0x24, 10},
 [MA35D1_RESET_I2C3] =    {0x24, 11},
 [MA35D1_RESET_QSPI0] =   {0x24, 12},
 [MA35D1_RESET_SPI0] =    {0x24, 13},
 [MA35D1_RESET_SPI1] =    {0x24, 14},
 [MA35D1_RESET_SPI2] =    {0x24, 15},
 [MA35D1_RESET_UART0] =   {0x24, 16},
 [MA35D1_RESET_UART1] =   {0x24, 17},
 [MA35D1_RESET_UART2] =   {0x24, 18},
 [MA35D1_RESET_UART3] =   {0x24, 19},
 [MA35D1_RESET_UART4] =   {0x24, 20},
 [MA35D1_RESET_UART5] =   {0x24, 21},
 [MA35D1_RESET_UART6] =   {0x24, 22},
 [MA35D1_RESET_UART7] =   {0x24, 23},
 [MA35D1_RESET_CANFD0] =  {0x24, 24},
 [MA35D1_RESET_CANFD1] =  {0x24, 25},
 [MA35D1_RESET_EADC0] =   {0x24, 28},
 [MA35D1_RESET_I2S0] =    {0x24, 29},
 [MA35D1_RESET_SC0] =     {0x28, 0},
 [MA35D1_RESET_SC1] =     {0x28, 1},
 [MA35D1_RESET_QSPI1] =   {0x28, 4},
 [MA35D1_RESET_SPI3] =    {0x28, 6},
 [MA35D1_RESET_EPWM0] =   {0x28, 16},
 [MA35D1_RESET_EPWM1] =   {0x28, 17},
 [MA35D1_RESET_QEI0] =    {0x28, 22},
 [MA35D1_RESET_QEI1] =    {0x28, 23},
 [MA35D1_RESET_ECAP0] =   {0x28, 26},
 [MA35D1_RESET_ECAP1] =   {0x28, 27},
 [MA35D1_RESET_CANFD2] =  {0x28, 28},
 [MA35D1_RESET_ADC0] =    {0x28, 31},
 [MA35D1_RESET_TMR4] =    {0x2C, 0},
 [MA35D1_RESET_TMR5] =    {0x2C, 1},
 [MA35D1_RESET_TMR6] =    {0x2C, 2},
 [MA35D1_RESET_TMR7] =    {0x2C, 3},
 [MA35D1_RESET_TMR8] =    {0x2C, 4},
 [MA35D1_RESET_TMR9] =    {0x2C, 5},
 [MA35D1_RESET_TMR10] =   {0x2C, 6},
 [MA35D1_RESET_TMR11] =   {0x2C, 7},
 [MA35D1_RESET_UART8] =   {0x2C, 8},
 [MA35D1_RESET_UART9] =   {0x2C, 9},
 [MA35D1_RESET_UART10] =  {0x2C, 10},
 [MA35D1_RESET_UART11] =  {0x2C, 11},
 [MA35D1_RESET_UART12] =  {0x2C, 12},
 [MA35D1_RESET_UART13] =  {0x2C, 13},
 [MA35D1_RESET_UART14] =  {0x2C, 14},
 [MA35D1_RESET_UART15] =  {0x2C, 15},
 [MA35D1_RESET_UART16] =  {0x2C, 16},
 [MA35D1_RESET_I2S1] =    {0x2C, 17},
 [MA35D1_RESET_I2C4] =    {0x2C, 18},
 [MA35D1_RESET_I2C5] =    {0x2C, 19},
 [MA35D1_RESET_EPWM2] =   {0x2C, 20},
 [MA35D1_RESET_ECAP2] =   {0x2C, 21},
 [MA35D1_RESET_QEI2] =    {0x2C, 22},
 [MA35D1_RESET_CANFD3] =  {0x2C, 23},
 [MA35D1_RESET_KPI] =     {0x2C, 24},
 [MA35D1_RESET_GIC] =     {0x2C, 28},
 [MA35D1_RESET_SSMCC] =   {0x2C, 30},
 [MA35D1_RESET_SSPCC] =   {0x2C, 31}
};

static int ma35d1_restart_handler(struct notifier_block *this, unsigned long mode, void *cmd)
{
 struct ma35d1_reset_data *data =
     container_of(this, struct ma35d1_reset_data, restart_handler);
 u32 id = MA35D1_RESET_CHIP;

 writel_relaxed(BIT(ma35d1_reset_map[id].bit),
         data->base + ma35d1_reset_map[id].reg_ofs);
 return 0;
}

static int ma35d1_reset_update(struct reset_controller_dev *rcdev, unsigned long id, bool assert)
{
 struct ma35d1_reset_data *data = container_of(rcdev, struct ma35d1_reset_data, rcdev);
 unsigned long flags;
 u32 reg;

 if (WARN_ON_ONCE(id >= ARRAY_SIZE(ma35d1_reset_map)))
  return -EINVAL;

 spin_lock_irqsave(&data->lock, flags);
 reg = readl_relaxed(data->base + ma35d1_reset_map[id].reg_ofs);
 if (assert)
  reg |= BIT(ma35d1_reset_map[id].bit);
 else
  reg &= ~(BIT(ma35d1_reset_map[id].bit));
 writel_relaxed(reg, data->base + ma35d1_reset_map[id].reg_ofs);
 spin_unlock_irqrestore(&data->lock, flags);

 return 0;
}

static int ma35d1_reset_assert(struct reset_controller_dev *rcdev, unsigned long id)
{
 return ma35d1_reset_update(rcdev, id, true);
}

static int ma35d1_reset_deassert(struct reset_controller_dev *rcdev, unsigned long id)
{
 return ma35d1_reset_update(rcdev, id, false);
}

static int ma35d1_reset_status(struct reset_controller_dev *rcdev, unsigned long id)
{
 struct ma35d1_reset_data *data = container_of(rcdev, struct ma35d1_reset_data, rcdev);
 u32 reg;

 if (WARN_ON_ONCE(id >= ARRAY_SIZE(ma35d1_reset_map)))
  return -EINVAL;

 reg = readl_relaxed(data->base + ma35d1_reset_map[id].reg_ofs);
 return !!(reg & BIT(ma35d1_reset_map[id].bit));
}

static const struct reset_control_ops ma35d1_reset_ops = {
 .assert = ma35d1_reset_assert,
 .deassert = ma35d1_reset_deassert,
 .status = ma35d1_reset_status,
};

static const struct of_device_id ma35d1_reset_dt_ids[] = {
 { .compatible = "nuvoton,ma35d1-reset" },
 { },
};

static int ma35d1_reset_probe(struct platform_device *pdev)
{
 struct ma35d1_reset_data *reset_data;
 struct device *dev = &pdev->dev;
 int err;

 if (!pdev->dev.of_node) {
  dev_err(&pdev->dev, "Device tree node not found\n");
  return -EINVAL;
 }

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

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

 reset_data->rcdev.owner = THIS_MODULE;
 reset_data->rcdev.nr_resets = MA35D1_RESET_COUNT;
 reset_data->rcdev.ops = &ma35d1_reset_ops;
 reset_data->rcdev.of_node = dev->of_node;
 reset_data->restart_handler.notifier_call = ma35d1_restart_handler;
 reset_data->restart_handler.priority = 192;
 spin_lock_init(&reset_data->lock);

 err = register_restart_handler(&reset_data->restart_handler);
 if (err)
  dev_warn(&pdev->dev, "failed to register restart handler\n");

 return devm_reset_controller_register(dev, &reset_data->rcdev);
}

static struct platform_driver ma35d1_reset_driver = {
 .probe = ma35d1_reset_probe,
 .driver = {
  .name = "ma35d1-reset",
  .of_match_table = ma35d1_reset_dt_ids,
 },
};

builtin_platform_driver(ma35d1_reset_driver);