linux-imx

/*

 * MEN Chameleon Bus.

 *

 * Copyright (C) 2014 MEN Mikroelektronik GmbH (www.men.de)

 * Author: Andreas Werner <andreas.werner@men.de>

 *

 * This program is free software; you can redistribute it and/or modify it

 * under the terms of the GNU General Public License as published by the Free

 * Software Foundation; version 2 of the License.

 */

​

#include <linux/platform_device.h>

#include <linux/module.h>

#include <linux/dmi.h>

#include <linux/mcb.h>

#include <linux/io.h>

#include "mcb-internal.h"

​

struct priv {

    struct mcb_bus *bus;

    struct resource *mem;

    void __iomem *base;

};

​

static int mcb_lpc_probe(struct platform_device *pdev)

{

    struct resource *res;

    struct priv *priv;

    int ret = 0;

​

    priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);

    if (!priv)

        return -ENOMEM;

​

    priv->mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);

    if (!priv->mem) {

        dev_err(&pdev->dev, "No Memory resource\n");

        return -ENODEV;

    }

​

    res = devm_request_mem_region(&pdev->dev, priv->mem->start,

                      resource_size(priv->mem),

                      KBUILD_MODNAME);

    if (!res) {

        dev_err(&pdev->dev, "Failed to request IO memory\n");

        return -EBUSY;

    }

​

    priv->base = devm_ioremap(&pdev->dev, priv->mem->start,

                  resource_size(priv->mem));

    if (!priv->base) {

        dev_err(&pdev->dev, "Cannot ioremap\n");

        return -ENOMEM;

    }

​

    platform_set_drvdata(pdev, priv);

​

    priv->bus = mcb_alloc_bus(&pdev->dev);

    if (IS_ERR(priv->bus))

        return PTR_ERR(priv->bus);

​

    ret = chameleon_parse_cells(priv->bus, priv->mem->start, priv->base);

    if (ret < 0) {