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 },
|
|
};
|