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>
83 #define LVTS_COEFF_A_MT8195			-250460
85 #define LVTS_COEFF_A_MT7988			-204650
119 		if (!((lvts_ctrl)->valid_sensor_mask & BIT(i))) \
221 	lvts_td->dom_dentry = debugfs_create_dir(dev_name(dev), NULL);  in lvts_debugfs_init()
222 	if (IS_ERR(lvts_td->dom_dentry))  in lvts_debugfs_init()
225 	for (i = 0; i < lvts_td->num_lvts_ctrl; i++) {  in lvts_debugfs_init()
227 		lvts_ctrl = &lvts_td->lvts_ctrl[i];  in lvts_debugfs_init()
230 		dentry = debugfs_create_dir(name, lvts_td->dom_dentry);  in lvts_debugfs_init()
238 		regset->base = lvts_ctrl->base;  in lvts_debugfs_init()
239 		regset->regs = lvts_regs;  in lvts_debugfs_init()
240 		regset->nregs = ARRAY_SIZE(lvts_regs);  in lvts_debugfs_init()
250 	debugfs_remove_recursive(lvts_td->dom_dentry);  in lvts_debugfs_exit()
277 	u32 raw_temp = ((s64)(golden_temp_offset - temperature)) << 14;  in lvts_temp_to_raw()
279 	raw_temp = div_s64(raw_temp, -temp_factor);  in lvts_temp_to_raw()
288 						   sensors[lvts_sensor->id]);  in lvts_get_temp()
289 	const struct lvts_data *lvts_data = lvts_ctrl->lvts_data;  in lvts_get_temp()
290 	void __iomem *msr = lvts_sensor->msr;  in lvts_get_temp()
297 	 * LVTS_MSR[0-3] / LVTS_IMMD[0-3]  in lvts_get_temp()
301 	 * 32-17: Unused  in lvts_get_temp()
303 	 * 15-0	: Raw temperature  in lvts_get_temp()
320 		return -EAGAIN;  in lvts_get_temp()
322 	*temp = lvts_raw_to_temp(value & 0xFFFF, lvts_data->temp_factor);  in lvts_get_temp()
338 	value = readl(LVTS_MONINT(lvts_ctrl->base));  in lvts_update_irq_mask()
341 		if (lvts_ctrl->sensors[i].high_thresh == lvts_ctrl->high_thresh  in lvts_update_irq_mask()
342 		    && lvts_ctrl->sensors[i].low_thresh == lvts_ctrl->low_thresh)  in lvts_update_irq_mask()
348 	writel(value, LVTS_MONINT(lvts_ctrl->base));  in lvts_update_irq_mask()
355 	if (high > lvts_ctrl->high_thresh)  in lvts_should_update_thresh()
359 		if (lvts_ctrl->sensors[i].high_thresh == lvts_ctrl->high_thresh  in lvts_should_update_thresh()
360 		    && lvts_ctrl->sensors[i].low_thresh == lvts_ctrl->low_thresh)  in lvts_should_update_thresh()
370 						   sensors[lvts_sensor->id]);  in lvts_set_trips()
371 	const struct lvts_data *lvts_data = lvts_ctrl->lvts_data;  in lvts_set_trips()
372 	void __iomem *base = lvts_sensor->base;  in lvts_set_trips()
373 	u32 raw_low = lvts_temp_to_raw(low != -INT_MAX ? low : LVTS_MINIMUM_THRESHOLD,  in lvts_set_trips()
374 				       lvts_data->temp_factor);  in lvts_set_trips()
375 	u32 raw_high = lvts_temp_to_raw(high, lvts_data->temp_factor);  in lvts_set_trips()
378 	lvts_sensor->low_thresh = low;  in lvts_set_trips()
379 	lvts_sensor->high_thresh = high;  in lvts_set_trips()
383 		lvts_ctrl->high_thresh = high;  in lvts_set_trips()
384 		lvts_ctrl->low_thresh = low;  in lvts_set_trips()
398 	 * 14-0 : Raw temperature for threshold  in lvts_set_trips()
411 	 * 14-0 : Raw temperature for threshold  in lvts_set_trips()
494 	value = readl(LVTS_MONINTSTS(lvts_ctrl->base));  in lvts_ctrl_irq_handler()
508 		thermal_zone_device_update(lvts_ctrl->sensors[i].tz,  in lvts_ctrl_irq_handler()
516 	writel(value, LVTS_MONINTSTS(lvts_ctrl->base));  in lvts_ctrl_irq_handler()
541 	for (i = 0; i < lvts_td->num_lvts_ctrl; i++) {  in lvts_irq_handler()
543 		aux = lvts_ctrl_irq_handler(&lvts_td->lvts_ctrl[i]);  in lvts_irq_handler()
561 	struct lvts_sensor *lvts_sensor = lvts_ctrl->sensors;  in lvts_sensor_init()
564 		LVTS_MSR0(lvts_ctrl->base),  in lvts_sensor_init()
565 		LVTS_MSR1(lvts_ctrl->base),  in lvts_sensor_init()
566 		LVTS_MSR2(lvts_ctrl->base),  in lvts_sensor_init()
567 		LVTS_MSR3(lvts_ctrl->base)  in lvts_sensor_init()
571 		LVTS_IMMD0(lvts_ctrl->base),  in lvts_sensor_init()
572 		LVTS_IMMD1(lvts_ctrl->base),  in lvts_sensor_init()
573 		LVTS_IMMD2(lvts_ctrl->base),  in lvts_sensor_init()
574 		LVTS_IMMD3(lvts_ctrl->base)  in lvts_sensor_init()
581 		int dt_id = lvts_ctrl_data->lvts_sensor[i].dt_id;  in lvts_sensor_init()
607 		lvts_sensor[i].base = lvts_ctrl->base;  in lvts_sensor_init()
612 		lvts_sensor[i].msr = lvts_ctrl_data->mode == LVTS_MSR_IMMEDIATE_MODE ?  in lvts_sensor_init()
619 	lvts_ctrl->valid_sensor_mask = lvts_ctrl_data->valid_sensor_mask;  in lvts_sensor_init()
631  * <-----mcu-tc#0-----> <-----sensor#0----->        <-----sensor#1----->
634  * <-----sensor#2----->        <-----sensor#3----->
637 …* <-----sensor#4----->        <-----sensor#5----->        <-----sensor#6----->        <-----sensor…
642  * <-----sensor#0----->        <-----sensor#1----->
645  * <-----sensor#2----->        <-----sensor#3----->
648  * <-----sensor#4----->        <-----sensor#5----->
651  * <-----sensor#6----->        <-----sensor#7----->        <-----sensor#8----->
657  * <-----mcu-tc#0-----> <-----sensor#0-----> <-----sensor#1----->
660  * <-----mcu-tc#1-----> <-----sensor#2-----> <-----sensor#3----->
663 …* <-----mcu-tc#2-----> <-----sensor#4-----> <-----sensor#5-----> <-----sensor#6-----> <-----sensor…
668  * <-----ap--tc#0-----> <-----sensor#0-----> <-----sensor#1----->
671  * <-----ap--tc#1-----> <-----sensor#2-----> <-----sensor#3----->
674  * <-----ap--tc#2-----> <-----sensor#4-----> <-----sensor#5-----> <-----sensor#6----->
677  * <-----ap--tc#3-----> <-----sensor#7-----> <-----sensor#8----->
693 	gt = (((u32 *)efuse_calibration)[0] >> lvts_ctrl->lvts_data->gt_calib_bit_offset) & 0xff;  in lvts_calibration_init()
697 					&lvts_ctrl_data->lvts_sensor[i];  in lvts_calibration_init()
699 		if (sensor->cal_offsets[0] >= calib_len ||  in lvts_calibration_init()
700 		    sensor->cal_offsets[1] >= calib_len ||  in lvts_calibration_init()
701 		    sensor->cal_offsets[2] >= calib_len)  in lvts_calibration_init()
702 			return -EINVAL;  in lvts_calibration_init()
705 			lvts_ctrl->calibration[i] =  in lvts_calibration_init()
706 				(efuse_calibration[sensor->cal_offsets[0]] << 0) +  in lvts_calibration_init()
707 				(efuse_calibration[sensor->cal_offsets[1]] << 8) +  in lvts_calibration_init()
708 				(efuse_calibration[sensor->cal_offsets[2]] << 16);  in lvts_calibration_init()
709 		} else if (lvts_ctrl->lvts_data->def_calibration) {  in lvts_calibration_init()
710 			lvts_ctrl->calibration[i] = lvts_ctrl->lvts_data->def_calibration;  in lvts_calibration_init()
713 			return -ENODATA;  in lvts_calibration_init()
734 	of_property_for_each_string(np, "nvmem-cell-names", prop, cell_name) {  in lvts_calibration_read()
753 		lvts_td->calib = devm_krealloc(dev, lvts_td->calib,  in lvts_calibration_read()
754 					       lvts_td->calib_len + len, GFP_KERNEL);  in lvts_calibration_read()
755 		if (!lvts_td->calib) {  in lvts_calibration_read()
757 			return -ENOMEM;  in lvts_calibration_read()
760 		memcpy(lvts_td->calib + lvts_td->calib_len, efuse, len);  in lvts_calibration_read()
762 		lvts_td->calib_len += len;  in lvts_calibration_read()
776 	 * The golden temp information is contained in the first 32-bit  in lvts_golden_temp_init()
779 	gt = (((u32 *)calib)[0] >> lvts_data->gt_calib_bit_offset) & 0xff;  in lvts_golden_temp_init()
785 	golden_temp_offset = golden_temp * 500 + lvts_data->temp_offset;  in lvts_golden_temp_init()
795 	size_t size = sizeof(*lvts_td->lvts_ctrl) * lvts_data->num_lvts_ctrl;  in lvts_ctrl_init()
806 	ret = lvts_golden_temp_init(dev, lvts_td->calib, lvts_data);  in lvts_ctrl_init()
812 		return -ENOMEM;  in lvts_ctrl_init()
814 	for (i = 0; i < lvts_data->num_lvts_ctrl; i++) {  in lvts_ctrl_init()
816 		lvts_ctrl[i].base = lvts_td->base + lvts_data->lvts_ctrl[i].offset;  in lvts_ctrl_init()
820 				       &lvts_data->lvts_ctrl[i]);  in lvts_ctrl_init()
825 					    &lvts_data->lvts_ctrl[i],  in lvts_ctrl_init()
826 					    lvts_td->calib,  in lvts_ctrl_init()
827 					    lvts_td->calib_len);  in lvts_ctrl_init()
835 		lvts_ctrl[i].mode = lvts_data->lvts_ctrl[i].mode;  in lvts_ctrl_init()
844 	devm_kfree(dev, lvts_td->calib);  in lvts_ctrl_init()
846 	lvts_td->lvts_ctrl = lvts_ctrl;  in lvts_ctrl_init()
847 	lvts_td->num_lvts_ctrl = lvts_data->num_lvts_ctrl;  in lvts_ctrl_init()
862 	if (lvts_ctrl->mode != LVTS_MSR_FILTERED_MODE)  in lvts_ctrl_monitor_enable()
873 	 *    0-3: Enable sensing point 0-3  in lvts_ctrl_monitor_enable()
875 	writel(sensor_map | BIT(9), LVTS_MONCTL0(lvts_ctrl->base));  in lvts_ctrl_monitor_enable()
892 		writel(cmds[i], LVTS_CONFIG(lvts_ctrl->base));  in lvts_write_config()
904 	 * 19-18 : Sensor to base the protection on  in lvts_irq_init()
905 	 * 17-16 : Strategy:  in lvts_irq_init()
908 	 *         10 : Selected sensor with bits 19-18  in lvts_irq_init()
919 	 * 14-0: Raw temperature threshold  in lvts_irq_init()
921 	 * writel(0x0, LVTS_PROTTA(lvts_ctrl->base));  in lvts_irq_init()
922 	 * writel(0x0, LVTS_PROTTB(lvts_ctrl->base));  in lvts_irq_init()
923 	 * writel(0x0, LVTS_PROTTC(lvts_ctrl->base));  in lvts_irq_init()
932 	writel(LVTS_MONINT_CONF, LVTS_MONINT(lvts_ctrl->base));  in lvts_irq_init()
960 	writel(enable, LVTS_CLKEN(lvts_ctrl->base));  in lvts_ctrl_set_enable()
976 	 * 0-5	: thermal controller id  in lvts_ctrl_connect()
979 	id = readl(LVTS_ID(lvts_ctrl->base));  in lvts_ctrl_connect()
981 		return -EIO;  in lvts_ctrl_connect()
1007 		LVTS_EDATA00(lvts_ctrl->base),  in lvts_ctrl_calibrate()
1008 		LVTS_EDATA01(lvts_ctrl->base),  in lvts_ctrl_calibrate()
1009 		LVTS_EDATA02(lvts_ctrl->base),  in lvts_ctrl_calibrate()
1010 		LVTS_EDATA03(lvts_ctrl->base)  in lvts_ctrl_calibrate()
1018 	 * 20-0 : Efuse value for normalization data  in lvts_ctrl_calibrate()
1021 		writel(lvts_ctrl->calibration[i], lvts_edata[i]);  in lvts_ctrl_calibrate()
1035 	 * 31-24: ADC Sense 3  in lvts_ctrl_configure()
1036 	 * 23-16: ADC Sense 2  in lvts_ctrl_configure()
1037 	 * 15-8	: ADC Sense 1  in lvts_ctrl_configure()
1038 	 * 7-0	: ADC Sense 0  in lvts_ctrl_configure()
1041 	writel(value, LVTS_TSSEL(lvts_ctrl->base));  in lvts_ctrl_configure()
1055 	 * 001 : Avg 2 samples  in lvts_ctrl_configure()
1056 	 * 010 : 4 samples, drop min and max, avg 2 samples  in lvts_ctrl_configure()
1057 	 * 011 : 6 samples, drop min and max, avg 4 samples  in lvts_ctrl_configure()
1058 	 * 100 : 10 samples, drop min and max, avg 8 samples  in lvts_ctrl_configure()
1059 	 * 101 : 18 samples, drop min and max, avg 16 samples  in lvts_ctrl_configure()
1063 	 * 0-2  : Sensor0 filter  in lvts_ctrl_configure()
1064 	 * 3-5  : Sensor1 filter  in lvts_ctrl_configure()
1065 	 * 6-8  : Sensor2 filter  in lvts_ctrl_configure()
1066 	 * 9-11 : Sensor3 filter  in lvts_ctrl_configure()
1070 	writel(value, LVTS_MSRCTL0(lvts_ctrl->base));  in lvts_ctrl_configure()
1084 	 * - Filter interval delay is a delay between two samples of  in lvts_ctrl_configure()
1087 	 * - Sensor interval delay is a delay between two samples of  in lvts_ctrl_configure()
1090 	 * - Group interval delay is a delay between different rounds.  in lvts_ctrl_configure()
1102 	 *        <--> Filter interval delay  in lvts_ctrl_configure()
1103 	 *                       <--> Sensor interval delay  in lvts_ctrl_configure()
1104 	 *                                             <--> Group interval delay  in lvts_ctrl_configure()
1106 	 *      29 - 20 : Group interval  in lvts_ctrl_configure()
1107 	 *      16 - 13 : Send a single interrupt when crossing the hot threshold (1)  in lvts_ctrl_configure()
1109 	 *       9 - 0  : Period unit  in lvts_ctrl_configure()
1113 	writel(value, LVTS_MONCTL1(lvts_ctrl->base));  in lvts_ctrl_configure()
1120 	 *      25-16 : Interval unit in PERIOD_UNIT between sample on  in lvts_ctrl_configure()
1122 	 *       9-0  : Interval unit in PERIOD_UNIT between each sensor  in lvts_ctrl_configure()
1126 	writel(value, LVTS_MONCTL2(lvts_ctrl->base));  in lvts_ctrl_configure()
1133 	struct lvts_sensor *lvts_sensors = lvts_ctrl->sensors;  in lvts_ctrl_start()
1144 	u32 *sensor_bitmap = lvts_ctrl->mode == LVTS_MSR_IMMEDIATE_MODE ?  in lvts_ctrl_start()
1159 			if (PTR_ERR(tz) == -ENODEV)  in lvts_ctrl_start()
1192 	if (lvts_ctrl->mode == LVTS_MSR_IMMEDIATE_MODE) {  in lvts_ctrl_start()
1206 		writel(sensor_map, LVTS_MSRCTL1(lvts_ctrl->base));  in lvts_ctrl_start()
1211 		 *    0-3: Enable sensing point 0-3  in lvts_ctrl_start()
1213 		writel(sensor_map | BIT(9), LVTS_MONCTL0(lvts_ctrl->base));  in lvts_ctrl_start()
1229 	ret = lvts_domain_reset(dev, lvts_td->reset);  in lvts_domain_init()
1235 	for (i = 0; i < lvts_td->num_lvts_ctrl; i++) {  in lvts_domain_init()
1237 		lvts_ctrl = &lvts_td->lvts_ctrl[i];  in lvts_domain_init()
1242 		 * - Enable the clock  in lvts_domain_init()
1243 		 * - Connect to the LVTS  in lvts_domain_init()
1244 		 * - Initialize the LVTS  in lvts_domain_init()
1245 		 * - Prepare the calibration data  in lvts_domain_init()
1246 		 * - Select monitored sensors  in lvts_domain_init()
1249 		 * - Start measurement  in lvts_domain_init()
1295 	struct device *dev = &pdev->dev;  in lvts_probe()
1301 		return -ENOMEM;  in lvts_probe()
1305 		return -ENODEV;  in lvts_probe()
1307 	lvts_td->clk = devm_clk_get_enabled(dev, NULL);  in lvts_probe()
1308 	if (IS_ERR(lvts_td->clk))  in lvts_probe()
1309 		return dev_err_probe(dev, PTR_ERR(lvts_td->clk), "Failed to retrieve clock\n");  in lvts_probe()
1313 		return dev_err_probe(dev, (-ENXIO), "No IO resource\n");  in lvts_probe()
1315 	lvts_td->base = devm_platform_get_and_ioremap_resource(pdev, 0, &res);  in lvts_probe()
1316 	if (IS_ERR(lvts_td->base))  in lvts_probe()
1317 		return dev_err_probe(dev, PTR_ERR(lvts_td->base), "Failed to map io resource\n");  in lvts_probe()
1319 	lvts_td->reset = devm_reset_control_get_by_index(dev, 0);  in lvts_probe()
1320 	if (IS_ERR(lvts_td->reset))  in lvts_probe()
1321 		return dev_err_probe(dev, PTR_ERR(lvts_td->reset), "Failed to get reset control\n");  in lvts_probe()
1327 	golden_temp_offset = lvts_data->temp_offset;  in lvts_probe()
1354 	for (i = 0; i < lvts_td->num_lvts_ctrl; i++)  in lvts_remove()
1355 		lvts_ctrl_set_enable(&lvts_td->lvts_ctrl[i], false);  in lvts_remove()
1398 	for (i = 0; i < lvts_td->num_lvts_ctrl; i++) {  in lvts_suspend()
1399 		lvts_ctrl_monitor_enable(dev, &lvts_td->lvts_ctrl[i], false);  in lvts_suspend()
1401 		lvts_ctrl_set_enable(&lvts_td->lvts_ctrl[i], false);  in lvts_suspend()
1404 	clk_disable_unprepare(lvts_td->clk);  in lvts_suspend()
1416 	ret = clk_prepare_enable(lvts_td->clk);  in lvts_resume()
1420 	for (i = 0; i < lvts_td->num_lvts_ctrl; i++) {  in lvts_resume()
1421 		lvts_ctrl_set_enable(&lvts_td->lvts_ctrl[i], true);  in lvts_resume()
1423 		lvts_ctrl_monitor_enable(dev, &lvts_td->lvts_ctrl[i], true);  in lvts_resume()
1430  * The MT8186 calibration data is stored as packed 3-byte little-endian
1431  * values using a weird layout that makes sense only when viewed as a 32-bit
1435  *   [S0B2-S0B1-S0B0-S1B2] [S1B1-S1B0-S2B2-S2B1] [S2B0-S3B2-S3B1-S3B0]
1793 	{ .compatible = "mediatek,mt7988-lvts-ap", .data = &mt7988_lvts_ap_data },
1794 	{ .compatible = "mediatek,mt8186-lvts", .data = &mt8186_lvts_data },
1795 	{ .compatible = "mediatek,mt8188-lvts-mcu", .data = &mt8188_lvts_mcu_data },
1796 	{ .compatible = "mediatek,mt8188-lvts-ap", .data = &mt8188_lvts_ap_data },
1797 	{ .compatible = "mediatek,mt8192-lvts-mcu", .data = &mt8192_lvts_mcu_data },
1798 	{ .compatible = "mediatek,mt8192-lvts-ap", .data = &mt8192_lvts_ap_data },
1799 	{ .compatible = "mediatek,mt8195-lvts-mcu", .data = &mt8195_lvts_mcu_data },
1800 	{ .compatible = "mediatek,mt8195-lvts-ap", .data = &mt8195_lvts_ap_data },
1813 		.name = "mtk-lvts-thermal",