[deliverable/linux.git] / arch / powerpc / sysdev / mv64x60_dev.c

/*
 * Platform device setup for Marvell mv64360/mv64460 host bridges (Discovery)
 *
 * Author: Dale Farnsworth <dale@farnsworth.org>
 *
 * 2007 (c) MontaVista, Software, Inc.  This file is licensed under
 * the terms of the GNU General Public License version 2.  This program
 * is licensed "as is" without any warranty of any kind, whether express
 * or implied.
 */

#include <linux/stddef.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/console.h>
#include <linux/mv643xx.h>
#include <linux/platform_device.h>
#include <linux/of_platform.h>
#include <linux/of_net.h>
#include <linux/dma-mapping.h>

#include <asm/prom.h>

/* These functions provide the necessary setup for the mv64x60 drivers. */

static struct of_device_id __initdata of_mv64x60_devices[] = {
	{ .compatible = "marvell,mv64306-devctrl", },
	{}
};

/*
 * Create MPSC platform devices
 */
static int __init mv64x60_mpsc_register_shared_pdev(struct device_node *np)
{
	struct platform_device *pdev;
	struct resource r[2];
	struct mpsc_shared_pdata pdata;
	const phandle *ph;
	struct device_node *mpscrouting, *mpscintr;
	int err;

	ph = of_get_property(np, "mpscrouting", NULL);
	mpscrouting = of_find_node_by_phandle(*ph);
	if (!mpscrouting)
		return -ENODEV;

	err = of_address_to_resource(mpscrouting, 0, &r[0]);
	of_node_put(mpscrouting);
	if (err)
		return err;

	ph = of_get_property(np, "mpscintr", NULL);
	mpscintr = of_find_node_by_phandle(*ph);
	if (!mpscintr)
		return -ENODEV;

	err = of_address_to_resource(mpscintr, 0, &r[1]);
	of_node_put(mpscintr);
	if (err)
		return err;

	memset(&pdata, 0, sizeof(pdata));

	pdev = platform_device_alloc(MPSC_SHARED_NAME, 0);
	if (!pdev)
		return -ENOMEM;

	err = platform_device_add_resources(pdev, r, 2);
	if (err)
		goto error;

	err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
	if (err)
		goto error;

	err = platform_device_add(pdev);
	if (err)
		goto error;

	return 0;

error:
	platform_device_put(pdev);
	return err;
}


static int __init mv64x60_mpsc_device_setup(struct device_node *np, int id)
{
	struct resource r[5];
	struct mpsc_pdata pdata;
	struct platform_device *pdev;
	const unsigned int *prop;
	const phandle *ph;
	struct device_node *sdma, *brg;
	int err;
	int port_number;

	/* only register the shared platform device the first time through */
	if (id == 0 && (err = mv64x60_mpsc_register_shared_pdev(np)))
		return err;

	memset(r, 0, sizeof(r));

	err = of_address_to_resource(np, 0, &r[0]);
	if (err)
		return err;

	of_irq_to_resource(np, 0, &r[4]);

	ph = of_get_property(np, "sdma", NULL);
	sdma = of_find_node_by_phandle(*ph);
	if (!sdma)
		return -ENODEV;

	of_irq_to_resource(sdma, 0, &r[3]);
	err = of_address_to_resource(sdma, 0, &r[1]);
	of_node_put(sdma);
	if (err)
		return err;

	ph = of_get_property(np, "brg", NULL);
	brg = of_find_node_by_phandle(*ph);
	if (!brg)
		return -ENODEV;

	err = of_address_to_resource(brg, 0, &r[2]);
	of_node_put(brg);
	if (err)
		return err;

	prop = of_get_property(np, "cell-index", NULL);
	if (!prop)
		return -ENODEV;
	port_number = *(int *)prop;

	memset(&pdata, 0, sizeof(pdata));

	pdata.cache_mgmt = 1; /* All current revs need this set */

	pdata.max_idle = 40; /* default */
	prop = of_get_property(np, "max_idle", NULL);
	if (prop)
		pdata.max_idle = *prop;

	prop = of_get_property(brg, "current-speed", NULL);
	if (prop)
		pdata.default_baud = *prop;

	/* Default is 8 bits, no parity, no flow control */
	pdata.default_bits = 8;
	pdata.default_parity = 'n';
	pdata.default_flow = 'n';

	prop = of_get_property(np, "chr_1", NULL);
	if (prop)
		pdata.chr_1_val = *prop;

	prop = of_get_property(np, "chr_2", NULL);
	if (prop)
		pdata.chr_2_val = *prop;

	prop = of_get_property(np, "chr_10", NULL);
	if (prop)
		pdata.chr_10_val = *prop;

	prop = of_get_property(np, "mpcr", NULL);
	if (prop)
		pdata.mpcr_val = *prop;

	prop = of_get_property(brg, "bcr", NULL);
	if (prop)
		pdata.bcr_val = *prop;

	pdata.brg_can_tune = 1; /* All current revs need this set */

	prop = of_get_property(brg, "clock-src", NULL);
	if (prop)
		pdata.brg_clk_src = *prop;

	prop = of_get_property(brg, "clock-frequency", NULL);
	if (prop)
		pdata.brg_clk_freq = *prop;

	pdev = platform_device_alloc(MPSC_CTLR_NAME, port_number);
	if (!pdev)
		return -ENOMEM;
	pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32);

	err = platform_device_add_resources(pdev, r, 5);
	if (err)
		goto error;

	err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
	if (err)
		goto error;

	err = platform_device_add(pdev);
	if (err)
		goto error;

	return 0;

