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 = thermal_zone_device_priv(th);
116 ret = regmap_field_read(sensor->overflow, &overflow);
122 ret = regmap_field_read(sensor->temp_data, &temp);
126 temp += sensor->cdata->temp_adjust_val;
143 struct st_thermal_sensor *sensor;
156 sensor = devm_kzalloc(dev, sizeof(*sensor), GFP_KERNEL);
157 if (!sensor)
160 sensor->dev = dev;
166 sensor->cdata = match->data;
167 if (!sensor->cdata->ops)
170 sensor->ops = sensor->cdata->ops;
172 ret = (sensor->ops->regmap_init)(sensor);
176 ret = st_thermal_alloc_regfields(sensor);
180 sensor->clk = devm_clk_get(dev, "thermal");
181 if (IS_ERR(sensor->clk)) {
183 return PTR_ERR(sensor->clk);
186 if (sensor->ops->register_enable_irq) {
187 ret = sensor->ops->register_enable_irq(sensor);
192 ret = st_thermal_sensor_on(sensor);
196 ret = st_thermal_calibration(sensor);
200 polling_delay = sensor->ops->register_enable_irq ? 0 : 1000;
202 trip.temperature = sensor->cdata->crit_temp;
205 sensor->thermal_dev =
206 thermal_zone_device_register_with_trips(dev_name(dev), &trip, 1, 0, sensor,
208 if (IS_ERR(sensor->thermal_dev)) {
210 ret = PTR_ERR(sensor->thermal_dev);
213 ret = thermal_zone_device_enable(sensor->thermal_dev);
217 platform_set_drvdata(pdev, sensor);
222 thermal_zone_device_unregister(sensor->thermal_dev);
224 st_thermal_sensor_off(sensor);
232 struct st_thermal_sensor *sensor = platform_get_drvdata(pdev);
234 st_thermal_sensor_off(sensor);
235 thermal_zone_device_unregister(sensor->thermal_dev);
242 struct st_thermal_sensor *sensor = dev_get_drvdata(dev);
244 return st_thermal_sensor_off(sensor);
250 struct st_thermal_sensor *sensor = dev_get_drvdata(dev);
252 ret = st_thermal_sensor_on(sensor);
256 ret = st_thermal_calibration(sensor);
260 if (sensor->ops->enable_irq) {
261 ret = sensor->ops->enable_irq(sensor);