62 	struct ths_device		*tmdev;  member
75 	int		(*calibrate)(struct ths_device *tmdev,
77 	int		(*init)(struct ths_device *tmdev);
78 	unsigned long	(*irq_ack)(struct ths_device *tmdev);
79 	int		(*calc_temp)(struct ths_device *tmdev,
94 static int sun8i_ths_calc_temp(struct ths_device *tmdev,  in sun8i_ths_calc_temp()  argument
97 	return tmdev->chip->offset - (reg * tmdev->chip->scale / 10);  in sun8i_ths_calc_temp()
100 static int sun50i_h5_calc_temp(struct ths_device *tmdev,  in sun50i_h5_calc_temp()  argument
114 	struct ths_device *tmdev = s->tmdev;  in sun8i_ths_get_temp()  local
117 	regmap_read(tmdev->regmap, tmdev->chip->temp_data_base +  in sun8i_ths_get_temp()
124 	*temp = tmdev->chip->calc_temp(tmdev, s->id, val);  in sun8i_ths_get_temp()
133 	*temp += tmdev->chip->ft_deviation;  in sun8i_ths_get_temp()
150 static unsigned long sun8i_h3_irq_ack(struct ths_device *tmdev)  in sun8i_h3_irq_ack()  argument
155 	regmap_read(tmdev->regmap, SUN8I_THS_IS, &state);  in sun8i_h3_irq_ack()
157 	for (i = 0; i < tmdev->chip->sensor_num; i++) {  in sun8i_h3_irq_ack()
159 			regmap_write(tmdev->regmap, SUN8I_THS_IS,  in sun8i_h3_irq_ack()
168 static unsigned long sun50i_h6_irq_ack(struct ths_device *tmdev)  in sun50i_h6_irq_ack()  argument
173 	regmap_read(tmdev->regmap, SUN50I_H6_THS_DIS, &state);  in sun50i_h6_irq_ack()
175 	for (i = 0; i < tmdev->chip->sensor_num; i++) {  in sun50i_h6_irq_ack()
177 			regmap_write(tmdev->regmap, SUN50I_H6_THS_DIS,  in sun50i_h6_irq_ack()
188 	struct ths_device *tmdev = data;  in sun8i_irq_thread()  local
189 	unsigned long irq_bitmap = tmdev->chip->irq_ack(tmdev);  in sun8i_irq_thread()
192 	for_each_set_bit(i, &irq_bitmap, tmdev->chip->sensor_num) {  in sun8i_irq_thread()
193 		thermal_zone_device_update(tmdev->sensor[i].tzd,  in sun8i_irq_thread()
200 static int sun8i_h3_ths_calibrate(struct ths_device *tmdev,  in sun8i_h3_ths_calibrate()  argument
205 	if (!caldata[0] || callen < 2 * tmdev->chip->sensor_num)  in sun8i_h3_ths_calibrate()
208 	for (i = 0; i < tmdev->chip->sensor_num; i++) {  in sun8i_h3_ths_calibrate()
211 		regmap_update_bits(tmdev->regmap,  in sun8i_h3_ths_calibrate()
220 static int sun50i_h6_ths_calibrate(struct ths_device *tmdev,  in sun50i_h6_ths_calibrate()  argument
223 	struct device *dev = tmdev->dev;  in sun50i_h6_ths_calibrate()
226 	if (!caldata[0] || callen < 2 + 2 * tmdev->chip->sensor_num)  in sun50i_h6_ths_calibrate()
247 	for (i = 0; i < tmdev->chip->sensor_num; i++) {  in sun50i_h6_ths_calibrate()
250 		int sensor_temp = tmdev->chip->calc_temp(tmdev, i, sensor_reg);  in sun50i_h6_ths_calibrate()
259 			((sensor_temp - ft_temp) * 10 / tmdev->chip->scale);  in sun50i_h6_ths_calibrate()
272 		regmap_update_bits(tmdev->regmap,  in sun50i_h6_ths_calibrate()
281 static int sun8i_ths_calibrate(struct ths_device *tmdev)  in sun8i_ths_calibrate()  argument
284 	struct device *dev = tmdev->dev;  in sun8i_ths_calibrate()
315 	tmdev->chip->calibrate(tmdev, caldata, callen);  in sun8i_ths_calibrate()
322 static int sun8i_ths_resource_init(struct ths_device *tmdev)  in sun8i_ths_resource_init()  argument
324 	struct device *dev = tmdev->dev;  in sun8i_ths_resource_init()
333 	tmdev->regmap = devm_regmap_init_mmio(dev, base, &config);  in sun8i_ths_resource_init()
334 	if (IS_ERR(tmdev->regmap))  in sun8i_ths_resource_init()
335 		return PTR_ERR(tmdev->regmap);  in sun8i_ths_resource_init()
337 	if (tmdev->chip->has_bus_clk_reset) {  in sun8i_ths_resource_init()
338 		tmdev->reset = devm_reset_control_get(dev, NULL);  in sun8i_ths_resource_init()
339 		if (IS_ERR(tmdev->reset))  in sun8i_ths_resource_init()
340 			return PTR_ERR(tmdev->reset);  in sun8i_ths_resource_init()
342 		tmdev->bus_clk = devm_clk_get(&pdev->dev, "bus");  in sun8i_ths_resource_init()
343 		if (IS_ERR(tmdev->bus_clk))  in sun8i_ths_resource_init()
344 			return PTR_ERR(tmdev->bus_clk);  in sun8i_ths_resource_init()
347 	if (tmdev->chip->has_mod_clk) {  in sun8i_ths_resource_init()
348 		tmdev->mod_clk = devm_clk_get(&pdev->dev, "mod");  in sun8i_ths_resource_init()
349 		if (IS_ERR(tmdev->mod_clk))  in sun8i_ths_resource_init()
350 			return PTR_ERR(tmdev->mod_clk);  in sun8i_ths_resource_init()
353 	ret = reset_control_deassert(tmdev->reset);  in sun8i_ths_resource_init()
357 	ret = clk_prepare_enable(tmdev->bus_clk);  in sun8i_ths_resource_init()
361 	ret = clk_set_rate(tmdev->mod_clk, 24000000);  in sun8i_ths_resource_init()
365 	ret = clk_prepare_enable(tmdev->mod_clk);  in sun8i_ths_resource_init()
369 	ret = sun8i_ths_calibrate(tmdev);  in sun8i_ths_resource_init()
376 	clk_disable_unprepare(tmdev->mod_clk);  in sun8i_ths_resource_init()
378 	clk_disable_unprepare(tmdev->bus_clk);  in sun8i_ths_resource_init()
380 	reset_control_assert(tmdev->reset);  in sun8i_ths_resource_init()
385 static int sun8i_h3_thermal_init(struct ths_device *tmdev)  in sun8i_h3_thermal_init()  argument
390 	regmap_write(tmdev->regmap, SUN8I_THS_MFC,  in sun8i_h3_thermal_init()
401 	val = GENMASK(7 + tmdev->chip->sensor_num, 8);  in sun8i_h3_thermal_init()
402 	regmap_write(tmdev->regmap, SUN8I_THS_IC,  in sun8i_h3_thermal_init()
411 	regmap_write(tmdev->regmap, SUN8I_THS_CTRL0,  in sun8i_h3_thermal_init()
413 	val = GENMASK(tmdev->chip->sensor_num - 1, 0);  in sun8i_h3_thermal_init()
414 	regmap_write(tmdev->regmap, SUN8I_THS_CTRL2,  in sun8i_h3_thermal_init()
426 static int sun50i_h6_thermal_init(struct ths_device *tmdev)  in sun50i_h6_thermal_init()  argument
437 	regmap_write(tmdev->regmap, SUN50I_THS_CTRL0,  in sun50i_h6_thermal_init()
440 	regmap_write(tmdev->regmap, SUN50I_H6_THS_MFC,  in sun50i_h6_thermal_init()
451 	regmap_write(tmdev->regmap, SUN50I_H6_THS_PC,  in sun50i_h6_thermal_init()
454 	val = GENMASK(tmdev->chip->sensor_num - 1, 0);  in sun50i_h6_thermal_init()
455 	regmap_write(tmdev->regmap, SUN50I_H6_THS_ENABLE, val);  in sun50i_h6_thermal_init()
457 	val = GENMASK(tmdev->chip->sensor_num - 1, 0);  in sun50i_h6_thermal_init()
458 	regmap_write(tmdev->regmap, SUN50I_H6_THS_DIC, val);  in sun50i_h6_thermal_init()
463 static int sun8i_ths_register(struct ths_device *tmdev)  in sun8i_ths_register()  argument
467 	for (i = 0; i < tmdev->chip->sensor_num; i++) {  in sun8i_ths_register()
468 		tmdev->sensor[i].tmdev = tmdev;  in sun8i_ths_register()
469 		tmdev->sensor[i].id = i;  in sun8i_ths_register()
470 		tmdev->sensor[i].tzd =  in sun8i_ths_register()
471 			devm_thermal_zone_of_sensor_register(tmdev->dev,  in sun8i_ths_register()
473 							     &tmdev->sensor[i],  in sun8i_ths_register()
475 		if (IS_ERR(tmdev->sensor[i].tzd))  in sun8i_ths_register()
476 			return PTR_ERR(tmdev->sensor[i].tzd);  in sun8i_ths_register()
478 		if (devm_thermal_add_hwmon_sysfs(tmdev->sensor[i].tzd))  in sun8i_ths_register()
479 			dev_warn(tmdev->dev,  in sun8i_ths_register()
488 	struct ths_device *tmdev;  in sun8i_ths_probe()  local
492 	tmdev = devm_kzalloc(dev, sizeof(*tmdev), GFP_KERNEL);  in sun8i_ths_probe()
493 	if (!tmdev)  in sun8i_ths_probe()
496 	tmdev->dev = dev;  in sun8i_ths_probe()
497 	tmdev->chip = of_device_get_match_data(&pdev->dev);  in sun8i_ths_probe()
498 	if (!tmdev->chip)  in sun8i_ths_probe()
501 	platform_set_drvdata(pdev, tmdev);  in sun8i_ths_probe()
503 	ret = sun8i_ths_resource_init(tmdev);  in sun8i_ths_probe()
511 	ret = tmdev->chip->init(tmdev);  in sun8i_ths_probe()
515 	ret = sun8i_ths_register(tmdev);  in sun8i_ths_probe()
526 					IRQF_ONESHOT, "ths", tmdev);  in sun8i_ths_probe()
535 	struct ths_device *tmdev = platform_get_drvdata(pdev);  in sun8i_ths_remove()  local
537 	clk_disable_unprepare(tmdev->mod_clk);  in sun8i_ths_remove()
538 	clk_disable_unprepare(tmdev->bus_clk);  in sun8i_ths_remove()
539 	reset_control_assert(tmdev->reset);  in sun8i_ths_remove()