@@ -15,6 +15,7 @@
#include <linux/delay.h>
#include <linux/gpio.h>
#include <linux/init.h>
+#include <linux/irq.h>
#include <linux/io.h>
#include <linux/stddef.h>
#include <linux/platform_device.h>
@@ -221,9 +222,53 @@ static struct platform_device n8x0_cbus_device = {
},
};
+static struct resource retu_resource[] = {
+ {
+ .start = -EINVAL, /* set later */
+ .flags = IORESOURCE_IRQ,
+ },
+};
+
+static struct platform_device retu_device = {
+ .name = "retu",
+ .id = -1,
+ .resource = retu_resource,
+ .num_resources = ARRAY_SIZE(retu_resource),
+};
+
static void __init n8x0_cbus_init(void)
{
+ int retu_irq_pin;
+ int ret;
+
platform_device_register(&n8x0_cbus_device);
+
+ if (machine_is_nokia770()) {
+ retu_irq_pin = 62;
+ } else if (machine_is_nokia_n800() || machine_is_nokia_n810() ||
+ machine_is_nokia_n810_wimax()) {
+ retu_irq_pin = 108;
+ } else {
+ pr_err("retu: Unsupported board for retu\n");
+ return;
+ }
+
+ ret = gpio_request(retu_irq_pin, "RETU irq");
+ if (ret < 0) {
+ pr_err("retu: Unable to reserve IRQ GPIO\n");
+ return;
+ }
+
+ ret = gpio_direction_input(retu_irq_pin);
+ if (ret < 0) {
+ pr_err("retu: Unable to change gpio direction\n");
+ gpio_free(retu_irq_pin);
+ return;
+ }
+
+ set_irq_type(gpio_to_irq(retu_irq_pin), IRQ_TYPE_EDGE_RISING);
+ retu_resource[0].start = gpio_to_irq(retu_irq_pin);
+ platform_device_register(&retu_device);
}
#else
@@ -50,7 +50,6 @@
#define PFX "retu: "
static int retu_initialized;
-static int retu_irq_pin;
static int retu_is_vilma;
static struct tasklet_struct retu_tasklet;
@@ -477,20 +476,6 @@ static struct platform_driver retu_driver = {
},
};
-static struct resource retu_resource[] = {
- {
- .start = -EINVAL, /* set later */
- .flags = IORESOURCE_IRQ,
- },
-};
-
-static struct platform_device retu_device = {
- .name = "retu",
- .id = -1,
- .resource = retu_resource,
- .num_resources = ARRAY_SIZE(retu_resource),
-};
-
/**
* retu_init - initialise Retu driver
*
@@ -498,57 +483,7 @@ static struct platform_device retu_device = {
*/
static int __init retu_init(void)
{
- int ret = 0;
-
- /* REVISIT: Pass these from board-*.c files in platform_data */
- if (machine_is_nokia770()) {
- retu_irq_pin = 62;
- } else if (machine_is_nokia_n800() || machine_is_nokia_n810() ||
- machine_is_nokia_n810_wimax()) {
- retu_irq_pin = 108;
- } else {
- pr_err("retu: Unsupported board for retu\n");
- ret = -ENODEV;
- goto err0;
- }
-
- ret = gpio_request(retu_irq_pin, "RETU irq");
- if (ret < 0) {
- pr_err("retu: Unable to reserve IRQ GPIO\n");
- goto err0;
- }
-
- /* Set the pin as input */
- ret = gpio_direction_input(retu_irq_pin);
- if (ret < 0) {
- pr_err("retu: Unable to change gpio direction\n");
- goto err1;
- }
-
- /* Rising edge triggers the IRQ */
- set_irq_type(gpio_to_irq(retu_irq_pin), IRQ_TYPE_EDGE_RISING);
-
- /* Set up correct gpio number on struct resource */
- retu_resource[0].start = gpio_to_irq(retu_irq_pin);
-
- ret = platform_device_register(&retu_device);
- if (ret < 0)
- goto err1;
-
- ret = platform_driver_probe(&retu_driver, retu_probe);
- if (ret < 0)
- goto err2;
-
- return 0;
-
-err2:
- platform_driver_unregister(&retu_driver);
-
-err1:
- gpio_free(retu_irq_pin);
-
-err0:
- return ret;
+ return platform_driver_probe(&retu_driver, retu_probe);
}
/*
@@ -556,9 +491,7 @@ err0:
*/
static void __exit retu_exit(void)
{
- platform_device_unregister(&retu_device);
platform_driver_unregister(&retu_driver);
- gpio_free(retu_irq_pin);
}
subsys_initcall(retu_init);