xref: /openbmc/linux/drivers/mfd/lochnagar-i2c.c (revision d20642ad)
1422dcafeSCharles Keepax // SPDX-License-Identifier: GPL-2.0
2422dcafeSCharles Keepax /*
3422dcafeSCharles Keepax  * Lochnagar I2C bus interface
4422dcafeSCharles Keepax  *
5422dcafeSCharles Keepax  * Copyright (c) 2012-2018 Cirrus Logic, Inc. and
6422dcafeSCharles Keepax  *                         Cirrus Logic International Semiconductor Ltd.
7422dcafeSCharles Keepax  *
8422dcafeSCharles Keepax  * Author: Charles Keepax <ckeepax@opensource.cirrus.com>
9422dcafeSCharles Keepax  */
10422dcafeSCharles Keepax 
11422dcafeSCharles Keepax #include <linux/delay.h>
12422dcafeSCharles Keepax #include <linux/device.h>
13422dcafeSCharles Keepax #include <linux/err.h>
14422dcafeSCharles Keepax #include <linux/gpio/consumer.h>
15422dcafeSCharles Keepax #include <linux/i2c.h>
16422dcafeSCharles Keepax #include <linux/lockdep.h>
17422dcafeSCharles Keepax #include <linux/mfd/core.h>
18422dcafeSCharles Keepax #include <linux/mutex.h>
19422dcafeSCharles Keepax #include <linux/of.h>
20422dcafeSCharles Keepax #include <linux/of_platform.h>
21422dcafeSCharles Keepax #include <linux/regmap.h>
22422dcafeSCharles Keepax 
23422dcafeSCharles Keepax #include <linux/mfd/lochnagar.h>
24422dcafeSCharles Keepax #include <linux/mfd/lochnagar1_regs.h>
25422dcafeSCharles Keepax #include <linux/mfd/lochnagar2_regs.h>
26422dcafeSCharles Keepax 
27422dcafeSCharles Keepax #define LOCHNAGAR_BOOT_RETRIES		10
28422dcafeSCharles Keepax #define LOCHNAGAR_BOOT_DELAY_MS		350
29422dcafeSCharles Keepax 
30422dcafeSCharles Keepax #define LOCHNAGAR_CONFIG_POLL_US	10000
31422dcafeSCharles Keepax 
lochnagar1_readable_register(struct device * dev,unsigned int reg)32422dcafeSCharles Keepax static bool lochnagar1_readable_register(struct device *dev, unsigned int reg)
33422dcafeSCharles Keepax {
34422dcafeSCharles Keepax 	switch (reg) {
35422dcafeSCharles Keepax 	case LOCHNAGAR_SOFTWARE_RESET:
36422dcafeSCharles Keepax 	case LOCHNAGAR_FIRMWARE_ID1...LOCHNAGAR_FIRMWARE_ID2:
37422dcafeSCharles Keepax 	case LOCHNAGAR1_CDC_AIF1_SEL...LOCHNAGAR1_CDC_AIF3_SEL:
38422dcafeSCharles Keepax 	case LOCHNAGAR1_CDC_MCLK1_SEL...LOCHNAGAR1_CDC_MCLK2_SEL:
39422dcafeSCharles Keepax 	case LOCHNAGAR1_CDC_AIF_CTRL1...LOCHNAGAR1_CDC_AIF_CTRL2:
40422dcafeSCharles Keepax 	case LOCHNAGAR1_EXT_AIF_CTRL:
41422dcafeSCharles Keepax 	case LOCHNAGAR1_DSP_AIF1_SEL...LOCHNAGAR1_DSP_AIF2_SEL:
42422dcafeSCharles Keepax 	case LOCHNAGAR1_DSP_CLKIN_SEL:
43422dcafeSCharles Keepax 	case LOCHNAGAR1_DSP_AIF:
44422dcafeSCharles Keepax 	case LOCHNAGAR1_GF_AIF1...LOCHNAGAR1_GF_AIF2:
45422dcafeSCharles Keepax 	case LOCHNAGAR1_PSIA_AIF:
46422dcafeSCharles Keepax 	case LOCHNAGAR1_PSIA1_SEL...LOCHNAGAR1_PSIA2_SEL:
47422dcafeSCharles Keepax 	case LOCHNAGAR1_SPDIF_AIF_SEL:
48422dcafeSCharles Keepax 	case LOCHNAGAR1_GF_AIF3_SEL...LOCHNAGAR1_GF_AIF4_SEL:
49422dcafeSCharles Keepax 	case LOCHNAGAR1_GF_CLKOUT1_SEL:
50422dcafeSCharles Keepax 	case LOCHNAGAR1_GF_AIF1_SEL...LOCHNAGAR1_GF_AIF2_SEL:
51422dcafeSCharles Keepax 	case LOCHNAGAR1_GF_GPIO2...LOCHNAGAR1_GF_GPIO7:
52422dcafeSCharles Keepax 	case LOCHNAGAR1_RST:
53422dcafeSCharles Keepax 	case LOCHNAGAR1_LED1...LOCHNAGAR1_LED2:
54422dcafeSCharles Keepax 	case LOCHNAGAR1_I2C_CTRL:
55422dcafeSCharles Keepax 		return true;
56422dcafeSCharles Keepax 	default:
57422dcafeSCharles Keepax 		return false;
58422dcafeSCharles Keepax 	}
59422dcafeSCharles Keepax }
60422dcafeSCharles Keepax 
61422dcafeSCharles Keepax static const struct regmap_config lochnagar1_i2c_regmap = {
62422dcafeSCharles Keepax 	.reg_bits = 8,
63422dcafeSCharles Keepax 	.val_bits = 8,
64422dcafeSCharles Keepax 	.reg_format_endian = REGMAP_ENDIAN_BIG,
65422dcafeSCharles Keepax 	.val_format_endian = REGMAP_ENDIAN_BIG,
66422dcafeSCharles Keepax 
67422dcafeSCharles Keepax 	.max_register = 0x50,
68422dcafeSCharles Keepax 	.readable_reg = lochnagar1_readable_register,
69422dcafeSCharles Keepax 
70422dcafeSCharles Keepax 	.use_single_read = true,
71422dcafeSCharles Keepax 	.use_single_write = true,
72422dcafeSCharles Keepax 
73422dcafeSCharles Keepax 	.cache_type = REGCACHE_RBTREE,
74422dcafeSCharles Keepax };
75422dcafeSCharles Keepax 
76422dcafeSCharles Keepax static const struct reg_sequence lochnagar1_patch[] = {
77422dcafeSCharles Keepax 	{ 0x40, 0x0083 },
78422dcafeSCharles Keepax 	{ 0x47, 0x0018 },
79422dcafeSCharles Keepax 	{ 0x50, 0x0000 },
80422dcafeSCharles Keepax };
81422dcafeSCharles Keepax 
lochnagar2_readable_register(struct device * dev,unsigned int reg)82422dcafeSCharles Keepax static bool lochnagar2_readable_register(struct device *dev, unsigned int reg)
83422dcafeSCharles Keepax {
84422dcafeSCharles Keepax 	switch (reg) {
85422dcafeSCharles Keepax 	case LOCHNAGAR_SOFTWARE_RESET:
86422dcafeSCharles Keepax 	case LOCHNAGAR_FIRMWARE_ID1...LOCHNAGAR_FIRMWARE_ID2:
87422dcafeSCharles Keepax 	case LOCHNAGAR2_CDC_AIF1_CTRL...LOCHNAGAR2_CDC_AIF3_CTRL:
88422dcafeSCharles Keepax 	case LOCHNAGAR2_DSP_AIF1_CTRL...LOCHNAGAR2_DSP_AIF2_CTRL:
89422dcafeSCharles Keepax 	case LOCHNAGAR2_PSIA1_CTRL...LOCHNAGAR2_PSIA2_CTRL:
90422dcafeSCharles Keepax 	case LOCHNAGAR2_GF_AIF3_CTRL...LOCHNAGAR2_GF_AIF4_CTRL:
91422dcafeSCharles Keepax 	case LOCHNAGAR2_GF_AIF1_CTRL...LOCHNAGAR2_GF_AIF2_CTRL:
92422dcafeSCharles Keepax 	case LOCHNAGAR2_SPDIF_AIF_CTRL:
93422dcafeSCharles Keepax 	case LOCHNAGAR2_USB_AIF1_CTRL...LOCHNAGAR2_USB_AIF2_CTRL:
94422dcafeSCharles Keepax 	case LOCHNAGAR2_ADAT_AIF_CTRL:
95422dcafeSCharles Keepax 	case LOCHNAGAR2_CDC_MCLK1_CTRL...LOCHNAGAR2_CDC_MCLK2_CTRL:
96422dcafeSCharles Keepax 	case LOCHNAGAR2_DSP_CLKIN_CTRL:
97422dcafeSCharles Keepax 	case LOCHNAGAR2_PSIA1_MCLK_CTRL...LOCHNAGAR2_PSIA2_MCLK_CTRL:
98422dcafeSCharles Keepax 	case LOCHNAGAR2_SPDIF_MCLK_CTRL:
99422dcafeSCharles Keepax 	case LOCHNAGAR2_GF_CLKOUT1_CTRL...LOCHNAGAR2_GF_CLKOUT2_CTRL:
100422dcafeSCharles Keepax 	case LOCHNAGAR2_ADAT_MCLK_CTRL:
101422dcafeSCharles Keepax 	case LOCHNAGAR2_SOUNDCARD_MCLK_CTRL:
102422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_FPGA_GPIO1...LOCHNAGAR2_GPIO_FPGA_GPIO6:
103422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_CDC_GPIO1...LOCHNAGAR2_GPIO_CDC_GPIO8:
104422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_DSP_GPIO1...LOCHNAGAR2_GPIO_DSP_GPIO6:
105422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_GF_GPIO2...LOCHNAGAR2_GPIO_GF_GPIO7:
106422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_CDC_AIF1_BCLK...LOCHNAGAR2_GPIO_CDC_AIF3_TXDAT:
107422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_DSP_AIF1_BCLK...LOCHNAGAR2_GPIO_DSP_AIF2_TXDAT:
108422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_PSIA1_BCLK...LOCHNAGAR2_GPIO_PSIA2_TXDAT:
109422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_GF_AIF3_BCLK...LOCHNAGAR2_GPIO_GF_AIF4_TXDAT:
110422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_GF_AIF1_BCLK...LOCHNAGAR2_GPIO_GF_AIF2_TXDAT:
111422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_DSP_UART1_RX...LOCHNAGAR2_GPIO_DSP_UART2_TX:
112422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_GF_UART2_RX...LOCHNAGAR2_GPIO_GF_UART2_TX:
113422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_USB_UART_RX:
114422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_CDC_PDMCLK1...LOCHNAGAR2_GPIO_CDC_PDMDAT2:
115422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_CDC_DMICCLK1...LOCHNAGAR2_GPIO_CDC_DMICDAT4:
116422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_DSP_DMICCLK1...LOCHNAGAR2_GPIO_DSP_DMICDAT2:
117422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_I2C2_SCL...LOCHNAGAR2_GPIO_I2C4_SDA:
118422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_DSP_STANDBY:
119422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_CDC_MCLK1...LOCHNAGAR2_GPIO_CDC_MCLK2:
120422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_DSP_CLKIN:
121422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_PSIA1_MCLK...LOCHNAGAR2_GPIO_PSIA2_MCLK:
122422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_GF_GPIO1...LOCHNAGAR2_GPIO_GF_GPIO5:
123422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_DSP_GPIO20:
124422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_CHANNEL1...LOCHNAGAR2_GPIO_CHANNEL16:
125422dcafeSCharles Keepax 	case LOCHNAGAR2_MINICARD_RESETS:
126422dcafeSCharles Keepax 	case LOCHNAGAR2_ANALOGUE_PATH_CTRL1...LOCHNAGAR2_ANALOGUE_PATH_CTRL2:
127422dcafeSCharles Keepax 	case LOCHNAGAR2_COMMS_CTRL4:
128422dcafeSCharles Keepax 	case LOCHNAGAR2_SPDIF_CTRL:
129422dcafeSCharles Keepax 	case LOCHNAGAR2_IMON_CTRL1...LOCHNAGAR2_IMON_CTRL4:
130422dcafeSCharles Keepax 	case LOCHNAGAR2_IMON_DATA1...LOCHNAGAR2_IMON_DATA2:
131422dcafeSCharles Keepax 	case LOCHNAGAR2_POWER_CTRL:
132422dcafeSCharles Keepax 	case LOCHNAGAR2_MICVDD_CTRL1:
133422dcafeSCharles Keepax 	case LOCHNAGAR2_MICVDD_CTRL2:
134422dcafeSCharles Keepax 	case LOCHNAGAR2_VDDCORE_CDC_CTRL1:
135422dcafeSCharles Keepax 	case LOCHNAGAR2_VDDCORE_CDC_CTRL2:
136422dcafeSCharles Keepax 	case LOCHNAGAR2_SOUNDCARD_AIF_CTRL:
137422dcafeSCharles Keepax 		return true;
138422dcafeSCharles Keepax 	default:
139422dcafeSCharles Keepax 		return false;
140422dcafeSCharles Keepax 	}
141422dcafeSCharles Keepax }
142422dcafeSCharles Keepax 
lochnagar2_volatile_register(struct device * dev,unsigned int reg)143422dcafeSCharles Keepax static bool lochnagar2_volatile_register(struct device *dev, unsigned int reg)
144422dcafeSCharles Keepax {
145422dcafeSCharles Keepax 	switch (reg) {
146422dcafeSCharles Keepax 	case LOCHNAGAR2_GPIO_CHANNEL1...LOCHNAGAR2_GPIO_CHANNEL16:
147422dcafeSCharles Keepax 	case LOCHNAGAR2_ANALOGUE_PATH_CTRL1:
148422dcafeSCharles Keepax 	case LOCHNAGAR2_IMON_CTRL3...LOCHNAGAR2_IMON_CTRL4:
149422dcafeSCharles Keepax 	case LOCHNAGAR2_IMON_DATA1...LOCHNAGAR2_IMON_DATA2:
150422dcafeSCharles Keepax 		return true;
151422dcafeSCharles Keepax 	default:
152422dcafeSCharles Keepax 		return false;
153422dcafeSCharles Keepax 	}
154422dcafeSCharles Keepax }
155422dcafeSCharles Keepax 
156422dcafeSCharles Keepax static const struct regmap_config lochnagar2_i2c_regmap = {
157422dcafeSCharles Keepax 	.reg_bits = 16,
158422dcafeSCharles Keepax 	.val_bits = 16,
159422dcafeSCharles Keepax 	.reg_format_endian = REGMAP_ENDIAN_BIG,
160422dcafeSCharles Keepax 	.val_format_endian = REGMAP_ENDIAN_BIG,
161422dcafeSCharles Keepax 
162422dcafeSCharles Keepax 	.max_register = 0x1F1F,
163422dcafeSCharles Keepax 	.readable_reg = lochnagar2_readable_register,
164422dcafeSCharles Keepax 	.volatile_reg = lochnagar2_volatile_register,
165422dcafeSCharles Keepax 
166422dcafeSCharles Keepax 	.cache_type = REGCACHE_RBTREE,
167422dcafeSCharles Keepax };
168422dcafeSCharles Keepax 
169422dcafeSCharles Keepax static const struct reg_sequence lochnagar2_patch[] = {
170422dcafeSCharles Keepax 	{ 0x00EE, 0x0000 },
171422dcafeSCharles Keepax };
172422dcafeSCharles Keepax 
173422dcafeSCharles Keepax struct lochnagar_config {
174422dcafeSCharles Keepax 	int id;
175422dcafeSCharles Keepax 	const char * const name;
176422dcafeSCharles Keepax 	enum lochnagar_type type;
177422dcafeSCharles Keepax 	const struct regmap_config *regmap;
178422dcafeSCharles Keepax 	const struct reg_sequence *patch;
179422dcafeSCharles Keepax 	int npatch;
180422dcafeSCharles Keepax };
181422dcafeSCharles Keepax 
182422dcafeSCharles Keepax static struct lochnagar_config lochnagar_configs[] = {
183422dcafeSCharles Keepax 	{
184422dcafeSCharles Keepax 		.id = 0x50,
185422dcafeSCharles Keepax 		.name = "lochnagar1",
186422dcafeSCharles Keepax 		.type = LOCHNAGAR1,
187422dcafeSCharles Keepax 		.regmap = &lochnagar1_i2c_regmap,
188422dcafeSCharles Keepax 		.patch = lochnagar1_patch,
189422dcafeSCharles Keepax 		.npatch = ARRAY_SIZE(lochnagar1_patch),
190422dcafeSCharles Keepax 	},
191422dcafeSCharles Keepax 	{
192422dcafeSCharles Keepax 		.id = 0xCB58,
193422dcafeSCharles Keepax 		.name = "lochnagar2",
194422dcafeSCharles Keepax 		.type = LOCHNAGAR2,
195422dcafeSCharles Keepax 		.regmap = &lochnagar2_i2c_regmap,
196422dcafeSCharles Keepax 		.patch = lochnagar2_patch,
197422dcafeSCharles Keepax 		.npatch = ARRAY_SIZE(lochnagar2_patch),
198422dcafeSCharles Keepax 	},
199422dcafeSCharles Keepax };
200422dcafeSCharles Keepax 
201422dcafeSCharles Keepax static const struct of_device_id lochnagar_of_match[] = {
202422dcafeSCharles Keepax 	{ .compatible = "cirrus,lochnagar1", .data = &lochnagar_configs[0] },
203422dcafeSCharles Keepax 	{ .compatible = "cirrus,lochnagar2", .data = &lochnagar_configs[1] },
204422dcafeSCharles Keepax 	{},
205422dcafeSCharles Keepax };
206422dcafeSCharles Keepax 
lochnagar_wait_for_boot(struct regmap * regmap,unsigned int * id)207422dcafeSCharles Keepax static int lochnagar_wait_for_boot(struct regmap *regmap, unsigned int *id)
208422dcafeSCharles Keepax {
209422dcafeSCharles Keepax 	int i, ret;
210422dcafeSCharles Keepax 
211422dcafeSCharles Keepax 	for (i = 0; i < LOCHNAGAR_BOOT_RETRIES; ++i) {
212422dcafeSCharles Keepax 		msleep(LOCHNAGAR_BOOT_DELAY_MS);
213422dcafeSCharles Keepax 
214422dcafeSCharles Keepax 		/* The reset register will return the device ID when read */
215422dcafeSCharles Keepax 		ret = regmap_read(regmap, LOCHNAGAR_SOFTWARE_RESET, id);
216422dcafeSCharles Keepax 		if (!ret)
217422dcafeSCharles Keepax 			return ret;
218422dcafeSCharles Keepax 	}
219422dcafeSCharles Keepax 
220422dcafeSCharles Keepax 	return -ETIMEDOUT;
221422dcafeSCharles Keepax }
222422dcafeSCharles Keepax 
223422dcafeSCharles Keepax /**
224422dcafeSCharles Keepax  * lochnagar_update_config - Synchronise the boards analogue configuration to
225422dcafeSCharles Keepax  *                           the hardware.
226422dcafeSCharles Keepax  *
227422dcafeSCharles Keepax  * @lochnagar: A pointer to the primary core data structure.
228422dcafeSCharles Keepax  *
229422dcafeSCharles Keepax  * Return: Zero on success or an appropriate negative error code on failure.
230422dcafeSCharles Keepax  */
lochnagar_update_config(struct lochnagar * lochnagar)231422dcafeSCharles Keepax int lochnagar_update_config(struct lochnagar *lochnagar)
232422dcafeSCharles Keepax {
233422dcafeSCharles Keepax 	struct regmap *regmap = lochnagar->regmap;
234422dcafeSCharles Keepax 	unsigned int done = LOCHNAGAR2_ANALOGUE_PATH_UPDATE_STS_MASK;
235422dcafeSCharles Keepax 	int timeout_ms = LOCHNAGAR_BOOT_DELAY_MS * LOCHNAGAR_BOOT_RETRIES;
236422dcafeSCharles Keepax 	unsigned int val = 0;
237422dcafeSCharles Keepax 	int ret;
238422dcafeSCharles Keepax 
239422dcafeSCharles Keepax 	lockdep_assert_held(&lochnagar->analogue_config_lock);
240422dcafeSCharles Keepax 
241422dcafeSCharles Keepax 	if (lochnagar->type != LOCHNAGAR2)
242422dcafeSCharles Keepax 		return 0;
243422dcafeSCharles Keepax 
244422dcafeSCharles Keepax 	/*
245422dcafeSCharles Keepax 	 * Toggle the ANALOGUE_PATH_UPDATE bit and wait for the device to
246422dcafeSCharles Keepax 	 * acknowledge that any outstanding changes to the analogue
247422dcafeSCharles Keepax 	 * configuration have been applied.
248422dcafeSCharles Keepax 	 */
249422dcafeSCharles Keepax 	ret = regmap_write(regmap, LOCHNAGAR2_ANALOGUE_PATH_CTRL1, 0);
250422dcafeSCharles Keepax 	if (ret < 0)
251422dcafeSCharles Keepax 		return ret;
252422dcafeSCharles Keepax 
253422dcafeSCharles Keepax 	ret = regmap_write(regmap, LOCHNAGAR2_ANALOGUE_PATH_CTRL1,
254422dcafeSCharles Keepax 			   LOCHNAGAR2_ANALOGUE_PATH_UPDATE_MASK);
255422dcafeSCharles Keepax 	if (ret < 0)
256422dcafeSCharles Keepax 		return ret;
257422dcafeSCharles Keepax 
258422dcafeSCharles Keepax 	ret = regmap_read_poll_timeout(regmap,
259422dcafeSCharles Keepax 				       LOCHNAGAR2_ANALOGUE_PATH_CTRL1, val,
260422dcafeSCharles Keepax 				       (val & done), LOCHNAGAR_CONFIG_POLL_US,
261422dcafeSCharles Keepax 				       timeout_ms * 1000);
262422dcafeSCharles Keepax 	if (ret < 0)
263422dcafeSCharles Keepax 		return ret;
264422dcafeSCharles Keepax 
265422dcafeSCharles Keepax 	return 0;
266422dcafeSCharles Keepax }
267422dcafeSCharles Keepax EXPORT_SYMBOL_GPL(lochnagar_update_config);
268422dcafeSCharles Keepax 
lochnagar_i2c_probe(struct i2c_client * i2c)269422dcafeSCharles Keepax static int lochnagar_i2c_probe(struct i2c_client *i2c)
270422dcafeSCharles Keepax {
271422dcafeSCharles Keepax 	struct device *dev = &i2c->dev;
272422dcafeSCharles Keepax 	const struct lochnagar_config *config = NULL;
273422dcafeSCharles Keepax 	const struct of_device_id *of_id;
274422dcafeSCharles Keepax 	struct lochnagar *lochnagar;
275422dcafeSCharles Keepax 	struct gpio_desc *reset, *present;
276422dcafeSCharles Keepax 	unsigned int val;
277422dcafeSCharles Keepax 	unsigned int firmwareid;
278422dcafeSCharles Keepax 	unsigned int devid, rev;
279422dcafeSCharles Keepax 	int ret;
280422dcafeSCharles Keepax 
281422dcafeSCharles Keepax 	lochnagar = devm_kzalloc(dev, sizeof(*lochnagar), GFP_KERNEL);
282422dcafeSCharles Keepax 	if (!lochnagar)
283422dcafeSCharles Keepax 		return -ENOMEM;
284422dcafeSCharles Keepax 
285422dcafeSCharles Keepax 	of_id = of_match_device(lochnagar_of_match, dev);
286422dcafeSCharles Keepax 	if (!of_id)
287422dcafeSCharles Keepax 		return -EINVAL;
288422dcafeSCharles Keepax 
289422dcafeSCharles Keepax 	config = of_id->data;
290422dcafeSCharles Keepax 
291422dcafeSCharles Keepax 	lochnagar->dev = dev;
292422dcafeSCharles Keepax 	mutex_init(&lochnagar->analogue_config_lock);
293422dcafeSCharles Keepax 
294422dcafeSCharles Keepax 	dev_set_drvdata(dev, lochnagar);
295422dcafeSCharles Keepax 
296422dcafeSCharles Keepax 	reset = devm_gpiod_get(dev, "reset", GPIOD_OUT_LOW);
297422dcafeSCharles Keepax 	if (IS_ERR(reset)) {
298422dcafeSCharles Keepax 		ret = PTR_ERR(reset);
299422dcafeSCharles Keepax 		dev_err(dev, "Failed to get reset GPIO: %d\n", ret);
300422dcafeSCharles Keepax 		return ret;
301422dcafeSCharles Keepax 	}
302422dcafeSCharles Keepax 
303422dcafeSCharles Keepax 	present = devm_gpiod_get_optional(dev, "present", GPIOD_OUT_HIGH);
304422dcafeSCharles Keepax 	if (IS_ERR(present)) {
305422dcafeSCharles Keepax 		ret = PTR_ERR(present);
306422dcafeSCharles Keepax 		dev_err(dev, "Failed to get present GPIO: %d\n", ret);
307422dcafeSCharles Keepax 		return ret;
308422dcafeSCharles Keepax 	}
309422dcafeSCharles Keepax 
310422dcafeSCharles Keepax 	/* Leave the Lochnagar in reset for a reasonable amount of time */
311422dcafeSCharles Keepax 	msleep(20);
312422dcafeSCharles Keepax 
313422dcafeSCharles Keepax 	/* Bring Lochnagar out of reset */
314422dcafeSCharles Keepax 	gpiod_set_value_cansleep(reset, 1);
315422dcafeSCharles Keepax 
316422dcafeSCharles Keepax 	/* Identify Lochnagar */
317422dcafeSCharles Keepax 	lochnagar->type = config->type;
318422dcafeSCharles Keepax 
319422dcafeSCharles Keepax 	lochnagar->regmap = devm_regmap_init_i2c(i2c, config->regmap);
320422dcafeSCharles Keepax 	if (IS_ERR(lochnagar->regmap)) {
321422dcafeSCharles Keepax 		ret = PTR_ERR(lochnagar->regmap);
322422dcafeSCharles Keepax 		dev_err(dev, "Failed to allocate register map: %d\n", ret);
323422dcafeSCharles Keepax 		return ret;
324422dcafeSCharles Keepax 	}
325422dcafeSCharles Keepax 
326422dcafeSCharles Keepax 	/* Wait for Lochnagar to boot */
327422dcafeSCharles Keepax 	ret = lochnagar_wait_for_boot(lochnagar->regmap, &val);
328422dcafeSCharles Keepax 	if (ret < 0) {
329422dcafeSCharles Keepax 		dev_err(dev, "Failed to read device ID: %d\n", ret);
330422dcafeSCharles Keepax 		return ret;
331422dcafeSCharles Keepax 	}
332422dcafeSCharles Keepax 
333422dcafeSCharles Keepax 	devid = val & LOCHNAGAR_DEVICE_ID_MASK;
334422dcafeSCharles Keepax 	rev = val & LOCHNAGAR_REV_ID_MASK;
335422dcafeSCharles Keepax 
336422dcafeSCharles Keepax 	if (devid != config->id) {
337422dcafeSCharles Keepax 		dev_err(dev,
338422dcafeSCharles Keepax 			"ID does not match %s (expected 0x%x got 0x%x)\n",
339422dcafeSCharles Keepax 			config->name, config->id, devid);
340422dcafeSCharles Keepax 		return -ENODEV;
341422dcafeSCharles Keepax 	}
342422dcafeSCharles Keepax 
343422dcafeSCharles Keepax 	/* Identify firmware */
344422dcafeSCharles Keepax 	ret = regmap_read(lochnagar->regmap, LOCHNAGAR_FIRMWARE_ID1, &val);
345422dcafeSCharles Keepax 	if (ret < 0) {
346422dcafeSCharles Keepax 		dev_err(dev, "Failed to read firmware id 1: %d\n", ret);
347422dcafeSCharles Keepax 		return ret;
348422dcafeSCharles Keepax 	}
349422dcafeSCharles Keepax 
350422dcafeSCharles Keepax 	firmwareid = val;
351422dcafeSCharles Keepax 
352422dcafeSCharles Keepax 	ret = regmap_read(lochnagar->regmap, LOCHNAGAR_FIRMWARE_ID2, &val);
353422dcafeSCharles Keepax 	if (ret < 0) {
354422dcafeSCharles Keepax 		dev_err(dev, "Failed to read firmware id 2: %d\n", ret);
355422dcafeSCharles Keepax 		return ret;
356422dcafeSCharles Keepax 	}
357422dcafeSCharles Keepax 
358422dcafeSCharles Keepax 	firmwareid |= (val << config->regmap->val_bits);
359422dcafeSCharles Keepax 
360422dcafeSCharles Keepax 	dev_info(dev, "Found %s (0x%x) revision %u firmware 0x%.6x\n",
361422dcafeSCharles Keepax 		 config->name, devid, rev + 1, firmwareid);
362422dcafeSCharles Keepax 
363422dcafeSCharles Keepax 	ret = regmap_register_patch(lochnagar->regmap, config->patch,
364422dcafeSCharles Keepax 				    config->npatch);
365422dcafeSCharles Keepax 	if (ret < 0) {
366422dcafeSCharles Keepax 		dev_err(dev, "Failed to register patch: %d\n", ret);
367422dcafeSCharles Keepax 		return ret;
368422dcafeSCharles Keepax 	}
369422dcafeSCharles Keepax 
370422dcafeSCharles Keepax 	ret = devm_of_platform_populate(dev);
371422dcafeSCharles Keepax 	if (ret < 0) {
372422dcafeSCharles Keepax 		dev_err(dev, "Failed to populate child nodes: %d\n", ret);
373422dcafeSCharles Keepax 		return ret;
374422dcafeSCharles Keepax 	}
375422dcafeSCharles Keepax 
376422dcafeSCharles Keepax 	return ret;
377422dcafeSCharles Keepax }
378422dcafeSCharles Keepax 
379422dcafeSCharles Keepax static struct i2c_driver lochnagar_i2c_driver = {
380422dcafeSCharles Keepax 	.driver = {
381422dcafeSCharles Keepax 		.name = "lochnagar",
382*d20642adSZhu Wang 		.of_match_table = lochnagar_of_match,
383422dcafeSCharles Keepax 		.suppress_bind_attrs = true,
384422dcafeSCharles Keepax 	},
3859816d859SUwe Kleine-König 	.probe = lochnagar_i2c_probe,
386422dcafeSCharles Keepax };
387422dcafeSCharles Keepax 
lochnagar_i2c_init(void)388422dcafeSCharles Keepax static int __init lochnagar_i2c_init(void)
389422dcafeSCharles Keepax {
390422dcafeSCharles Keepax 	int ret;
391422dcafeSCharles Keepax 
392422dcafeSCharles Keepax 	ret = i2c_add_driver(&lochnagar_i2c_driver);
393422dcafeSCharles Keepax 	if (ret)
394422dcafeSCharles Keepax 		pr_err("Failed to register Lochnagar driver: %d\n", ret);
395422dcafeSCharles Keepax 
396422dcafeSCharles Keepax 	return ret;
397422dcafeSCharles Keepax }
398422dcafeSCharles Keepax subsys_initcall(lochnagar_i2c_init);
399