|
@@ -21,7 +21,7 @@
|
|
|
#include <linux/regmap.h>
|
|
|
#include "tsens.h"
|
|
|
|
|
|
-#define S0_ST_ADDR 0x1030
|
|
|
+#define STATUS_OFFSET 0x30
|
|
|
#define SN_ADDR_OFFSET 0x4
|
|
|
#define SN_ST_TEMP_MASK 0x3ff
|
|
|
#define CAL_DEGC_PT1 30
|
|
@@ -107,8 +107,9 @@ int get_temp_common(struct tsens_device *tmdev, int id, int *temp)
|
|
|
unsigned int status_reg;
|
|
|
int last_temp = 0, ret;
|
|
|
|
|
|
- status_reg = S0_ST_ADDR + s->hw_id * SN_ADDR_OFFSET;
|
|
|
+ status_reg = tmdev->tm_offset + STATUS_OFFSET + s->hw_id * SN_ADDR_OFFSET;
|
|
|
ret = regmap_read(tmdev->map, status_reg, &code);
|
|
|
+
|
|
|
if (ret)
|
|
|
return ret;
|
|
|
last_temp = code & SN_ST_TEMP_MASK;
|