error:
	platform_device_put(pdev);
	return err;
}

/*
 * Create mv64x60_eth platform devices
 */
static struct platform_device * __init mv64x60_eth_register_shared_pdev(
						struct device_node *np, int id)
{
	struct platform_device *pdev;
	struct resource r[1];
	int err;

	err = of_address_to_resource(np, 0, &r[0]);
	if (err)
		return ERR_PTR(err);

	pdev = platform_device_register_simple(MV643XX_ETH_SHARED_NAME, id,
					       r, 1);
	return pdev;
}

static int __init mv64x60_eth_device_setup(struct device_node *np, int id,
					   struct platform_device *shared_pdev)
{
	struct resource r[1];
	struct mv643xx_eth_platform_data pdata;
	struct platform_device *pdev;
	struct device_node *phy;
	const u8 *mac_addr;
	const int *prop;
	const phandle *ph;
	int err;

	memset(r, 0, sizeof(r));
	of_irq_to_resource(np, 0, &r[0]);

	memset(&pdata, 0, sizeof(pdata));

	pdata.shared = shared_pdev;

	prop = of_get_property(np, "reg", NULL);
	if (!prop)
		return -ENODEV;
	pdata.port_number = *prop;

	mac_addr = of_get_mac_address(np);
	if (mac_addr)
		memcpy(pdata.mac_addr, mac_addr, 6);

	prop = of_get_property(np, "speed", NULL);
	if (prop)
		pdata.speed = *prop;

	prop = of_get_property(np, "tx_queue_size", NULL);
	if (prop)
		pdata.tx_queue_size = *prop;

	prop = of_get_property(np, "rx_queue_size", NULL);
	if (prop)
		pdata.rx_queue_size = *prop;

	prop = of_get_property(np, "tx_sram_addr", NULL);
	if (prop)
		pdata.tx_sram_addr = *prop;

	prop = of_get_property(np, "tx_sram_size", NULL);
	if (prop)
		pdata.tx_sram_size = *prop;

	prop = of_get_property(np, "rx_sram_addr", NULL);
	if (prop)
		pdata.rx_sram_addr = *prop;

	prop = of_get_property(np, "rx_sram_size", NULL);
	if (prop)
		pdata.rx_sram_size = *prop;

	ph = of_get_property(np, "phy", NULL);
	if (!ph)
		return -ENODEV;

	phy = of_find_node_by_phandle(*ph);
	if (phy == NULL)
		return -ENODEV;

	prop = of_get_property(phy, "reg", NULL);
	if (prop)
		pdata.phy_addr = MV643XX_ETH_PHY_ADDR(*prop);

	of_node_put(phy);

