[RFC 7/8] powerpc: Add arch/powerpc mv64x60 I2C platform data setup

[Mark A. Greer]

From: Dale Farnsworth <dale at farnsworth.org>

Signed-off-by: Dale Farnsworth <dale at farnsworth.org>
---

 mv64x60.c |   75 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 75 insertions(+)
---

Index: linux-2.6-powerpc-df/arch/powerpc/sysdev/mv64x60.c
===================================================================
--- linux-2.6-powerpc-df.orig/arch/powerpc/sysdev/mv64x60.c
+++ linux-2.6-powerpc-df/arch/powerpc/sysdev/mv64x60.c
@@ -755,3 +755,78 @@ ret_node_put:
 arch_initcall(mv64x60_eth_platform_device_init);
 
 #endif /* defined(CONFIG_MV643XX_ETH) || defined(CONFIG_MV643XX_ETH_MODULE) */
+
+#if defined(CONFIG_I2C_MV64XXX) || defined(CONFIG_I2C_MV64XXX_MODULE)
+static int __init mv64x60_i2c_platform_device_init(void)
+{
+	struct device_node *np;
+	struct platform_device *pdev;
+	int err;
+
+	np = of_find_compatible_node(NULL, "i2c", "mv64x60-i2c");
+	if (np) {
+		struct resource r[2];
+		struct mv64xxx_i2c_pdata pdata;
+		const unsigned int *prop;
+
+		err = of_address_to_resource(np, 0, &r[0]);
+		if (err)
+			goto ret_node_put;
+
+		memset(&r[1], 0, sizeof(r[1]));
+		of_irq_to_resource(np, 0, &r[1]);
+
+		pdev = platform_device_register_simple(MV64XXX_I2C_CTLR_NAME,
+						       0, r, 2);
+		if (IS_ERR(pdev)) {
+			err = PTR_ERR(pdev);
+			goto ret_node_put;
+		}
+
+		memset(&pdata, 0, sizeof(pdata));
+
+		prop = get_property(np, "freq_m", NULL);
+		if (!prop) {
+			err = -ENODEV;
+			goto ret_unreg;
+		}
+		pdata.freq_m = *prop;
+
+		prop = get_property(np, "freq_n", NULL);
+		if (!prop) {
+			err = -ENODEV;
+			goto ret_unreg;
+		}
+		pdata.freq_n = *prop;
+
+		prop = get_property(np, "timeout", NULL);
+		if (prop)
+			pdata.timeout = *prop;
+		else
+			pdata.timeout = 1000;	/* 1 second */
+
+		prop = get_property(np, "retries", NULL);
+		if (prop)
+			pdata.retries = *prop;
+		else
+			pdata.retries = 1;
+
+		err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
+		if (err)
+			goto ret_unreg;
+
+		of_node_put(np);
+	}
+
+	return 0;
+
+ret_unreg:
+	platform_device_unregister(pdev);
+ret_node_put:
+	of_node_put(np);
+	return err;
+}
+
+arch_initcall(mv64x60_i2c_platform_device_init);
+
+#endif /* defined(CONFIG_I2C_MV64XXX) || defined(CONFIG_I2C_MV64XXX_MODULE) */