linux-imx

// SPDX-License-Identifier: GPL-2.0

//

// reset-uniphier-glue.c - Glue layer reset driver for UniPhier

// Copyright 2018 Socionext Inc.

// Author: Kunihiko Hayashi <hayashi.kunihiko@socionext.com>

​

#include <linux/clk.h>

#include <linux/module.h>

#include <linux/of_device.h>

#include <linux/platform_device.h>

#include <linux/reset.h>

​

#include "reset-simple.h"

​

#define MAX_CLKS    2

#define MAX_RSTS    2

​

struct uniphier_glue_reset_soc_data {

    int nclks;

    const char * const *clock_names;

    int nrsts;

    const char * const *reset_names;

};

​

struct uniphier_glue_reset_priv {

    struct clk_bulk_data clk[MAX_CLKS];

    struct reset_control *rst[MAX_RSTS];

    struct reset_simple_data rdata;

    const struct uniphier_glue_reset_soc_data *data;

};

​

static int uniphier_glue_reset_probe(struct platform_device *pdev)

{

    struct device *dev = &pdev->dev;

    struct uniphier_glue_reset_priv *priv;

    struct resource *res;

    resource_size_t size;

    const char *name;

    int i, ret, nr;

​

    priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);

    if (!priv)

        return -ENOMEM;

​

    priv->data = of_device_get_match_data(dev);

    if (WARN_ON(!priv->data || priv->data->nclks > MAX_CLKS ||

            priv->data->nrsts > MAX_RSTS))

        return -EINVAL;

​

    res = platform_get_resource(pdev, IORESOURCE_MEM, 0);

    size = resource_size(res);

    priv->rdata.membase = devm_ioremap_resource(dev, res);

    if (IS_ERR(priv->rdata.membase))

        return PTR_ERR(priv->rdata.membase);

​

    for (i = 0; i < priv->data->nclks; i++)

        priv->clk[i].id = priv->data->clock_names[i];

    ret = devm_clk_bulk_get(dev, priv->data->nclks, priv->clk);

    if (ret)

        return ret;

​

    for (i = 0; i < priv->data->nrsts; i++) {

        name = priv->data->reset_names[i];