forked from Minki/linux
c130a7602e
Registers have moved around across TSENS generations. For example, the CTRL register was at offset 0x0 in the SROT region on msm8916 but is at offset 0x4 in newer v2 based TSENS HW blocks. Allow passing offsets of important registers so that we can continue to use common functions. Signed-off-by: Amit Kucheria <amit.kucheria@linaro.org> Reviewed-by: Bjorn Andersson <bjorn.andersson@linaro.org> Signed-off-by: Eduardo Valentin <edubezval@gmail.com>
106 lines
2.7 KiB
C
106 lines
2.7 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright (c) 2015, The Linux Foundation. All rights reserved.
|
|
*/
|
|
|
|
#include <linux/platform_device.h>
|
|
#include "tsens.h"
|
|
|
|
/* eeprom layout data for 8916 */
|
|
#define BASE0_MASK 0x0000007f
|
|
#define BASE1_MASK 0xfe000000
|
|
#define BASE0_SHIFT 0
|
|
#define BASE1_SHIFT 25
|
|
|
|
#define S0_P1_MASK 0x00000f80
|
|
#define S1_P1_MASK 0x003e0000
|
|
#define S2_P1_MASK 0xf8000000
|
|
#define S3_P1_MASK 0x000003e0
|
|
#define S4_P1_MASK 0x000f8000
|
|
|
|
#define S0_P2_MASK 0x0001f000
|
|
#define S1_P2_MASK 0x07c00000
|
|
#define S2_P2_MASK 0x0000001f
|
|
#define S3_P2_MASK 0x00007c00
|
|
#define S4_P2_MASK 0x01f00000
|
|
|
|
#define S0_P1_SHIFT 7
|
|
#define S1_P1_SHIFT 17
|
|
#define S2_P1_SHIFT 27
|
|
#define S3_P1_SHIFT 5
|
|
#define S4_P1_SHIFT 15
|
|
|
|
#define S0_P2_SHIFT 12
|
|
#define S1_P2_SHIFT 22
|
|
#define S2_P2_SHIFT 0
|
|
#define S3_P2_SHIFT 10
|
|
#define S4_P2_SHIFT 20
|
|
|
|
#define CAL_SEL_MASK 0xe0000000
|
|
#define CAL_SEL_SHIFT 29
|
|
|
|
static int calibrate_8916(struct tsens_device *tmdev)
|
|
{
|
|
int base0 = 0, base1 = 0, i;
|
|
u32 p1[5], p2[5];
|
|
int mode = 0;
|
|
u32 *qfprom_cdata, *qfprom_csel;
|
|
|
|
qfprom_cdata = (u32 *)qfprom_read(tmdev->dev, "calib");
|
|
if (IS_ERR(qfprom_cdata))
|
|
return PTR_ERR(qfprom_cdata);
|
|
|
|
qfprom_csel = (u32 *)qfprom_read(tmdev->dev, "calib_sel");
|
|
if (IS_ERR(qfprom_csel))
|
|
return PTR_ERR(qfprom_csel);
|
|
|
|
mode = (qfprom_csel[0] & CAL_SEL_MASK) >> CAL_SEL_SHIFT;
|
|
dev_dbg(tmdev->dev, "calibration mode is %d\n", mode);
|
|
|
|
switch (mode) {
|
|
case TWO_PT_CALIB:
|
|
base1 = (qfprom_cdata[1] & BASE1_MASK) >> BASE1_SHIFT;
|
|
p2[0] = (qfprom_cdata[0] & S0_P2_MASK) >> S0_P2_SHIFT;
|
|
p2[1] = (qfprom_cdata[0] & S1_P2_MASK) >> S1_P2_SHIFT;
|
|
p2[2] = (qfprom_cdata[1] & S2_P2_MASK) >> S2_P2_SHIFT;
|
|
p2[3] = (qfprom_cdata[1] & S3_P2_MASK) >> S3_P2_SHIFT;
|
|
p2[4] = (qfprom_cdata[1] & S4_P2_MASK) >> S4_P2_SHIFT;
|
|
for (i = 0; i < tmdev->num_sensors; i++)
|
|
p2[i] = ((base1 + p2[i]) << 3);
|
|
/* Fall through */
|
|
case ONE_PT_CALIB2:
|
|
base0 = (qfprom_cdata[0] & BASE0_MASK);
|
|
p1[0] = (qfprom_cdata[0] & S0_P1_MASK) >> S0_P1_SHIFT;
|
|
p1[1] = (qfprom_cdata[0] & S1_P1_MASK) >> S1_P1_SHIFT;
|
|
p1[2] = (qfprom_cdata[0] & S2_P1_MASK) >> S2_P1_SHIFT;
|
|
p1[3] = (qfprom_cdata[1] & S3_P1_MASK) >> S3_P1_SHIFT;
|
|
p1[4] = (qfprom_cdata[1] & S4_P1_MASK) >> S4_P1_SHIFT;
|
|
for (i = 0; i < tmdev->num_sensors; i++)
|
|
p1[i] = (((base0) + p1[i]) << 3);
|
|
break;
|
|
default:
|
|
for (i = 0; i < tmdev->num_sensors; i++) {
|
|
p1[i] = 500;
|
|
p2[i] = 780;
|
|
}
|
|
break;
|
|
}
|
|
|
|
compute_intercept_slope(tmdev, p1, p2, mode);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct tsens_ops ops_8916 = {
|
|
.init = init_common,
|
|
.calibrate = calibrate_8916,
|
|
.get_temp = get_temp_common,
|
|
};
|
|
|
|
const struct tsens_data data_8916 = {
|
|
.num_sensors = 5,
|
|
.ops = &ops_8916,
|
|
.reg_offsets = { [SROT_CTRL_OFFSET] = 0x0 },
|
|
.hw_ids = (unsigned int []){0, 1, 2, 4, 5 },
|
|
};
|