60 	struct ths_device		*tmdev;  member
73 	int		(*calibrate)(struct ths_device *tmdev,
75 	int		(*init)(struct ths_device *tmdev);
76 	unsigned long	(*irq_ack)(struct ths_device *tmdev);
77 	int		(*calc_temp)(struct ths_device *tmdev,
92 static int sun8i_ths_calc_temp(struct ths_device *tmdev,  in sun8i_ths_calc_temp()  argument
95 	return tmdev->chip->offset - (reg * tmdev->chip->scale / 10);  in sun8i_ths_calc_temp()
98 static int sun50i_h5_calc_temp(struct ths_device *tmdev,  in sun50i_h5_calc_temp()  argument
112 	struct ths_device *tmdev = s->tmdev;  in sun8i_ths_get_temp()  local
115 	regmap_read(tmdev->regmap, tmdev->chip->temp_data_base +  in sun8i_ths_get_temp()
122 	*temp = tmdev->chip->calc_temp(tmdev, s->id, val);  in sun8i_ths_get_temp()
131 	*temp += tmdev->chip->ft_deviation;  in sun8i_ths_get_temp()
148 static unsigned long sun8i_h3_irq_ack(struct ths_device *tmdev)  in sun8i_h3_irq_ack()  argument
153 	regmap_read(tmdev->regmap, SUN8I_THS_IS, &state);  in sun8i_h3_irq_ack()
155 	for (i = 0; i < tmdev->chip->sensor_num; i++) {  in sun8i_h3_irq_ack()
157 			regmap_write(tmdev->regmap, SUN8I_THS_IS,  in sun8i_h3_irq_ack()
166 static unsigned long sun50i_h6_irq_ack(struct ths_device *tmdev)  in sun50i_h6_irq_ack()  argument
171 	regmap_read(tmdev->regmap, SUN50I_H6_THS_DIS, &state);  in sun50i_h6_irq_ack()
173 	for (i = 0; i < tmdev->chip->sensor_num; i++) {  in sun50i_h6_irq_ack()
175 			regmap_write(tmdev->regmap, SUN50I_H6_THS_DIS,  in sun50i_h6_irq_ack()
186 	struct ths_device *tmdev = data;  in sun8i_irq_thread()  local
187 	unsigned long irq_bitmap = tmdev->chip->irq_ack(tmdev);  in sun8i_irq_thread()
190 	for_each_set_bit(i, &irq_bitmap, tmdev->chip->sensor_num) {  in sun8i_irq_thread()
191 		thermal_zone_device_update(tmdev->sensor[i].tzd,  in sun8i_irq_thread()
198 static int sun8i_h3_ths_calibrate(struct ths_device *tmdev,  in sun8i_h3_ths_calibrate()  argument
203 	if (!caldata[0] || callen < 2 * tmdev->chip->sensor_num)  in sun8i_h3_ths_calibrate()
206 	for (i = 0; i < tmdev->chip->sensor_num; i++) {  in sun8i_h3_ths_calibrate()
209 		regmap_update_bits(tmdev->regmap,  in sun8i_h3_ths_calibrate()
218 static int sun50i_h6_ths_calibrate(struct ths_device *tmdev,  in sun50i_h6_ths_calibrate()  argument
221 	struct device *dev = tmdev->dev;  in sun50i_h6_ths_calibrate()
224 	if (!caldata[0] || callen < 2 + 2 * tmdev->chip->sensor_num)  in sun50i_h6_ths_calibrate()
245 	for (i = 0; i < tmdev->chip->sensor_num; i++) {  in sun50i_h6_ths_calibrate()
248 		int sensor_temp = tmdev->chip->calc_temp(tmdev, i, sensor_reg);  in sun50i_h6_ths_calibrate()
257 			((sensor_temp - ft_temp) * 10 / tmdev->chip->scale);  in sun50i_h6_ths_calibrate()
270 		regmap_update_bits(tmdev->regmap,  in sun50i_h6_ths_calibrate()
279 static int sun8i_ths_calibrate(struct ths_device *tmdev)  in sun8i_ths_calibrate()  argument
282 	struct device *dev = tmdev->dev;  in sun8i_ths_calibrate()
313 	tmdev->chip->calibrate(tmdev, caldata, callen);  in sun8i_ths_calibrate()
327 static int sun8i_ths_resource_init(struct ths_device *tmdev)  in sun8i_ths_resource_init()  argument
329 	struct device *dev = tmdev->dev;  in sun8i_ths_resource_init()
338 	tmdev->regmap = devm_regmap_init_mmio(dev, base, &config);  in sun8i_ths_resource_init()
339 	if (IS_ERR(tmdev->regmap))  in sun8i_ths_resource_init()
340 		return PTR_ERR(tmdev->regmap);  in sun8i_ths_resource_init()
342 	if (tmdev->chip->has_bus_clk_reset) {  in sun8i_ths_resource_init()
343 		tmdev->reset = devm_reset_control_get(dev, NULL);  in sun8i_ths_resource_init()
344 		if (IS_ERR(tmdev->reset))  in sun8i_ths_resource_init()
345 			return PTR_ERR(tmdev->reset);  in sun8i_ths_resource_init()
347 		ret = reset_control_deassert(tmdev->reset);  in sun8i_ths_resource_init()
352 					       tmdev->reset);  in sun8i_ths_resource_init()
356 		tmdev->bus_clk = devm_clk_get_enabled(&pdev->dev, "bus");  in sun8i_ths_resource_init()
357 		if (IS_ERR(tmdev->bus_clk))  in sun8i_ths_resource_init()
358 			return PTR_ERR(tmdev->bus_clk);  in sun8i_ths_resource_init()
361 	if (tmdev->chip->has_mod_clk) {  in sun8i_ths_resource_init()
362 		tmdev->mod_clk = devm_clk_get_enabled(&pdev->dev, "mod");  in sun8i_ths_resource_init()
363 		if (IS_ERR(tmdev->mod_clk))  in sun8i_ths_resource_init()
364 			return PTR_ERR(tmdev->mod_clk);  in sun8i_ths_resource_init()
367 	ret = clk_set_rate(tmdev->mod_clk, 24000000);  in sun8i_ths_resource_init()
371 	ret = sun8i_ths_calibrate(tmdev);  in sun8i_ths_resource_init()
378 static int sun8i_h3_thermal_init(struct ths_device *tmdev)  in sun8i_h3_thermal_init()  argument
383 	regmap_write(tmdev->regmap, SUN8I_THS_MFC,  in sun8i_h3_thermal_init()
394 	val = GENMASK(7 + tmdev->chip->sensor_num, 8);  in sun8i_h3_thermal_init()
395 	regmap_write(tmdev->regmap, SUN8I_THS_IC,  in sun8i_h3_thermal_init()
404 	regmap_write(tmdev->regmap, SUN8I_THS_CTRL0,  in sun8i_h3_thermal_init()
406 	val = GENMASK(tmdev->chip->sensor_num - 1, 0);  in sun8i_h3_thermal_init()
407 	regmap_write(tmdev->regmap, SUN8I_THS_CTRL2,  in sun8i_h3_thermal_init()
419 static int sun50i_h6_thermal_init(struct ths_device *tmdev)  in sun50i_h6_thermal_init()  argument
430 	regmap_write(tmdev->regmap, SUN50I_THS_CTRL0,  in sun50i_h6_thermal_init()
433 	regmap_write(tmdev->regmap, SUN50I_H6_THS_MFC,  in sun50i_h6_thermal_init()
444 	regmap_write(tmdev->regmap, SUN50I_H6_THS_PC,  in sun50i_h6_thermal_init()
447 	val = GENMASK(tmdev->chip->sensor_num - 1, 0);  in sun50i_h6_thermal_init()
448 	regmap_write(tmdev->regmap, SUN50I_H6_THS_ENABLE, val);  in sun50i_h6_thermal_init()
450 	val = GENMASK(tmdev->chip->sensor_num - 1, 0);  in sun50i_h6_thermal_init()
451 	regmap_write(tmdev->regmap, SUN50I_H6_THS_DIC, val);  in sun50i_h6_thermal_init()
456 static int sun8i_ths_register(struct ths_device *tmdev)  in sun8i_ths_register()  argument
460 	for (i = 0; i < tmdev->chip->sensor_num; i++) {  in sun8i_ths_register()
461 		tmdev->sensor[i].tmdev = tmdev;  in sun8i_ths_register()
462 		tmdev->sensor[i].id = i;  in sun8i_ths_register()
463 		tmdev->sensor[i].tzd =  in sun8i_ths_register()
464 			devm_thermal_of_zone_register(tmdev->dev,  in sun8i_ths_register()
466 						      &tmdev->sensor[i],  in sun8i_ths_register()
468 		if (IS_ERR(tmdev->sensor[i].tzd))  in sun8i_ths_register()
469 			return PTR_ERR(tmdev->sensor[i].tzd);  in sun8i_ths_register()
471 		devm_thermal_add_hwmon_sysfs(tmdev->dev, tmdev->sensor[i].tzd);  in sun8i_ths_register()
479 	struct ths_device *tmdev;  in sun8i_ths_probe()  local
483 	tmdev = devm_kzalloc(dev, sizeof(*tmdev), GFP_KERNEL);  in sun8i_ths_probe()
484 	if (!tmdev)  in sun8i_ths_probe()
487 	tmdev->dev = dev;  in sun8i_ths_probe()
488 	tmdev->chip = of_device_get_match_data(&pdev->dev);  in sun8i_ths_probe()
489 	if (!tmdev->chip)  in sun8i_ths_probe()
492 	ret = sun8i_ths_resource_init(tmdev);  in sun8i_ths_probe()
500 	ret = tmdev->chip->init(tmdev);  in sun8i_ths_probe()
504 	ret = sun8i_ths_register(tmdev);  in sun8i_ths_probe()
515 					IRQF_ONESHOT, "ths", tmdev);  in sun8i_ths_probe()