4 * Copyright 2010 Benjamin Herrenschmidt, IBM Corp.
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version
9 * 2 of the License, or (at your option) any later version.
12 #include <linux/cpumask.h>
15 #include <linux/spinlock.h>
16 #include <linux/types.h>
17 #include <linux/of_address.h>
19 #include <asm/cputhreads.h>
20 #include <asm/reg_a2.h>
27 static scom_map_t wsp_scom_map(struct device_node *dev, u64 reg, u64 count)
32 if (!of_get_property(dev, "scom-controller", NULL)) {
33 pr_err("%s: device %s is not a SCOM controller\n",
34 __func__, dev->full_name);
35 return SCOM_MAP_INVALID;
38 if (of_address_to_resource(dev, 0, &r)) {
39 pr_debug("Failed to find SCOM controller address\n");
43 /* Transform the SCOM address into an XSCOM offset */
44 xscom_addr = ((reg & 0x7f000000) >> 1) | ((reg & 0xfffff) << 3);
46 return (scom_map_t)ioremap(r.start + xscom_addr, count << 3);
49 static void wsp_scom_unmap(scom_map_t map)
54 static int wsp_scom_read(scom_map_t map, u64 reg, u64 *value)
56 u64 __iomem *addr = (u64 __iomem *)map;
58 *value = in_be64(addr + reg);
63 static int wsp_scom_write(scom_map_t map, u64 reg, u64 value)
65 u64 __iomem *addr = (u64 __iomem *)map;
67 out_be64(addr + reg, value);
72 static const struct scom_controller wsp_scom_controller = {
74 .unmap = wsp_scom_unmap,
75 .read = wsp_scom_read,
76 .write = wsp_scom_write
79 void scom_init_wsp(void)
81 scom_init(&wsp_scom_controller);