forked from ~ljy/RK356X_SDK_RELEASE
blame | history | patch | commit | commitdiff
hc
2024-05-10 9999e48639b3cecb08ffb37358bcba3b48161b29 
 kernel/drivers/hwmon/pmbus/ibm-cffps.c
....@@ -1,12 +1,9 @@
1
+// SPDX-License-Identifier: GPL-2.0-or-later
12 /*
23  * Copyright 2017 IBM Corp.
3
- *
4
- * This program is free software; you can redistribute it and/or modify
5
- * it under the terms of the GNU General Public License as published by
6
- * the Free Software Foundation; either version 2 of the License, or
7
- * (at your option) any later version.
84  */
95 
6
+#include <linux/bitfield.h>
107 #include <linux/bitops.h>
118 #include <linux/debugfs.h>
129 #include <linux/device.h>
....@@ -16,20 +13,32 @@
1613 #include <linux/leds.h>
1714 #include <linux/module.h>
1815 #include <linux/mutex.h>
16
+#include <linux/of_device.h>
1917 #include <linux/pmbus.h>
2018 
2119 #include "pmbus.h"
2220 
2321 #define CFFPS_FRU_CMD				0x9A
2422 #define CFFPS_PN_CMD				0x9B
23
+#define CFFPS_HEADER_CMD			0x9C
2524 #define CFFPS_SN_CMD				0x9E
25
+#define CFFPS_MAX_POWER_OUT_CMD			0xA7
2626 #define CFFPS_CCIN_CMD				0xBD
27
-#define CFFPS_FW_CMD_START			0xFA
28
-#define CFFPS_FW_NUM_BYTES			4
27
+#define CFFPS_FW_CMD				0xFA
28
+#define CFFPS1_FW_NUM_BYTES			4
29
+#define CFFPS2_FW_NUM_WORDS			3
2930 #define CFFPS_SYS_CONFIG_CMD			0xDA
31
+#define CFFPS_12VCS_VOUT_CMD			0xDE
3032 
3133 #define CFFPS_INPUT_HISTORY_CMD			0xD6
3234 #define CFFPS_INPUT_HISTORY_SIZE		100
35
+
36
+#define CFFPS_CCIN_REVISION			GENMASK(7, 0)
37
+#define  CFFPS_CCIN_REVISION_LEGACY		 0xde
38
+#define CFFPS_CCIN_VERSION			GENMASK(15, 8)
39
+#define CFFPS_CCIN_VERSION_1			 0x2b
40
+#define CFFPS_CCIN_VERSION_2			 0x2e
41
+#define CFFPS_CCIN_VERSION_3			 0x51
3342 
3443 /* STATUS_MFR_SPECIFIC bits */
3544 #define CFFPS_MFR_FAN_FAULT			BIT(0)
....@@ -41,20 +50,25 @@
4150 #define CFFPS_MFR_VAUX_FAULT			BIT(6)
4251 #define CFFPS_MFR_CURRENT_SHARE_WARNING		BIT(7)
4352 
44
-#define CFFPS_LED_BLINK				BIT(0)
45
-#define CFFPS_LED_ON				BIT(1)
46
-#define CFFPS_LED_OFF				BIT(2)
53
+#define CFFPS_LED_BLINK				(BIT(0) | BIT(6))
54
+#define CFFPS_LED_ON				(BIT(1) | BIT(6))
55
+#define CFFPS_LED_OFF				(BIT(2) | BIT(6))
4756 #define CFFPS_BLINK_RATE_MS			250
4857 
4958 enum {
5059 	CFFPS_DEBUGFS_INPUT_HISTORY = 0,
5160 	CFFPS_DEBUGFS_FRU,
5261 	CFFPS_DEBUGFS_PN,
62
+	CFFPS_DEBUGFS_HEADER,
5363 	CFFPS_DEBUGFS_SN,
64
+	CFFPS_DEBUGFS_MAX_POWER_OUT,
5465 	CFFPS_DEBUGFS_CCIN,
5566 	CFFPS_DEBUGFS_FW,
67
+	CFFPS_DEBUGFS_ON_OFF_CONFIG,
5668 	CFFPS_DEBUGFS_NUM_ENTRIES
5769 };
70
+
71
+enum versions { cffps1, cffps2, cffps_unknown };
5872 
5973 struct ibm_cffps_input_history {
6074 	struct mutex update_lock;
....@@ -65,6 +79,7 @@
6579 };
6680 
6781 struct ibm_cffps {
82
+	enum versions version;
6883 	struct i2c_client *client;
6984 
7085 	struct ibm_cffps_input_history input_history;
....@@ -75,6 +90,8 @@
7590 	u8 led_state;
7691 	struct led_classdev led;
7792 };
93
+
94
+static const struct i2c_device_id ibm_cffps_id[];
7895 
7996 #define to_psu(x, y) container_of((x), struct ibm_cffps, debugfs_entries[(y)])
8097 
....@@ -126,15 +143,17 @@
126143 				       psu->input_history.byte_count);
127144 }
128145 
129
-static ssize_t ibm_cffps_debugfs_op(struct file *file, char __user *buf,
130
-				    size_t count, loff_t *ppos)
146
+static ssize_t ibm_cffps_debugfs_read(struct file *file, char __user *buf,
147
+				      size_t count, loff_t *ppos)
131148 {
132149 	u8 cmd;
133150 	int i, rc;
134151 	int *idxp = file->private_data;
135152 	int idx = *idxp;
136153 	struct ibm_cffps *psu = to_psu(idxp, idx);
137
-	char data[I2C_SMBUS_BLOCK_MAX] = { 0 };
154
+	char data[I2C_SMBUS_BLOCK_MAX + 2] = { 0 };
155
+
156
+	pmbus_set_page(psu->client, 0, 0xff);
138157 
139158 	switch (idx) {
140159 	case CFFPS_DEBUGFS_INPUT_HISTORY:
....@@ -145,9 +164,26 @@
145164 	case CFFPS_DEBUGFS_PN:
146165 		cmd = CFFPS_PN_CMD;
147166 		break;
167
+	case CFFPS_DEBUGFS_HEADER:
168
+		cmd = CFFPS_HEADER_CMD;
169
+		break;
148170 	case CFFPS_DEBUGFS_SN:
149171 		cmd = CFFPS_SN_CMD;
150172 		break;
173
+	case CFFPS_DEBUGFS_MAX_POWER_OUT:
174
+		if (psu->version == cffps1) {
175
+			rc = i2c_smbus_read_word_swapped(psu->client,
176
+					CFFPS_MAX_POWER_OUT_CMD);
177
+		} else {
178
+			rc = i2c_smbus_read_word_data(psu->client,
179
+					CFFPS_MAX_POWER_OUT_CMD);
180
+		}
181
+
182
+		if (rc < 0)
183
+			return rc;
184
+
185
+		rc = snprintf(data, I2C_SMBUS_BLOCK_MAX, "%d", rc);
186
+		goto done;
151187 	case CFFPS_DEBUGFS_CCIN:
152188 		rc = i2c_smbus_read_word_swapped(psu->client, CFFPS_CCIN_CMD);
153189 		if (rc < 0)
....@@ -156,16 +192,44 @@
156192 		rc = snprintf(data, 5, "%04X", rc);
157193 		goto done;
158194 	case CFFPS_DEBUGFS_FW:
159
-		for (i = 0; i < CFFPS_FW_NUM_BYTES; ++i) {
160
-			rc = i2c_smbus_read_byte_data(psu->client,
161
-						      CFFPS_FW_CMD_START + i);
162
-			if (rc < 0)
163
-				return rc;
195
+		switch (psu->version) {
196
+		case cffps1:
197
+			for (i = 0; i < CFFPS1_FW_NUM_BYTES; ++i) {
198
+				rc = i2c_smbus_read_byte_data(psu->client,
199
+							      CFFPS_FW_CMD +
200
+								i);
201
+				if (rc < 0)
202
+					return rc;
164203 
165
-			snprintf(&data[i * 2], 3, "%02X", rc);
204
+				snprintf(&data[i * 2], 3, "%02X", rc);
205
+			}
206
+
207
+			rc = i * 2;
208
+			break;
209
+		case cffps2:
210
+			for (i = 0; i < CFFPS2_FW_NUM_WORDS; ++i) {
211
+				rc = i2c_smbus_read_word_data(psu->client,
212
+							      CFFPS_FW_CMD +
213
+								i);
214
+				if (rc < 0)
215
+					return rc;
216
+
217
+				snprintf(&data[i * 4], 5, "%04X", rc);
218
+			}
219
+
220
+			rc = i * 4;
221
+			break;
222
+		default:
223
+			return -EOPNOTSUPP;
166224 		}
225
+		goto done;
226
+	case CFFPS_DEBUGFS_ON_OFF_CONFIG:
227
+		rc = i2c_smbus_read_byte_data(psu->client,
228
+					      PMBUS_ON_OFF_CONFIG);
229
+		if (rc < 0)
230
+			return rc;
167231 
168
-		rc = i * 2;
232
+		rc = snprintf(data, 3, "%02x", rc);
169233 		goto done;
170234 	default:
171235 		return -EINVAL;
....@@ -182,9 +246,42 @@
182246 	return simple_read_from_buffer(buf, count, ppos, data, rc);
183247 }
184248 
249
+static ssize_t ibm_cffps_debugfs_write(struct file *file,
250
+				       const char __user *buf, size_t count,
251
+				       loff_t *ppos)
252
+{
253
+	u8 data;
254
+	ssize_t rc;
255
+	int *idxp = file->private_data;
256
+	int idx = *idxp;
257
+	struct ibm_cffps *psu = to_psu(idxp, idx);
258
+
259
+	switch (idx) {
260
+	case CFFPS_DEBUGFS_ON_OFF_CONFIG:
261
+		pmbus_set_page(psu->client, 0, 0xff);
262
+
263
+		rc = simple_write_to_buffer(&data, 1, ppos, buf, count);
264
+		if (rc <= 0)
265
+			return rc;
266
+
267
+		rc = i2c_smbus_write_byte_data(psu->client,
268
+					       PMBUS_ON_OFF_CONFIG, data);
269
+		if (rc)
270
+			return rc;
271
+
272
+		rc = 1;
273
+		break;
274
+	default:
275
+		return -EINVAL;
276
+	}
277
+
278
+	return rc;
279
+}
280
+
185281 static const struct file_operations ibm_cffps_fops = {
186282 	.llseek = noop_llseek,
187
-	.read = ibm_cffps_debugfs_op,
283
+	.read = ibm_cffps_debugfs_read,
284
+	.write = ibm_cffps_debugfs_write,
188285 	.open = simple_open,
189286 };
190287 
....@@ -239,13 +336,13 @@
239336 }
240337 
241338 static int ibm_cffps_read_word_data(struct i2c_client *client, int page,
242
-				    int reg)
339
+				    int phase, int reg)
243340 {
244341 	int rc, mfr;
245342 
246343 	switch (reg) {
247344 	case PMBUS_STATUS_WORD:
248
-		rc = pmbus_read_word_data(client, page, reg);
345
+		rc = pmbus_read_word_data(client, page, phase, reg);
249346 		if (rc < 0)
250347 			return rc;
251348 
....@@ -261,6 +358,10 @@
261358 		if (mfr & CFFPS_MFR_PS_KILL)
262359 			rc |= PB_STATUS_OFF;
263360 		break;
361
+	case PMBUS_VIRT_READ_VMON:
362
+		rc = pmbus_read_word_data(client, page, phase,
363
+					  CFFPS_12VCS_VOUT_CMD);
364
+		break;
264365 	default:
265366 		rc = -ENODATA;
266367 		break;
....@@ -273,21 +374,31 @@
273374 					enum led_brightness brightness)
274375 {
275376 	int rc;
377
+	u8 next_led_state;
276378 	struct ibm_cffps *psu = container_of(led_cdev, struct ibm_cffps, led);
277379 
278380 	if (brightness == LED_OFF) {
279
-		psu->led_state = CFFPS_LED_OFF;
381
+		next_led_state = CFFPS_LED_OFF;
280382 	} else {
281383 		brightness = LED_FULL;
384
+
282385 		if (psu->led_state != CFFPS_LED_BLINK)
283
-			psu->led_state = CFFPS_LED_ON;
386
+			next_led_state = CFFPS_LED_ON;
387
+		else
388
+			next_led_state = CFFPS_LED_BLINK;
284389 	}
285390 
391
+	dev_dbg(&psu->client->dev, "LED brightness set: %d. Command: %d.\n",
392
+		brightness, next_led_state);
393
+
394
+	pmbus_set_page(psu->client, 0, 0xff);
395
+
286396 	rc = i2c_smbus_write_byte_data(psu->client, CFFPS_SYS_CONFIG_CMD,
287
-				       psu->led_state);
397
+				       next_led_state);
288398 	if (rc < 0)
289399 		return rc;
290400 
401
+	psu->led_state = next_led_state;
291402 	led_cdev->brightness = brightness;
292403 
293404 	return 0;
....@@ -300,16 +411,17 @@
300411 	int rc;
301412 	struct ibm_cffps *psu = container_of(led_cdev, struct ibm_cffps, led);
302413 
303
-	psu->led_state = CFFPS_LED_BLINK;
414
+	dev_dbg(&psu->client->dev, "LED blink set.\n");
304415 
305
-	if (led_cdev->brightness == LED_OFF)
306
-		return 0;
416
+	pmbus_set_page(psu->client, 0, 0xff);
307417 
308418 	rc = i2c_smbus_write_byte_data(psu->client, CFFPS_SYS_CONFIG_CMD,
309419 				       CFFPS_LED_BLINK);
310420 	if (rc < 0)
311421 		return rc;
312422 
423
+	psu->led_state = CFFPS_LED_BLINK;
424
+	led_cdev->brightness = LED_FULL;
313425 	*delay_on = CFFPS_BLINK_RATE_MS;
314426 	*delay_off = CFFPS_BLINK_RATE_MS;
315427 
....@@ -332,33 +444,93 @@
332444 	rc = devm_led_classdev_register(dev, &psu->led);
333445 	if (rc)
334446 		dev_warn(dev, "failed to register led class: %d\n", rc);
447
+	else
448
+		i2c_smbus_write_byte_data(client, CFFPS_SYS_CONFIG_CMD,
449
+					  CFFPS_LED_OFF);
335450 }
336451 
337
-static struct pmbus_driver_info ibm_cffps_info = {
338
-	.pages = 1,
339
-	.func[0] = PMBUS_HAVE_VIN | PMBUS_HAVE_VOUT | PMBUS_HAVE_IOUT |
340
-		PMBUS_HAVE_PIN | PMBUS_HAVE_FAN12 | PMBUS_HAVE_TEMP |
341
-		PMBUS_HAVE_TEMP2 | PMBUS_HAVE_TEMP3 | PMBUS_HAVE_STATUS_VOUT |
342
-		PMBUS_HAVE_STATUS_IOUT | PMBUS_HAVE_STATUS_INPUT |
343
-		PMBUS_HAVE_STATUS_TEMP | PMBUS_HAVE_STATUS_FAN12,
344
-	.read_byte_data = ibm_cffps_read_byte_data,
345
-	.read_word_data = ibm_cffps_read_word_data,
452
+static struct pmbus_driver_info ibm_cffps_info[] = {
453
+	[cffps1] = {
454
+		.pages = 1,
455
+		.func[0] = PMBUS_HAVE_VIN | PMBUS_HAVE_VOUT | PMBUS_HAVE_IOUT |
456
+			PMBUS_HAVE_PIN | PMBUS_HAVE_FAN12 | PMBUS_HAVE_TEMP |
457
+			PMBUS_HAVE_TEMP2 | PMBUS_HAVE_TEMP3 |
458
+			PMBUS_HAVE_STATUS_VOUT | PMBUS_HAVE_STATUS_IOUT |
459
+			PMBUS_HAVE_STATUS_INPUT | PMBUS_HAVE_STATUS_TEMP |
460
+			PMBUS_HAVE_STATUS_FAN12,
461
+		.read_byte_data = ibm_cffps_read_byte_data,
462
+		.read_word_data = ibm_cffps_read_word_data,
463
+	},
464
+	[cffps2] = {
465
+		.pages = 2,
466
+		.func[0] = PMBUS_HAVE_VIN | PMBUS_HAVE_VOUT | PMBUS_HAVE_IOUT |
467
+			PMBUS_HAVE_PIN | PMBUS_HAVE_FAN12 | PMBUS_HAVE_TEMP |
468
+			PMBUS_HAVE_TEMP2 | PMBUS_HAVE_TEMP3 |
469
+			PMBUS_HAVE_STATUS_VOUT | PMBUS_HAVE_STATUS_IOUT |
470
+			PMBUS_HAVE_STATUS_INPUT | PMBUS_HAVE_STATUS_TEMP |
471
+			PMBUS_HAVE_STATUS_FAN12 | PMBUS_HAVE_VMON,
472
+		.func[1] = PMBUS_HAVE_VOUT | PMBUS_HAVE_IOUT |
473
+			PMBUS_HAVE_TEMP | PMBUS_HAVE_TEMP2 | PMBUS_HAVE_TEMP3 |
474
+			PMBUS_HAVE_STATUS_VOUT | PMBUS_HAVE_STATUS_IOUT,
475
+		.read_byte_data = ibm_cffps_read_byte_data,
476
+		.read_word_data = ibm_cffps_read_word_data,
477
+	},
346478 };
347479 
348480 static struct pmbus_platform_data ibm_cffps_pdata = {
349481 	.flags = PMBUS_SKIP_STATUS_CHECK,
350482 };
351483 
352
-static int ibm_cffps_probe(struct i2c_client *client,
353
-			   const struct i2c_device_id *id)
484
+static int ibm_cffps_probe(struct i2c_client *client)
354485 {
355486 	int i, rc;
487
+	enum versions vs = cffps_unknown;
356488 	struct dentry *debugfs;
357489 	struct dentry *ibm_cffps_dir;
358490 	struct ibm_cffps *psu;
491
+	const void *md = of_device_get_match_data(&client->dev);
492
+	const struct i2c_device_id *id;
493
+
494
+	if (md) {
495
+		vs = (enum versions)md;
496
+	} else {
497
+		id = i2c_match_id(ibm_cffps_id, client);
498
+		if (id)
499
+			vs = (enum versions)id->driver_data;
500
+	}
501
+
502
+	if (vs == cffps_unknown) {
503
+		u16 ccin_revision = 0;
504
+		u16 ccin_version = CFFPS_CCIN_VERSION_1;
505
+		int ccin = i2c_smbus_read_word_swapped(client, CFFPS_CCIN_CMD);
506
+
507
+		if (ccin > 0) {
508
+			ccin_revision = FIELD_GET(CFFPS_CCIN_REVISION, ccin);
509
+			ccin_version = FIELD_GET(CFFPS_CCIN_VERSION, ccin);
510
+		}
511
+
512
+		switch (ccin_version) {
513
+		default:
514
+		case CFFPS_CCIN_VERSION_1:
515
+			vs = cffps1;
516
+			break;
517
+		case CFFPS_CCIN_VERSION_2:
518
+			vs = cffps2;
519
+			break;
520
+		case CFFPS_CCIN_VERSION_3:
521
+			if (ccin_revision == CFFPS_CCIN_REVISION_LEGACY)
522
+				vs = cffps1;
523
+			else
524
+				vs = cffps2;
525
+			break;
526
+		}
527
+
528
+		/* Set the client name to include the version number. */
529
+		snprintf(client->name, I2C_NAME_SIZE, "cffps%d", vs + 1);
530
+	}
359531 
360532 	client->dev.platform_data = &ibm_cffps_pdata;
361
-	rc = pmbus_do_probe(client, id, &ibm_cffps_info);
533
+	rc = pmbus_do_probe(client, &ibm_cffps_info[vs]);
362534 	if (rc)
363535 		return rc;
364536 
....@@ -370,6 +542,7 @@
370542 	if (!psu)
371543 		return 0;
372544 
545
+	psu->version = vs;
373546 	psu->client = client;
374547 	mutex_init(&psu->input_history.update_lock);
375548 	psu->input_history.last_update = jiffies - HZ;
....@@ -397,8 +570,14 @@
397570 	debugfs_create_file("part_number", 0444, ibm_cffps_dir,
398571 			    &psu->debugfs_entries[CFFPS_DEBUGFS_PN],
399572 			    &ibm_cffps_fops);
573
+	debugfs_create_file("header", 0444, ibm_cffps_dir,
574
+			    &psu->debugfs_entries[CFFPS_DEBUGFS_HEADER],
575
+			    &ibm_cffps_fops);
400576 	debugfs_create_file("serial_number", 0444, ibm_cffps_dir,
401577 			    &psu->debugfs_entries[CFFPS_DEBUGFS_SN],
578
+			    &ibm_cffps_fops);
579
+	debugfs_create_file("max_power_out", 0444, ibm_cffps_dir,
580
+			    &psu->debugfs_entries[CFFPS_DEBUGFS_MAX_POWER_OUT],
402581 			    &ibm_cffps_fops);
403582 	debugfs_create_file("ccin", 0444, ibm_cffps_dir,
404583 			    &psu->debugfs_entries[CFFPS_DEBUGFS_CCIN],
....@@ -406,18 +585,34 @@
406585 	debugfs_create_file("fw_version", 0444, ibm_cffps_dir,
407586 			    &psu->debugfs_entries[CFFPS_DEBUGFS_FW],
408587 			    &ibm_cffps_fops);
588
+	debugfs_create_file("on_off_config", 0644, ibm_cffps_dir,
589
+			    &psu->debugfs_entries[CFFPS_DEBUGFS_ON_OFF_CONFIG],
590
+			    &ibm_cffps_fops);
409591 
410592 	return 0;
411593 }
412594 
413595 static const struct i2c_device_id ibm_cffps_id[] = {
414
-	{ "ibm_cffps1", 1 },
596
+	{ "ibm_cffps1", cffps1 },
597
+	{ "ibm_cffps2", cffps2 },
598
+	{ "ibm_cffps", cffps_unknown },
415599 	{}
416600 };
417601 MODULE_DEVICE_TABLE(i2c, ibm_cffps_id);
418602 
419603 static const struct of_device_id ibm_cffps_of_match[] = {
420
-	{ .compatible = "ibm,cffps1" },
604
+	{
605
+		.compatible = "ibm,cffps1",
606
+		.data = (void *)cffps1
607
+	},
608
+	{
609
+		.compatible = "ibm,cffps2",
610
+		.data = (void *)cffps2
611
+	},
612
+	{
613
+		.compatible = "ibm,cffps",
614
+		.data = (void *)cffps_unknown
615
+	},
421616 	{}
422617 };
423618 MODULE_DEVICE_TABLE(of, ibm_cffps_of_match);
....@@ -427,7 +622,7 @@
427622 		.name = "ibm-cffps",
428623 		.of_match_table = ibm_cffps_of_match,
429624 	},
430
-	.probe = ibm_cffps_probe,
625
+	.probe_new = ibm_cffps_probe,
431626 	.remove = pmbus_do_remove,
432627 	.id_table = ibm_cffps_id,
433628 };