	pdev = platform_device_alloc(MV643XX_ETH_NAME, id);
	if (!pdev)
		return -ENOMEM;

	pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
	err = platform_device_add_resources(pdev, r, 1);
	if (err)
		goto error;

	err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
	if (err)
		goto error;

	err = platform_device_add(pdev);
	if (err)
		goto error;

	return 0;

error:
	platform_device_put(pdev);
	return err;
}

/*
 * Create mv64x60_i2c platform devices
 */
static int __init mv64x60_i2c_device_setup(struct device_node *np, int id)
{
	struct resource r[2];
	struct platform_device *pdev;
	struct mv64xxx_i2c_pdata pdata;
	const unsigned int *prop;
	int err;

	memset(r, 0, sizeof(r));

	err = of_address_to_resource(np, 0, &r[0]);
	if (err)
		return err;

	of_irq_to_resource(np, 0, &r[1]);

	memset(&pdata, 0, sizeof(pdata));

	pdata.freq_m = 8;	/* default */
	prop = of_get_property(np, "freq_m", NULL);
	if (prop)
		pdata.freq_m = *prop;

	pdata.freq_n = 3;	/* default */
	prop = of_get_property(np, "freq_n", NULL);
	if (prop)
		pdata.freq_n = *prop;

	pdata.timeout = 1000;				/* default: 1 second */

	pdev = platform_device_alloc(MV64XXX_I2C_CTLR_NAME, id);
	if (!pdev)
		return -ENOMEM;

	err = platform_device_add_resources(pdev, r, 2);
	if (err)
		goto error;

	err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
	if (err)
		goto error;

	err = platform_device_add(pdev);
	if (err)
		goto error;

	return 0;

error:
	platform_device_put(pdev);
	return err;
}

/*
 * Create mv64x60_wdt platform devices
 */
static int __init mv64x60_wdt_device_setup(struct device_node *np, int id)
{
	struct resource r;
	struct platform_device *pdev;
	struct mv64x60_wdt_pdata pdata;
	const unsigned int *prop;
	int err;

	err = of_address_to_resource(np, 0, &r);
	if (err)
		return err;

	memset(&pdata, 0, sizeof(pdata));

	pdata.timeout = 10;			/* Default: 10 seconds */

	np = of_get_parent(np);
	if (!np)
		return -ENODEV;

	prop = of_get_property(np, "clock-frequency", NULL);
	of_node_put(np);
	if (!prop)
		return -ENODEV;
	pdata.bus_clk = *prop / 1000000; /* wdt driver wants freq in MHz */

	pdev = platform_device_alloc(MV64x60_WDT_NAME, id);
	if (!pdev)
		return -ENOMEM;

	err = platform_device_add_resources(pdev, &r, 1);
	if (err)
		goto error;

	err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
	if (err)
		goto error;

	err = platform_device_add(pdev);
	if (err)
		goto error;

	return 0;

error:
	platform_device_put(pdev);
	return err;
}

static int __init mv64x60_device_setup(void)
{
	struct device_node *np, *np2;
	struct platform_device *pdev;
	int id, id2;
	int err;

	id = 0;
	for_each_compatible_node(np, "serial", "marvell,mv64360-mpsc") {
		err = mv64x60_mpsc_device_setup(np, id++);
		if (err)
			printk(KERN_ERR "Failed to initialize MV64x60 "
					"serial device %s: error %d.\n",
					np->full_name, err);
	}

	id = 0;
	id2 = 0;
	for_each_compatible_node(np, NULL, "marvell,mv64360-eth-group") {
		pdev = mv64x60_eth_register_shared_pdev(np, id++);
		if (IS_ERR(pdev)) {
			err = PTR_ERR(pdev);
			printk(KERN_ERR "Failed to initialize MV64x60 "
					"network block %s: error %d.\n",
					np->full_name, err);
			continue;
		}
		for_each_child_of_node(np, np2) {
			if (!of_device_is_compatible(np2,
					"marvell,mv64360-eth"))
				continue;
			err = mv64x60_eth_device_setup(np2, id2++, pdev);
			if (err)
				printk(KERN_ERR "Failed to initialize "
						"MV64x60 network device %s: "
						"error %d.\n",
						np2->full_name, err);
		}
	}

	id = 0;
	for_each_compatible_node(np, "i2c", "marvell,mv64360-i2c") {
		err = mv64x60_i2c_device_setup(np, id++);
		if (err)
			printk(KERN_ERR "Failed to initialize MV64x60 I2C "
					"bus %s: error %d.\n",
					np->full_name, err);
	}

	/* support up to one watchdog timer */
	np = of_find_compatible_node(np, NULL, "marvell,mv64360-wdt");
	if (np) {
		if ((err = mv64x60_wdt_device_setup(np, id)))
			printk(KERN_ERR "Failed to initialize MV64x60 "
					"Watchdog %s: error %d.\n",
					np->full_name, err);
		of_node_put(np);
	}

	/* Now add every node that is on the device bus */
	for_each_compatible_node(np, NULL, "marvell,mv64360")
		of_platform_bus_probe(np, of_mv64x60_devices, NULL);

	return 0;
}
arch_initcall(mv64x60_device_setup);

