1 // SPDX-License-Identifier: GPL-2.0-only
15 #include <linux/nvmem-consumer.h>
113 /* The calibration coefficient of sensor  */
117  * Layout of the fuses providing the calibration data
119  * MT8183 has 6 sensors and needs 6 VTS calibration data.
120  * MT8173 has 5 sensors and needs 5 VTS calibration data.
121  * MT2701 has 3 sensors and needs 3 VTS calibration data.
122  * MT2712 has 4 sensors and needs 4 VTS calibration data.
138  * Layout of the fuses providing the calibration data
183 /* The calibration coefficient of sensor  */
204 /* The calibration coefficient of sensor  */
217 /* The calibration coefficient of sensor  */
243 /* The calibration coefficient of sensor  */
283 	/* Calibration values */
295 /* MT8183 thermal sensor data */
316 /* MT8173 thermal sensor data */
339 /* MT2701 thermal sensor data */
359 /* MT2712 thermal sensor data */
379 /* MT7622 thermal sensor data */
395  * the bank concept wouldn't be necessary here. However, the SVS (Smart
397  * data, and this indeed needs the temperatures of the individual banks
436  * so the bank concept wouldn't be necessary here. However, the SVS (Smart
438  * data.
467  * so the bank concept wouldn't be necessary here. However, the SVS (Smart
469  * data.
493  * MT7622 have only one sensing point which uses AUXADC Channel 11 for raw data
523  * the bank concept wouldn't be necessary here. However, the SVS (Smart
525  * data, and this indeed needs the temperatures of the individual banks
551  * raw_to_mcelsius - convert a raw ADC value to mcelsius
557  * calibration constants
566 	tmp /= mt->conf->cali_val + mt->o_slope;  in raw_to_mcelsius_v1()
567 	tmp /= 10000 + mt->adc_ge;  in raw_to_mcelsius_v1()
568 	tmp *= raw - mt->vts[sensno] - 3350;  in raw_to_mcelsius_v1()
571 	return mt->degc_cali * 500 - tmp;  in raw_to_mcelsius_v1()
587 	g_gain = 10000 + (((mt->adc_ge - 512) * 10000) >> 12);  in raw_to_mcelsius_v2()
588 	g_oe = mt->adc_oe - 512;  in raw_to_mcelsius_v2()
589 	format_1 = mt->vts[VTS2] + 3105 - g_oe;  in raw_to_mcelsius_v2()
590 	format_2 = (mt->degc_cali * 10) >> 1;  in raw_to_mcelsius_v2()
593 	tmp = (((((raw - g_oe) * 10000) >> 12) * 10000) / g_gain) - g_x_roomt;  in raw_to_mcelsius_v2()
596 	if (mt->o_slope_sign == 0)  in raw_to_mcelsius_v2()
597 		tmp = tmp / (165 - mt->o_slope);  in raw_to_mcelsius_v2()
599 		tmp = tmp / (165 + mt->o_slope);  in raw_to_mcelsius_v2()
601 	return (format_2 - tmp) * 100;  in raw_to_mcelsius_v2()
605  * mtk_thermal_get_bank - get bank
613 	struct mtk_thermal *mt = bank->mt;  in mtk_thermal_get_bank()
616 	if (mt->conf->need_switch_bank) {  in mtk_thermal_get_bank()
617 		mutex_lock(&mt->lock);  in mtk_thermal_get_bank()
619 		val = readl(mt->thermal_base + PTPCORESEL);  in mtk_thermal_get_bank()
621 		val |= bank->id;  in mtk_thermal_get_bank()
622 		writel(val, mt->thermal_base + PTPCORESEL);  in mtk_thermal_get_bank()
627  * mtk_thermal_put_bank - release bank
634 	struct mtk_thermal *mt = bank->mt;  in mtk_thermal_put_bank()
636 	if (mt->conf->need_switch_bank)  in mtk_thermal_put_bank()
637 		mutex_unlock(&mt->lock);  in mtk_thermal_put_bank()
641  * mtk_thermal_bank_temperature - get the temperature of a bank
649 	struct mtk_thermal *mt = bank->mt;  in mtk_thermal_bank_temperature()
650 	const struct mtk_thermal_data *conf = mt->conf;  in mtk_thermal_bank_temperature()
654 	for (i = 0; i < conf->bank_data[bank->id].num_sensors; i++) {  in mtk_thermal_bank_temperature()
655 		raw = readl(mt->thermal_base + conf->msr[i]);  in mtk_thermal_bank_temperature()
657 		if (mt->conf->version == MTK_THERMAL_V1) {  in mtk_thermal_bank_temperature()
659 				mt, conf->bank_data[bank->id].sensors[i], raw);  in mtk_thermal_bank_temperature()
662 				mt, conf->bank_data[bank->id].sensors[i], raw);  in mtk_thermal_bank_temperature()
680 static int mtk_read_temp(void *data, int *temperature)  in mtk_read_temp()  argument
682 	struct mtk_thermal *mt = data;  in mtk_read_temp()
686 	for (i = 0; i < mt->conf->num_banks; i++) {  in mtk_read_temp()
687 		struct mtk_thermal_bank *bank = &mt->banks[i];  in mtk_read_temp()
709 	struct mtk_thermal_bank *bank = &mt->banks[num];  in mtk_thermal_init_bank()
710 	const struct mtk_thermal_data *conf = mt->conf;  in mtk_thermal_init_bank()
713 	int offset = mt->conf->controller_offset[ctrl_id];  in mtk_thermal_init_bank()
714 	void __iomem *controller_base = mt->thermal_base + offset;  in mtk_thermal_init_bank()
716 	bank->id = num;  in mtk_thermal_init_bank()
717 	bank->mt = mt;  in mtk_thermal_init_bank()
759 	writel(BIT(conf->auxadc_channel), controller_base + TEMP_ADCMUX);  in mtk_thermal_init_bank()
765 	if (mt->conf->version == MTK_THERMAL_V1) {  in mtk_thermal_init_bank()
772 	writel(BIT(conf->auxadc_channel), controller_base + TEMP_ADCEN);  in mtk_thermal_init_bank()
779 	writel(auxadc_phys_base + AUXADC_DATA(conf->auxadc_channel),  in mtk_thermal_init_bank()
783 	writel(auxadc_phys_base + AUXADC_DATA(conf->auxadc_channel),  in mtk_thermal_init_bank()
800 	for (i = 0; i < conf->bank_data[num].num_sensors; i++)  in mtk_thermal_init_bank()
801 		writel(conf->sensor_mux_values[conf->bank_data[num].sensors[i]],  in mtk_thermal_init_bank()
802 		       mt->thermal_base + conf->adcpnp[i]);  in mtk_thermal_init_bank()
804 	writel((1 << conf->bank_data[num].num_sensors) - 1,  in mtk_thermal_init_bank()
831 		return -EINVAL;  in mtk_thermal_extract_efuse_v1()
833 	mt->adc_ge = CALIB_BUF1_ADC_GE_V1(buf[1]);  in mtk_thermal_extract_efuse_v1()
835 	for (i = 0; i < mt->conf->num_sensors; i++) {  in mtk_thermal_extract_efuse_v1()
836 		switch (mt->conf->vts_index[i]) {  in mtk_thermal_extract_efuse_v1()
838 			mt->vts[VTS1] = CALIB_BUF0_VTS_TS1_V1(buf[0]);  in mtk_thermal_extract_efuse_v1()
841 			mt->vts[VTS2] = CALIB_BUF0_VTS_TS2_V1(buf[0]);  in mtk_thermal_extract_efuse_v1()
844 			mt->vts[VTS3] = CALIB_BUF1_VTS_TS3_V1(buf[1]);  in mtk_thermal_extract_efuse_v1()
847 			mt->vts[VTS4] = CALIB_BUF2_VTS_TS4_V1(buf[2]);  in mtk_thermal_extract_efuse_v1()
850 			mt->vts[VTS5] = CALIB_BUF2_VTS_TS5_V1(buf[2]);  in mtk_thermal_extract_efuse_v1()
853 			mt->vts[VTSABB] =  in mtk_thermal_extract_efuse_v1()
861 	mt->degc_cali = CALIB_BUF0_DEGC_CALI_V1(buf[0]);  in mtk_thermal_extract_efuse_v1()
864 		mt->o_slope = -CALIB_BUF0_O_SLOPE_V1(buf[0]);  in mtk_thermal_extract_efuse_v1()
866 		mt->o_slope = CALIB_BUF0_O_SLOPE_V1(buf[0]);  in mtk_thermal_extract_efuse_v1()
874 		return -EINVAL;  in mtk_thermal_extract_efuse_v2()
876 	mt->adc_oe = CALIB_BUF0_ADC_OE_V2(buf[0]);  in mtk_thermal_extract_efuse_v2()
877 	mt->adc_ge = CALIB_BUF0_ADC_GE_V2(buf[0]);  in mtk_thermal_extract_efuse_v2()
878 	mt->degc_cali = CALIB_BUF0_DEGC_CALI_V2(buf[0]);  in mtk_thermal_extract_efuse_v2()
879 	mt->o_slope = CALIB_BUF0_O_SLOPE_V2(buf[0]);  in mtk_thermal_extract_efuse_v2()
880 	mt->vts[VTS1] = CALIB_BUF1_VTS_TS1_V2(buf[1]);  in mtk_thermal_extract_efuse_v2()
881 	mt->vts[VTS2] = CALIB_BUF1_VTS_TS2_V2(buf[1]);  in mtk_thermal_extract_efuse_v2()
882 	mt->vts[VTSABB] = CALIB_BUF1_VTS_TSABB_V2(buf[1]);  in mtk_thermal_extract_efuse_v2()
883 	mt->o_slope_sign = CALIB_BUF1_O_SLOPE_SIGN_V2(buf[1]);  in mtk_thermal_extract_efuse_v2()
897 	mt->adc_ge = 512;  in mtk_thermal_get_calibration_data()
898 	for (i = 0; i < mt->conf->num_sensors; i++)  in mtk_thermal_get_calibration_data()
899 		mt->vts[i] = 260;  in mtk_thermal_get_calibration_data()
900 	mt->degc_cali = 40;  in mtk_thermal_get_calibration_data()
901 	mt->o_slope = 0;  in mtk_thermal_get_calibration_data()
903 	cell = nvmem_cell_get(dev, "calibration-data");  in mtk_thermal_get_calibration_data()
905 		if (PTR_ERR(cell) == -EPROBE_DEFER)  in mtk_thermal_get_calibration_data()
918 		dev_warn(dev, "invalid calibration data\n");  in mtk_thermal_get_calibration_data()
919 		ret = -EINVAL;  in mtk_thermal_get_calibration_data()
923 	if (mt->conf->version == MTK_THERMAL_V1)  in mtk_thermal_get_calibration_data()
929 		dev_info(dev, "Device not calibrated, using default calibration values\n");  in mtk_thermal_get_calibration_data()
941 		.compatible = "mediatek,mt8173-thermal",
942 		.data = (void *)&mt8173_thermal_data,
945 		.compatible = "mediatek,mt2701-thermal",
946 		.data = (void *)&mt2701_thermal_data,
949 		.compatible = "mediatek,mt2712-thermal",
950 		.data = (void *)&mt2712_thermal_data,
953 		.compatible = "mediatek,mt7622-thermal",
954 		.data = (void *)&mt7622_thermal_data,
957 		.compatible = "mediatek,mt8183-thermal",
958 		.data = (void *)&mt8183_thermal_data,
981 	writel(0x1, mt->thermal_base + TEMP_MONCTL0);  in mtk_thermal_release_periodic_ts()
982 	tmp = readl(mt->thermal_base + TEMP_MSRCTL1);  in mtk_thermal_release_periodic_ts()
983 	writel((tmp & (~0x10e)), mt->thermal_base + TEMP_MSRCTL1);  in mtk_thermal_release_periodic_ts()
989 	struct device_node *auxadc, *apmixedsys, *np = pdev->dev.of_node;  in mtk_thermal_probe()
996 	mt = devm_kzalloc(&pdev->dev, sizeof(*mt), GFP_KERNEL);  in mtk_thermal_probe()
998 		return -ENOMEM;  in mtk_thermal_probe()
1000 	mt->conf = of_device_get_match_data(&pdev->dev);  in mtk_thermal_probe()
1002 	mt->clk_peri_therm = devm_clk_get(&pdev->dev, "therm");  in mtk_thermal_probe()
1003 	if (IS_ERR(mt->clk_peri_therm))  in mtk_thermal_probe()
1004 		return PTR_ERR(mt->clk_peri_therm);  in mtk_thermal_probe()
1006 	mt->clk_auxadc = devm_clk_get(&pdev->dev, "auxadc");  in mtk_thermal_probe()
1007 	if (IS_ERR(mt->clk_auxadc))  in mtk_thermal_probe()
1008 		return PTR_ERR(mt->clk_auxadc);  in mtk_thermal_probe()
1011 	mt->thermal_base = devm_ioremap_resource(&pdev->dev, res);  in mtk_thermal_probe()
1012 	if (IS_ERR(mt->thermal_base))  in mtk_thermal_probe()
1013 		return PTR_ERR(mt->thermal_base);  in mtk_thermal_probe()
1015 	ret = mtk_thermal_get_calibration_data(&pdev->dev, mt);  in mtk_thermal_probe()
1019 	mutex_init(&mt->lock);  in mtk_thermal_probe()
1021 	mt->dev = &pdev->dev;  in mtk_thermal_probe()
1025 		dev_err(&pdev->dev, "missing auxadc node\n");  in mtk_thermal_probe()
1026 		return -ENODEV;  in mtk_thermal_probe()
1035 		dev_err(&pdev->dev, "Can't get auxadc phys address\n");  in mtk_thermal_probe()
1036 		return -EINVAL;  in mtk_thermal_probe()
1041 		dev_err(&pdev->dev, "missing apmixedsys node\n");  in mtk_thermal_probe()
1042 		return -ENODEV;  in mtk_thermal_probe()
1051 		dev_err(&pdev->dev, "Can't get auxadc phys address\n");  in mtk_thermal_probe()
1052 		return -EINVAL;  in mtk_thermal_probe()
1055 	ret = device_reset(&pdev->dev);  in mtk_thermal_probe()
1059 	ret = clk_prepare_enable(mt->clk_auxadc);  in mtk_thermal_probe()
1061 		dev_err(&pdev->dev, "Can't enable auxadc clk: %d\n", ret);  in mtk_thermal_probe()
1065 	ret = clk_prepare_enable(mt->clk_peri_therm);  in mtk_thermal_probe()
1067 		dev_err(&pdev->dev, "Can't enable peri clk: %d\n", ret);  in mtk_thermal_probe()
1071 	if (mt->conf->version == MTK_THERMAL_V2) {  in mtk_thermal_probe()
1076 	for (ctrl_id = 0; ctrl_id < mt->conf->num_controller ; ctrl_id++)  in mtk_thermal_probe()
1077 		for (i = 0; i < mt->conf->num_banks; i++)  in mtk_thermal_probe()
1083 	tzdev = devm_thermal_zone_of_sensor_register(&pdev->dev, 0, mt,  in mtk_thermal_probe()
1093 	clk_disable_unprepare(mt->clk_peri_therm);  in mtk_thermal_probe()
1095 	clk_disable_unprepare(mt->clk_auxadc);  in mtk_thermal_probe()
1104 	clk_disable_unprepare(mt->clk_peri_therm);  in mtk_thermal_remove()
1105 	clk_disable_unprepare(mt->clk_auxadc);  in mtk_thermal_remove()
1114 		.name = "mtk-thermal",