1 // SPDX-License-Identifier: GPL-2.0-only
8 #include <linux/clk-provider.h>
15 #include <linux/nvmem-consumer.h>
20 #include <dt-bindings/thermal/mediatek,lvts-thermal.h>
86 #define LVTS_COEFF_A_MT8195			-250460
88 #define LVTS_COEFF_A_MT7988			-204650
122 		if (!((lvts_ctrl)->valid_sensor_mask & BIT(i))) \
224 	lvts_td->dom_dentry = debugfs_create_dir(dev_name(dev), NULL);  in lvts_debugfs_init()
225 	if (IS_ERR(lvts_td->dom_dentry))  in lvts_debugfs_init()
228 	for (i = 0; i < lvts_td->num_lvts_ctrl; i++) {  in lvts_debugfs_init()
230 		lvts_ctrl = &lvts_td->lvts_ctrl[i];  in lvts_debugfs_init()
233 		dentry = debugfs_create_dir(name, lvts_td->dom_dentry);  in lvts_debugfs_init()
241 		regset->base = lvts_ctrl->base;  in lvts_debugfs_init()
242 		regset->regs = lvts_regs;  in lvts_debugfs_init()
243 		regset->nregs = ARRAY_SIZE(lvts_regs);  in lvts_debugfs_init()
253 	debugfs_remove_recursive(lvts_td->dom_dentry);  in lvts_debugfs_exit()
280 	u32 raw_temp = ((s64)(golden_temp_offset - temperature)) << 14;  in lvts_temp_to_raw()
282 	raw_temp = div_s64(raw_temp, -temp_factor);  in lvts_temp_to_raw()
291 						   sensors[lvts_sensor->id]);  in lvts_get_temp()
292 	const struct lvts_data *lvts_data = lvts_ctrl->lvts_data;  in lvts_get_temp()
293 	void __iomem *msr = lvts_sensor->msr;  in lvts_get_temp()
300 	 * LVTS_MSR[0-3] / LVTS_IMMD[0-3]  in lvts_get_temp()
304 	 * 32-17: Unused  in lvts_get_temp()
306 	 * 15-0	: Raw temperature  in lvts_get_temp()
323 		return -EAGAIN;  in lvts_get_temp()
325 	*temp = lvts_raw_to_temp(value & 0xFFFF, lvts_data->temp_factor);  in lvts_get_temp()
347 	value = readl(LVTS_MONINT(lvts_ctrl->base));  in lvts_update_irq_mask()
350 		if (lvts_ctrl->sensors[i].high_thresh == lvts_ctrl->high_thresh  in lvts_update_irq_mask()
351 		    && lvts_ctrl->sensors[i].low_thresh == lvts_ctrl->low_thresh) {  in lvts_update_irq_mask()
358 			if (lvts_ctrl->low_thresh == -INT_MAX) {  in lvts_update_irq_mask()
369 	writel(value, LVTS_MONINT(lvts_ctrl->base));  in lvts_update_irq_mask()
376 	if (high > lvts_ctrl->high_thresh)  in lvts_should_update_thresh()
380 		if (lvts_ctrl->sensors[i].high_thresh == lvts_ctrl->high_thresh  in lvts_should_update_thresh()
381 		    && lvts_ctrl->sensors[i].low_thresh == lvts_ctrl->low_thresh)  in lvts_should_update_thresh()
391 						   sensors[lvts_sensor->id]);  in lvts_set_trips()
392 	const struct lvts_data *lvts_data = lvts_ctrl->lvts_data;  in lvts_set_trips()
393 	void __iomem *base = lvts_sensor->base;  in lvts_set_trips()
394 	u32 raw_low = lvts_temp_to_raw(low != -INT_MAX ? low : LVTS_MINIMUM_THRESHOLD,  in lvts_set_trips()
395 				       lvts_data->temp_factor);  in lvts_set_trips()
396 	u32 raw_high = lvts_temp_to_raw(high, lvts_data->temp_factor);  in lvts_set_trips()
399 	lvts_sensor->low_thresh = low;  in lvts_set_trips()
400 	lvts_sensor->high_thresh = high;  in lvts_set_trips()
404 		lvts_ctrl->high_thresh = high;  in lvts_set_trips()
405 		lvts_ctrl->low_thresh = low;  in lvts_set_trips()
419 	 * 14-0 : Raw temperature for threshold  in lvts_set_trips()
432 	 * 14-0 : Raw temperature for threshold  in lvts_set_trips()
515 	value = readl(LVTS_MONINTSTS(lvts_ctrl->base));  in lvts_ctrl_irq_handler()
529 		thermal_zone_device_update(lvts_ctrl->sensors[i].tz,  in lvts_ctrl_irq_handler()
537 	writel(value, LVTS_MONINTSTS(lvts_ctrl->base));  in lvts_ctrl_irq_handler()
562 	for (i = 0; i < lvts_td->num_lvts_ctrl; i++) {  in lvts_irq_handler()
564 		aux = lvts_ctrl_irq_handler(&lvts_td->lvts_ctrl[i]);  in lvts_irq_handler()
582 	struct lvts_sensor *lvts_sensor = lvts_ctrl->sensors;  in lvts_sensor_init()
585 		LVTS_MSR0(lvts_ctrl->base),  in lvts_sensor_init()
586 		LVTS_MSR1(lvts_ctrl->base),  in lvts_sensor_init()
587 		LVTS_MSR2(lvts_ctrl->base),  in lvts_sensor_init()
588 		LVTS_MSR3(lvts_ctrl->base)  in lvts_sensor_init()
592 		LVTS_IMMD0(lvts_ctrl->base),  in lvts_sensor_init()
593 		LVTS_IMMD1(lvts_ctrl->base),  in lvts_sensor_init()
594 		LVTS_IMMD2(lvts_ctrl->base),  in lvts_sensor_init()
595 		LVTS_IMMD3(lvts_ctrl->base)  in lvts_sensor_init()
602 		int dt_id = lvts_ctrl_data->lvts_sensor[i].dt_id;  in lvts_sensor_init()
628 		lvts_sensor[i].base = lvts_ctrl->base;  in lvts_sensor_init()
633 		lvts_sensor[i].msr = lvts_ctrl_data->mode == LVTS_MSR_IMMEDIATE_MODE ?  in lvts_sensor_init()
640 	lvts_ctrl->valid_sensor_mask = lvts_ctrl_data->valid_sensor_mask;  in lvts_sensor_init()
652  * <-----mcu-tc#0-----> <-----sensor#0----->        <-----sensor#1----->
655  * <-----sensor#2----->        <-----sensor#3----->
658 …* <-----sensor#4----->        <-----sensor#5----->        <-----sensor#6----->        <-----sensor…
663  * <-----sensor#0----->        <-----sensor#1----->
666  * <-----sensor#2----->        <-----sensor#3----->
669  * <-----sensor#4----->        <-----sensor#5----->
672  * <-----sensor#6----->        <-----sensor#7----->        <-----sensor#8----->
678  * <-----mcu-tc#0-----> <-----sensor#0-----> <-----sensor#1----->
681  * <-----mcu-tc#1-----> <-----sensor#2-----> <-----sensor#3----->
684 …* <-----mcu-tc#2-----> <-----sensor#4-----> <-----sensor#5-----> <-----sensor#6-----> <-----sensor…
689  * <-----ap--tc#0-----> <-----sensor#0-----> <-----sensor#1----->
692  * <-----ap--tc#1-----> <-----sensor#2-----> <-----sensor#3----->
695  * <-----ap--tc#2-----> <-----sensor#4-----> <-----sensor#5-----> <-----sensor#6----->
698  * <-----ap--tc#3-----> <-----sensor#7-----> <-----sensor#8----->
714 	gt = (((u32 *)efuse_calibration)[0] >> lvts_ctrl->lvts_data->gt_calib_bit_offset) & 0xff;  in lvts_calibration_init()
718 					&lvts_ctrl_data->lvts_sensor[i];  in lvts_calibration_init()
720 		if (sensor->cal_offsets[0] >= calib_len ||  in lvts_calibration_init()
721 		    sensor->cal_offsets[1] >= calib_len ||  in lvts_calibration_init()
722 		    sensor->cal_offsets[2] >= calib_len)  in lvts_calibration_init()
723 			return -EINVAL;  in lvts_calibration_init()
726 			lvts_ctrl->calibration[i] =  in lvts_calibration_init()
727 				(efuse_calibration[sensor->cal_offsets[0]] << 0) +  in lvts_calibration_init()
728 				(efuse_calibration[sensor->cal_offsets[1]] << 8) +  in lvts_calibration_init()
729 				(efuse_calibration[sensor->cal_offsets[2]] << 16);  in lvts_calibration_init()
730 		} else if (lvts_ctrl->lvts_data->def_calibration) {  in lvts_calibration_init()
731 			lvts_ctrl->calibration[i] = lvts_ctrl->lvts_data->def_calibration;  in lvts_calibration_init()
734 			return -ENODATA;  in lvts_calibration_init()
755 	of_property_for_each_string(np, "nvmem-cell-names", prop, cell_name) {  in lvts_calibration_read()
774 		lvts_td->calib = devm_krealloc(dev, lvts_td->calib,  in lvts_calibration_read()
775 					       lvts_td->calib_len + len, GFP_KERNEL);  in lvts_calibration_read()
776 		if (!lvts_td->calib) {  in lvts_calibration_read()
778 			return -ENOMEM;  in lvts_calibration_read()
781 		memcpy(lvts_td->calib + lvts_td->calib_len, efuse, len);  in lvts_calibration_read()
783 		lvts_td->calib_len += len;  in lvts_calibration_read()
797 	 * The golden temp information is contained in the first 32-bit  in lvts_golden_temp_init()
800 	gt = (((u32 *)calib)[0] >> lvts_data->gt_calib_bit_offset) & 0xff;  in lvts_golden_temp_init()
806 	golden_temp_offset = golden_temp * 500 + lvts_data->temp_offset;  in lvts_golden_temp_init()
816 	size_t size = sizeof(*lvts_td->lvts_ctrl) * lvts_data->num_lvts_ctrl;  in lvts_ctrl_init()
827 	ret = lvts_golden_temp_init(dev, lvts_td->calib, lvts_data);  in lvts_ctrl_init()
833 		return -ENOMEM;  in lvts_ctrl_init()
835 	for (i = 0; i < lvts_data->num_lvts_ctrl; i++) {  in lvts_ctrl_init()
837 		lvts_ctrl[i].base = lvts_td->base + lvts_data->lvts_ctrl[i].offset;  in lvts_ctrl_init()
841 				       &lvts_data->lvts_ctrl[i]);  in lvts_ctrl_init()
846 					    &lvts_data->lvts_ctrl[i],  in lvts_ctrl_init()
847 					    lvts_td->calib,  in lvts_ctrl_init()
848 					    lvts_td->calib_len);  in lvts_ctrl_init()
856 		lvts_ctrl[i].mode = lvts_data->lvts_ctrl[i].mode;  in lvts_ctrl_init()
865 	devm_kfree(dev, lvts_td->calib);  in lvts_ctrl_init()
867 	lvts_td->lvts_ctrl = lvts_ctrl;  in lvts_ctrl_init()
868 	lvts_td->num_lvts_ctrl = lvts_data->num_lvts_ctrl;  in lvts_ctrl_init()
883 	if (lvts_ctrl->mode != LVTS_MSR_FILTERED_MODE)  in lvts_ctrl_monitor_enable()
894 	 *    0-3: Enable sensing point 0-3  in lvts_ctrl_monitor_enable()
896 	writel(sensor_map | BIT(9), LVTS_MONCTL0(lvts_ctrl->base));  in lvts_ctrl_monitor_enable()
913 		writel(cmds[i], LVTS_CONFIG(lvts_ctrl->base));  in lvts_write_config()
925 	 * 19-18 : Sensor to base the protection on  in lvts_irq_init()
926 	 * 17-16 : Strategy:  in lvts_irq_init()
929 	 *         10 : Selected sensor with bits 19-18  in lvts_irq_init()
940 	 * 14-0: Raw temperature threshold  in lvts_irq_init()
942 	 * writel(0x0, LVTS_PROTTA(lvts_ctrl->base));  in lvts_irq_init()
943 	 * writel(0x0, LVTS_PROTTB(lvts_ctrl->base));  in lvts_irq_init()
944 	 * writel(0x0, LVTS_PROTTC(lvts_ctrl->base));  in lvts_irq_init()
953 	writel(0, LVTS_MONINT(lvts_ctrl->base));  in lvts_irq_init()
981 	writel(enable, LVTS_CLKEN(lvts_ctrl->base));  in lvts_ctrl_set_enable()
997 	 * 0-5	: thermal controller id  in lvts_ctrl_connect()
1000 	id = readl(LVTS_ID(lvts_ctrl->base));  in lvts_ctrl_connect()
1002 		return -EIO;  in lvts_ctrl_connect()
1028 		LVTS_EDATA00(lvts_ctrl->base),  in lvts_ctrl_calibrate()
1029 		LVTS_EDATA01(lvts_ctrl->base),  in lvts_ctrl_calibrate()
1030 		LVTS_EDATA02(lvts_ctrl->base),  in lvts_ctrl_calibrate()
1031 		LVTS_EDATA03(lvts_ctrl->base)  in lvts_ctrl_calibrate()
1039 	 * 20-0 : Efuse value for normalization data  in lvts_ctrl_calibrate()
1042 		writel(lvts_ctrl->calibration[i], lvts_edata[i]);  in lvts_ctrl_calibrate()
1056 	 * 31-24: ADC Sense 3  in lvts_ctrl_configure()
1057 	 * 23-16: ADC Sense 2  in lvts_ctrl_configure()
1058 	 * 15-8	: ADC Sense 1  in lvts_ctrl_configure()
1059 	 * 7-0	: ADC Sense 0  in lvts_ctrl_configure()
1062 	writel(value, LVTS_TSSEL(lvts_ctrl->base));  in lvts_ctrl_configure()
1076 	 * 001 : Avg 2 samples  in lvts_ctrl_configure()
1077 	 * 010 : 4 samples, drop min and max, avg 2 samples  in lvts_ctrl_configure()
1078 	 * 011 : 6 samples, drop min and max, avg 4 samples  in lvts_ctrl_configure()
1079 	 * 100 : 10 samples, drop min and max, avg 8 samples  in lvts_ctrl_configure()
1080 	 * 101 : 18 samples, drop min and max, avg 16 samples  in lvts_ctrl_configure()
1084 	 * 0-2  : Sensor0 filter  in lvts_ctrl_configure()
1085 	 * 3-5  : Sensor1 filter  in lvts_ctrl_configure()
1086 	 * 6-8  : Sensor2 filter  in lvts_ctrl_configure()
1087 	 * 9-11 : Sensor3 filter  in lvts_ctrl_configure()
1091 	writel(value, LVTS_MSRCTL0(lvts_ctrl->base));  in lvts_ctrl_configure()
1105 	 * - Filter interval delay is a delay between two samples of  in lvts_ctrl_configure()
1108 	 * - Sensor interval delay is a delay between two samples of  in lvts_ctrl_configure()
1111 	 * - Group interval delay is a delay between different rounds.  in lvts_ctrl_configure()
1123 	 *        <--> Filter interval delay  in lvts_ctrl_configure()
1124 	 *                       <--> Sensor interval delay  in lvts_ctrl_configure()
1125 	 *                                             <--> Group interval delay  in lvts_ctrl_configure()
1127 	 *      29 - 20 : Group interval  in lvts_ctrl_configure()
1128 	 *      16 - 13 : Send a single interrupt when crossing the hot threshold (1)  in lvts_ctrl_configure()
1130 	 *       9 - 0  : Period unit  in lvts_ctrl_configure()
1134 	writel(value, LVTS_MONCTL1(lvts_ctrl->base));  in lvts_ctrl_configure()
1141 	 *      25-16 : Interval unit in PERIOD_UNIT between sample on  in lvts_ctrl_configure()
1143 	 *       9-0  : Interval unit in PERIOD_UNIT between each sensor  in lvts_ctrl_configure()
1147 	writel(value, LVTS_MONCTL2(lvts_ctrl->base));  in lvts_ctrl_configure()
1154 	struct lvts_sensor *lvts_sensors = lvts_ctrl->sensors;  in lvts_ctrl_start()
1165 	u32 *sensor_bitmap = lvts_ctrl->mode == LVTS_MSR_IMMEDIATE_MODE ?  in lvts_ctrl_start()
1180 			if (PTR_ERR(tz) == -ENODEV)  in lvts_ctrl_start()
1213 	if (lvts_ctrl->mode == LVTS_MSR_IMMEDIATE_MODE) {  in lvts_ctrl_start()
1227 		writel(sensor_map, LVTS_MSRCTL1(lvts_ctrl->base));  in lvts_ctrl_start()
1232 		 *    0-3: Enable sensing point 0-3  in lvts_ctrl_start()
1234 		writel(sensor_map | BIT(9), LVTS_MONCTL0(lvts_ctrl->base));  in lvts_ctrl_start()
1250 	ret = lvts_domain_reset(dev, lvts_td->reset);  in lvts_domain_init()
1256 	for (i = 0; i < lvts_td->num_lvts_ctrl; i++) {  in lvts_domain_init()
1258 		lvts_ctrl = &lvts_td->lvts_ctrl[i];  in lvts_domain_init()
1263 		 * - Enable the clock  in lvts_domain_init()
1264 		 * - Connect to the LVTS  in lvts_domain_init()
1265 		 * - Initialize the LVTS  in lvts_domain_init()
1266 		 * - Prepare the calibration data  in lvts_domain_init()
1267 		 * - Select monitored sensors  in lvts_domain_init()
1270 		 * - Start measurement  in lvts_domain_init()
1316 	struct device *dev = &pdev->dev;  in lvts_probe()
1322 		return -ENOMEM;  in lvts_probe()
1326 		return -ENODEV;  in lvts_probe()
1328 	lvts_td->clk = devm_clk_get_enabled(dev, NULL);  in lvts_probe()
1329 	if (IS_ERR(lvts_td->clk))  in lvts_probe()
1330 		return dev_err_probe(dev, PTR_ERR(lvts_td->clk), "Failed to retrieve clock\n");  in lvts_probe()
1334 		return dev_err_probe(dev, (-ENXIO), "No IO resource\n");  in lvts_probe()
1336 	lvts_td->base = devm_platform_get_and_ioremap_resource(pdev, 0, &res);  in lvts_probe()
1337 	if (IS_ERR(lvts_td->base))  in lvts_probe()
1338 		return dev_err_probe(dev, PTR_ERR(lvts_td->base), "Failed to map io resource\n");  in lvts_probe()
1340 	lvts_td->reset = devm_reset_control_get_by_index(dev, 0);  in lvts_probe()
1341 	if (IS_ERR(lvts_td->reset))  in lvts_probe()
1342 		return dev_err_probe(dev, PTR_ERR(lvts_td->reset), "Failed to get reset control\n");  in lvts_probe()
1348 	golden_temp_offset = lvts_data->temp_offset;  in lvts_probe()
1375 	for (i = 0; i < lvts_td->num_lvts_ctrl; i++)  in lvts_remove()
1376 		lvts_ctrl_set_enable(&lvts_td->lvts_ctrl[i], false);  in lvts_remove()
1419 	for (i = 0; i < lvts_td->num_lvts_ctrl; i++) {  in lvts_suspend()
1420 		lvts_ctrl_monitor_enable(dev, &lvts_td->lvts_ctrl[i], false);  in lvts_suspend()
1422 		lvts_ctrl_set_enable(&lvts_td->lvts_ctrl[i], false);  in lvts_suspend()
1425 	clk_disable_unprepare(lvts_td->clk);  in lvts_suspend()
1437 	ret = clk_prepare_enable(lvts_td->clk);  in lvts_resume()
1441 	for (i = 0; i < lvts_td->num_lvts_ctrl; i++) {  in lvts_resume()
1442 		lvts_ctrl_set_enable(&lvts_td->lvts_ctrl[i], true);  in lvts_resume()
1444 		lvts_ctrl_monitor_enable(dev, &lvts_td->lvts_ctrl[i], true);  in lvts_resume()
1451  * The MT8186 calibration data is stored as packed 3-byte little-endian
1452  * values using a weird layout that makes sense only when viewed as a 32-bit
1456  *   [S0B2-S0B1-S0B0-S1B2] [S1B1-S1B0-S2B2-S2B1] [S2B0-S3B2-S3B1-S3B0]
1814 	{ .compatible = "mediatek,mt7988-lvts-ap", .data = &mt7988_lvts_ap_data },
1815 	{ .compatible = "mediatek,mt8186-lvts", .data = &mt8186_lvts_data },
1816 	{ .compatible = "mediatek,mt8188-lvts-mcu", .data = &mt8188_lvts_mcu_data },
1817 	{ .compatible = "mediatek,mt8188-lvts-ap", .data = &mt8188_lvts_ap_data },
1818 	{ .compatible = "mediatek,mt8192-lvts-mcu", .data = &mt8192_lvts_mcu_data },
1819 	{ .compatible = "mediatek,mt8192-lvts-ap", .data = &mt8192_lvts_ap_data },
1820 	{ .compatible = "mediatek,mt8195-lvts-mcu", .data = &mt8195_lvts_mcu_data },
1821 	{ .compatible = "mediatek,mt8195-lvts-ap", .data = &mt8195_lvts_ap_data },
1834 		.name = "mtk-lvts-thermal",