static int __init mv64x60_add_mpsc_console(void)
{
	struct device_node *np = NULL;
	const char *prop;

	prop = of_get_property(of_chosen, "linux,stdout-path", NULL);
	if (prop == NULL)
		goto not_mpsc;

	np = of_find_node_by_path(prop);
	if (!np)
		goto not_mpsc;

	if (!of_device_is_compatible(np, "marvell,mv64360-mpsc"))
		goto not_mpsc;

	prop = of_get_property(np, "cell-index", NULL);
	if (!prop)
		goto not_mpsc;

	add_preferred_console("ttyMM", *(int *)prop, NULL);

not_mpsc:
	return 0;
}
console_initcall(mv64x60_add_mpsc_console);
Commit	Line	Data
52d3aff9 DF	1	/*
	2	* Platform device setup for Marvell mv64360/mv64460 host bridges (Discovery)
	3	*
	4	* Author: Dale Farnsworth <dale@farnsworth.org>
	5	*
	6	* 2007 (c) MontaVista, Software, Inc. This file is licensed under
	7	* the terms of the GNU General Public License version 2. This program
	8	* is licensed "as is" without any warranty of any kind, whether express
	9	* or implied.
	10	*/
	11
	12	#include <linux/stddef.h>
	13	#include <linux/kernel.h>
	14	#include <linux/init.h>
542c98c0	15	#include <linux/console.h>
52d3aff9 DF	16	#include <linux/mv643xx.h>
52d3aff9 DF	17	#include <linux/platform_device.h>
683307da	18	#include <linux/of_platform.h>
4b6ba8aa	19	#include <linux/of_net.h>
e0508b15	20	#include <linux/dma-mapping.h>
52d3aff9 DF	21
	22	#include <asm/prom.h>
	23
eca39301	24	/* These functions provide the necessary setup for the mv64x60 drivers. */
52d3aff9	25
683307da RM	26	static struct of_device_id __initdata of_mv64x60_devices[] = {
	27	{ .compatible = "marvell,mv64306-devctrl", },
	28	{}
	29	};
	30
