drivers: thermal: tsens: Move get_temp_tsens_v2 to allow sharing
Just rename the function and move it to allow code sharing with future versions of TSENS IP Signed-off-by: Amit Kucheria <amit.kucheria@linaro.org> Signed-off-by: Eduardo Valentin <edubezval@gmail.com>
This commit is contained in:

committed by
Eduardo Valentin

parent
dbdaa582e4
commit
c8b6169093
@@ -102,6 +102,41 @@ static inline int code_to_degc(u32 adc_code, const struct tsens_sensor *s)
|
||||
return degc;
|
||||
}
|
||||
|
||||
int get_temp_tsens_valid(struct tsens_priv *priv, int i, int *temp)
|
||||
{
|
||||
struct tsens_sensor *s = &priv->sensor[i];
|
||||
u32 temp_idx = LAST_TEMP_0 + s->hw_id;
|
||||
u32 valid_idx = VALID_0 + s->hw_id;
|
||||
u32 last_temp = 0, valid, mask;
|
||||
int ret;
|
||||
|
||||
ret = regmap_field_read(priv->rf[valid_idx], &valid);
|
||||
if (ret)
|
||||
return ret;
|
||||
while (!valid) {
|
||||
/* Valid bit is 0 for 6 AHB clock cycles.
|
||||
* At 19.2MHz, 1 AHB clock is ~60ns.
|
||||
* We should enter this loop very, very rarely.
|
||||
*/
|
||||
ndelay(400);
|
||||
ret = regmap_field_read(priv->rf[valid_idx], &valid);
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Valid bit is set, OK to read the temperature */
|
||||
ret = regmap_field_read(priv->rf[temp_idx], &last_temp);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
mask = GENMASK(priv->fields[LAST_TEMP_0].msb,
|
||||
priv->fields[LAST_TEMP_0].lsb);
|
||||
/* Convert temperature from deciCelsius to milliCelsius */
|
||||
*temp = sign_extend32(last_temp, fls(mask) - 1) * 100;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int get_temp_common(struct tsens_priv *priv, int i, int *temp)
|
||||
{
|
||||
struct tsens_sensor *s = &priv->sensor[i];
|
||||
|
Reference in New Issue
Block a user