28 static int st_thermal_alloc_regfields(struct st_thermal_sensor *sensor)  in st_thermal_alloc_regfields()  argument
30 	struct device *dev = sensor->dev;  in st_thermal_alloc_regfields()
31 	struct regmap *regmap = sensor->regmap;  in st_thermal_alloc_regfields()
32 	const struct reg_field *reg_fields = sensor->cdata->reg_fields;  in st_thermal_alloc_regfields()
34 	sensor->dcorrect = devm_regmap_field_alloc(dev, regmap,  in st_thermal_alloc_regfields()
37 	sensor->overflow = devm_regmap_field_alloc(dev, regmap,  in st_thermal_alloc_regfields()
40 	sensor->temp_data = devm_regmap_field_alloc(dev, regmap,  in st_thermal_alloc_regfields()
43 	if (IS_ERR(sensor->dcorrect) ||  in st_thermal_alloc_regfields()
44 	    IS_ERR(sensor->overflow) ||  in st_thermal_alloc_regfields()
45 	    IS_ERR(sensor->temp_data)) {  in st_thermal_alloc_regfields()
50 	return sensor->ops->alloc_regfields(sensor);  in st_thermal_alloc_regfields()
53 static int st_thermal_sensor_on(struct st_thermal_sensor *sensor)  in st_thermal_sensor_on()  argument
56 	struct device *dev = sensor->dev;  in st_thermal_sensor_on()
58 	ret = clk_prepare_enable(sensor->clk);  in st_thermal_sensor_on()
64 	ret = sensor->ops->power_ctrl(sensor, POWER_ON);  in st_thermal_sensor_on()
67 		clk_disable_unprepare(sensor->clk);  in st_thermal_sensor_on()
73 static int st_thermal_sensor_off(struct st_thermal_sensor *sensor)  in st_thermal_sensor_off()  argument
77 	ret = sensor->ops->power_ctrl(sensor, POWER_OFF);  in st_thermal_sensor_off()
81 	clk_disable_unprepare(sensor->clk);  in st_thermal_sensor_off()
86 static int st_thermal_calibration(struct st_thermal_sensor *sensor)  in st_thermal_calibration()  argument
90 	struct device *dev = sensor->dev;  in st_thermal_calibration()
93 	ret = regmap_field_read(sensor->dcorrect, &val);  in st_thermal_calibration()
104 		ret = regmap_field_write(sensor->dcorrect,  in st_thermal_calibration()
105 					 sensor->cdata->calibration_val);  in st_thermal_calibration()
116 	struct st_thermal_sensor *sensor = th->devdata;  in st_thermal_get_temp()  local
117 	struct device *dev = sensor->dev;  in st_thermal_get_temp()
122 	ret = regmap_field_read(sensor->overflow, &overflow);  in st_thermal_get_temp()
128 	ret = regmap_field_read(sensor->temp_data, &temp);  in st_thermal_get_temp()
132 	temp += sensor->cdata->temp_adjust_val;  in st_thermal_get_temp()
145 	struct st_thermal_sensor *sensor = th->devdata;  in st_thermal_get_trip_type()  local
146 	struct device *dev = sensor->dev;  in st_thermal_get_trip_type()
163 	struct st_thermal_sensor *sensor = th->devdata;  in st_thermal_get_trip_temp()  local
164 	struct device *dev = sensor->dev;  in st_thermal_get_trip_temp()
168 		*temp = mcelsius(sensor->cdata->crit_temp);  in st_thermal_get_trip_temp()
187 	struct st_thermal_sensor *sensor;  in st_thermal_register()  local
200 	sensor = devm_kzalloc(dev, sizeof(*sensor), GFP_KERNEL);  in st_thermal_register()
201 	if (!sensor)  in st_thermal_register()
204 	sensor->dev = dev;  in st_thermal_register()
210 	sensor->cdata = match->data;  in st_thermal_register()
211 	if (!sensor->cdata->ops)  in st_thermal_register()
214 	sensor->ops = sensor->cdata->ops;  in st_thermal_register()
216 	ret = (sensor->ops->regmap_init)(sensor);  in st_thermal_register()
220 	ret = st_thermal_alloc_regfields(sensor);  in st_thermal_register()
224 	sensor->clk = devm_clk_get(dev, "thermal");  in st_thermal_register()
225 	if (IS_ERR(sensor->clk)) {  in st_thermal_register()
227 		return PTR_ERR(sensor->clk);  in st_thermal_register()
230 	if (sensor->ops->register_enable_irq) {  in st_thermal_register()
231 		ret = sensor->ops->register_enable_irq(sensor);  in st_thermal_register()
236 	ret = st_thermal_sensor_on(sensor);  in st_thermal_register()
240 	ret = st_thermal_calibration(sensor);  in st_thermal_register()
244 	polling_delay = sensor->ops->register_enable_irq ? 0 : 1000;  in st_thermal_register()
246 	sensor->thermal_dev =  in st_thermal_register()
247 		thermal_zone_device_register(dev_name(dev), 1, 0, sensor,  in st_thermal_register()
249 	if (IS_ERR(sensor->thermal_dev)) {  in st_thermal_register()
251 		ret = PTR_ERR(sensor->thermal_dev);  in st_thermal_register()
255 	platform_set_drvdata(pdev, sensor);  in st_thermal_register()
260 	st_thermal_sensor_off(sensor);  in st_thermal_register()
268 	struct st_thermal_sensor *sensor = platform_get_drvdata(pdev);  in st_thermal_unregister()  local
270 	st_thermal_sensor_off(sensor);  in st_thermal_unregister()
271 	thermal_zone_device_unregister(sensor->thermal_dev);  in st_thermal_unregister()
281 	struct st_thermal_sensor *sensor = platform_get_drvdata(pdev);  in st_thermal_suspend()  local
283 	return st_thermal_sensor_off(sensor);  in st_thermal_suspend()
290 	struct st_thermal_sensor *sensor = platform_get_drvdata(pdev);  in st_thermal_resume()  local
292 	ret = st_thermal_sensor_on(sensor);  in st_thermal_resume()
296 	ret = st_thermal_calibration(sensor);  in st_thermal_resume()
300 	if (sensor->ops->enable_irq) {  in st_thermal_resume()
301 		ret = sensor->ops->enable_irq(sensor);  in st_thermal_resume()