52d3aff9 DF	31	/*
	32	* Create MPSC platform devices
	33	*/
	34	static int __init mv64x60_mpsc_register_shared_pdev(struct device_node *np)
	35	{
	36	struct platform_device *pdev;
	37	struct resource r[2];
	38	struct mpsc_shared_pdata pdata;
	39	const phandle *ph;
	40	struct device_node mpscrouting, mpscintr;
	41	int err;
	42
	43	ph = of_get_property(np, "mpscrouting", NULL);
	44	mpscrouting = of_find_node_by_phandle(*ph);
	45	if (!mpscrouting)
	46	return -ENODEV;
	47
	48	err = of_address_to_resource(mpscrouting, 0, &r[0]);
	49	of_node_put(mpscrouting);
	50	if (err)
	51	return err;
	52
	53	ph = of_get_property(np, "mpscintr", NULL);
	54	mpscintr = of_find_node_by_phandle(*ph);
	55	if (!mpscintr)
	56	return -ENODEV;
	57
	58	err = of_address_to_resource(mpscintr, 0, &r[1]);
	59	of_node_put(mpscintr);
	60	if (err)
	61	return err;
	62
	63	memset(&pdata, 0, sizeof(pdata));
	64
	65	pdev = platform_device_alloc(MPSC_SHARED_NAME, 0);
	66	if (!pdev)
	67	return -ENOMEM;
	68
	69	err = platform_device_add_resources(pdev, r, 2);
	70	if (err)
	71	goto error;
	72
	73	err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
	74	if (err)
	75	goto error;
	76
	77	err = platform_device_add(pdev);
	78	if (err)
	79	goto error;
	80
	81	return 0;
	82
	83	error:
	84	platform_device_put(pdev);
	85	return err;
	86	}
	87
	88
	89	static int __init mv64x60_mpsc_device_setup(struct device_node *np, int id)
	90	{
	91	struct resource r[5];
	92	struct mpsc_pdata pdata;
	93	struct platform_device *pdev;
	94	const unsigned int *prop;
95	const phandle *ph;
96	struct device_node sdma, brg;
97	int err;
98	int port_number;
99
100	/* only register the shared platform device the first time through */
101	if (id == 0 && (err = mv64x60_mpsc_register_shared_pdev(np)))
102	return err;
103
104	memset(r, 0, sizeof(r));
105
106	err = of_address_to_resource(np, 0, &r[0]);
107	if (err)
108	return err;
109
110	of_irq_to_resource(np, 0, &r[4]);
111
112	ph = of_get_property(np, "sdma", NULL);
113	sdma = of_find_node_by_phandle(*ph);
114	if (!sdma)
115	return -ENODEV;
116
117	of_irq_to_resource(sdma, 0, &r[3]);
118	err = of_address_to_resource(sdma, 0, &r[1]);
119	of_node_put(sdma);
120	if (err)
121	return err;
122
123	ph = of_get_property(np, "brg", NULL);
124	brg = of_find_node_by_phandle(*ph);
125	if (!brg)
126	return -ENODEV;
127
128	err = of_address_to_resource(brg, 0, &r[2]);
129	of_node_put(brg);
130	if (err)
131	return err;
132
1791f91b	133	prop = of_get_property(np, "cell-index", NULL);
52d3aff9 DF	134	if (!prop)
	135	return -ENODEV;
	136	port_number = (int )prop;
	137
	138	memset(&pdata, 0, sizeof(pdata));
	139
	140	pdata.cache_mgmt = 1; /* All current revs need this set */
	141
1791f91b	142	pdata.max_idle = 40; /* default */
52d3aff9 DF	143	prop = of_get_property(np, "max_idle", NULL);
	144	if (prop)
	145	pdata.max_idle = *prop;
	146
	147	prop = of_get_property(brg, "current-speed", NULL);
	148	if (prop)
	149	pdata.default_baud = *prop;
	150
	151	/* Default is 8 bits, no parity, no flow control */
	152	pdata.default_bits = 8;
	153	pdata.default_parity = 'n';
	154	pdata.default_flow = 'n';
	155
	156	prop = of_get_property(np, "chr_1", NULL);
	157	if (prop)
	158	pdata.chr_1_val = *prop;
	159
	160	prop = of_get_property(np, "chr_2", NULL);
	161	if (prop)
	162	pdata.chr_2_val = *prop;
	163
	164	prop = of_get_property(np, "chr_10", NULL);
	165	if (prop)
	166	pdata.chr_10_val = *prop;
	167
	168	prop = of_get_property(np, "mpcr", NULL);
	169	if (prop)
	170	pdata.mpcr_val = *prop;
	171
	172	prop = of_get_property(brg, "bcr", NULL);
	173	if (prop)
	174	pdata.bcr_val = *prop;
	175
	176	pdata.brg_can_tune = 1; /* All current revs need this set */
	177
	178	prop = of_get_property(brg, "clock-src", NULL);
	179	if (prop)
	180	pdata.brg_clk_src = *prop;
	181
	182	prop = of_get_property(brg, "clock-frequency", NULL);
	183	if (prop)
	184	pdata.brg_clk_freq = *prop;
	185
	186	pdev = platform_device_alloc(MPSC_CTLR_NAME, port_number);
	187	if (!pdev)
	188	return -ENOMEM;
e0508b15	189	pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
52d3aff9 DF	190
	191	err = platform_device_add_resources(pdev, r, 5);
	192	if (err)
	193	goto error;
	194
	195	err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
	196	if (err)
	197	goto error;
	198
	199	err = platform_device_add(pdev);
	200	if (err)
	201	goto error;
	202
	203	return 0;
	204
	205	error:
	206	platform_device_put(pdev);
	207	return err;
	208	}
	209
