|
@@ -241,8 +241,8 @@ static int stm_thermal_read_factory_settings(struct stm_thermal_sensor *sensor)
|
|
|
sensor->t0 = TS1_T0_VAL1;
|
|
|
|
|
|
/* Retrieve fmt0 and put it on Hz */
|
|
|
- sensor->fmt0 = ADJUST * readl_relaxed(sensor->base + DTS_T0VALR1_OFFSET)
|
|
|
- & TS1_FMT0_MASK;
|
|
|
+ sensor->fmt0 = ADJUST * (readl_relaxed(sensor->base +
|
|
|
+ DTS_T0VALR1_OFFSET) & TS1_FMT0_MASK);
|
|
|
|
|
|
/* Retrieve ramp coefficient */
|
|
|
sensor->ramp_coeff = readl_relaxed(sensor->base + DTS_RAMPVALR_OFFSET) &
|
|
@@ -532,6 +532,10 @@ static int stm_thermal_prepare(struct stm_thermal_sensor *sensor)
|
|
|
if (ret)
|
|
|
return ret;
|
|
|
|
|
|
+ ret = stm_thermal_read_factory_settings(sensor);
|
|
|
+ if (ret)
|
|
|
+ goto thermal_unprepare;
|
|
|
+
|
|
|
ret = stm_thermal_calibration(sensor);
|
|
|
if (ret)
|
|
|
goto thermal_unprepare;
|
|
@@ -636,10 +640,6 @@ static int stm_thermal_probe(struct platform_device *pdev)
|
|
|
/* Populate sensor */
|
|
|
sensor->base = base;
|
|
|
|
|
|
- ret = stm_thermal_read_factory_settings(sensor);
|
|
|
- if (ret)
|
|
|
- return ret;
|
|
|
-
|
|
|
sensor->clk = devm_clk_get(&pdev->dev, "pclk");
|
|
|
if (IS_ERR(sensor->clk)) {
|
|
|
dev_err(&pdev->dev, "%s: failed to fetch PCLK clock\n",
|