Each AT91 variant (AT91RM9200, AT91SAM9260, etc) currently has its own
devices file, which includes the MMIO address, interrupt
configuration, GPIO setup, etc for each device. This results in a large
amount of duplicated code.
This patch introduces a framework for adding shared devices for the
AT91 platform. The subsequent patches in this series replace the
multiple device setup implementations for each device with single
implementations in the new framework.
Signed-off-by: Ryan Mallon <ryan at bluewatersys.com>
---
arch/arm/mach-at91/Makefile | 2 +-
arch/arm/mach-at91/devices.c | 120 ++++++++++++++++++++++++++++++++++++++++++
arch/arm/mach-at91/devices.h | 36 +++++++++++++
3 files changed, 157 insertions(+), 1 deletions(-)
create mode 100644 arch/arm/mach-at91/devices.c
create mode 100644 arch/arm/mach-at91/devices.h
diff --git a/arch/arm/mach-at91/Makefile b/arch/arm/mach-at91/Makefile
index a83835e..14962f2 100644
--- a/arch/arm/mach-at91/Makefile
+++ b/arch/arm/mach-at91/Makefile
@@ -2,7 +2,7 @@
# Makefile for the linux kernel.
#
-obj-y := irq.o gpio.o
+obj-y := irq.o gpio.o devices.o
obj-m :=
obj-n :=
obj- :=
diff --git a/arch/arm/mach-at91/devices.c b/arch/arm/mach-at91/devices.c
new file mode 100644
index 0000000..89d0fa9
--- /dev/null
+++ b/arch/arm/mach-at91/devices.c
@@ -0,0 +1,120 @@
+/*
+ * arch/arm/mach-at91/devices.c
+ *
+ * Copyright (C) 2011 Bluewater Systems
+ * Copyright (C) 2011 Ryan Mallon <ryan at bluewatersys.com>
+ *
+ * Based on code from arch/arm/mach-at91/xxx_devices.c
+ *
+ * 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; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ */
+
+#include <linux/platform_device.h>
+#include <linux/gpio.h>
+
+#include "devices.h"
+
+static struct at91_device_table *devices __initdata;
+
+static __init void at91_config_pins(struct at91_pin_config *pins, int nr_pins)
+{
+ int i;
+
+ for (i = 0; i < nr_pins; i++) {
+ switch (pins[i].mode) {
+ case AT91_PIN_PERIPH_A:
+ at91_set_A_periph(pins[i].pin, pins[i].pullup);
+ break;
+
+ case AT91_PIN_PERIPH_B:
+ at91_set_B_periph(pins[i].pin, pins[i].pullup);
+ break;
+
+ default:
+ /* GPIO */
+ if (pins[i].direction == GPIOF_DIR_OUT)
+ at91_set_gpio_output(pins[i].pin,
+ pins[i].value);
+ else
+ at91_set_gpio_input(pins[i].pin,
+ pins[i].pullup);
+ break;
+ }
+ }
+}
+
+static inline void __init init_resource_mem(struct resource *res,
+ unsigned mmio_base,
+ unsigned mmio_size)
+{
+ res->flags = IORESOURCE_MEM;
+ res->start = mmio_base;
+ res->end = mmio_base + mmio_size - 1;
+}
+
+static inline void __init init_resource_irq(struct resource *res, int irq)
+{
+ if (irq) {
+ res->flags = IORESOURCE_IRQ;
+ res->start = irq;
+ res->end = irq;
+ }
+}
+
+static int __init at91_add_platform_device(struct platform_device *pdev,
+ const struct resource *resources,
+ int nr_resources, const void *data,
+ size_t data_size)
+{
+ int err;
+
+ if (resources) {
+ err = platform_device_add_resources(pdev, resources,
+ nr_resources);
+ if (err) {
+ pr_err("Unable to add resources to device %s: %d\n",
+ pdev->name, err);
+ goto fail;
+ }
+ }
+
+ if (data) {
+ err = platform_device_add_data(pdev, data, data_size);
+ if (err) {
+ pr_err("Unable to add platform data to device %s: %d\n",
+ pdev->name, err);
+ goto fail_free_resources;
+ }
+ }
+
+ err = platform_device_register(pdev);
+ if (err) {
+ pr_err("Unable to register device %s: %d\n", pdev->name, err);
+ goto fail_free_data;
+ }
+
+ return 0;
+
+fail_free_data:
+ if (data) {
+ kfree(pdev->dev.platform_data);
+ pdev->dev.platform_data = NULL;
+ }
+fail_free_resources:
+ if (resources) {
+ kfree(pdev->resource);
+ pdev->resource = NULL;
+ pdev->num_resources = 0;
+ }
+fail:
+ return err;
+}
+
+void __init at91_init_devices(struct at91_device_table *device_table)
+{
+ devices = device_table;
+}
diff --git a/arch/arm/mach-at91/devices.h b/arch/arm/mach-at91/devices.h
new file mode 100644
index 0000000..738f736
--- /dev/null
+++ b/arch/arm/mach-at91/devices.h
@@ -0,0 +1,36 @@
+/*
+ * arch/arm/mach-at91/devices.h
+ *
+ * Copyright (C) 2011 Bluewater Systems
+ * Copyright (C) 2011 Ryan Mallon <ryan at bluewatersys.com>
+ *
+ * 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; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ */
+
+#ifndef _AT91_DEVICES_H
+#define _AT91_DEVICES_H
+
+enum {
+ AT91_PIN_PERIPH_A,
+ AT91_PIN_PERIPH_B,
+ AT91_PIN_GPIO,
+};
+
+struct at91_pin_config {
+ int pin;
+ int mode;
+ int pullup;
+ int direction;
+ int value;
+};
+
+struct at91_device_table {
+};
+
+extern void __init at91_init_devices(struct at91_device_table *device_table);
+
+#endif /* _AT91_DEVICES_H */
--
1.7.0.4