1 // SPDX-License-Identifier: GPL-2.0-only
2 /****************************************************************************
3  * Driver for Solarflare network controllers and boards
4  * Copyright 2007-2012 Solarflare Communications Inc.
5  */
6 
7 #include <linux/rtnetlink.h>
8 
9 #include "net_driver.h"
10 #include "phy.h"
11 #include "efx.h"
12 #include "nic.h"
13 #include "workarounds.h"
14 
15 /* Macros for unpacking the board revision */
16 /* The revision info is in host byte order. */
17 #define FALCON_BOARD_TYPE(_rev) (_rev >> 8)
18 #define FALCON_BOARD_MAJOR(_rev) ((_rev >> 4) & 0xf)
19 #define FALCON_BOARD_MINOR(_rev) (_rev & 0xf)
20 
21 /* Board types */
22 #define FALCON_BOARD_SFE4001 0x01
23 #define FALCON_BOARD_SFE4002 0x02
24 #define FALCON_BOARD_SFE4003 0x03
25 #define FALCON_BOARD_SFN4112F 0x52
26 
27 /* Board temperature is about 15°C above ambient when air flow is
28  * limited.  The maximum acceptable ambient temperature varies
29  * depending on the PHY specifications but the critical temperature
30  * above which we should shut down to avoid damage is 80°C. */
31 #define FALCON_BOARD_TEMP_BIAS	15
32 #define FALCON_BOARD_TEMP_CRIT	(80 + FALCON_BOARD_TEMP_BIAS)
33 
34 /* SFC4000 datasheet says: 'The maximum permitted junction temperature
35  * is 125°C; the thermal design of the environment for the SFC4000
36  * should aim to keep this well below 100°C.' */
37 #define FALCON_JUNC_TEMP_MIN	0
38 #define FALCON_JUNC_TEMP_MAX	90
39 #define FALCON_JUNC_TEMP_CRIT	125
40 
41 /*****************************************************************************
42  * Support for LM87 sensor chip used on several boards
43  */
44 #define LM87_REG_TEMP_HW_INT_LOCK	0x13
45 #define LM87_REG_TEMP_HW_EXT_LOCK	0x14
46 #define LM87_REG_TEMP_HW_INT		0x17
47 #define LM87_REG_TEMP_HW_EXT		0x18
48 #define LM87_REG_TEMP_EXT1		0x26
49 #define LM87_REG_TEMP_INT		0x27
50 #define LM87_REG_ALARMS1		0x41
51 #define LM87_REG_ALARMS2		0x42
52 #define LM87_IN_LIMITS(nr, _min, _max)			\
53 	0x2B + (nr) * 2, _max, 0x2C + (nr) * 2, _min
54 #define LM87_AIN_LIMITS(nr, _min, _max)			\
55 	0x3B + (nr), _max, 0x1A + (nr), _min
56 #define LM87_TEMP_INT_LIMITS(_min, _max)		\
57 	0x39, _max, 0x3A, _min
58 #define LM87_TEMP_EXT1_LIMITS(_min, _max)		\
59 	0x37, _max, 0x38, _min
60 
61 #define LM87_ALARM_TEMP_INT		0x10
62 #define LM87_ALARM_TEMP_EXT1		0x20
63 
64 #if IS_ENABLED(CONFIG_SENSORS_LM87)
65 
66 static int ef4_poke_lm87(struct i2c_client *client, const u8 *reg_values)
67 {
68 	while (*reg_values) {
69 		u8 reg = *reg_values++;
70 		u8 value = *reg_values++;
71 		int rc = i2c_smbus_write_byte_data(client, reg, value);
72 		if (rc)
73 			return rc;
74 	}
75 	return 0;
76 }
77 
78 static const u8 falcon_lm87_common_regs[] = {
79 	LM87_REG_TEMP_HW_INT_LOCK, FALCON_BOARD_TEMP_CRIT,
80 	LM87_REG_TEMP_HW_INT, FALCON_BOARD_TEMP_CRIT,
81 	LM87_TEMP_EXT1_LIMITS(FALCON_JUNC_TEMP_MIN, FALCON_JUNC_TEMP_MAX),
82 	LM87_REG_TEMP_HW_EXT_LOCK, FALCON_JUNC_TEMP_CRIT,
83 	LM87_REG_TEMP_HW_EXT, FALCON_JUNC_TEMP_CRIT,
84 	0
85 };
86 
87 static int ef4_init_lm87(struct ef4_nic *efx, const struct i2c_board_info *info,
88 			 const u8 *reg_values)
89 {
90 	struct falcon_board *board = falcon_board(efx);
91 	struct i2c_client *client = i2c_new_device(&board->i2c_adap, info);
92 	int rc;
93 
94 	if (!client)
95 		return -EIO;
96 
97 	/* Read-to-clear alarm/interrupt status */
98 	i2c_smbus_read_byte_data(client, LM87_REG_ALARMS1);
99 	i2c_smbus_read_byte_data(client, LM87_REG_ALARMS2);
100 
101 	rc = ef4_poke_lm87(client, reg_values);
102 	if (rc)
103 		goto err;
104 	rc = ef4_poke_lm87(client, falcon_lm87_common_regs);
105 	if (rc)
106 		goto err;
107 
108 	board->hwmon_client = client;
109 	return 0;
110 
111 err:
112 	i2c_unregister_device(client);
113 	return rc;
114 }
115 
116 static void ef4_fini_lm87(struct ef4_nic *efx)
117 {
118 	i2c_unregister_device(falcon_board(efx)->hwmon_client);
119 }
120 
121 static int ef4_check_lm87(struct ef4_nic *efx, unsigned mask)
122 {
123 	struct i2c_client *client = falcon_board(efx)->hwmon_client;
124 	bool temp_crit, elec_fault, is_failure;
125 	u16 alarms;
126 	s32 reg;
127 
128 	/* If link is up then do not monitor temperature */
129 	if (EF4_WORKAROUND_7884(efx) && efx->link_state.up)
130 		return 0;
131 
132 	reg = i2c_smbus_read_byte_data(client, LM87_REG_ALARMS1);
133 	if (reg < 0)
134 		return reg;
135 	alarms = reg;
136 	reg = i2c_smbus_read_byte_data(client, LM87_REG_ALARMS2);
137 	if (reg < 0)
138 		return reg;
139 	alarms |= reg << 8;
140 	alarms &= mask;
141 
142 	temp_crit = false;
143 	if (alarms & LM87_ALARM_TEMP_INT) {
144 		reg = i2c_smbus_read_byte_data(client, LM87_REG_TEMP_INT);
145 		if (reg < 0)
146 			return reg;
147 		if (reg > FALCON_BOARD_TEMP_CRIT)
148 			temp_crit = true;
149 	}
150 	if (alarms & LM87_ALARM_TEMP_EXT1) {
151 		reg = i2c_smbus_read_byte_data(client, LM87_REG_TEMP_EXT1);
152 		if (reg < 0)
153 			return reg;
154 		if (reg > FALCON_JUNC_TEMP_CRIT)
155 			temp_crit = true;
156 	}
157 	elec_fault = alarms & ~(LM87_ALARM_TEMP_INT | LM87_ALARM_TEMP_EXT1);
158 	is_failure = temp_crit || elec_fault;
159 
160 	if (alarms)
161 		netif_err(efx, hw, efx->net_dev,
162 			  "LM87 detected a hardware %s (status %02x:%02x)"
163 			  "%s%s%s%s\n",
164 			  is_failure ? "failure" : "problem",
165 			  alarms & 0xff, alarms >> 8,
166 			  (alarms & LM87_ALARM_TEMP_INT) ?
167 			  "; board is overheating" : "",
168 			  (alarms & LM87_ALARM_TEMP_EXT1) ?
169 			  "; controller is overheating" : "",
170 			  temp_crit ? "; reached critical temperature" : "",
171 			  elec_fault ? "; electrical fault" : "");
172 
173 	return is_failure ? -ERANGE : 0;
174 }
175 
176 #else /* !CONFIG_SENSORS_LM87 */
177 
178 static inline int
179 ef4_init_lm87(struct ef4_nic *efx, const struct i2c_board_info *info,
180 	      const u8 *reg_values)
181 {
182 	return 0;
183 }
184 static inline void ef4_fini_lm87(struct ef4_nic *efx)
185 {
186 }
187 static inline int ef4_check_lm87(struct ef4_nic *efx, unsigned mask)
188 {
189 	return 0;
190 }
191 
192 #endif /* CONFIG_SENSORS_LM87 */
193 
194 /*****************************************************************************
195  * Support for the SFE4001 NIC.
196  *
197  * The SFE4001 does not power-up fully at reset due to its high power
198  * consumption.  We control its power via a PCA9539 I/O expander.
199  * It also has a MAX6647 temperature monitor which we expose to
200  * the lm90 driver.
201  *
202  * This also provides minimal support for reflashing the PHY, which is
203  * initiated by resetting it with the FLASH_CFG_1 pin pulled down.
204  * On SFE4001 rev A2 and later this is connected to the 3V3X output of
205  * the IO-expander.
206  * We represent reflash mode as PHY_MODE_SPECIAL and make it mutually
207  * exclusive with the network device being open.
208  */
209 
210 /**************************************************************************
211  * Support for I2C IO Expander device on SFE4001
212  */
213 #define	PCA9539 0x74
214 
215 #define	P0_IN 0x00
216 #define	P0_OUT 0x02
217 #define	P0_INVERT 0x04
218 #define	P0_CONFIG 0x06
219 
220 #define	P0_EN_1V0X_LBN 0
221 #define	P0_EN_1V0X_WIDTH 1
222 #define	P0_EN_1V2_LBN 1
223 #define	P0_EN_1V2_WIDTH 1
224 #define	P0_EN_2V5_LBN 2
225 #define	P0_EN_2V5_WIDTH 1
226 #define	P0_EN_3V3X_LBN 3
227 #define	P0_EN_3V3X_WIDTH 1
228 #define	P0_EN_5V_LBN 4
229 #define	P0_EN_5V_WIDTH 1
230 #define	P0_SHORTEN_JTAG_LBN 5
231 #define	P0_SHORTEN_JTAG_WIDTH 1
232 #define	P0_X_TRST_LBN 6
233 #define	P0_X_TRST_WIDTH 1
234 #define	P0_DSP_RESET_LBN 7
235 #define	P0_DSP_RESET_WIDTH 1
236 
237 #define	P1_IN 0x01
238 #define	P1_OUT 0x03
239 #define	P1_INVERT 0x05
240 #define	P1_CONFIG 0x07
241 
242 #define	P1_AFE_PWD_LBN 0
243 #define	P1_AFE_PWD_WIDTH 1
244 #define	P1_DSP_PWD25_LBN 1
245 #define	P1_DSP_PWD25_WIDTH 1
246 #define	P1_RESERVED_LBN 2
247 #define	P1_RESERVED_WIDTH 2
248 #define	P1_SPARE_LBN 4
249 #define	P1_SPARE_WIDTH 4
250 
251 /* Temperature Sensor */
252 #define MAX664X_REG_RSL		0x02
253 #define MAX664X_REG_WLHO	0x0B
254 
255 static void sfe4001_poweroff(struct ef4_nic *efx)
256 {
257 	struct i2c_client *ioexp_client = falcon_board(efx)->ioexp_client;
258 	struct i2c_client *hwmon_client = falcon_board(efx)->hwmon_client;
259 
260 	/* Turn off all power rails and disable outputs */
261 	i2c_smbus_write_byte_data(ioexp_client, P0_OUT, 0xff);
262 	i2c_smbus_write_byte_data(ioexp_client, P1_CONFIG, 0xff);
263 	i2c_smbus_write_byte_data(ioexp_client, P0_CONFIG, 0xff);
264 
265 	/* Clear any over-temperature alert */
266 	i2c_smbus_read_byte_data(hwmon_client, MAX664X_REG_RSL);
267 }
268 
269 static int sfe4001_poweron(struct ef4_nic *efx)
270 {
271 	struct i2c_client *ioexp_client = falcon_board(efx)->ioexp_client;
272 	struct i2c_client *hwmon_client = falcon_board(efx)->hwmon_client;
273 	unsigned int i, j;
274 	int rc;
275 	u8 out;
276 
277 	/* Clear any previous over-temperature alert */
278 	rc = i2c_smbus_read_byte_data(hwmon_client, MAX664X_REG_RSL);
279 	if (rc < 0)
280 		return rc;
281 
282 	/* Enable port 0 and port 1 outputs on IO expander */
283 	rc = i2c_smbus_write_byte_data(ioexp_client, P0_CONFIG, 0x00);
284 	if (rc)
285 		return rc;
286 	rc = i2c_smbus_write_byte_data(ioexp_client, P1_CONFIG,
287 				       0xff & ~(1 << P1_SPARE_LBN));
288 	if (rc)
289 		goto fail_on;
290 
291 	/* If PHY power is on, turn it all off and wait 1 second to
292 	 * ensure a full reset.
293 	 */
294 	rc = i2c_smbus_read_byte_data(ioexp_client, P0_OUT);
295 	if (rc < 0)
296 		goto fail_on;
297 	out = 0xff & ~((0 << P0_EN_1V2_LBN) | (0 << P0_EN_2V5_LBN) |
298 		       (0 << P0_EN_3V3X_LBN) | (0 << P0_EN_5V_LBN) |
299 		       (0 << P0_EN_1V0X_LBN));
300 	if (rc != out) {
301 		netif_info(efx, hw, efx->net_dev, "power-cycling PHY\n");
302 		rc = i2c_smbus_write_byte_data(ioexp_client, P0_OUT, out);
303 		if (rc)
304 			goto fail_on;
305 		schedule_timeout_uninterruptible(HZ);
306 	}
307 
308 	for (i = 0; i < 20; ++i) {
309 		/* Turn on 1.2V, 2.5V, 3.3V and 5V power rails */
310 		out = 0xff & ~((1 << P0_EN_1V2_LBN) | (1 << P0_EN_2V5_LBN) |
311 			       (1 << P0_EN_3V3X_LBN) | (1 << P0_EN_5V_LBN) |
312 			       (1 << P0_X_TRST_LBN));
313 		if (efx->phy_mode & PHY_MODE_SPECIAL)
314 			out |= 1 << P0_EN_3V3X_LBN;
315 
316 		rc = i2c_smbus_write_byte_data(ioexp_client, P0_OUT, out);
317 		if (rc)
318 			goto fail_on;
319 		msleep(10);
320 
321 		/* Turn on 1V power rail */
322 		out &= ~(1 << P0_EN_1V0X_LBN);
323 		rc = i2c_smbus_write_byte_data(ioexp_client, P0_OUT, out);
324 		if (rc)
325 			goto fail_on;
326 
327 		netif_info(efx, hw, efx->net_dev,
328 			   "waiting for DSP boot (attempt %d)...\n", i);
329 
330 		/* In flash config mode, DSP does not turn on AFE, so
331 		 * just wait 1 second.
332 		 */
333 		if (efx->phy_mode & PHY_MODE_SPECIAL) {
334 			schedule_timeout_uninterruptible(HZ);
335 			return 0;
336 		}
337 
338 		for (j = 0; j < 10; ++j) {
339 			msleep(100);
340 
341 			/* Check DSP has asserted AFE power line */
342 			rc = i2c_smbus_read_byte_data(ioexp_client, P1_IN);
343 			if (rc < 0)
344 				goto fail_on;
345 			if (rc & (1 << P1_AFE_PWD_LBN))
346 				return 0;
347 		}
348 	}
349 
350 	netif_info(efx, hw, efx->net_dev, "timed out waiting for DSP boot\n");
351 	rc = -ETIMEDOUT;
352 fail_on:
353 	sfe4001_poweroff(efx);
354 	return rc;
355 }
356 
357 static ssize_t show_phy_flash_cfg(struct device *dev,
358 				  struct device_attribute *attr, char *buf)
359 {
360 	struct ef4_nic *efx = pci_get_drvdata(to_pci_dev(dev));
361 	return sprintf(buf, "%d\n", !!(efx->phy_mode & PHY_MODE_SPECIAL));
362 }
363 
364 static ssize_t set_phy_flash_cfg(struct device *dev,
365 				 struct device_attribute *attr,
366 				 const char *buf, size_t count)
367 {
368 	struct ef4_nic *efx = pci_get_drvdata(to_pci_dev(dev));
369 	enum ef4_phy_mode old_mode, new_mode;
370 	int err;
371 
372 	rtnl_lock();
373 	old_mode = efx->phy_mode;
374 	if (count == 0 || *buf == '0')
375 		new_mode = old_mode & ~PHY_MODE_SPECIAL;
376 	else
377 		new_mode = PHY_MODE_SPECIAL;
378 	if (!((old_mode ^ new_mode) & PHY_MODE_SPECIAL)) {
379 		err = 0;
380 	} else if (efx->state != STATE_READY || netif_running(efx->net_dev)) {
381 		err = -EBUSY;
382 	} else {
383 		/* Reset the PHY, reconfigure the MAC and enable/disable
384 		 * MAC stats accordingly. */
385 		efx->phy_mode = new_mode;
386 		if (new_mode & PHY_MODE_SPECIAL)
387 			falcon_stop_nic_stats(efx);
388 		err = sfe4001_poweron(efx);
389 		if (!err)
390 			err = ef4_reconfigure_port(efx);
391 		if (!(new_mode & PHY_MODE_SPECIAL))
392 			falcon_start_nic_stats(efx);
393 	}
394 	rtnl_unlock();
395 
396 	return err ? err : count;
397 }
398 
399 static DEVICE_ATTR(phy_flash_cfg, 0644, show_phy_flash_cfg, set_phy_flash_cfg);
400 
401 static void sfe4001_fini(struct ef4_nic *efx)
402 {
403 	struct falcon_board *board = falcon_board(efx);
404 
405 	netif_info(efx, drv, efx->net_dev, "%s\n", __func__);
406 
407 	device_remove_file(&efx->pci_dev->dev, &dev_attr_phy_flash_cfg);
408 	sfe4001_poweroff(efx);
409 	i2c_unregister_device(board->ioexp_client);
410 	i2c_unregister_device(board->hwmon_client);
411 }
412 
413 static int sfe4001_check_hw(struct ef4_nic *efx)
414 {
415 	struct falcon_nic_data *nic_data = efx->nic_data;
416 	s32 status;
417 
418 	/* If XAUI link is up then do not monitor */
419 	if (EF4_WORKAROUND_7884(efx) && !nic_data->xmac_poll_required)
420 		return 0;
421 
422 	/* Check the powered status of the PHY. Lack of power implies that
423 	 * the MAX6647 has shut down power to it, probably due to a temp.
424 	 * alarm. Reading the power status rather than the MAX6647 status
425 	 * directly because the later is read-to-clear and would thus
426 	 * start to power up the PHY again when polled, causing us to blip
427 	 * the power undesirably.
428 	 * We know we can read from the IO expander because we did
429 	 * it during power-on. Assume failure now is bad news. */
430 	status = i2c_smbus_read_byte_data(falcon_board(efx)->ioexp_client, P1_IN);
431 	if (status >= 0 &&
432 	    (status & ((1 << P1_AFE_PWD_LBN) | (1 << P1_DSP_PWD25_LBN))) != 0)
433 		return 0;
434 
435 	/* Use board power control, not PHY power control */
436 	sfe4001_poweroff(efx);
437 	efx->phy_mode = PHY_MODE_OFF;
438 
439 	return (status < 0) ? -EIO : -ERANGE;
440 }
441 
442 static const struct i2c_board_info sfe4001_hwmon_info = {
443 	I2C_BOARD_INFO("max6647", 0x4e),
444 };
445 
446 /* This board uses an I2C expander to provider power to the PHY, which needs to
447  * be turned on before the PHY can be used.
448  * Context: Process context, rtnl lock held
449  */
450 static int sfe4001_init(struct ef4_nic *efx)
451 {
452 	struct falcon_board *board = falcon_board(efx);
453 	int rc;
454 
455 #if IS_ENABLED(CONFIG_SENSORS_LM90)
456 	board->hwmon_client =
457 		i2c_new_device(&board->i2c_adap, &sfe4001_hwmon_info);
458 #else
459 	board->hwmon_client =
460 		i2c_new_dummy(&board->i2c_adap, sfe4001_hwmon_info.addr);
461 #endif
462 	if (!board->hwmon_client)
463 		return -EIO;
464 
465 	/* Raise board/PHY high limit from 85 to 90 degrees Celsius */
466 	rc = i2c_smbus_write_byte_data(board->hwmon_client,
467 				       MAX664X_REG_WLHO, 90);
468 	if (rc)
469 		goto fail_hwmon;
470 
471 	board->ioexp_client = i2c_new_dummy(&board->i2c_adap, PCA9539);
472 	if (!board->ioexp_client) {
473 		rc = -EIO;
474 		goto fail_hwmon;
475 	}
476 
477 	if (efx->phy_mode & PHY_MODE_SPECIAL) {
478 		/* PHY won't generate a 156.25 MHz clock and MAC stats fetch
479 		 * will fail. */
480 		falcon_stop_nic_stats(efx);
481 	}
482 	rc = sfe4001_poweron(efx);
483 	if (rc)
484 		goto fail_ioexp;
485 
486 	rc = device_create_file(&efx->pci_dev->dev, &dev_attr_phy_flash_cfg);
487 	if (rc)
488 		goto fail_on;
489 
490 	netif_info(efx, hw, efx->net_dev, "PHY is powered on\n");
491 	return 0;
492 
493 fail_on:
494 	sfe4001_poweroff(efx);
495 fail_ioexp:
496 	i2c_unregister_device(board->ioexp_client);
497 fail_hwmon:
498 	i2c_unregister_device(board->hwmon_client);
499 	return rc;
500 }
501 
502 /*****************************************************************************
503  * Support for the SFE4002
504  *
505  */
506 static u8 sfe4002_lm87_channel = 0x03; /* use AIN not FAN inputs */
507 
508 static const u8 sfe4002_lm87_regs[] = {
509 	LM87_IN_LIMITS(0, 0x7c, 0x99),		/* 2.5V:  1.8V +/- 10% */
510 	LM87_IN_LIMITS(1, 0x4c, 0x5e),		/* Vccp1: 1.2V +/- 10% */
511 	LM87_IN_LIMITS(2, 0xac, 0xd4),		/* 3.3V:  3.3V +/- 10% */
512 	LM87_IN_LIMITS(3, 0xac, 0xd4),		/* 5V:    5.0V +/- 10% */
513 	LM87_IN_LIMITS(4, 0xac, 0xe0),		/* 12V:   10.8-14V */
514 	LM87_IN_LIMITS(5, 0x3f, 0x4f),		/* Vccp2: 1.0V +/- 10% */
515 	LM87_AIN_LIMITS(0, 0x98, 0xbb),		/* AIN1:  1.66V +/- 10% */
516 	LM87_AIN_LIMITS(1, 0x8a, 0xa9),		/* AIN2:  1.5V +/- 10% */
517 	LM87_TEMP_INT_LIMITS(0, 80 + FALCON_BOARD_TEMP_BIAS),
518 	LM87_TEMP_EXT1_LIMITS(0, FALCON_JUNC_TEMP_MAX),
519 	0
520 };
521 
522 static const struct i2c_board_info sfe4002_hwmon_info = {
523 	I2C_BOARD_INFO("lm87", 0x2e),
524 	.platform_data	= &sfe4002_lm87_channel,
525 };
526 
527 /****************************************************************************/
528 /* LED allocations. Note that on rev A0 boards the schematic and the reality
529  * differ: red and green are swapped. Below is the fixed (A1) layout (there
530  * are only 3 A0 boards in existence, so no real reason to make this
531  * conditional).
532  */
533 #define SFE4002_FAULT_LED (2)	/* Red */
534 #define SFE4002_RX_LED    (0)	/* Green */
535 #define SFE4002_TX_LED    (1)	/* Amber */
536 
537 static void sfe4002_init_phy(struct ef4_nic *efx)
538 {
539 	/* Set the TX and RX LEDs to reflect status and activity, and the
540 	 * fault LED off */
541 	falcon_qt202x_set_led(efx, SFE4002_TX_LED,
542 			      QUAKE_LED_TXLINK | QUAKE_LED_LINK_ACTSTAT);
543 	falcon_qt202x_set_led(efx, SFE4002_RX_LED,
544 			      QUAKE_LED_RXLINK | QUAKE_LED_LINK_ACTSTAT);
545 	falcon_qt202x_set_led(efx, SFE4002_FAULT_LED, QUAKE_LED_OFF);
546 }
547 
548 static void sfe4002_set_id_led(struct ef4_nic *efx, enum ef4_led_mode mode)
549 {
550 	falcon_qt202x_set_led(
551 		efx, SFE4002_FAULT_LED,
552 		(mode == EF4_LED_ON) ? QUAKE_LED_ON : QUAKE_LED_OFF);
553 }
554 
555 static int sfe4002_check_hw(struct ef4_nic *efx)
556 {
557 	struct falcon_board *board = falcon_board(efx);
558 
559 	/* A0 board rev. 4002s report a temperature fault the whole time
560 	 * (bad sensor) so we mask it out. */
561 	unsigned alarm_mask =
562 		(board->major == 0 && board->minor == 0) ?
563 		~LM87_ALARM_TEMP_EXT1 : ~0;
564 
565 	return ef4_check_lm87(efx, alarm_mask);
566 }
567 
568 static int sfe4002_init(struct ef4_nic *efx)
569 {
570 	return ef4_init_lm87(efx, &sfe4002_hwmon_info, sfe4002_lm87_regs);
571 }
572 
573 /*****************************************************************************
574  * Support for the SFN4112F
575  *
576  */
577 static u8 sfn4112f_lm87_channel = 0x03; /* use AIN not FAN inputs */
578 
579 static const u8 sfn4112f_lm87_regs[] = {
580 	LM87_IN_LIMITS(0, 0x7c, 0x99),		/* 2.5V:  1.8V +/- 10% */
581 	LM87_IN_LIMITS(1, 0x4c, 0x5e),		/* Vccp1: 1.2V +/- 10% */
582 	LM87_IN_LIMITS(2, 0xac, 0xd4),		/* 3.3V:  3.3V +/- 10% */
583 	LM87_IN_LIMITS(4, 0xac, 0xe0),		/* 12V:   10.8-14V */
584 	LM87_IN_LIMITS(5, 0x3f, 0x4f),		/* Vccp2: 1.0V +/- 10% */
585 	LM87_AIN_LIMITS(1, 0x8a, 0xa9),		/* AIN2:  1.5V +/- 10% */
586 	LM87_TEMP_INT_LIMITS(0, 60 + FALCON_BOARD_TEMP_BIAS),
587 	LM87_TEMP_EXT1_LIMITS(0, FALCON_JUNC_TEMP_MAX),
588 	0
589 };
590 
591 static const struct i2c_board_info sfn4112f_hwmon_info = {
592 	I2C_BOARD_INFO("lm87", 0x2e),
593 	.platform_data	= &sfn4112f_lm87_channel,
594 };
595 
596 #define SFN4112F_ACT_LED	0
597 #define SFN4112F_LINK_LED	1
598 
599 static void sfn4112f_init_phy(struct ef4_nic *efx)
600 {
601 	falcon_qt202x_set_led(efx, SFN4112F_ACT_LED,
602 			      QUAKE_LED_RXLINK | QUAKE_LED_LINK_ACT);
603 	falcon_qt202x_set_led(efx, SFN4112F_LINK_LED,
604 			      QUAKE_LED_RXLINK | QUAKE_LED_LINK_STAT);
605 }
606 
607 static void sfn4112f_set_id_led(struct ef4_nic *efx, enum ef4_led_mode mode)
608 {
609 	int reg;
610 
611 	switch (mode) {
612 	case EF4_LED_OFF:
613 		reg = QUAKE_LED_OFF;
614 		break;
615 	case EF4_LED_ON:
616 		reg = QUAKE_LED_ON;
617 		break;
618 	default:
619 		reg = QUAKE_LED_RXLINK | QUAKE_LED_LINK_STAT;
620 		break;
621 	}
622 
623 	falcon_qt202x_set_led(efx, SFN4112F_LINK_LED, reg);
624 }
625 
626 static int sfn4112f_check_hw(struct ef4_nic *efx)
627 {
628 	/* Mask out unused sensors */
629 	return ef4_check_lm87(efx, ~0x48);
630 }
631 
632 static int sfn4112f_init(struct ef4_nic *efx)
633 {
634 	return ef4_init_lm87(efx, &sfn4112f_hwmon_info, sfn4112f_lm87_regs);
635 }
636 
637 /*****************************************************************************
638  * Support for the SFE4003
639  *
640  */
641 static u8 sfe4003_lm87_channel = 0x03; /* use AIN not FAN inputs */
642 
643 static const u8 sfe4003_lm87_regs[] = {
644 	LM87_IN_LIMITS(0, 0x67, 0x7f),		/* 2.5V:  1.5V +/- 10% */
645 	LM87_IN_LIMITS(1, 0x4c, 0x5e),		/* Vccp1: 1.2V +/- 10% */
646 	LM87_IN_LIMITS(2, 0xac, 0xd4),		/* 3.3V:  3.3V +/- 10% */
647 	LM87_IN_LIMITS(4, 0xac, 0xe0),		/* 12V:   10.8-14V */
648 	LM87_IN_LIMITS(5, 0x3f, 0x4f),		/* Vccp2: 1.0V +/- 10% */
649 	LM87_TEMP_INT_LIMITS(0, 70 + FALCON_BOARD_TEMP_BIAS),
650 	0
651 };
652 
653 static const struct i2c_board_info sfe4003_hwmon_info = {
654 	I2C_BOARD_INFO("lm87", 0x2e),
655 	.platform_data	= &sfe4003_lm87_channel,
656 };
657 
658 /* Board-specific LED info. */
659 #define SFE4003_RED_LED_GPIO	11
660 #define SFE4003_LED_ON		1
661 #define SFE4003_LED_OFF		0
662 
663 static void sfe4003_set_id_led(struct ef4_nic *efx, enum ef4_led_mode mode)
664 {
665 	struct falcon_board *board = falcon_board(efx);
666 
667 	/* The LEDs were not wired to GPIOs before A3 */
668 	if (board->minor < 3 && board->major == 0)
669 		return;
670 
671 	falcon_txc_set_gpio_val(
672 		efx, SFE4003_RED_LED_GPIO,
673 		(mode == EF4_LED_ON) ? SFE4003_LED_ON : SFE4003_LED_OFF);
674 }
675 
676 static void sfe4003_init_phy(struct ef4_nic *efx)
677 {
678 	struct falcon_board *board = falcon_board(efx);
679 
680 	/* The LEDs were not wired to GPIOs before A3 */
681 	if (board->minor < 3 && board->major == 0)
682 		return;
683 
684 	falcon_txc_set_gpio_dir(efx, SFE4003_RED_LED_GPIO, TXC_GPIO_DIR_OUTPUT);
685 	falcon_txc_set_gpio_val(efx, SFE4003_RED_LED_GPIO, SFE4003_LED_OFF);
686 }
687 
688 static int sfe4003_check_hw(struct ef4_nic *efx)
689 {
690 	struct falcon_board *board = falcon_board(efx);
691 
692 	/* A0/A1/A2 board rev. 4003s  report a temperature fault the whole time
693 	 * (bad sensor) so we mask it out. */
694 	unsigned alarm_mask =
695 		(board->major == 0 && board->minor <= 2) ?
696 		~LM87_ALARM_TEMP_EXT1 : ~0;
697 
698 	return ef4_check_lm87(efx, alarm_mask);
699 }
700 
701 static int sfe4003_init(struct ef4_nic *efx)
702 {
703 	return ef4_init_lm87(efx, &sfe4003_hwmon_info, sfe4003_lm87_regs);
704 }
705 
706 static const struct falcon_board_type board_types[] = {
707 	{
708 		.id		= FALCON_BOARD_SFE4001,
709 		.init		= sfe4001_init,
710 		.init_phy	= ef4_port_dummy_op_void,
711 		.fini		= sfe4001_fini,
712 		.set_id_led	= tenxpress_set_id_led,
713 		.monitor	= sfe4001_check_hw,
714 	},
715 	{
716 		.id		= FALCON_BOARD_SFE4002,
717 		.init		= sfe4002_init,
718 		.init_phy	= sfe4002_init_phy,
719 		.fini		= ef4_fini_lm87,
720 		.set_id_led	= sfe4002_set_id_led,
721 		.monitor	= sfe4002_check_hw,
722 	},
723 	{
724 		.id		= FALCON_BOARD_SFE4003,
725 		.init		= sfe4003_init,
726 		.init_phy	= sfe4003_init_phy,
727 		.fini		= ef4_fini_lm87,
728 		.set_id_led	= sfe4003_set_id_led,
729 		.monitor	= sfe4003_check_hw,
730 	},
731 	{
732 		.id		= FALCON_BOARD_SFN4112F,
733 		.init		= sfn4112f_init,
734 		.init_phy	= sfn4112f_init_phy,
735 		.fini		= ef4_fini_lm87,
736 		.set_id_led	= sfn4112f_set_id_led,
737 		.monitor	= sfn4112f_check_hw,
738 	},
739 };
740 
741 int falcon_probe_board(struct ef4_nic *efx, u16 revision_info)
742 {
743 	struct falcon_board *board = falcon_board(efx);
744 	u8 type_id = FALCON_BOARD_TYPE(revision_info);
745 	int i;
746 
747 	board->major = FALCON_BOARD_MAJOR(revision_info);
748 	board->minor = FALCON_BOARD_MINOR(revision_info);
749 
750 	for (i = 0; i < ARRAY_SIZE(board_types); i++)
751 		if (board_types[i].id == type_id)
752 			board->type = &board_types[i];
753 
754 	if (board->type) {
755 		return 0;
756 	} else {
757 		netif_err(efx, probe, efx->net_dev, "unknown board type %d\n",
758 			  type_id);
759 		return -ENODEV;
760 	}
761 }
762