A-Team_Digital_Solutions/android_kernel_motorola_sm6375
Watch
2
0
Fork
You've already forked android_kernel_motorola_sm6375
 0
mirror of https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git synced 2026-10-10 06:09:23 -04:00
Code Issues Projects Releases Packages Wiki Activity

add xtalk and offset sysfs for tof calibration

Browse source 
Add xtalk sysfs interface for tof xtalk calibration.
Update the offset sysfs for tof offset calibration.

Change-Id: I6cb6b9762fa3446829f4bb3f921615215f90a2f1
Signed-off-by: Yonghua Yan <yanyh2@motorola.com>
Reviewed-on: https://gerrit.mot.com/1387848
SME-Granted: SME Approvals Granted
SLTApproved: Slta Waiver
Tested-by: Jira Key
Reviewed-by: Dawei Wang <wangdw10@motorola.com>
Reviewed-by: Yuecai Liu <liuyc20@motorola.com>
Reviewed-by: Jianqi Yang <yangj@motorola.com>
Submit-Approved: Jira Key
Reviewed-on: https://gerrit.mot.com/1390242
Reviewed-by: Huosheng Liao <liaohs@motorola.com>
This commit is contained in:
Yonghua Yan 2019-07-18 23:16:36 +08:00 • committed by Yuecai Liu
commit 940f3d27b1
1 changed files with 157 additions and 9 deletions
Download patch file Download diff file Expand all files Collapse all files

166
drivers/input/misc/vl53L1/stmvl53l1_module.c
View file