649c8e02 DF	210	/*
	211	* Create mv64x60_eth platform devices
	212	*/
a0916bd6 DF	213	static struct platform_device * __init mv64x60_eth_register_shared_pdev(
a0916bd6 DF	214	struct device_node *np, int id)
649c8e02 DF	215	{
	216	struct platform_device *pdev;
	217	struct resource r[1];
	218	int err;
	219
649c8e02	220	err = of_address_to_resource(np, 0, &r[0]);
649c8e02	221	if (err)
a0916bd6	222	return ERR_PTR(err);
649c8e02	223
a0916bd6	224	pdev = platform_device_register_simple(MV643XX_ETH_SHARED_NAME, id,
649c8e02	225	r, 1);
a0916bd6	226	return pdev;
649c8e02 DF	227	}
649c8e02 DF	228
a0916bd6 DF	229	static int __init mv64x60_eth_device_setup(struct device_node *np, int id,
a0916bd6 DF	230	struct platform_device *shared_pdev)
649c8e02 DF	231	{
	232	struct resource r[1];
	233	struct mv643xx_eth_platform_data pdata;
	234	struct platform_device *pdev;
	235	struct device_node *phy;
	236	const u8 *mac_addr;
	237	const int *prop;
	238	const phandle *ph;
	239	int err;
	240
649c8e02 DF	241	memset(r, 0, sizeof(r));
	242	of_irq_to_resource(np, 0, &r[0]);
	243
	244	memset(&pdata, 0, sizeof(pdata));
	245
fa3959f4 LB	246	pdata.shared = shared_pdev;
fa3959f4 LB	247
a0916bd6	248	prop = of_get_property(np, "reg", NULL);
649c8e02 DF	249	if (!prop)
	250	return -ENODEV;
	251	pdata.port_number = *prop;
	252
	253	mac_addr = of_get_mac_address(np);
	254	if (mac_addr)
	255	memcpy(pdata.mac_addr, mac_addr, 6);
	256
	257	prop = of_get_property(np, "speed", NULL);
	258	if (prop)
	259	pdata.speed = *prop;
	260
	261	prop = of_get_property(np, "tx_queue_size", NULL);
	262	if (prop)
	263	pdata.tx_queue_size = *prop;
	264
	265	prop = of_get_property(np, "rx_queue_size", NULL);
	266	if (prop)
	267	pdata.rx_queue_size = *prop;
	268
	269	prop = of_get_property(np, "tx_sram_addr", NULL);
	270	if (prop)
	271	pdata.tx_sram_addr = *prop;
	272
	273	prop = of_get_property(np, "tx_sram_size", NULL);
	274	if (prop)
	275	pdata.tx_sram_size = *prop;
	276
	277	prop = of_get_property(np, "rx_sram_addr", NULL);
	278	if (prop)
	279	pdata.rx_sram_addr = *prop;
	280
	281	prop = of_get_property(np, "rx_sram_size", NULL);
	282	if (prop)
	283	pdata.rx_sram_size = *prop;
	284
	285	ph = of_get_property(np, "phy", NULL);
	286	if (!ph)
	287	return -ENODEV;
	288
	289	phy = of_find_node_by_phandle(*ph);
	290	if (phy == NULL)
	291	return -ENODEV;
	292
	293	prop = of_get_property(phy, "reg", NULL);
ac840605 LB	294	if (prop)
ac840605 LB	295	pdata.phy_addr = MV643XX_ETH_PHY_ADDR(*prop);
649c8e02 DF	296
	297	of_node_put(phy);
	298
a0916bd6	299	pdev = platform_device_alloc(MV643XX_ETH_NAME, id);
649c8e02 DF	300	if (!pdev)
	301	return -ENOMEM;
	302
e0508b15	303	pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
649c8e02 DF	304	err = platform_device_add_resources(pdev, r, 1);
	305	if (err)
	306	goto error;
	307
	308	err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
	309	if (err)
	310	goto error;
	311
	312	err = platform_device_add(pdev);
	313	if (err)
	314	goto error;
	315
	316	return 0;
	317
	318	error:
	319	platform_device_put(pdev);
	320	return err;
	321	}
	322
