89 lines
2.2 KiB
Diff
89 lines
2.2 KiB
Diff
|
From 5d94449a92e4121b408e7cb8931a47984135eeea Mon Sep 17 00:00:00 2001
|
||
|
|
From: Hauke Mehrtens <hauke@hauke-m.de>
|
||
|
|
Date: Sun, 4 May 2014 14:34:31 +0200
|
||
|
|
Subject: [PATCH 07/15] bcma: get sprom from devicetree
|
||
|
|
|
||
|
|
This patch make it possible to device an sprom provider in device tree
|
||
|
|
and get the sprom from this driver. Every time there is such a provider
|
||
|
|
it gets asked for a sprom.
|
||
|
|
|
||
|
|
Signed-off-by: Hauke Mehrtens <hauke@hauke-m.de>
|
||
|
|
---
|
||
|
|
drivers/bcma/sprom.c | 51 ++++++++++++++++++++++++++++++++++++++++++++++++++-
|
||
|
|
1 file changed, 50 insertions(+), 1 deletion(-)
|
||
|
|
|
||
|
|
--- a/drivers/bcma/sprom.c
|
||
|
|
+++ b/drivers/bcma/sprom.c
|
||
|
|
@@ -15,6 +15,8 @@
|
||
|
|
#include <linux/io.h>
|
||
|
|
#include <linux/dma-mapping.h>
|
||
|
|
#include <linux/slab.h>
|
||
|
|
+#include <linux/of.h>
|
||
|
|
+#include <linux/of_platform.h>
|
||
|
|
|
||
|
|
static int(*get_fallback_sprom)(struct bcma_bus *dev, struct ssb_sprom *out);
|
||
|
|
|
||
|
|
@@ -46,6 +48,46 @@ int bcma_arch_register_fallback_sprom(in
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
+#ifdef CONFIG_OF
|
||
|
|
+static int bcma_fill_sprom_with_dt(struct bcma_bus *bus,
|
||
|
|
+ struct ssb_sprom *out)
|
||
|
|
+{
|
||
|
|
+ const phandle *handle;
|
||
|
|
+ struct device_node *sprom_node;
|
||
|
|
+ struct platform_device *sprom_dev;
|
||
|
|
+ struct ssb_sprom *sprom;
|
||
|
|
+
|
||
|
|
+ if (!bus->host_pdev || !bus->host_pdev->dev.of_node)
|
||
|
|
+ return -ENOENT;
|
||
|
|
+
|
||
|
|
+ handle = of_get_property(bus->host_pdev->dev.of_node, "sprom", NULL);
|
||
|
|
+ if (!handle)
|
||
|
|
+ return -ENOENT;
|
||
|
|
+
|
||
|
|
+ sprom_node = of_find_node_by_phandle(be32_to_cpup(handle));
|
||
|
|
+ if (!sprom_node)
|
||
|
|
+ return -ENOENT;
|
||
|
|
+
|
||
|
|
+ sprom_dev = of_find_device_by_node(sprom_node);
|
||
|
|
+ if (!sprom_dev)
|
||
|
|
+ return -ENOENT;
|
||
|
|
+
|
||
|
|
+ sprom = platform_get_drvdata(sprom_dev);
|
||
|
|
+ if (!sprom)
|
||
|
|
+ return -ENOENT;
|
||
|
|
+
|
||
|
|
+ memcpy(out, sprom, sizeof(*out));
|
||
|
|
+
|
||
|
|
+ return 0;
|
||
|
|
+}
|
||
|
|
+#else
|
||
|
|
+static int bcma_fill_sprom_with_dt(struct bcma_bus *bus,
|
||
|
|
+ struct ssb_sprom *out)
|
||
|
|
+{
|
||
|
|
+ return -ENOENT;
|
||
|
|
+}
|
||
|
|
+#endif
|
||
|
|
+
|
||
|
|
static int bcma_fill_sprom_with_fallback(struct bcma_bus *bus,
|
||
|
|
struct ssb_sprom *out)
|
||
|
|
{
|
||
|
|
@@ -553,7 +595,14 @@ int bcma_sprom_get(struct bcma_bus *bus)
|
||
|
|
u16 *sprom;
|
||
|
|
size_t sprom_sizes[] = { SSB_SPROMSIZE_WORDS_R4,
|
||
|
|
SSB_SPROMSIZE_WORDS_R10, };
|
||
|
|
- int i, err = 0;
|
||
|
|
+ int i, err;
|
||
|
|
+
|
||
|
|
+ err = bcma_fill_sprom_with_dt(bus, &bus->sprom);
|
||
|
|
+ if (err == 0) {
|
||
|
|
+ bcma_info(bus, "Found sprom from device tree provider\n");
|
||
|
|
+ return 0;
|
||
|
|
+ }
|
||
|
|
+ err = 0;
|
||
|
|
|
||
|
|
if (!bus->drv_cc.core)
|
||
|
|
return -EOPNOTSUPP;
|