/* * Copyright (C) 2012, Samsung Electronics Co. Ltd. All Rights Reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * */ #include "ssp.h" #define VENDOR "CAPELLA" #define CHIP_ID "CM36651" #define CANCELATION_FILE_PATH "/efs/prox_cal" #define LCD_LDI_FILE_PATH "/sys/class/lcd/panel/window_type" #define LINE_1 '4' #define LINE_2 '2' #define LDI_OTHERS '0' #define LDI_GRAY '1' #define LDI_WHITE '2' #define CANCELATION_THRESHOLD 9 #define DEFAULT_THRESHOLD 13 #define OTHERS_OCTA_DEFAULT_THRESHOLD 14 #define WHITE_OCTA_DEFAULT_THRESHOLD 13 #define GRAY_OCTA_DEFAULT_THRESHOLD 12 /*************************************************************************/ /* factory Sysfs */ /*************************************************************************/ static ssize_t prox_vendor_show(struct device *dev, struct device_attribute *attr, char *buf) { return sprintf(buf, "%s\n", VENDOR); } static ssize_t prox_name_show(struct device *dev, struct device_attribute *attr, char *buf) { return sprintf(buf, "%s\n", CHIP_ID); } static ssize_t proximity_avg_show(struct device *dev, struct device_attribute *attr, char *buf) { struct ssp_data *data = dev_get_drvdata(dev); return snprintf(buf, PAGE_SIZE, "%d,%d,%d\n", data->buf[PROXIMITY_RAW].prox[1], data->buf[PROXIMITY_RAW].prox[2], data->buf[PROXIMITY_RAW].prox[3]); } static ssize_t proximity_avg_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t size) { char chTempbuf[2] = { 1, 20}; int iRet; int64_t dEnable; struct ssp_data *data = dev_get_drvdata(dev); iRet = strict_strtoll(buf, 10, &dEnable); if (iRet < 0) return iRet; if (dEnable) { send_instruction(data, ADD_SENSOR, PROXIMITY_RAW, chTempbuf, 2); data->bProximityRawEnabled = true; } else { send_instruction(data, REMOVE_SENSOR, PROXIMITY_RAW, chTempbuf, 2); data->bProximityRawEnabled = false; } return size; } static unsigned char get_proximity_rawdata(struct ssp_data *data) { unsigned char uRowdata = 0; char chTempbuf[2] = { 1, 20}; if (data->bProximityRawEnabled == false) { send_instruction(data, ADD_SENSOR, PROXIMITY_RAW, chTempbuf, 2); msleep(200); uRowdata = data->buf[PROXIMITY_RAW].prox[0]; send_instruction(data, REMOVE_SENSOR, PROXIMITY_RAW, chTempbuf, 2); } else { uRowdata = data->buf[PROXIMITY_RAW].prox[0]; } return uRowdata; } static ssize_t proximity_state_show(struct device *dev, struct device_attribute *attr, char *buf) { struct ssp_data *data = dev_get_drvdata(dev); return sprintf(buf, "%u\n", get_proximity_rawdata(data)); } static void change_proximity_default_threshold(struct ssp_data *data) { switch (data->chLcdLdi[1]) { case LDI_GRAY: data->uProxHiThresh = GRAY_OCTA_DEFAULT_THRESHOLD; break; case LDI_WHITE: data->uProxHiThresh = WHITE_OCTA_DEFAULT_THRESHOLD; break; case LDI_OTHERS: data->uProxHiThresh = OTHERS_OCTA_DEFAULT_THRESHOLD; break; default: data->uProxHiThresh = DEFAULT_THRESHOLD; break; } } int proximity_open_lcd_ldi(struct ssp_data *data) { int iRet = 0; mm_segment_t old_fs; struct file *cancel_filp = NULL; old_fs = get_fs(); set_fs(KERNEL_DS); cancel_filp = filp_open(LCD_LDI_FILE_PATH, O_RDONLY, 0666); if (IS_ERR(cancel_filp)) { iRet = PTR_ERR(cancel_filp); if (iRet != -ENOENT) pr_err("[SSP]: %s - Can't open lcd ldi file\n", __func__); set_fs(old_fs); data->chLcdLdi[0] = 0; data->chLcdLdi[1] = 0; goto exit; } iRet = cancel_filp->f_op->read(cancel_filp, (u8 *)data->chLcdLdi, sizeof(u8) * 2, &cancel_filp->f_pos); if (iRet != (sizeof(u8) * 2)) { pr_err("[SSP]: %s - Can't read the lcd ldi data\n", __func__); iRet = -EIO; } ssp_dbg("[SSP]: %s - %c%c\n", __func__, data->chLcdLdi[0], data->chLcdLdi[1]); filp_close(cancel_filp, current->files); set_fs(old_fs); exit: change_proximity_default_threshold(data); return iRet; } int proximity_open_calibration(struct ssp_data *data) { int iRet = 0; mm_segment_t old_fs; struct file *cancel_filp = NULL; old_fs = get_fs(); set_fs(KERNEL_DS); cancel_filp = filp_open(CANCELATION_FILE_PATH, O_RDONLY, 0666); if (IS_ERR(cancel_filp)) { iRet = PTR_ERR(cancel_filp); if (iRet != -ENOENT) pr_err("[SSP]: %s - Can't open cancelation file\n", __func__); set_fs(old_fs); goto exit; } iRet = cancel_filp->f_op->read(cancel_filp, (u8 *)&data->uProxCanc, sizeof(u8), &cancel_filp->f_pos); if (iRet != sizeof(u8)) { pr_err("[SSP]: %s - Can't read the cancel data\n", __func__); iRet = -EIO; } if (data->uProxCanc != 0) /* If there is an offset cal data. */ data->uProxHiThresh = CANCELATION_THRESHOLD; pr_info("%s: proximity ps_canc = %d, ps_thresh = %d\n", __func__, data->uProxCanc, data->uProxHiThresh); filp_close(cancel_filp, current->files); set_fs(old_fs); exit: set_proximity_threshold(data, data->uProxHiThresh, data->uProxCanc); return iRet; } static int proximity_store_cancelation(struct ssp_data *data, int iCalCMD) { int iRet = 0; mm_segment_t old_fs; struct file *cancel_filp = NULL; if (iCalCMD) { data->uProxHiThresh = CANCELATION_THRESHOLD; data->uProxCanc = get_proximity_rawdata(data); } else { change_proximity_default_threshold(data); data->uProxCanc = 0; } set_proximity_threshold(data, data->uProxHiThresh, data->uProxCanc); old_fs = get_fs(); set_fs(KERNEL_DS); cancel_filp = filp_open(CANCELATION_FILE_PATH, O_CREAT | O_TRUNC | O_WRONLY, 0666); if (IS_ERR(cancel_filp)) { pr_err("%s: Can't open cancelation file\n", __func__); set_fs(old_fs); iRet = PTR_ERR(cancel_filp); return iRet; } iRet = cancel_filp->f_op->write(cancel_filp, (u8 *)&data->uProxCanc, sizeof(u8), &cancel_filp->f_pos); if (iRet != sizeof(u8)) { pr_err("%s: Can't write the cancel data to file\n", __func__); iRet = -EIO; } filp_close(cancel_filp, current->files); set_fs(old_fs); return iRet; } static ssize_t proximity_cancel_show(struct device *dev, struct device_attribute *attr, char *buf) { struct ssp_data *data = dev_get_drvdata(dev); ssp_dbg("[SSP]: uProxThresh = %u, uProxCanc = %u\n", data->uProxHiThresh, data->uProxCanc); return sprintf(buf, "%u,%u\n", data->uProxCanc, data->uProxHiThresh); } static ssize_t proximity_cancel_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t size) { int iCalCMD = 0, iRet = 0; struct ssp_data *data = dev_get_drvdata(dev); if (sysfs_streq(buf, "1")) /* calibrate cancelation value */ iCalCMD = 1; else if (sysfs_streq(buf, "0")) /* reset cancelation value */ iCalCMD = 0; else { pr_debug("%s: invalid value %d\n", __func__, *buf); return -EINVAL; } iRet = proximity_store_cancelation(data, iCalCMD); if (iRet < 0) { pr_err("[SSP]: - %s proximity_store_cancelation() failed\n", __func__); return iRet; } ssp_dbg("[SSP]: %s - %u\n", __func__, iCalCMD); return size; } static ssize_t proximity_thresh_show(struct device *dev, struct device_attribute *attr, char *buf) { struct ssp_data *data = dev_get_drvdata(dev); ssp_dbg("[SSP]: uProxThresh = %u\n", data->uProxHiThresh); return sprintf(buf, "%u\n", data->uProxHiThresh); } static ssize_t proximity_thresh_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t size) { u8 uNewThresh = 0x09; int iRet = 0; struct ssp_data *data = dev_get_drvdata(dev); iRet = kstrtou8(buf, 10, &uNewThresh); if (iRet < 0) pr_err("[SSP]: %s - kstrtoint failed.", __func__); data->uProxHiThresh = uNewThresh; set_proximity_threshold(data, data->uProxHiThresh, data->uProxCanc); ssp_dbg("[SSP]: %s - new prox threshold = 0x%x\n", __func__, data->uProxHiThresh); return size; } static ssize_t barcode_emul_enable_show(struct device *dev, struct device_attribute *attr, char *buf) { struct ssp_data *data = dev_get_drvdata(dev); return snprintf(buf, PAGE_SIZE, "%u\n", data->bBarcodeEnabled); } static ssize_t barcode_emul_enable_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t size) { int iRet; int64_t dEnable; struct ssp_data *data = dev_get_drvdata(dev); iRet = strict_strtoll(buf, 10, &dEnable); if (iRet < 0) return iRet; if (dEnable) set_proximity_barcode_enable(data, true); else set_proximity_barcode_enable(data, false); return size; } static DEVICE_ATTR(vendor, S_IRUGO, prox_vendor_show, NULL); static DEVICE_ATTR(name, S_IRUGO, prox_name_show, NULL); static DEVICE_ATTR(state, S_IRUGO, proximity_state_show, NULL); static DEVICE_ATTR(barcode_emul_en, S_IRUGO | S_IWUSR | S_IWGRP, barcode_emul_enable_show, barcode_emul_enable_store); static DEVICE_ATTR(prox_avg, S_IRUGO | S_IWUSR | S_IWGRP, proximity_avg_show, proximity_avg_store); static DEVICE_ATTR(prox_cal, S_IRUGO | S_IWUSR | S_IWGRP, proximity_cancel_show, proximity_cancel_store); static DEVICE_ATTR(prox_thresh, S_IRUGO | S_IWUSR | S_IWGRP, proximity_thresh_show, proximity_thresh_store); static struct device_attribute *prox_attrs[] = { &dev_attr_vendor, &dev_attr_name, &dev_attr_state, &dev_attr_prox_avg, &dev_attr_prox_cal, &dev_attr_prox_thresh, &dev_attr_barcode_emul_en, NULL, }; void initialize_prox_factorytest(struct ssp_data *data) { sensors_register(data->prox_device, data, prox_attrs, "proximity_sensor"); } void remove_prox_factorytest(struct ssp_data *data) { sensors_unregister(data->prox_device, prox_attrs); }