Lines Matching defs:sensor
23 static int st_thermal_alloc_regfields(struct st_thermal_sensor *sensor)
25 struct device *dev = sensor->dev;
26 struct regmap *regmap = sensor->regmap;
27 const struct reg_field *reg_fields = sensor->cdata->reg_fields;
29 sensor->dcorrect = devm_regmap_field_alloc(dev, regmap,
32 sensor->overflow = devm_regmap_field_alloc(dev, regmap,
35 sensor->temp_data = devm_regmap_field_alloc(dev, regmap,
38 if (IS_ERR(sensor->dcorrect) ||
39 IS_ERR(sensor->overflow) ||
40 IS_ERR(sensor->temp_data)) {
45 return sensor->ops->alloc_regfields(sensor);
48 static int st_thermal_sensor_on(struct st_thermal_sensor *sensor)
51 struct device *dev = sensor->dev;
53 ret = clk_prepare_enable(sensor->clk);
59 ret = sensor->ops->power_ctrl(sensor, POWER_ON);
61 dev_err(dev, "failed to power on sensor\n");
62 clk_disable_unprepare(sensor->clk);
68 static int st_thermal_sensor_off(struct st_thermal_sensor *sensor)
72 ret = sensor->ops->power_ctrl(sensor, POWER_OFF);
76 clk_disable_unprepare(sensor->clk);
81 static int st_thermal_calibration(struct st_thermal_sensor *sensor)
85 struct device *dev = sensor->dev;
87 /* Check if sensor calibration data is already written */
88 ret = regmap_field_read(sensor->dcorrect, &val);
99 ret = regmap_field_write(sensor->dcorrect,
100 sensor->cdata->calibration_val);
111 struct st_thermal_sensor *sensor = th->devdata;
112 struct device *dev = sensor->dev;
117 ret = regmap_field_read(sensor->overflow, &overflow);
123 ret = regmap_field_read(sensor->temp_data, &temp);
127 temp += sensor->cdata->temp_adjust_val;
140 struct st_thermal_sensor *sensor = th->devdata;
141 struct device *dev = sensor->dev;
158 struct st_thermal_sensor *sensor = th->devdata;
159 struct device *dev = sensor->dev;
163 *temp = mcelsius(sensor->cdata->crit_temp);
182 struct st_thermal_sensor *sensor;
195 sensor = devm_kzalloc(dev, sizeof(*sensor), GFP_KERNEL);
196 if (!sensor)
199 sensor->dev = dev;
205 sensor->cdata = match->data;
206 if (!sensor->cdata->ops)
209 sensor->ops = sensor->cdata->ops;
211 ret = (sensor->ops->regmap_init)(sensor);
215 ret = st_thermal_alloc_regfields(sensor);
219 sensor->clk = devm_clk_get(dev, "thermal");
220 if (IS_ERR(sensor->clk)) {
222 return PTR_ERR(sensor->clk);
225 if (sensor->ops->register_enable_irq) {
226 ret = sensor->ops->register_enable_irq(sensor);
231 ret = st_thermal_sensor_on(sensor);
235 ret = st_thermal_calibration(sensor);
239 polling_delay = sensor->ops->register_enable_irq ? 0 : 1000;
241 sensor->thermal_dev =
242 thermal_zone_device_register(dev_name(dev), 1, 0, sensor,
244 if (IS_ERR(sensor->thermal_dev)) {
246 ret = PTR_ERR(sensor->thermal_dev);
249 ret = thermal_zone_device_enable(sensor->thermal_dev);
253 platform_set_drvdata(pdev, sensor);
258 thermal_zone_device_unregister(sensor->thermal_dev);
260 st_thermal_sensor_off(sensor);
268 struct st_thermal_sensor *sensor = platform_get_drvdata(pdev);
270 st_thermal_sensor_off(sensor);
271 thermal_zone_device_unregister(sensor->thermal_dev);
280 struct st_thermal_sensor *sensor = dev_get_drvdata(dev);
282 return st_thermal_sensor_off(sensor);
288 struct st_thermal_sensor *sensor = dev_get_drvdata(dev);
290 ret = st_thermal_sensor_on(sensor);
294 ret = st_thermal_calibration(sensor);
298 if (sensor->ops->enable_irq) {
299 ret = sensor->ops->enable_irq(sensor);