01f0e78e DF	323	/*
	324	* Create mv64x60_i2c platform devices
	325	*/
	326	static int __init mv64x60_i2c_device_setup(struct device_node *np, int id)
	327	{
	328	struct resource r[2];
	329	struct platform_device *pdev;
	330	struct mv64xxx_i2c_pdata pdata;
	331	const unsigned int *prop;
	332	int err;
	333
	334	memset(r, 0, sizeof(r));
	335
	336	err = of_address_to_resource(np, 0, &r[0]);
	337	if (err)
	338	return err;
	339
	340	of_irq_to_resource(np, 0, &r[1]);
	341
	342	memset(&pdata, 0, sizeof(pdata));
	343
1791f91b	344	pdata.freq_m = 8; /* default */
01f0e78e	345	prop = of_get_property(np, "freq_m", NULL);
21dbfd29 RM	346	if (prop)
21dbfd29 RM	347	pdata.freq_m = *prop;
01f0e78e	348
ae39573a	349	pdata.freq_n = 3; /* default */
01f0e78e	350	prop = of_get_property(np, "freq_n", NULL);
21dbfd29 RM	351	if (prop)
21dbfd29 RM	352	pdata.freq_n = *prop;
01f0e78e	353
1791f91b	354	pdata.timeout = 1000; /* default: 1 second */
01f0e78e	355
01f0e78e DF	356	pdev = platform_device_alloc(MV64XXX_I2C_CTLR_NAME, id);
	357	if (!pdev)
	358	return -ENOMEM;
	359
	360	err = platform_device_add_resources(pdev, r, 2);
	361	if (err)
	362	goto error;
	363
	364	err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
	365	if (err)
	366	goto error;
	367
	368	err = platform_device_add(pdev);
	369	if (err)
	370	goto error;
	371
	372	return 0;
	373
	374	error:
	375	platform_device_put(pdev);
	376	return err;
	377	}
	378
7e07a159 DF	379	/*
	380	* Create mv64x60_wdt platform devices
	381	*/
	382	static int __init mv64x60_wdt_device_setup(struct device_node *np, int id)
	383	{
	384	struct resource r;
	385	struct platform_device *pdev;
	386	struct mv64x60_wdt_pdata pdata;
	387	const unsigned int *prop;
	388	int err;
	389
	390	err = of_address_to_resource(np, 0, &r);
	391	if (err)
	392	return err;
	393
	394	memset(&pdata, 0, sizeof(pdata));
	395
1791f91b	396	pdata.timeout = 10; /* Default: 10 seconds */
7e07a159 DF	397
	398	np = of_get_parent(np);
	399	if (!np)
	400	return -ENODEV;
	401
	402	prop = of_get_property(np, "clock-frequency", NULL);
	403	of_node_put(np);
	404	if (!prop)
	405	return -ENODEV;
	406	pdata.bus_clk = prop / 1000000; / wdt driver wants freq in MHz */
	407
	408	pdev = platform_device_alloc(MV64x60_WDT_NAME, id);
	409	if (!pdev)
	410	return -ENOMEM;
	411
	412	err = platform_device_add_resources(pdev, &r, 1);
	413	if (err)
	414	goto error;
	415
	416	err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
	417	if (err)
	418	goto error;
	419
	420	err = platform_device_add(pdev);
	421	if (err)
	422	goto error;
	423
	424	return 0;
	425
	426	error:
	427	platform_device_put(pdev);
	428	return err;
	429	}
	430
