30e3488cbf
In case of error, the function platform_device_register_resndata() returns ERR_PTR() and never returns NULL. The NULL test in the return value check should be replaced with IS_ERR(). Signed-off-by: Wei Yongjun <yongjun_wei@trendmicro.com.cn> Acked-by: Igor Grinberg <grinberg@compulab.co.il> Signed-off-by: Tony Lindgren <tony@atomide.com>
100 lines
2.6 KiB
C
100 lines
2.6 KiB
C
/*
|
|
* linux/arch/arm/mach-omap2/gpmc-smsc911x.c
|
|
*
|
|
* Copyright (C) 2009 Li-Pro.Net
|
|
* Stephan Linz <linz@li-pro.net>
|
|
*
|
|
* Modified from linux/arch/arm/mach-omap2/gpmc-smc91x.c
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
#define pr_fmt(fmt) "%s: " fmt, __func__
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/io.h>
|
|
#include <linux/smsc911x.h>
|
|
|
|
#include "gpmc.h"
|
|
#include "gpmc-smsc911x.h"
|
|
|
|
static struct resource gpmc_smsc911x_resources[] = {
|
|
[0] = {
|
|
.flags = IORESOURCE_MEM,
|
|
},
|
|
[1] = {
|
|
.flags = IORESOURCE_IRQ | IORESOURCE_IRQ_LOWLEVEL,
|
|
},
|
|
};
|
|
|
|
static struct smsc911x_platform_config gpmc_smsc911x_config = {
|
|
.phy_interface = PHY_INTERFACE_MODE_MII,
|
|
.irq_polarity = SMSC911X_IRQ_POLARITY_ACTIVE_LOW,
|
|
.irq_type = SMSC911X_IRQ_TYPE_OPEN_DRAIN,
|
|
};
|
|
|
|
/*
|
|
* Initialize smsc911x device connected to the GPMC. Note that we
|
|
* assume that pin multiplexing is done in the board-*.c file,
|
|
* or in the bootloader.
|
|
*/
|
|
void __init gpmc_smsc911x_init(struct omap_smsc911x_platform_data *gpmc_cfg)
|
|
{
|
|
struct platform_device *pdev;
|
|
unsigned long cs_mem_base;
|
|
int ret;
|
|
|
|
if (gpmc_cs_request(gpmc_cfg->cs, SZ_16M, &cs_mem_base) < 0) {
|
|
pr_err("Failed to request GPMC mem region\n");
|
|
return;
|
|
}
|
|
|
|
gpmc_smsc911x_resources[0].start = cs_mem_base + 0x0;
|
|
gpmc_smsc911x_resources[0].end = cs_mem_base + 0xff;
|
|
|
|
if (gpio_request_one(gpmc_cfg->gpio_irq, GPIOF_IN, "smsc911x irq")) {
|
|
pr_err("Failed to request IRQ GPIO%d\n", gpmc_cfg->gpio_irq);
|
|
goto free1;
|
|
}
|
|
|
|
gpmc_smsc911x_resources[1].start = gpio_to_irq(gpmc_cfg->gpio_irq);
|
|
|
|
if (gpio_is_valid(gpmc_cfg->gpio_reset)) {
|
|
ret = gpio_request_one(gpmc_cfg->gpio_reset,
|
|
GPIOF_OUT_INIT_HIGH, "smsc911x reset");
|
|
if (ret) {
|
|
pr_err("Failed to request reset GPIO%d\n",
|
|
gpmc_cfg->gpio_reset);
|
|
goto free2;
|
|
}
|
|
|
|
gpio_set_value(gpmc_cfg->gpio_reset, 0);
|
|
msleep(100);
|
|
gpio_set_value(gpmc_cfg->gpio_reset, 1);
|
|
}
|
|
|
|
gpmc_smsc911x_config.flags = gpmc_cfg->flags ? : SMSC911X_USE_16BIT;
|
|
|
|
pdev = platform_device_register_resndata(NULL, "smsc911x", gpmc_cfg->id,
|
|
gpmc_smsc911x_resources, ARRAY_SIZE(gpmc_smsc911x_resources),
|
|
&gpmc_smsc911x_config, sizeof(gpmc_smsc911x_config));
|
|
if (IS_ERR(pdev)) {
|
|
pr_err("Unable to register platform device\n");
|
|
gpio_free(gpmc_cfg->gpio_reset);
|
|
goto free2;
|
|
}
|
|
|
|
return;
|
|
|
|
free2:
|
|
gpio_free(gpmc_cfg->gpio_irq);
|
|
free1:
|
|
gpmc_cs_free(gpmc_cfg->cs);
|
|
|
|
pr_err("Could not initialize smsc911x device\n");
|
|
}
|