@ -2184,10 +2184,36 @@ static DEVICE_ATTR(enable_sar, 0660/*S_IWUGO | S_IRUGO*/,
static ssize_t stmvl53l1_show_offset(struct device *dev,
struct device_attribute *attr, char *buf)
{
int rc;
struct stmvl53l1_data *data = dev_get_drvdata(dev);
VL53L1_CalibrationData_t cali_data;
return scnprintf(buf, PAGE_SIZE, "%d,%d\n",
data->inner_offset, data->outer_offset);
mutex_lock(&data->work_mutex);
memset(&cali_data, 0, sizeof(cali_data));
rc = VL53L1_GetCalibrationData(&data->stdev, &cali_data);
if (rc) {
mutex_unlock(&data->work_mutex);
vl53l1_errmsg("VL53L1_GetCalibrationData fail\n");
return -EINVAL;
}
mutex_unlock(&data->work_mutex);
return scnprintf(buf, PAGE_SIZE, "%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d",
cali_data.customer.mm_config__inner_offset_mm,
cali_data.customer.mm_config__outer_offset_mm,
cali_data.customer.global_config__spad_enables_ref_0,
cali_data.customer.global_config__spad_enables_ref_1,
cali_data.customer.global_config__spad_enables_ref_2,
cali_data.customer.global_config__spad_enables_ref_3,
cali_data.customer.global_config__spad_enables_ref_4,
cali_data.customer.global_config__spad_enables_ref_5,
cali_data.customer.ref_spad_man__num_requested_ref_spads,
cali_data.customer.ref_spad_man__ref_location,
cali_data.cust_dmax_cal.ref__actual_effective_spads,
cali_data.cust_dmax_cal.ref__peak_signal_count_rate_mcps,
cali_data.cust_dmax_cal.ref__distance_mm,
cali_data.cust_dmax_cal.ref_reflectance_pc,
cali_data.cust_dmax_cal.coverglass_transmission);
}
static ssize_t stmvl53l1_store_offset(struct device *dev,
@ -2200,7 +2226,19 @@ static ssize_t stmvl53l1_store_offset(struct device *dev,
int n = 0;
int inner = 0;
int outer = 0;
int refspad_0 = 0;
int refspad_1 = 0;
int refspad_2 = 0;
int refspad_3 = 0;
int refspad_4 = 0;
int refspad_5 = 0;
int refspad_num = 0;
int refspad_location = 0;
int ref__actual_effective_spads = 0;
int ref__peak_signal_count_rate_mcps = 0;
int ref__distance_mm = 0;
int ref_reflectance_pc = 0;
int coverglass_transmission = 0;
mutex_lock(&data->work_mutex);
if (data->enable_sensor) {
@ -2209,8 +2247,12 @@ static ssize_t stmvl53l1_store_offset(struct device *dev,
goto finish;
}
n = sscanf(buf, "%d,%d", &inner, &outer);
if(n != 2) {
n = sscanf(buf, "%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d",
&inner, &outer,&refspad_0,&refspad_1,&refspad_2,&refspad_3,
&refspad_4, &refspad_5,&refspad_num,&refspad_location,
&ref__actual_effective_spads,&ref__peak_signal_count_rate_mcps,
&ref__distance_mm,&ref_reflectance_pc,&coverglass_transmission);
if(n != 15) {
vl53l1_errmsg("wrong offset syntax around %s\n", buf);
rc = -EINVAL;
goto finish;
@ -2230,6 +2272,19 @@ static ssize_t stmvl53l1_store_offset(struct device *dev,
cali_data.customer.mm_config__outer_offset_mm);
cali_data.customer.mm_config__inner_offset_mm = inner;
cali_data.customer.mm_config__outer_offset_mm = outer;
cali_data.customer.global_config__spad_enables_ref_0 = refspad_0;
cali_data.customer.global_config__spad_enables_ref_1 = refspad_1;
cali_data.customer.global_config__spad_enables_ref_2 = refspad_2;
cali_data.customer.global_config__spad_enables_ref_3 = refspad_3;
cali_data.customer.global_config__spad_enables_ref_4 = refspad_4;
cali_data.customer.global_config__spad_enables_ref_5 = refspad_5;
cali_data.customer.ref_spad_man__num_requested_ref_spads = refspad_num;
cali_data.customer.ref_spad_man__ref_location = ref_reflectance_pc;
cali_data.cust_dmax_cal.ref__actual_effective_spads = ref__actual_effective_spads;
cali_data.cust_dmax_cal.ref__peak_signal_count_rate_mcps = ref__peak_signal_count_rate_mcps;
cali_data.cust_dmax_cal.ref__distance_mm = ref__distance_mm;
cali_data.cust_dmax_cal.ref_reflectance_pc = ref_reflectance_pc;
cali_data.cust_dmax_cal.coverglass_transmission = coverglass_transmission;
rc = VL53L1_SetCalibrationData(&data->stdev, &cali_data);
if (rc) {
@ -2247,11 +2302,9 @@ finish:
}
/**
* sysfs attribute "enable_sar" [rd/wr]
* sysfs attribute "offset" [rd/wr]
*
* To enable/disable the sar mode
* @li 0 disable sar mode
* @li 1 enable sar mode
* To read/write offset calibration data
*
* @ingroup sysfs_attrib
*/
@ -2259,6 +2312,100 @@ static DEVICE_ATTR(offset, 0660/*S_IWUGO | S_IRUGO*/,
stmvl53l1_show_offset,
stmvl53l1_store_offset);
static ssize_t stmvl53l1_show_xtalk(struct device *dev,
struct device_attribute *attr, char *buf)
{
int rc;
struct stmvl53l1_data *data = dev_get_drvdata(dev);
VL53L1_CalibrationData_t cali_data;
mutex_lock(&data->work_mutex);
memset(&cali_data, 0, sizeof(cali_data));
rc = VL53L1_GetCalibrationData(&data->stdev, &cali_data);
if (rc) {
mutex_unlock(&data->work_mutex);
vl53l1_errmsg("VL53L1_GetCalibrationData fail\n");
return -EINVAL;
}
mutex_unlock(&data->work_mutex);
return scnprintf(buf, PAGE_SIZE, "%d,%d,%d",
cali_data.customer.algo__crosstalk_compensation_plane_offset_kcps,
cali_data.customer.algo__crosstalk_compensation_x_plane_gradient_kcps,
cali_data.customer.algo__crosstalk_compensation_y_plane_gradient_kcps);
}
static ssize_t stmvl53l1_store_xtalk(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t count)
{
struct stmvl53l1_data *data = dev_get_drvdata(dev);
VL53L1_CalibrationData_t cali_data;
int rc = 0;
int n = 0;
int xtalk_offset = 0;
int xtalk_x = 0;
int xtalk_y = 0;
mutex_lock(&data->work_mutex);
if (data->enable_sensor) {
vl53l1_errmsg("can't set offset while ranging\n");
rc = -EBUSY;
goto finish;
}
n = sscanf(buf, "%d,%d,%d", &xtalk_offset, &xtalk_x, &xtalk_y);
if(n != 3) {
vl53l1_errmsg("wrong xtalk syntax around %s\n", buf);
rc = -EINVAL;
goto finish;
}
memset(&cali_data, 0, sizeof(cali_data));
rc = VL53L1_GetCalibrationData(&data->stdev, &cali_data);
if (rc) {
vl53l1_errmsg("VL53L1_GetCalibrationData fail\n");
rc = -EINVAL;
goto finish;
}
/* update xtalk values */
vl53l1_info("previous xtalk is %d,%d,%d\n",
cali_data.customer.algo__crosstalk_compensation_plane_offset_kcps,
cali_data.customer.algo__crosstalk_compensation_x_plane_gradient_kcps,
cali_data.customer.algo__crosstalk_compensation_y_plane_gradient_kcps);
cali_data.customer.algo__crosstalk_compensation_plane_offset_kcps = xtalk_offset;
cali_data.customer.algo__crosstalk_compensation_x_plane_gradient_kcps = xtalk_x;
cali_data.customer.algo__crosstalk_compensation_y_plane_gradient_kcps = xtalk_y;
rc = VL53L1_SetCalibrationData(&data->stdev, &cali_data);
if (rc) {
vl53l1_errmsg("VL53L1_SetCalibrationData fail\n");
rc = -EINVAL;
goto finish;
}
data->xtalk_offset = xtalk_offset;
data->xtalk_x = xtalk_x;
data->xtalk_y = xtalk_y;
vl53l1_info("xtalk is set to %d,%d,%d\n", xtalk_offset, xtalk_x, xtalk_y);
finish:
mutex_unlock(&data->work_mutex);
return rc ? rc : count;
}
/**
* sysfs attribute "xtalk" [rd/wr]
*
* To read/write xtalk calibration data
*
* @ingroup sysfs_attrib
*/
static DEVICE_ATTR(xtalk, 0660/*S_IWUGO | S_IRUGO*/,
stmvl53l1_show_xtalk,
stmvl53l1_store_xtalk);
static struct attribute *stmvl53l1_attributes[] = {
&dev_attr_enable_ps_sensor.attr,
&dev_attr_set_delay_ms.attr,
@ -2283,6 +2430,7 @@ static struct attribute *stmvl53l1_attributes[] = {
&dev_attr_is_xtalk_value_changed.attr,
&dev_attr_enable_sar.attr,
&dev_attr_offset.attr,
&dev_attr_xtalk.attr,
NULL
};