mirror of
https://github.com/team-infusion-developers/android_kernel_samsung_msm8976.git
synced 2024-10-31 18:09:19 +00:00
input: sensors: add self test support for akm09911
The self test mode can be used for factory test. User space applications can get self test result via sysfs. Change-Id: Ida3a3513ac96380dddb08fdd20d3d9b2ad498eb8 Signed-off-by: Oliver Wang <mengmeng@codeaurora.org>
This commit is contained in:
Oliver Wang
parent
18c43109aa
commit
cc930bbd4c
2 changed files with 265 additions and 0 deletions
|
|
@ -1,5 +1,6 @@
|
|||
/* drivers/misc/akm09911.c - akm09911 compass driver
|
||||
*
|
||||
* Copyright (c) 2014-2015, Linux Foundation. All rights reserved.
|
||||
* Copyright (C) 2007-2008 HTC Corporation.
|
||||
* Author: Hou-Kun Chen <houkun.chen@gmail.com>
|
||||
*
|
||||
|
|
@ -51,6 +52,15 @@
|
|||
|
||||
#define STATUS_ERROR(st) (((st)&0x08) != 0x0)
|
||||
|
||||
#define AKM09911_RETRY_COUNT 10
|
||||
|
||||
enum {
|
||||
AKM09911_AXIS_X = 0,
|
||||
AKM09911_AXIS_Y,
|
||||
AKM09911_AXIS_Z,
|
||||
AKM09911_AXIS_COUNT,
|
||||
};
|
||||
|
||||
/* Save last device state for power down */
|
||||
struct akm_sensor_state {
|
||||
bool power_on;
|
||||
|
|
@ -1903,6 +1913,201 @@ static enum hrtimer_restart akm_timer_func(struct hrtimer *timer)
|
|||
return HRTIMER_RESTART;
|
||||
}
|
||||
|
||||
static int case_test(struct akm_compass_data *akm, const char test_name[],
|
||||
const int testdata, const int lo_limit, const int hi_limit,
|
||||
int *fail_total)
|
||||
{
|
||||
/* Pass:0, Fail:-1 */
|
||||
int result = 0;
|
||||
|
||||
if (fail_total == NULL)
|
||||
return -EINVAL;
|
||||
|
||||
if (strcmp(test_name, "START") == 0) {
|
||||
dev_dbg(&akm->i2c->dev, "----------------------------------------------------------\n");
|
||||
dev_dbg(&akm->i2c->dev, "Test Name Fail Test Data [ Low High]\n");
|
||||
dev_dbg(&akm->i2c->dev, "----------------------------------------------------------\n");
|
||||
} else if (strcmp(test_name, "END") == 0) {
|
||||
dev_dbg(&akm->i2c->dev, "----------------------------------------------------------\n");
|
||||
if (*fail_total == 0)
|
||||
dev_dbg(&akm->i2c->dev, "Factory shipment test passed.\n\n");
|
||||
else
|
||||
dev_dbg(&akm->i2c->dev, "%d test cases failed.\n\n",
|
||||
*fail_total);
|
||||
} else {
|
||||
if ((testdata < lo_limit) || (testdata > hi_limit)) {
|
||||
result = -1;
|
||||
*fail_total += 1;
|
||||
}
|
||||
|
||||
dev_dbg(&akm->i2c->dev, " %-10s %c %9d [%9d %9d]\n",
|
||||
test_name, ((result == 0) ? ('.') : ('F')),
|
||||
testdata, lo_limit, hi_limit);
|
||||
}
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
static int akm_self_test(struct sensors_classdev *sensors_cdev)
|
||||
{
|
||||
struct akm_compass_data *akm = container_of(sensors_cdev,
|
||||
struct akm_compass_data, cdev);
|
||||
uint8_t i2c_data[AKM_SENSOR_DATA_SIZE];
|
||||
int hdata[AKM09911_AXIS_COUNT];
|
||||
int asax, asay, asaz;
|
||||
int count;
|
||||
int ret;
|
||||
int fail_total = 0;
|
||||
uint8_t mode;
|
||||
bool power_enabled = akm->power_enabled ? true : false;
|
||||
|
||||
mutex_lock(&akm->op_mutex);
|
||||
|
||||
asax = akm->sense_conf[AKM09911_AXIS_X];
|
||||
asay = akm->sense_conf[AKM09911_AXIS_Y];
|
||||
asaz = akm->sense_conf[AKM09911_AXIS_Z];
|
||||
|
||||
if (!power_enabled) {
|
||||
ret = akm_compass_power_set(akm, true);
|
||||
if (ret) {
|
||||
dev_err(&akm->i2c->dev, "Power up failed.\n");
|
||||
goto exit;
|
||||
}
|
||||
} else {
|
||||
i2c_data[0] = AKM_REG_MODE;
|
||||
ret = akm_i2c_rxdata(akm->i2c, i2c_data, 1);
|
||||
if (ret < 0) {
|
||||
dev_err(&akm->i2c->dev, "Get mode failed.\n");
|
||||
goto exit;
|
||||
}
|
||||
mode = i2c_data[1];
|
||||
}
|
||||
|
||||
ret = AKECS_Reset(akm, 0);
|
||||
if (ret < 0) {
|
||||
dev_err(&akm->i2c->dev, "Reset failed.\n");
|
||||
goto exit;
|
||||
}
|
||||
|
||||
/* start test */
|
||||
case_test(akm, "START", 0, 0, 0, &fail_total);
|
||||
|
||||
case_test(akm, TLIMIT_TN_ASAX_09911, asax, TLIMIT_LO_ASAX_09911,
|
||||
TLIMIT_HI_ASAX_09911, &fail_total);
|
||||
case_test(akm, TLIMIT_TN_ASAY_09911, asay, TLIMIT_LO_ASAY_09911,
|
||||
TLIMIT_HI_ASAY_09911, &fail_total);
|
||||
case_test(akm, TLIMIT_TN_ASAZ_09911, asaz, TLIMIT_LO_ASAZ_09911,
|
||||
TLIMIT_HI_ASAZ_09911, &fail_total);
|
||||
|
||||
ret = AKECS_SetMode(akm, AK09911_MODE_SNG_MEASURE);
|
||||
if (ret < 0) {
|
||||
dev_err(&akm->i2c->dev, "Set to single measurement failed.\n");
|
||||
goto exit;
|
||||
}
|
||||
|
||||
count = AKM09911_RETRY_COUNT;
|
||||
do {
|
||||
/* The typical time for single measurement is 7.2ms */
|
||||
ret = AKECS_GetData_Poll(akm, i2c_data, AKM_SENSOR_DATA_SIZE);
|
||||
if (ret == -EAGAIN)
|
||||
usleep_range(1000, 10000);
|
||||
} while ((ret == -EAGAIN) && (--count));
|
||||
|
||||
if (!count) {
|
||||
dev_err(&akm->i2c->dev, "Timeout get valid data.\n");
|
||||
goto exit;
|
||||
}
|
||||
|
||||
hdata[AKM09911_AXIS_X] = (s16)(i2c_data[1] | (i2c_data[2] << 8));
|
||||
hdata[AKM09911_AXIS_Y] = (s16)(i2c_data[3] | (i2c_data[4] << 8));
|
||||
hdata[AKM09911_AXIS_Z] = (s16)(i2c_data[5] | (i2c_data[6] << 8));
|
||||
|
||||
i2c_data[0] &= 0x7F;
|
||||
case_test(akm, TLIMIT_TN_SNG_ST1_09911,
|
||||
(int)i2c_data[0], TLIMIT_LO_SNG_ST1_09911,
|
||||
TLIMIT_HI_SNG_ST1_09911, &fail_total);
|
||||
|
||||
case_test(akm, TLIMIT_TN_SNG_HX_09911, hdata[0], TLIMIT_LO_SNG_HX_09911,
|
||||
TLIMIT_HI_SNG_HX_09911, &fail_total);
|
||||
case_test(akm, TLIMIT_TN_SNG_HY_09911, hdata[1], TLIMIT_LO_SNG_HY_09911,
|
||||
TLIMIT_HI_SNG_HY_09911, &fail_total);
|
||||
case_test(akm, TLIMIT_TN_SNG_HZ_09911, hdata[2], TLIMIT_LO_SNG_HZ_09911,
|
||||
TLIMIT_HI_SNG_HZ_09911, &fail_total);
|
||||
|
||||
case_test(akm, TLIMIT_TN_SNG_ST2_09911, (int)i2c_data[8],
|
||||
TLIMIT_LO_SNG_ST2_09911, TLIMIT_HI_SNG_ST2_09911,
|
||||
&fail_total);
|
||||
|
||||
/* self-test mode */
|
||||
ret = AKECS_SetMode(akm, AK09911_MODE_SELF_TEST);
|
||||
if (ret < 0) {
|
||||
dev_err(&akm->i2c->dev, "Set to self test mode failed\n");
|
||||
goto exit;
|
||||
}
|
||||
|
||||
count = AKM09911_RETRY_COUNT;
|
||||
do {
|
||||
/* The typical time for single measurement is 7.2ms */
|
||||
ret = AKECS_GetData_Poll(akm, i2c_data, AKM_SENSOR_DATA_SIZE);
|
||||
if (ret == -EAGAIN)
|
||||
usleep_range(1000, 10000);
|
||||
} while ((ret == -EAGAIN) && (--count));
|
||||
|
||||
if (!count) {
|
||||
dev_err(&akm->i2c->dev, "Timeout get valid data.\n");
|
||||
goto exit;
|
||||
}
|
||||
|
||||
i2c_data[0] &= 0x7F;
|
||||
|
||||
case_test(akm, TLIMIT_TN_SLF_ST1_09911, (int)i2c_data[0],
|
||||
TLIMIT_LO_SLF_ST1_09911, TLIMIT_HI_SLF_ST1_09911,
|
||||
&fail_total);
|
||||
|
||||
hdata[AKM09911_AXIS_X] = (s16)(i2c_data[1] | (i2c_data[2] << 8));
|
||||
hdata[AKM09911_AXIS_Y] = (s16)(i2c_data[3] | (i2c_data[4] << 8));
|
||||
hdata[AKM09911_AXIS_Z] = (s16)(i2c_data[5] | (i2c_data[6] << 8));
|
||||
|
||||
case_test(akm, TLIMIT_TN_SLF_RVHX_09911, (hdata[0])*(asax/128 + 1),
|
||||
TLIMIT_LO_SLF_RVHX_09911, TLIMIT_HI_SLF_RVHX_09911,
|
||||
&fail_total);
|
||||
|
||||
case_test(akm, TLIMIT_TN_SLF_RVHY_09911, (hdata[1])*(asay/128 + 1),
|
||||
TLIMIT_LO_SLF_RVHY_09911, TLIMIT_HI_SLF_RVHY_09911,
|
||||
&fail_total);
|
||||
|
||||
case_test(akm, TLIMIT_TN_SLF_RVHZ_09911, (hdata[2])*(asaz/128 + 1),
|
||||
TLIMIT_LO_SLF_RVHZ_09911, TLIMIT_HI_SLF_RVHZ_09911,
|
||||
&fail_total);
|
||||
|
||||
case_test(akm, TLIMIT_TN_SLF_ST2_09911, (int)i2c_data[8],
|
||||
TLIMIT_LO_SLF_ST2_09911, TLIMIT_HI_SLF_ST2_09911,
|
||||
&fail_total);
|
||||
|
||||
case_test(akm, "END", 0, 0, 0, &fail_total);
|
||||
/* clean up */
|
||||
if (!power_enabled) {
|
||||
ret = akm_compass_power_set(akm, false);
|
||||
if (ret) {
|
||||
dev_err(&akm->i2c->dev, "Power down failed.\n");
|
||||
goto exit;
|
||||
}
|
||||
} else {
|
||||
/* Set measure mode */
|
||||
i2c_data[0] = AKM_REG_MODE;
|
||||
i2c_data[1] = mode;
|
||||
ret = akm_i2c_txdata(akm->i2c, i2c_data, 2);
|
||||
if (ret < 0) {
|
||||
dev_err(&akm->i2c->dev, "restore mode failed\n");
|
||||
goto exit;
|
||||
}
|
||||
}
|
||||
|
||||
exit:
|
||||
mutex_unlock(&akm->op_mutex);
|
||||
return ((fail_total > 0) || ret) ? -EIO : 0;
|
||||
}
|
||||
|
||||
int akm_compass_probe(struct i2c_client *client, const struct i2c_device_id *id)
|
||||
{
|
||||
struct akm09911_platform_data *pdata;
|
||||
|
|
@ -2063,6 +2268,7 @@ int akm_compass_probe(struct i2c_client *client, const struct i2c_device_id *id)
|
|||
s_akm->cdev = sensors_cdev;
|
||||
s_akm->cdev.sensors_enable = akm_enable_set;
|
||||
s_akm->cdev.sensors_poll_delay = akm_poll_delay_set;
|
||||
s_akm->cdev.sensors_self_test = akm_self_test;
|
||||
|
||||
s_akm->delay[MAG_DATA_FLAG] = sensors_cdev.delay_msec * 1000000;
|
||||
|
||||
|
|
|
|||
|
|
@ -42,6 +42,65 @@
|
|||
#define AK09911_WIA1_VALUE 0x48
|
||||
#define AK09911_WIA2_VALUE 0x05
|
||||
|
||||
/*** Limit of factory shipment test *******************************************/
|
||||
#define TLIMIT_TN_REVISION_09911 ""
|
||||
#define TLIMIT_TN_RST_WIA1_09911 "RST_WIA1"
|
||||
#define TLIMIT_LO_RST_WIA1_09911 0x48
|
||||
#define TLIMIT_HI_RST_WIA1_09911 0x48
|
||||
#define TLIMIT_TN_RST_WIA2_09911 "RST_WIA2"
|
||||
#define TLIMIT_LO_RST_WIA2_09911 0x05
|
||||
#define TLIMIT_HI_RST_WIA2_09911 0x05
|
||||
|
||||
#define TLIMIT_TN_ASAX_09911 "ASAX"
|
||||
#define TLIMIT_LO_ASAX_09911 1
|
||||
#define TLIMIT_HI_ASAX_09911 254
|
||||
#define TLIMIT_TN_ASAY_09911 "ASAY"
|
||||
#define TLIMIT_LO_ASAY_09911 1
|
||||
#define TLIMIT_HI_ASAY_09911 254
|
||||
#define TLIMIT_TN_ASAZ_09911 "ASAZ"
|
||||
#define TLIMIT_LO_ASAZ_09911 1
|
||||
#define TLIMIT_HI_ASAZ_09911 254
|
||||
|
||||
#define TLIMIT_TN_SNG_ST1_09911 "SNG_ST1"
|
||||
#define TLIMIT_LO_SNG_ST1_09911 1
|
||||
#define TLIMIT_HI_SNG_ST1_09911 1
|
||||
|
||||
#define TLIMIT_TN_SNG_HX_09911 "SNG_HX"
|
||||
#define TLIMIT_LO_SNG_HX_09911 -8189
|
||||
#define TLIMIT_HI_SNG_HX_09911 8189
|
||||
|
||||
#define TLIMIT_TN_SNG_HY_09911 "SNG_HY"
|
||||
#define TLIMIT_LO_SNG_HY_09911 -8189
|
||||
#define TLIMIT_HI_SNG_HY_09911 8189
|
||||
|
||||
#define TLIMIT_TN_SNG_HZ_09911 "SNG_HZ"
|
||||
#define TLIMIT_LO_SNG_HZ_09911 -8189
|
||||
#define TLIMIT_HI_SNG_HZ_09911 8189
|
||||
|
||||
#define TLIMIT_TN_SNG_ST2_09911 "SNG_ST2"
|
||||
#define TLIMIT_LO_SNG_ST2_09911 0
|
||||
#define TLIMIT_HI_SNG_ST2_09911 0
|
||||
|
||||
#define TLIMIT_TN_SLF_ST1_09911 "SLF_ST1"
|
||||
#define TLIMIT_LO_SLF_ST1_09911 1
|
||||
#define TLIMIT_HI_SLF_ST1_09911 1
|
||||
|
||||
#define TLIMIT_TN_SLF_RVHX_09911 "SLF_REVSHX"
|
||||
#define TLIMIT_LO_SLF_RVHX_09911 -30
|
||||
#define TLIMIT_HI_SLF_RVHX_09911 30
|
||||
|
||||
#define TLIMIT_TN_SLF_RVHY_09911 "SLF_REVSHY"
|
||||
#define TLIMIT_LO_SLF_RVHY_09911 -30
|
||||
#define TLIMIT_HI_SLF_RVHY_09911 30
|
||||
|
||||
#define TLIMIT_TN_SLF_RVHZ_09911 "SLF_REVSHZ"
|
||||
#define TLIMIT_LO_SLF_RVHZ_09911 -400
|
||||
#define TLIMIT_HI_SLF_RVHZ_09911 -50
|
||||
|
||||
#define TLIMIT_TN_SLF_ST2_09911 "SLF_ST2"
|
||||
#define TLIMIT_LO_SLF_ST2_09911 0
|
||||
#define TLIMIT_HI_SLF_ST2_09911 0
|
||||
|
||||
/* To avoid device dependency, convert to general name */
|
||||
#define AKM_I2C_NAME "akm09911"
|
||||
#define AKM_MISCDEV_NAME "akm09911_dev"
|
||||
|
|
|
|||
Loading…
Reference in a new issue