18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci    i2c Support for Apple SMU Controller
48c2ecf20Sopenharmony_ci
58c2ecf20Sopenharmony_ci    Copyright (c) 2005 Benjamin Herrenschmidt, IBM Corp.
68c2ecf20Sopenharmony_ci                       <benh@kernel.crashing.org>
78c2ecf20Sopenharmony_ci
88c2ecf20Sopenharmony_ci
98c2ecf20Sopenharmony_ci*/
108c2ecf20Sopenharmony_ci
118c2ecf20Sopenharmony_ci#include <linux/module.h>
128c2ecf20Sopenharmony_ci#include <linux/kernel.h>
138c2ecf20Sopenharmony_ci#include <linux/types.h>
148c2ecf20Sopenharmony_ci#include <linux/i2c.h>
158c2ecf20Sopenharmony_ci#include <linux/device.h>
168c2ecf20Sopenharmony_ci#include <linux/platform_device.h>
178c2ecf20Sopenharmony_ci#include <linux/of_irq.h>
188c2ecf20Sopenharmony_ci#include <asm/prom.h>
198c2ecf20Sopenharmony_ci#include <asm/pmac_low_i2c.h>
208c2ecf20Sopenharmony_ci
218c2ecf20Sopenharmony_ciMODULE_AUTHOR("Benjamin Herrenschmidt <benh@kernel.crashing.org>");
228c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("I2C driver for Apple PowerMac");
238c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL");
248c2ecf20Sopenharmony_ci
258c2ecf20Sopenharmony_ci/*
268c2ecf20Sopenharmony_ci * SMBUS-type transfer entrypoint
278c2ecf20Sopenharmony_ci */
288c2ecf20Sopenharmony_cistatic s32 i2c_powermac_smbus_xfer(	struct i2c_adapter*	adap,
298c2ecf20Sopenharmony_ci					u16			addr,
308c2ecf20Sopenharmony_ci					unsigned short		flags,
318c2ecf20Sopenharmony_ci					char			read_write,
328c2ecf20Sopenharmony_ci					u8			command,
338c2ecf20Sopenharmony_ci					int			size,
348c2ecf20Sopenharmony_ci					union i2c_smbus_data*	data)
358c2ecf20Sopenharmony_ci{
368c2ecf20Sopenharmony_ci	struct pmac_i2c_bus	*bus = i2c_get_adapdata(adap);
378c2ecf20Sopenharmony_ci	int			rc = 0;
388c2ecf20Sopenharmony_ci	int			read = (read_write == I2C_SMBUS_READ);
398c2ecf20Sopenharmony_ci	int			addrdir = (addr << 1) | read;
408c2ecf20Sopenharmony_ci	int			mode, subsize, len;
418c2ecf20Sopenharmony_ci	u32			subaddr;
428c2ecf20Sopenharmony_ci	u8			*buf;
438c2ecf20Sopenharmony_ci	u8			local[2];
448c2ecf20Sopenharmony_ci
458c2ecf20Sopenharmony_ci	if (size == I2C_SMBUS_QUICK || size == I2C_SMBUS_BYTE) {
468c2ecf20Sopenharmony_ci		mode = pmac_i2c_mode_std;
478c2ecf20Sopenharmony_ci		subsize = 0;
488c2ecf20Sopenharmony_ci		subaddr = 0;
498c2ecf20Sopenharmony_ci	} else {
508c2ecf20Sopenharmony_ci		mode = read ? pmac_i2c_mode_combined : pmac_i2c_mode_stdsub;
518c2ecf20Sopenharmony_ci		subsize = 1;
528c2ecf20Sopenharmony_ci		subaddr = command;
538c2ecf20Sopenharmony_ci	}
548c2ecf20Sopenharmony_ci
558c2ecf20Sopenharmony_ci	switch (size) {
568c2ecf20Sopenharmony_ci        case I2C_SMBUS_QUICK:
578c2ecf20Sopenharmony_ci		buf = NULL;
588c2ecf20Sopenharmony_ci		len = 0;
598c2ecf20Sopenharmony_ci	    	break;
608c2ecf20Sopenharmony_ci        case I2C_SMBUS_BYTE:
618c2ecf20Sopenharmony_ci        case I2C_SMBUS_BYTE_DATA:
628c2ecf20Sopenharmony_ci		buf = &data->byte;
638c2ecf20Sopenharmony_ci		len = 1;
648c2ecf20Sopenharmony_ci	    	break;
658c2ecf20Sopenharmony_ci        case I2C_SMBUS_WORD_DATA:
668c2ecf20Sopenharmony_ci		if (!read) {
678c2ecf20Sopenharmony_ci			local[0] = data->word & 0xff;
688c2ecf20Sopenharmony_ci			local[1] = (data->word >> 8) & 0xff;
698c2ecf20Sopenharmony_ci		}
708c2ecf20Sopenharmony_ci		buf = local;
718c2ecf20Sopenharmony_ci		len = 2;
728c2ecf20Sopenharmony_ci	    	break;
738c2ecf20Sopenharmony_ci
748c2ecf20Sopenharmony_ci	/* Note that these are broken vs. the expected smbus API where
758c2ecf20Sopenharmony_ci	 * on reads, the length is actually returned from the function,
768c2ecf20Sopenharmony_ci	 * but I think the current API makes no sense and I don't want
778c2ecf20Sopenharmony_ci	 * any driver that I haven't verified for correctness to go
788c2ecf20Sopenharmony_ci	 * anywhere near a pmac i2c bus anyway ...
798c2ecf20Sopenharmony_ci	 *
808c2ecf20Sopenharmony_ci	 * I'm also not completely sure what kind of phases to do between
818c2ecf20Sopenharmony_ci	 * the actual command and the data (what I am _supposed_ to do that
828c2ecf20Sopenharmony_ci	 * is). For now, I assume writes are a single stream and reads have
838c2ecf20Sopenharmony_ci	 * a repeat start/addr phase (but not stop in between)
848c2ecf20Sopenharmony_ci	 */
858c2ecf20Sopenharmony_ci        case I2C_SMBUS_BLOCK_DATA:
868c2ecf20Sopenharmony_ci		buf = data->block;
878c2ecf20Sopenharmony_ci		len = data->block[0] + 1;
888c2ecf20Sopenharmony_ci		break;
898c2ecf20Sopenharmony_ci	case I2C_SMBUS_I2C_BLOCK_DATA:
908c2ecf20Sopenharmony_ci		buf = &data->block[1];
918c2ecf20Sopenharmony_ci		len = data->block[0];
928c2ecf20Sopenharmony_ci		break;
938c2ecf20Sopenharmony_ci
948c2ecf20Sopenharmony_ci        default:
958c2ecf20Sopenharmony_ci		return -EINVAL;
968c2ecf20Sopenharmony_ci	}
978c2ecf20Sopenharmony_ci
988c2ecf20Sopenharmony_ci	rc = pmac_i2c_open(bus, 0);
998c2ecf20Sopenharmony_ci	if (rc) {
1008c2ecf20Sopenharmony_ci		dev_err(&adap->dev, "Failed to open I2C, err %d\n", rc);
1018c2ecf20Sopenharmony_ci		return rc;
1028c2ecf20Sopenharmony_ci	}
1038c2ecf20Sopenharmony_ci
1048c2ecf20Sopenharmony_ci	rc = pmac_i2c_setmode(bus, mode);
1058c2ecf20Sopenharmony_ci	if (rc) {
1068c2ecf20Sopenharmony_ci		dev_err(&adap->dev, "Failed to set I2C mode %d, err %d\n",
1078c2ecf20Sopenharmony_ci			mode, rc);
1088c2ecf20Sopenharmony_ci		goto bail;
1098c2ecf20Sopenharmony_ci	}
1108c2ecf20Sopenharmony_ci
1118c2ecf20Sopenharmony_ci	rc = pmac_i2c_xfer(bus, addrdir, subsize, subaddr, buf, len);
1128c2ecf20Sopenharmony_ci	if (rc) {
1138c2ecf20Sopenharmony_ci		if (rc == -ENXIO)
1148c2ecf20Sopenharmony_ci			dev_dbg(&adap->dev,
1158c2ecf20Sopenharmony_ci				"I2C transfer at 0x%02x failed, size %d, "
1168c2ecf20Sopenharmony_ci				"err %d\n", addrdir >> 1, size, rc);
1178c2ecf20Sopenharmony_ci		else
1188c2ecf20Sopenharmony_ci			dev_err(&adap->dev,
1198c2ecf20Sopenharmony_ci				"I2C transfer at 0x%02x failed, size %d, "
1208c2ecf20Sopenharmony_ci				"err %d\n", addrdir >> 1, size, rc);
1218c2ecf20Sopenharmony_ci		goto bail;
1228c2ecf20Sopenharmony_ci	}
1238c2ecf20Sopenharmony_ci
1248c2ecf20Sopenharmony_ci	if (size == I2C_SMBUS_WORD_DATA && read) {
1258c2ecf20Sopenharmony_ci		data->word = ((u16)local[1]) << 8;
1268c2ecf20Sopenharmony_ci		data->word |= local[0];
1278c2ecf20Sopenharmony_ci	}
1288c2ecf20Sopenharmony_ci
1298c2ecf20Sopenharmony_ci bail:
1308c2ecf20Sopenharmony_ci	pmac_i2c_close(bus);
1318c2ecf20Sopenharmony_ci	return rc;
1328c2ecf20Sopenharmony_ci}
1338c2ecf20Sopenharmony_ci
1348c2ecf20Sopenharmony_ci/*
1358c2ecf20Sopenharmony_ci * Generic i2c master transfer entrypoint. This driver only support single
1368c2ecf20Sopenharmony_ci * messages (for "lame i2c" transfers). Anything else should use the smbus
1378c2ecf20Sopenharmony_ci * entry point
1388c2ecf20Sopenharmony_ci */
1398c2ecf20Sopenharmony_cistatic int i2c_powermac_master_xfer(	struct i2c_adapter *adap,
1408c2ecf20Sopenharmony_ci					struct i2c_msg *msgs,
1418c2ecf20Sopenharmony_ci					int num)
1428c2ecf20Sopenharmony_ci{
1438c2ecf20Sopenharmony_ci	struct pmac_i2c_bus	*bus = i2c_get_adapdata(adap);
1448c2ecf20Sopenharmony_ci	int			rc = 0;
1458c2ecf20Sopenharmony_ci	int			addrdir;
1468c2ecf20Sopenharmony_ci
1478c2ecf20Sopenharmony_ci	if (msgs->flags & I2C_M_TEN)
1488c2ecf20Sopenharmony_ci		return -EINVAL;
1498c2ecf20Sopenharmony_ci	addrdir = i2c_8bit_addr_from_msg(msgs);
1508c2ecf20Sopenharmony_ci
1518c2ecf20Sopenharmony_ci	rc = pmac_i2c_open(bus, 0);
1528c2ecf20Sopenharmony_ci	if (rc) {
1538c2ecf20Sopenharmony_ci		dev_err(&adap->dev, "Failed to open I2C, err %d\n", rc);
1548c2ecf20Sopenharmony_ci		return rc;
1558c2ecf20Sopenharmony_ci	}
1568c2ecf20Sopenharmony_ci	rc = pmac_i2c_setmode(bus, pmac_i2c_mode_std);
1578c2ecf20Sopenharmony_ci	if (rc) {
1588c2ecf20Sopenharmony_ci		dev_err(&adap->dev, "Failed to set I2C mode %d, err %d\n",
1598c2ecf20Sopenharmony_ci			pmac_i2c_mode_std, rc);
1608c2ecf20Sopenharmony_ci		goto bail;
1618c2ecf20Sopenharmony_ci	}
1628c2ecf20Sopenharmony_ci	rc = pmac_i2c_xfer(bus, addrdir, 0, 0, msgs->buf, msgs->len);
1638c2ecf20Sopenharmony_ci	if (rc < 0) {
1648c2ecf20Sopenharmony_ci		if (rc == -ENXIO)
1658c2ecf20Sopenharmony_ci			dev_dbg(&adap->dev, "I2C %s 0x%02x failed, err %d\n",
1668c2ecf20Sopenharmony_ci				addrdir & 1 ? "read from" : "write to",
1678c2ecf20Sopenharmony_ci				addrdir >> 1, rc);
1688c2ecf20Sopenharmony_ci		else
1698c2ecf20Sopenharmony_ci			dev_err(&adap->dev, "I2C %s 0x%02x failed, err %d\n",
1708c2ecf20Sopenharmony_ci				addrdir & 1 ? "read from" : "write to",
1718c2ecf20Sopenharmony_ci				addrdir >> 1, rc);
1728c2ecf20Sopenharmony_ci	}
1738c2ecf20Sopenharmony_ci bail:
1748c2ecf20Sopenharmony_ci	pmac_i2c_close(bus);
1758c2ecf20Sopenharmony_ci	return rc < 0 ? rc : 1;
1768c2ecf20Sopenharmony_ci}
1778c2ecf20Sopenharmony_ci
1788c2ecf20Sopenharmony_cistatic u32 i2c_powermac_func(struct i2c_adapter * adapter)
1798c2ecf20Sopenharmony_ci{
1808c2ecf20Sopenharmony_ci	return I2C_FUNC_SMBUS_QUICK | I2C_FUNC_SMBUS_BYTE |
1818c2ecf20Sopenharmony_ci		I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA |
1828c2ecf20Sopenharmony_ci		I2C_FUNC_SMBUS_BLOCK_DATA | I2C_FUNC_I2C;
1838c2ecf20Sopenharmony_ci}
1848c2ecf20Sopenharmony_ci
1858c2ecf20Sopenharmony_ci/* For now, we only handle smbus */
1868c2ecf20Sopenharmony_cistatic const struct i2c_algorithm i2c_powermac_algorithm = {
1878c2ecf20Sopenharmony_ci	.smbus_xfer	= i2c_powermac_smbus_xfer,
1888c2ecf20Sopenharmony_ci	.master_xfer	= i2c_powermac_master_xfer,
1898c2ecf20Sopenharmony_ci	.functionality	= i2c_powermac_func,
1908c2ecf20Sopenharmony_ci};
1918c2ecf20Sopenharmony_ci
1928c2ecf20Sopenharmony_cistatic const struct i2c_adapter_quirks i2c_powermac_quirks = {
1938c2ecf20Sopenharmony_ci	.max_num_msgs = 1,
1948c2ecf20Sopenharmony_ci};
1958c2ecf20Sopenharmony_ci
1968c2ecf20Sopenharmony_cistatic int i2c_powermac_remove(struct platform_device *dev)
1978c2ecf20Sopenharmony_ci{
1988c2ecf20Sopenharmony_ci	struct i2c_adapter	*adapter = platform_get_drvdata(dev);
1998c2ecf20Sopenharmony_ci
2008c2ecf20Sopenharmony_ci	i2c_del_adapter(adapter);
2018c2ecf20Sopenharmony_ci	memset(adapter, 0, sizeof(*adapter));
2028c2ecf20Sopenharmony_ci
2038c2ecf20Sopenharmony_ci	return 0;
2048c2ecf20Sopenharmony_ci}
2058c2ecf20Sopenharmony_ci
2068c2ecf20Sopenharmony_cistatic u32 i2c_powermac_get_addr(struct i2c_adapter *adap,
2078c2ecf20Sopenharmony_ci					   struct pmac_i2c_bus *bus,
2088c2ecf20Sopenharmony_ci					   struct device_node *node)
2098c2ecf20Sopenharmony_ci{
2108c2ecf20Sopenharmony_ci	u32 prop;
2118c2ecf20Sopenharmony_ci	int ret;
2128c2ecf20Sopenharmony_ci
2138c2ecf20Sopenharmony_ci	/* First check for valid "reg" */
2148c2ecf20Sopenharmony_ci	ret = of_property_read_u32(node, "reg", &prop);
2158c2ecf20Sopenharmony_ci	if (ret == 0)
2168c2ecf20Sopenharmony_ci		return (prop & 0xff) >> 1;
2178c2ecf20Sopenharmony_ci
2188c2ecf20Sopenharmony_ci	/* Then check old-style "i2c-address" */
2198c2ecf20Sopenharmony_ci	ret = of_property_read_u32(node, "i2c-address", &prop);
2208c2ecf20Sopenharmony_ci	if (ret == 0)
2218c2ecf20Sopenharmony_ci		return (prop & 0xff) >> 1;
2228c2ecf20Sopenharmony_ci
2238c2ecf20Sopenharmony_ci	/* Now handle some devices with missing "reg" properties */
2248c2ecf20Sopenharmony_ci	if (of_node_name_eq(node, "cereal"))
2258c2ecf20Sopenharmony_ci		return 0x60;
2268c2ecf20Sopenharmony_ci	else if (of_node_name_eq(node, "deq"))
2278c2ecf20Sopenharmony_ci		return 0x34;
2288c2ecf20Sopenharmony_ci
2298c2ecf20Sopenharmony_ci	dev_warn(&adap->dev, "No i2c address for %pOF\n", node);
2308c2ecf20Sopenharmony_ci
2318c2ecf20Sopenharmony_ci	return 0xffffffff;
2328c2ecf20Sopenharmony_ci}
2338c2ecf20Sopenharmony_ci
2348c2ecf20Sopenharmony_cistatic void i2c_powermac_create_one(struct i2c_adapter *adap,
2358c2ecf20Sopenharmony_ci					      const char *type,
2368c2ecf20Sopenharmony_ci					      u32 addr)
2378c2ecf20Sopenharmony_ci{
2388c2ecf20Sopenharmony_ci	struct i2c_board_info info = {};
2398c2ecf20Sopenharmony_ci	struct i2c_client *newdev;
2408c2ecf20Sopenharmony_ci
2418c2ecf20Sopenharmony_ci	strncpy(info.type, type, sizeof(info.type));
2428c2ecf20Sopenharmony_ci	info.addr = addr;
2438c2ecf20Sopenharmony_ci	newdev = i2c_new_client_device(adap, &info);
2448c2ecf20Sopenharmony_ci	if (IS_ERR(newdev))
2458c2ecf20Sopenharmony_ci		dev_err(&adap->dev,
2468c2ecf20Sopenharmony_ci			"i2c-powermac: Failure to register missing %s\n",
2478c2ecf20Sopenharmony_ci			type);
2488c2ecf20Sopenharmony_ci}
2498c2ecf20Sopenharmony_ci
2508c2ecf20Sopenharmony_cistatic void i2c_powermac_add_missing(struct i2c_adapter *adap,
2518c2ecf20Sopenharmony_ci					       struct pmac_i2c_bus *bus,
2528c2ecf20Sopenharmony_ci					       bool found_onyx)
2538c2ecf20Sopenharmony_ci{
2548c2ecf20Sopenharmony_ci	struct device_node *busnode = pmac_i2c_get_bus_node(bus);
2558c2ecf20Sopenharmony_ci	int rc;
2568c2ecf20Sopenharmony_ci
2578c2ecf20Sopenharmony_ci	/* Check for the onyx audio codec */
2588c2ecf20Sopenharmony_ci#define ONYX_REG_CONTROL		67
2598c2ecf20Sopenharmony_ci	if (of_device_is_compatible(busnode, "k2-i2c") && !found_onyx) {
2608c2ecf20Sopenharmony_ci		union i2c_smbus_data data;
2618c2ecf20Sopenharmony_ci
2628c2ecf20Sopenharmony_ci		rc = i2c_smbus_xfer(adap, 0x46, 0, I2C_SMBUS_READ,
2638c2ecf20Sopenharmony_ci				    ONYX_REG_CONTROL, I2C_SMBUS_BYTE_DATA,
2648c2ecf20Sopenharmony_ci				    &data);
2658c2ecf20Sopenharmony_ci		if (rc >= 0)
2668c2ecf20Sopenharmony_ci			i2c_powermac_create_one(adap, "MAC,pcm3052", 0x46);
2678c2ecf20Sopenharmony_ci
2688c2ecf20Sopenharmony_ci		rc = i2c_smbus_xfer(adap, 0x47, 0, I2C_SMBUS_READ,
2698c2ecf20Sopenharmony_ci				    ONYX_REG_CONTROL, I2C_SMBUS_BYTE_DATA,
2708c2ecf20Sopenharmony_ci				    &data);
2718c2ecf20Sopenharmony_ci		if (rc >= 0)
2728c2ecf20Sopenharmony_ci			i2c_powermac_create_one(adap, "MAC,pcm3052", 0x47);
2738c2ecf20Sopenharmony_ci	}
2748c2ecf20Sopenharmony_ci}
2758c2ecf20Sopenharmony_ci
2768c2ecf20Sopenharmony_cistatic bool i2c_powermac_get_type(struct i2c_adapter *adap,
2778c2ecf20Sopenharmony_ci					    struct device_node *node,
2788c2ecf20Sopenharmony_ci					    u32 addr, char *type, int type_size)
2798c2ecf20Sopenharmony_ci{
2808c2ecf20Sopenharmony_ci	char tmp[16];
2818c2ecf20Sopenharmony_ci
2828c2ecf20Sopenharmony_ci	/*
2838c2ecf20Sopenharmony_ci	 * Note: we do _NOT_ want the standard i2c drivers to match with any of
2848c2ecf20Sopenharmony_ci	 * our powermac stuff unless they have been specifically modified to
2858c2ecf20Sopenharmony_ci	 * handle it on a case by case basis. For example, for thermal control,
2868c2ecf20Sopenharmony_ci	 * things like lm75 etc... shall match with their corresponding
2878c2ecf20Sopenharmony_ci	 * windfarm drivers, _NOT_ the generic ones, so we force a prefix of
2888c2ecf20Sopenharmony_ci	 * 'MAC', onto the modalias to make that happen
2898c2ecf20Sopenharmony_ci	 */
2908c2ecf20Sopenharmony_ci
2918c2ecf20Sopenharmony_ci	/* First try proper modalias */
2928c2ecf20Sopenharmony_ci	if (of_modalias_node(node, tmp, sizeof(tmp)) >= 0) {
2938c2ecf20Sopenharmony_ci		snprintf(type, type_size, "MAC,%s", tmp);
2948c2ecf20Sopenharmony_ci		return true;
2958c2ecf20Sopenharmony_ci	}
2968c2ecf20Sopenharmony_ci
2978c2ecf20Sopenharmony_ci	/* Now look for known workarounds */
2988c2ecf20Sopenharmony_ci	if (of_node_name_eq(node, "deq")) {
2998c2ecf20Sopenharmony_ci		/* Apple uses address 0x34 for TAS3001 and 0x35 for TAS3004 */
3008c2ecf20Sopenharmony_ci		if (addr == 0x34) {
3018c2ecf20Sopenharmony_ci			snprintf(type, type_size, "MAC,tas3001");
3028c2ecf20Sopenharmony_ci			return true;
3038c2ecf20Sopenharmony_ci		} else if (addr == 0x35) {
3048c2ecf20Sopenharmony_ci			snprintf(type, type_size, "MAC,tas3004");
3058c2ecf20Sopenharmony_ci			return true;
3068c2ecf20Sopenharmony_ci		}
3078c2ecf20Sopenharmony_ci	}
3088c2ecf20Sopenharmony_ci
3098c2ecf20Sopenharmony_ci	dev_err(&adap->dev, "i2c-powermac: modalias failure on %pOF\n", node);
3108c2ecf20Sopenharmony_ci	return false;
3118c2ecf20Sopenharmony_ci}
3128c2ecf20Sopenharmony_ci
3138c2ecf20Sopenharmony_cistatic void i2c_powermac_register_devices(struct i2c_adapter *adap,
3148c2ecf20Sopenharmony_ci						    struct pmac_i2c_bus *bus)
3158c2ecf20Sopenharmony_ci{
3168c2ecf20Sopenharmony_ci	struct i2c_client *newdev;
3178c2ecf20Sopenharmony_ci	struct device_node *node;
3188c2ecf20Sopenharmony_ci	bool found_onyx = false;
3198c2ecf20Sopenharmony_ci
3208c2ecf20Sopenharmony_ci	/*
3218c2ecf20Sopenharmony_ci	 * In some cases we end up with the via-pmu node itself, in this
3228c2ecf20Sopenharmony_ci	 * case we skip this function completely as the device-tree will
3238c2ecf20Sopenharmony_ci	 * not contain anything useful.
3248c2ecf20Sopenharmony_ci	 */
3258c2ecf20Sopenharmony_ci	if (of_node_name_eq(adap->dev.of_node, "via-pmu"))
3268c2ecf20Sopenharmony_ci		return;
3278c2ecf20Sopenharmony_ci
3288c2ecf20Sopenharmony_ci	for_each_child_of_node(adap->dev.of_node, node) {
3298c2ecf20Sopenharmony_ci		struct i2c_board_info info = {};
3308c2ecf20Sopenharmony_ci		u32 addr;
3318c2ecf20Sopenharmony_ci
3328c2ecf20Sopenharmony_ci		/* Get address & channel */
3338c2ecf20Sopenharmony_ci		addr = i2c_powermac_get_addr(adap, bus, node);
3348c2ecf20Sopenharmony_ci		if (addr == 0xffffffff)
3358c2ecf20Sopenharmony_ci			continue;
3368c2ecf20Sopenharmony_ci
3378c2ecf20Sopenharmony_ci		/* Multibus setup, check channel */
3388c2ecf20Sopenharmony_ci		if (!pmac_i2c_match_adapter(node, adap))
3398c2ecf20Sopenharmony_ci			continue;
3408c2ecf20Sopenharmony_ci
3418c2ecf20Sopenharmony_ci		dev_dbg(&adap->dev, "i2c-powermac: register %pOF\n", node);
3428c2ecf20Sopenharmony_ci
3438c2ecf20Sopenharmony_ci		/*
3448c2ecf20Sopenharmony_ci		 * Keep track of some device existence to handle
3458c2ecf20Sopenharmony_ci		 * workarounds later.
3468c2ecf20Sopenharmony_ci		 */
3478c2ecf20Sopenharmony_ci		if (of_device_is_compatible(node, "pcm3052"))
3488c2ecf20Sopenharmony_ci			found_onyx = true;
3498c2ecf20Sopenharmony_ci
3508c2ecf20Sopenharmony_ci		/* Make up a modalias */
3518c2ecf20Sopenharmony_ci		if (!i2c_powermac_get_type(adap, node, addr,
3528c2ecf20Sopenharmony_ci					   info.type, sizeof(info.type))) {
3538c2ecf20Sopenharmony_ci			continue;
3548c2ecf20Sopenharmony_ci		}
3558c2ecf20Sopenharmony_ci
3568c2ecf20Sopenharmony_ci		/* Fill out the rest of the info structure */
3578c2ecf20Sopenharmony_ci		info.addr = addr;
3588c2ecf20Sopenharmony_ci		info.irq = irq_of_parse_and_map(node, 0);
3598c2ecf20Sopenharmony_ci		info.of_node = of_node_get(node);
3608c2ecf20Sopenharmony_ci
3618c2ecf20Sopenharmony_ci		newdev = i2c_new_client_device(adap, &info);
3628c2ecf20Sopenharmony_ci		if (IS_ERR(newdev)) {
3638c2ecf20Sopenharmony_ci			dev_err(&adap->dev, "i2c-powermac: Failure to register"
3648c2ecf20Sopenharmony_ci				" %pOF\n", node);
3658c2ecf20Sopenharmony_ci			of_node_put(node);
3668c2ecf20Sopenharmony_ci			/* We do not dispose of the interrupt mapping on
3678c2ecf20Sopenharmony_ci			 * purpose. It's not necessary (interrupt cannot be
3688c2ecf20Sopenharmony_ci			 * re-used) and somebody else might have grabbed it
3698c2ecf20Sopenharmony_ci			 * via direct DT lookup so let's not bother
3708c2ecf20Sopenharmony_ci			 */
3718c2ecf20Sopenharmony_ci			continue;
3728c2ecf20Sopenharmony_ci		}
3738c2ecf20Sopenharmony_ci	}
3748c2ecf20Sopenharmony_ci
3758c2ecf20Sopenharmony_ci	/* Additional workarounds */
3768c2ecf20Sopenharmony_ci	i2c_powermac_add_missing(adap, bus, found_onyx);
3778c2ecf20Sopenharmony_ci}
3788c2ecf20Sopenharmony_ci
3798c2ecf20Sopenharmony_cistatic int i2c_powermac_probe(struct platform_device *dev)
3808c2ecf20Sopenharmony_ci{
3818c2ecf20Sopenharmony_ci	struct pmac_i2c_bus *bus = dev_get_platdata(&dev->dev);
3828c2ecf20Sopenharmony_ci	struct device_node *parent;
3838c2ecf20Sopenharmony_ci	struct i2c_adapter *adapter;
3848c2ecf20Sopenharmony_ci	int rc;
3858c2ecf20Sopenharmony_ci
3868c2ecf20Sopenharmony_ci	if (bus == NULL)
3878c2ecf20Sopenharmony_ci		return -EINVAL;
3888c2ecf20Sopenharmony_ci	adapter = pmac_i2c_get_adapter(bus);
3898c2ecf20Sopenharmony_ci
3908c2ecf20Sopenharmony_ci	/* Ok, now we need to make up a name for the interface that will
3918c2ecf20Sopenharmony_ci	 * match what we used to do in the past, that is basically the
3928c2ecf20Sopenharmony_ci	 * controller's parent device node for keywest. PMU didn't have a
3938c2ecf20Sopenharmony_ci	 * naming convention and SMU has a different one
3948c2ecf20Sopenharmony_ci	 */
3958c2ecf20Sopenharmony_ci	switch(pmac_i2c_get_type(bus)) {
3968c2ecf20Sopenharmony_ci	case pmac_i2c_bus_keywest:
3978c2ecf20Sopenharmony_ci		parent = of_get_parent(pmac_i2c_get_controller(bus));
3988c2ecf20Sopenharmony_ci		if (parent == NULL)
3998c2ecf20Sopenharmony_ci			return -EINVAL;
4008c2ecf20Sopenharmony_ci		snprintf(adapter->name, sizeof(adapter->name), "%pOFn %d",
4018c2ecf20Sopenharmony_ci			 parent,
4028c2ecf20Sopenharmony_ci			 pmac_i2c_get_channel(bus));
4038c2ecf20Sopenharmony_ci		of_node_put(parent);
4048c2ecf20Sopenharmony_ci		break;
4058c2ecf20Sopenharmony_ci	case pmac_i2c_bus_pmu:
4068c2ecf20Sopenharmony_ci		snprintf(adapter->name, sizeof(adapter->name), "pmu %d",
4078c2ecf20Sopenharmony_ci			 pmac_i2c_get_channel(bus));
4088c2ecf20Sopenharmony_ci		break;
4098c2ecf20Sopenharmony_ci	case pmac_i2c_bus_smu:
4108c2ecf20Sopenharmony_ci		/* This is not what we used to do but I'm fixing drivers at
4118c2ecf20Sopenharmony_ci		 * the same time as this change
4128c2ecf20Sopenharmony_ci		 */
4138c2ecf20Sopenharmony_ci		snprintf(adapter->name, sizeof(adapter->name), "smu %d",
4148c2ecf20Sopenharmony_ci			 pmac_i2c_get_channel(bus));
4158c2ecf20Sopenharmony_ci		break;
4168c2ecf20Sopenharmony_ci	default:
4178c2ecf20Sopenharmony_ci		return -EINVAL;
4188c2ecf20Sopenharmony_ci	}
4198c2ecf20Sopenharmony_ci
4208c2ecf20Sopenharmony_ci	platform_set_drvdata(dev, adapter);
4218c2ecf20Sopenharmony_ci	adapter->algo = &i2c_powermac_algorithm;
4228c2ecf20Sopenharmony_ci	adapter->quirks = &i2c_powermac_quirks;
4238c2ecf20Sopenharmony_ci	i2c_set_adapdata(adapter, bus);
4248c2ecf20Sopenharmony_ci	adapter->dev.parent = &dev->dev;
4258c2ecf20Sopenharmony_ci
4268c2ecf20Sopenharmony_ci	/* Clear of_node to skip automatic registration of i2c child nodes */
4278c2ecf20Sopenharmony_ci	adapter->dev.of_node = NULL;
4288c2ecf20Sopenharmony_ci	rc = i2c_add_adapter(adapter);
4298c2ecf20Sopenharmony_ci	if (rc) {
4308c2ecf20Sopenharmony_ci		printk(KERN_ERR "i2c-powermac: Adapter %s registration "
4318c2ecf20Sopenharmony_ci		       "failed\n", adapter->name);
4328c2ecf20Sopenharmony_ci		memset(adapter, 0, sizeof(*adapter));
4338c2ecf20Sopenharmony_ci		return rc;
4348c2ecf20Sopenharmony_ci	}
4358c2ecf20Sopenharmony_ci
4368c2ecf20Sopenharmony_ci	printk(KERN_INFO "PowerMac i2c bus %s registered\n", adapter->name);
4378c2ecf20Sopenharmony_ci
4388c2ecf20Sopenharmony_ci	/* Use custom child registration due to Apple device-tree funkyness */
4398c2ecf20Sopenharmony_ci	adapter->dev.of_node = dev->dev.of_node;
4408c2ecf20Sopenharmony_ci	i2c_powermac_register_devices(adapter, bus);
4418c2ecf20Sopenharmony_ci
4428c2ecf20Sopenharmony_ci	return 0;
4438c2ecf20Sopenharmony_ci}
4448c2ecf20Sopenharmony_ci
4458c2ecf20Sopenharmony_cistatic struct platform_driver i2c_powermac_driver = {
4468c2ecf20Sopenharmony_ci	.probe = i2c_powermac_probe,
4478c2ecf20Sopenharmony_ci	.remove = i2c_powermac_remove,
4488c2ecf20Sopenharmony_ci	.driver = {
4498c2ecf20Sopenharmony_ci		.name = "i2c-powermac",
4508c2ecf20Sopenharmony_ci		.bus = &platform_bus_type,
4518c2ecf20Sopenharmony_ci	},
4528c2ecf20Sopenharmony_ci};
4538c2ecf20Sopenharmony_ci
4548c2ecf20Sopenharmony_cimodule_platform_driver(i2c_powermac_driver);
4558c2ecf20Sopenharmony_ci
4568c2ecf20Sopenharmony_ciMODULE_ALIAS("platform:i2c-powermac");
457