52d3aff9 DF	431	static int __init mv64x60_device_setup(void)
52d3aff9 DF	432	{
a0916bd6 DF	433	struct device_node np, np2;
	434	struct platform_device *pdev;
	435	int id, id2;
52d3aff9 DF	436	int err;
52d3aff9 DF	437
26cb7d8b	438	id = 0;
ff114b66 RM	439	for_each_compatible_node(np, "serial", "marvell,mv64360-mpsc") {
	440	err = mv64x60_mpsc_device_setup(np, id++);
	441	if (err)
	442	printk(KERN_ERR "Failed to initialize MV64x60 "
	443	"serial device %s: error %d.\n",
	444	np->full_name, err);
	445	}
52d3aff9	446
26cb7d8b	447	id = 0;
a0916bd6 DF	448	id2 = 0;
	449	for_each_compatible_node(np, NULL, "marvell,mv64360-eth-group") {
	450	pdev = mv64x60_eth_register_shared_pdev(np, id++);
	451	if (IS_ERR(pdev)) {
	452	err = PTR_ERR(pdev);
ff114b66 RM	453	printk(KERN_ERR "Failed to initialize MV64x60 "
	454	"network block %s: error %d.\n",
	455	np->full_name, err);
	456	continue;
a0916bd6 DF	457	}
	458	for_each_child_of_node(np, np2) {
	459	if (!of_device_is_compatible(np2,
	460	"marvell,mv64360-eth"))
	461	continue;
	462	err = mv64x60_eth_device_setup(np2, id2++, pdev);
ff114b66 RM	463	if (err)
	464	printk(KERN_ERR "Failed to initialize "
	465	"MV64x60 network device %s: "
	466	"error %d.\n",
	467	np2->full_name, err);
a0916bd6 DF	468	}
a0916bd6 DF	469	}
649c8e02	470
26cb7d8b	471	id = 0;
ff114b66 RM	472	for_each_compatible_node(np, "i2c", "marvell,mv64360-i2c") {
	473	err = mv64x60_i2c_device_setup(np, id++);
	474	if (err)
	475	printk(KERN_ERR "Failed to initialize MV64x60 I2C "
	476	"bus %s: error %d.\n",
	477	np->full_name, err);
	478	}
01f0e78e	479
7e07a159	480	/* support up to one watchdog timer */
a1810b44	481	np = of_find_compatible_node(np, NULL, "marvell,mv64360-wdt");
7e07a159 DF	482	if (np) {
7e07a159 DF	483	if ((err = mv64x60_wdt_device_setup(np, id)))
ff114b66 RM	484	printk(KERN_ERR "Failed to initialize MV64x60 "
	485	"Watchdog %s: error %d.\n",
	486	np->full_name, err);
7e07a159 DF	487	of_node_put(np);
	488	}
	489
683307da RM	490	/* Now add every node that is on the device bus */
	491	for_each_compatible_node(np, NULL, "marvell,mv64360")
	492	of_platform_bus_probe(np, of_mv64x60_devices, NULL);
	493
52d3aff9	494	return 0;
52d3aff9 DF	495	}
52d3aff9 DF	496	arch_initcall(mv64x60_device_setup);
542c98c0 MG	497
	498	static int __init mv64x60_add_mpsc_console(void)
	499	{
	500	struct device_node *np = NULL;
	501	const char *prop;
	502
	503	prop = of_get_property(of_chosen, "linux,stdout-path", NULL);
	504	if (prop == NULL)
	505	goto not_mpsc;
	506
	507	np = of_find_node_by_path(prop);
	508	if (!np)
	509	goto not_mpsc;
	510
a1810b44	511	if (!of_device_is_compatible(np, "marvell,mv64360-mpsc"))
542c98c0 MG	512	goto not_mpsc;
542c98c0 MG	513
1791f91b	514	prop = of_get_property(np, "cell-index", NULL);
542c98c0 MG	515	if (!prop)
	516	goto not_mpsc;
	517
	518	add_preferred_console("ttyMM", (int )prop, NULL);
	519
	520	not_mpsc:
	521	return 0;
	522	}
	523	console_initcall(mv64x60_add_mpsc_console);