Lines Matching refs:sensor
23 static int st_thermal_alloc_regfields(struct st_thermal_sensor *sensor) in st_thermal_alloc_regfields() argument
25 struct device *dev = sensor->dev; in st_thermal_alloc_regfields()
26 struct regmap *regmap = sensor->regmap; in st_thermal_alloc_regfields()
27 const struct reg_field *reg_fields = sensor->cdata->reg_fields; in st_thermal_alloc_regfields()
29 sensor->dcorrect = devm_regmap_field_alloc(dev, regmap, in st_thermal_alloc_regfields()
32 sensor->overflow = devm_regmap_field_alloc(dev, regmap, in st_thermal_alloc_regfields()
35 sensor->temp_data = devm_regmap_field_alloc(dev, regmap, in st_thermal_alloc_regfields()
38 if (IS_ERR(sensor->dcorrect) || in st_thermal_alloc_regfields()
39 IS_ERR(sensor->overflow) || in st_thermal_alloc_regfields()
40 IS_ERR(sensor->temp_data)) { in st_thermal_alloc_regfields()
45 return sensor->ops->alloc_regfields(sensor); in st_thermal_alloc_regfields()
48 static int st_thermal_sensor_on(struct st_thermal_sensor *sensor) in st_thermal_sensor_on() argument
51 struct device *dev = sensor->dev; in st_thermal_sensor_on()
53 ret = clk_prepare_enable(sensor->clk); in st_thermal_sensor_on()
59 ret = sensor->ops->power_ctrl(sensor, POWER_ON); in st_thermal_sensor_on()
62 clk_disable_unprepare(sensor->clk); in st_thermal_sensor_on()
68 static int st_thermal_sensor_off(struct st_thermal_sensor *sensor) in st_thermal_sensor_off() argument
72 ret = sensor->ops->power_ctrl(sensor, POWER_OFF); in st_thermal_sensor_off()
76 clk_disable_unprepare(sensor->clk); in st_thermal_sensor_off()
81 static int st_thermal_calibration(struct st_thermal_sensor *sensor) in st_thermal_calibration() argument
85 struct device *dev = sensor->dev; in st_thermal_calibration()
88 ret = regmap_field_read(sensor->dcorrect, &val); in st_thermal_calibration()
99 ret = regmap_field_write(sensor->dcorrect, in st_thermal_calibration()
100 sensor->cdata->calibration_val); in st_thermal_calibration()
111 struct st_thermal_sensor *sensor = th->devdata; in st_thermal_get_temp() local
112 struct device *dev = sensor->dev; in st_thermal_get_temp()
117 ret = regmap_field_read(sensor->overflow, &overflow); in st_thermal_get_temp()
123 ret = regmap_field_read(sensor->temp_data, &temp); in st_thermal_get_temp()
127 temp += sensor->cdata->temp_adjust_val; in st_thermal_get_temp()
146 struct st_thermal_sensor *sensor; in st_thermal_register() local
159 sensor = devm_kzalloc(dev, sizeof(*sensor), GFP_KERNEL); in st_thermal_register()
160 if (!sensor) in st_thermal_register()
163 sensor->dev = dev; in st_thermal_register()
169 sensor->cdata = match->data; in st_thermal_register()
170 if (!sensor->cdata->ops) in st_thermal_register()
173 sensor->ops = sensor->cdata->ops; in st_thermal_register()
175 ret = (sensor->ops->regmap_init)(sensor); in st_thermal_register()
179 ret = st_thermal_alloc_regfields(sensor); in st_thermal_register()
183 sensor->clk = devm_clk_get(dev, "thermal"); in st_thermal_register()
184 if (IS_ERR(sensor->clk)) { in st_thermal_register()
186 return PTR_ERR(sensor->clk); in st_thermal_register()
189 if (sensor->ops->register_enable_irq) { in st_thermal_register()
190 ret = sensor->ops->register_enable_irq(sensor); in st_thermal_register()
195 ret = st_thermal_sensor_on(sensor); in st_thermal_register()
199 ret = st_thermal_calibration(sensor); in st_thermal_register()
203 polling_delay = sensor->ops->register_enable_irq ? 0 : 1000; in st_thermal_register()
205 trip.temperature = sensor->cdata->crit_temp; in st_thermal_register()
208 sensor->thermal_dev = in st_thermal_register()
209 thermal_zone_device_register_with_trips(dev_name(dev), &trip, 1, 0, sensor, in st_thermal_register()
211 if (IS_ERR(sensor->thermal_dev)) { in st_thermal_register()
213 ret = PTR_ERR(sensor->thermal_dev); in st_thermal_register()
216 ret = thermal_zone_device_enable(sensor->thermal_dev); in st_thermal_register()
220 platform_set_drvdata(pdev, sensor); in st_thermal_register()
225 thermal_zone_device_unregister(sensor->thermal_dev); in st_thermal_register()
227 st_thermal_sensor_off(sensor); in st_thermal_register()
235 struct st_thermal_sensor *sensor = platform_get_drvdata(pdev); in st_thermal_unregister() local
237 st_thermal_sensor_off(sensor); in st_thermal_unregister()
238 thermal_zone_device_unregister(sensor->thermal_dev); in st_thermal_unregister()
247 struct st_thermal_sensor *sensor = dev_get_drvdata(dev); in st_thermal_suspend() local
249 return st_thermal_sensor_off(sensor); in st_thermal_suspend()
255 struct st_thermal_sensor *sensor = dev_get_drvdata(dev); in st_thermal_resume() local
257 ret = st_thermal_sensor_on(sensor); in st_thermal_resume()
261 ret = st_thermal_calibration(sensor); in st_thermal_resume()
265 if (sensor->ops->enable_irq) { in st_thermal_resume()
266 ret = sensor->ops->enable_irq(sensor); in st_thermal_resume()