kernel_samsung_a34x-permissive/drivers/fingerprint/el7xx-spi.c

1153 lines
28 KiB
C
Raw Normal View History

/*
* Copyright (C) 2016 Samsung Electronics. 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
* version 2 as published by the Free Software Foundation.
*
* 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 "fingerprint.h"
#include "el7xx.h"
#include <linux/fs.h>
#include <linux/init.h>
#include <linux/sched.h>
#include <linux/io.h>
#include <linux/platform_device.h>
#include <linux/cdev.h>
#include <linux/miscdevice.h>
#include <linux/gpio.h>
#include <linux/of_gpio.h>
#include <linux/sysfs.h>
struct debug_logger *g_logger;
static void el7xx_reset(struct el7xx_data *etspi)
{
pr_info("Entry\n");
if (etspi->sleepPin) {
gpio_set_value(etspi->sleepPin, 0);
usleep_range(1050, 1100);
gpio_set_value(etspi->sleepPin, 1);
etspi->reset_count++;
}
}
static void el7xx_reset_control(struct el7xx_data *etspi, int status)
{
pr_debug("Entry\n");
if (etspi->sleepPin)
gpio_set_value(etspi->sleepPin, status);
}
void el7xx_pin_control(struct el7xx_data *etspi, bool pin_set)
{
int retval = 0;
if (IS_ERR(etspi->p))
return;
etspi->p->state = NULL;
if (pin_set) {
if (!IS_ERR(etspi->pins_poweron)) {
retval = pinctrl_select_state(etspi->p, etspi->pins_poweron);
if (retval)
pr_err("can't set pin default state : %d\n", retval);
pr_info("idle\n");
}
} else {
if (!IS_ERR(etspi->pins_poweroff)) {
retval = pinctrl_select_state(etspi->p, etspi->pins_poweroff);
if (retval)
pr_err("can't set pin sleep state : %d\n", retval);
pr_info("sleep\n");
}
}
}
static void el7xx_power_control(struct el7xx_data *etspi, int status)
{
int retval = 0;
if (etspi->ldo_enabled == status) {
pr_err("called duplicate\n");
return;
}
pr_info("status = %d\n", status);
if (status == 1) {
if (etspi->regulator_3p3) {
retval = regulator_enable(etspi->regulator_3p3);
if (retval) {
pr_err("regulator enable failed rc=%d\n", retval);
goto regulator_failed;
}
etspi->ldo_enabled = 1;
usleep_range(2300, 2350);
} else if (etspi->ldo_pin) {
gpio_set_value(etspi->ldo_pin, 1);
etspi->ldo_enabled = 1;
usleep_range(2100, 2150);
}
if (etspi->sleepPin) {
gpio_set_value(etspi->sleepPin, 1);
usleep_range(1100, 1150);
}
el7xx_pin_control(etspi, true);
usleep_range(5000, 5050);
} else if (status == 0) {
el7xx_pin_control(etspi, false);
if (etspi->sleepPin)
gpio_set_value(etspi->sleepPin, 0);
if (etspi->regulator_3p3) {
retval = regulator_disable(etspi->regulator_3p3);
if (retval) {
pr_err("regulator disable failed rc=%d\n", retval);
goto regulator_failed;
}
etspi->ldo_enabled = 0;
} else if (etspi->ldo_pin) {
gpio_set_value(etspi->ldo_pin, 0);
etspi->ldo_enabled = 0;
}
} else {
pr_err("can't support this value. %d\n", status);
}
regulator_failed:
return;
}
static ssize_t el7xx_read(struct file *filp,
char __user *buf,
size_t count,
loff_t *f_pos)
{
return 0;
}
static ssize_t el7xx_write(struct file *filp,
const char __user *buf,
size_t count,
loff_t *f_pos)
{
return 0;
}
static long el7xx_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
{
int retval = 0;
struct el7xx_data *etspi;
u32 tmp;
struct egis_ioc_transfer *ioc = NULL;
#ifndef ENABLE_SENSORS_FPRINT_SECURE
u8 *buf, *address, *result, *fr;
#endif
/* Check type and command number */
if (_IOC_TYPE(cmd) != EGIS_IOC_MAGIC) {
pr_err("_IOC_TYPE(cmd) != EGIS_IOC_MAGIC");
return -ENOTTY;
}
if (!filp || !filp->private_data) {
pr_err("NULL pointer passed\n");
return -EINVAL;
}
if (IS_ERR((void __user *)arg)) {
pr_err("invalid user space pointer %lu\n", arg);
return -EINVAL;
}
/* guard against device removal before, or while,
* we issue this ioctl.
*/
etspi = filp->private_data;
mutex_lock(&etspi->buf_lock);
/* segmented and/or full-duplex I/O request */
if (_IOC_NR(cmd) != _IOC_NR(EGIS_IOC_MESSAGE(0))
|| _IOC_DIR(cmd) != _IOC_WRITE) {
retval = -ENOTTY;
goto el7xx_ioctl_out;
}
tmp = _IOC_SIZE(cmd);
if ((tmp == 0) || (tmp % sizeof(struct egis_ioc_transfer)) != 0) {
pr_err("ioc size error\n");
retval = -EINVAL;
goto el7xx_ioctl_out;
}
/* copy into scratch area */
ioc = kmalloc(tmp, GFP_KERNEL);
if (!ioc) {
retval = -ENOMEM;
goto el7xx_ioctl_out;
}
if (__copy_from_user(ioc, (void __user *)arg, tmp)) {
pr_err("__copy_from_user error\n");
retval = -EFAULT;
goto el7xx_ioctl_out;
}
switch (ioc->opcode) {
#ifndef ENABLE_SENSORS_FPRINT_SECURE
/*
* Read register
* tx_buf include register address will be read
*/
case FP_REGISTER_READ:
address = ioc->tx_buf;
result = ioc->rx_buf;
pr_debug("etspi FP_REGISTER_READ\n");
retval = el7xx_io_read_register(etspi, address, result, ioc);
if (retval < 0)
pr_err("FP_REGISTER_READ error retval = %d\n", retval);
break;
case FP_REGISTER_BREAD:
pr_debug("FP_REGISTER_BREAD\n");
retval = el7xx_io_burst_read_register(etspi, ioc);
if (retval < 0)
pr_err("FP_REGISTER_BREAD error retval = %d\n", retval);
break;
case FP_REGISTER_BREAD_BACKWARD:
pr_debug("FP_REGISTER_BREAD_BACKWARD\n");
retval = el7xx_io_burst_read_register_backward(etspi, ioc);
if (retval < 0)
pr_err("FP_REGISTER_BREAD_BACKWARD error retval = %d\n", retval);
break;
/*
* Write data to register
* tx_buf includes address and value will be wrote
*/
case FP_REGISTER_WRITE:
buf = ioc->tx_buf;
pr_debug("FP_REGISTER_WRITE\n");
retval = el7xx_io_write_register(etspi, buf, ioc);
if (retval < 0)
pr_err("FP_REGISTER_WRITE error retval = %d\n", retval);
break;
case FP_REGISTER_BWRITE:
pr_debug("FP_REGISTER_BWRITE\n");
retval = el7xx_io_burst_write_register(etspi, ioc);
if (retval < 0)
pr_err("FP_REGISTER_BWRITE error retval = %d\n", retval);
break;
case FP_REGISTER_BWRITE_BACKWARD:
pr_debug("FP_REGISTER_BWRITE_BACKWARD\n");
retval = el7xx_io_burst_write_register_backward(etspi, ioc);
if (retval < 0)
pr_err("FP_REGISTER_BWRITE_BACKWARD error retval = %d\n", retval);
break;
case FP_EFUSE_READ:
pr_debug("FP_EFUSE_READ\n");
retval = el7xx_io_read_efuse(etspi, ioc);
if (retval < 0)
pr_err("FP_EFUSE_READ error retval = %d\n", retval);
break;
case FP_EFUSE_WRITE:
pr_debug("FP_EFUSE_WRITE\n");
retval = el7xx_io_write_efuse(etspi, ioc);
if (retval < 0)
pr_err("FP_EFUSE_WRITE error retval = %d\n", retval);
break;
case FP_GET_IMG:
fr = ioc->rx_buf;
pr_debug("FP_GET_IMG\n");
retval = el7xx_io_get_frame(etspi, fr, ioc->len);
if (retval < 0)
pr_err("FP_GET_IMG error retval = %d\n", retval);
break;
case FP_WRITE_IMG:
fr = ioc->tx_buf;
pr_debug("FP_WRITE_IMG\n");
retval = el7xx_io_write_frame(etspi, fr, ioc->len);
if (retval < 0)
pr_err("FP_WRITE_IMG error retval = %d\n", retval);
break;
case FP_TRANSFER_COMMAND:
pr_debug("FP_TRANSFER_COMMAND\n");
retval = el7xx_io_transfer_command(etspi, ioc->tx_buf, ioc->rx_buf, ioc->len);
if (retval < 0)
pr_err("FP_TRANSFER_COMMAND error retval = %d\n", retval);
break;
case FP_SET_SPI_SETUP_CONF:
pr_info("FP_SET_SPI_SETUP_CONF : %d\n", ioc->len);
el7xx_spi_setup_conf(etspi, ioc->len);
break;
#endif
case FP_SENSOR_RESET:
pr_info("FP_SENSOR_RESET\n");
el7xx_reset(etspi);
break;
case FP_RESET_CONTROL:
pr_info("FP_RESET_CONTROL, status = %d\n", ioc->len);
el7xx_reset_control(etspi, ioc->len);
break;
case FP_POWER_CONTROL:
pr_info("FP_POWER_CONTROL, status = %d\n", ioc->len);
el7xx_power_control(etspi, ioc->len);
break;
case FP_SET_SPI_CLOCK:
pr_info("FP_SET_SPI_CLOCK, clock = %d\n", ioc->speed_hz);
etspi->clk_setting->spi_speed = (unsigned int)ioc->speed_hz;
#ifndef ENABLE_SENSORS_FPRINT_SECURE
etspi->spi->max_speed_hz = ioc->speed_hz;
#endif
spi_clk_enable(etspi->clk_setting);
break;
#ifdef ENABLE_SENSORS_FPRINT_SECURE
case FP_DISABLE_SPI_CLOCK:
pr_info("FP_DISABLE_SPI_CLOCK\n");
spi_clk_disable(etspi->clk_setting);
break;
case FP_CPU_SPEEDUP:
pr_debug("FP_CPU_SPEEDUP\n");
if (ioc->len)
cpu_speedup_enable(etspi->boosting);
else
cpu_speedup_disable(etspi->boosting);
break;
case FP_SET_SENSOR_TYPE:
set_sensor_type((int)ioc->len, &etspi->sensortype);
break;
#endif
case FP_SPI_VALUE:
etspi->spi_value = ioc->len;
pr_info("spi_value: 0x%x\n", etspi->spi_value);
break;
case FP_MODEL_INFO:
pr_info("modelinfo is %s\n", etspi->model_info);
retval = copy_to_user((u8 __user *) (uintptr_t)ioc->rx_buf,
etspi->model_info, 10);
if (retval != 0)
pr_err("FP_IOCTL_MODEL_INFO copy_to_user failed: %d\n", retval);
break;
case FP_IOCTL_RESERVED_01:
case FP_IOCTL_RESERVED_02:
case FP_IOCTL_RESERVED_03:
case FP_IOCTL_RESERVED_04:
case FP_IOCTL_RESERVED_05:
case FP_IOCTL_RESERVED_06:
case FP_IOCTL_RESERVED_07:
break;
default:
retval = -EFAULT;
break;
}
el7xx_ioctl_out:
if (ioc != NULL)
kfree(ioc);
mutex_unlock(&etspi->buf_lock);
if (retval < 0)
pr_err("retval = %d\n", retval);
return retval;
}
#ifdef CONFIG_COMPAT
static long el7xx_compat_ioctl(struct file *filp,
unsigned int cmd,
unsigned long arg)
{
return el7xx_ioctl(filp, cmd, (unsigned long)compat_ptr(arg));
}
#else
#define el7xx_compat_ioctl NULL
#endif /* CONFIG_COMPAT */
static int el7xx_open(struct inode *inode, struct file *filp)
{
struct el7xx_data *etspi;
int retval = -ENXIO;
pr_info("Entry\n");
mutex_lock(&device_list_lock);
list_for_each_entry(etspi, &device_list, device_entry) {
if (etspi->devt == inode->i_rdev) {
retval = 0;
break;
}
}
if (retval == 0) {
etspi->users++;
filp->private_data = etspi;
nonseekable_open(inode, filp);
} else
pr_debug("nothing for minor %d\n", iminor(inode));
mutex_unlock(&device_list_lock);
return retval;
}
static int el7xx_release(struct inode *inode, struct file *filp)
{
struct el7xx_data *etspi;
pr_info("Entry\n");
mutex_lock(&device_list_lock);
etspi = filp->private_data;
filp->private_data = NULL;
/* last close? */
etspi->users--;
if (etspi->users == 0) {
#ifndef ENABLE_SENSORS_FPRINT_SECURE
int dofree;
#endif
/* ... after we unbound from the underlying device? */
#ifndef ENABLE_SENSORS_FPRINT_SECURE
spin_lock_irq(&etspi->spi_lock);
dofree = (etspi->spi == NULL);
spin_unlock_irq(&etspi->spi_lock);
if (dofree)
kfree(etspi);
#endif
}
mutex_unlock(&device_list_lock);
return 0;
}
int el7xx_platformInit(struct el7xx_data *etspi)
{
int retval = 0;
pr_info("Entry\n");
/* gpio setting for ldo, sleep pin */
if (etspi != NULL) {
if (etspi->btp_vdd) {
etspi->regulator_3p3 = regulator_get(NULL, etspi->btp_vdd);
if (IS_ERR(etspi->regulator_3p3)) {
pr_err("regulator get failed\n");
retval = PTR_ERR(etspi->regulator_3p3);
goto el7xx_platformInit_ldo_failed;
}
regulator_set_load(etspi->regulator_3p3, 100000);
pr_info("btp_regulator ok\n");
etspi->ldo_enabled = 0;
} else if (etspi->ldo_pin) {
retval = gpio_request(etspi->ldo_pin, "el7xx_ldo_en");
if (retval < 0) {
pr_err("gpio_request el7xx_ldo_en failed\n");
goto el7xx_platformInit_ldo_failed;
}
gpio_direction_output(etspi->ldo_pin, 0);
etspi->ldo_enabled = 0;
}
retval = gpio_request(etspi->sleepPin, "el7xx_sleep");
if (retval < 0) {
pr_err("gpio_requset el7xx_sleep failed\n");
goto el7xx_platformInit_sleep_failed;
}
gpio_direction_output(etspi->sleepPin, 0);
if (retval < 0) {
pr_err("gpio_direction_output SLEEP failed\n");
retval = -EBUSY;
goto el7xx_platformInit_sleep_failed;
}
if (etspi->sleepPin)
pr_info("sleep value =%d\n", gpio_get_value(etspi->sleepPin));
if (etspi->ldo_pin)
pr_info("ldo en value =%d\n", gpio_get_value(etspi->ldo_pin));
#ifdef ENABLE_SENSORS_FPRINT_SECURE
#if KERNEL_VERSION(4, 19, 188) > LINUX_VERSION_CODE
/* 4.19 R */
wakeup_source_init(etspi->clk_setting->spi_wake_lock, "el7xx_wake_lock");
/* 4.19 Q */
if (!(etspi->clk_setting->spi_wake_lock)) {
etspi->clk_setting->spi_wake_lock = wakeup_source_create("el7xx_wake_lock");
if (etspi->clk_setting->spi_wake_lock)
wakeup_source_add(etspi->clk_setting->spi_wake_lock);
}
#else
/* 5.4 */
etspi->clk_setting->spi_wake_lock = wakeup_source_register(etspi->dev, "el7xx_wake_lock");
#endif
#endif
} else {
retval = -EFAULT;
}
pr_info("successful status=%d\n", retval);
return retval;
el7xx_platformInit_sleep_failed:
if (etspi->sleepPin)
gpio_free(etspi->sleepPin);
if (etspi->ldo_pin)
gpio_free(etspi->ldo_pin);
el7xx_platformInit_ldo_failed:
pr_err("is failed. %d\n", retval);
return retval;
}
void el7xx_platformUninit(struct el7xx_data *etspi)
{
pr_info("Entry\n");
if (etspi != NULL) {
el7xx_pin_control(etspi, false);
if (etspi->regulator_3p3)
regulator_put(etspi->regulator_3p3);
else if (etspi->ldo_pin)
gpio_free(etspi->ldo_pin);
if (etspi->sleepPin)
gpio_free(etspi->sleepPin);
#ifdef ENABLE_SENSORS_FPRINT_SECURE
wakeup_source_unregister(etspi->clk_setting->spi_wake_lock);
#endif
}
}
static int el7xx_parse_dt(struct device *dev, struct el7xx_data *etspi)
{
struct device_node *np = dev->of_node;
enum of_gpio_flags flags;
int retval = 0;
int gpio;
gpio = of_get_named_gpio_flags(np, "etspi-sleepPin", 0, &flags);
if (gpio < 0) {
retval = gpio;
pr_err("fail to get sleepPin\n");
goto dt_exit;
} else {
etspi->sleepPin = gpio;
pr_info("sleepPin=%d\n", etspi->sleepPin);
}
gpio = of_get_named_gpio_flags(np, "etspi-ldoPin", 0, &flags);
if (gpio < 0) {
etspi->ldo_pin = 0;
pr_info("not use ldo_pin\n");
} else {
etspi->ldo_pin = gpio;
pr_info("ldo_pin=%d\n", etspi->ldo_pin);
}
if (of_property_read_string(np, "etspi-regulator", &etspi->btp_vdd) < 0) {
pr_info("not use btp_regulator\n");
etspi->btp_vdd = NULL;
if (gpio < 0) {
retval = gpio;
pr_err("fail to get power\n");
goto dt_exit;
}
}
pr_info("regulator: %s\n", etspi->btp_vdd);
if (of_property_read_u32(np, "etspi-min_cpufreq_limit",
&etspi->boosting->min_cpufreq_limit))
etspi->boosting->min_cpufreq_limit = 0;
if (of_property_read_string_index(np, "etspi-chipid", 0,
(const char **)&etspi->chipid)) {
etspi->chipid = "NULL";
}
pr_info("chipid: %s\n", etspi->chipid);
if (of_property_read_string_index(np, "etspi-modelinfo", 0,
(const char **)&etspi->model_info)) {
etspi->model_info = "NONE";
}
pr_info("modelinfo: %s\n", etspi->model_info);
if (of_property_read_string_index(np, "etspi-position", 0,
(const char **)&etspi->sensor_position)) {
etspi->sensor_position = "0.00,0.00,0.00,0.00,0.00,0.00,0.00,0.00";
}
pr_info("position: %s\n", etspi->sensor_position);
if (of_property_read_string_index(np, "etspi-rb", 0,
(const char **)&etspi->rb)) {
etspi->rb = "525,-1,-1";
}
pr_info("rb: %s\n", etspi->rb);
etspi->p = pinctrl_get_select_default(dev);
if (IS_ERR(etspi->p)) {
retval = PTR_ERR(etspi->p);
pr_err("failed pinctrl_get\n");
goto dt_exit;
}
#if !defined(ENABLE_SENSORS_FPRINT_SECURE) || defined(DISABLED_GPIO_PROTECTION)
etspi->pins_poweroff = pinctrl_lookup_state(etspi->p, "pins_poweroff");
if (IS_ERR(etspi->pins_poweroff)) {
pr_err("could not get pins sleep_state (%li)\n",
PTR_ERR(etspi->pins_poweroff));
}
etspi->pins_poweron = pinctrl_lookup_state(etspi->p, "pins_poweron");
if (IS_ERR(etspi->pins_poweron)) {
pr_err("could not get pins idle_state (%li)\n",
PTR_ERR(etspi->pins_poweron));
}
#endif
el7xx_pin_control(etspi, false);
pr_info("is successful\n");
return retval;
dt_exit:
pr_err("is failed. %d\n", retval);
return retval;
}
static const struct file_operations el7xx_fops = {
.owner = THIS_MODULE,
.write = el7xx_write,
.read = el7xx_read,
.unlocked_ioctl = el7xx_ioctl,
.compat_ioctl = el7xx_compat_ioctl,
.open = el7xx_open,
.release = el7xx_release,
.llseek = no_llseek,
};
#ifndef ENABLE_SENSORS_FPRINT_SECURE
static int el7xx_type_check(struct el7xx_data *etspi)
{
u8 buf1, buf2, buf3;
el7xx_power_control(etspi, 1);
msleep(20);
el7xx_read_register(etspi, 0x00, &buf1);
el7xx_read_register(etspi, 0x01, &buf2);
el7xx_read_register(etspi, 0x02, &buf3);
el7xx_power_control(etspi, 0);
pr_info("buf1-3: %x, %x, %x\n", buf1, buf2, buf3);
/*
* type check return value
* EL721 : 0x07 / 0x15
*/
if ((buf1 == 0x07) && (buf2 == 0x15)) {
etspi->sensortype = SENSOR_OK;
pr_info("sensor type is EGIS EL721 sensor\n");
} else {
etspi->sensortype = SENSOR_FAILED;
pr_info("sensor type is FAILED\n");
return -ENODEV;
}
return 0;
}
#endif
static ssize_t bfs_values_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct el7xx_data *data = dev_get_drvdata(dev);
return snprintf(buf, PAGE_SIZE, "\"FP_SPICLK\":\"%d\"\n",
data->clk_setting->spi_speed);
}
static ssize_t type_check_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct el7xx_data *data = dev_get_drvdata(dev);
#ifndef ENABLE_SENSORS_FPRINT_SECURE
int retry = 0;
int retval = 0;
do {
retval = el7xx_type_check(data);
pr_info("type (%u), retry (%d)\n",
data->sensortype, retry);
} while (!data->sensortype && ++retry < 3);
if (retval == -ENODEV)
pr_info("type check fail\n");
#endif
return snprintf(buf, PAGE_SIZE, "%d\n", data->sensortype);
}
static ssize_t vendor_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
return snprintf(buf, PAGE_SIZE, "%s\n", VENDOR);
}
static ssize_t name_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct el7xx_data *etspi = dev_get_drvdata(dev);
return snprintf(buf, PAGE_SIZE, "%s\n", etspi->chipid);
}
static ssize_t adm_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
return snprintf(buf, PAGE_SIZE, "%d\n", DETECT_ADM);
}
static ssize_t position_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct el7xx_data *etspi = dev_get_drvdata(dev);
return snprintf(buf, PAGE_SIZE, "%s\n", etspi->sensor_position);
}
static ssize_t rb_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct el7xx_data *etspi = dev_get_drvdata(dev);
return snprintf(buf, PAGE_SIZE, "%s\n", etspi->rb);
}
static ssize_t resetcnt_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct el7xx_data *etspi = dev_get_drvdata(dev);
return snprintf(buf, PAGE_SIZE, "%d\n", etspi->reset_count);
}
static ssize_t resetcnt_store(struct device *dev,
struct device_attribute *attr, const char *buf,
size_t size)
{
struct el7xx_data *etspi = dev_get_drvdata(dev);
if (sysfs_streq(buf, "c")) {
etspi->reset_count = 0;
pr_info("initialization is done\n");
}
return size;
}
static DEVICE_ATTR_RO(bfs_values);
static DEVICE_ATTR_RO(type_check);
static DEVICE_ATTR_RO(vendor);
static DEVICE_ATTR_RO(name);
static DEVICE_ATTR_RO(adm);
static DEVICE_ATTR_RW(resetcnt);
static DEVICE_ATTR_RO(position);
static DEVICE_ATTR_RO(rb);
static struct device_attribute *fp_attrs[] = {
&dev_attr_bfs_values,
&dev_attr_type_check,
&dev_attr_vendor,
&dev_attr_name,
&dev_attr_adm,
&dev_attr_resetcnt,
&dev_attr_position,
&dev_attr_rb,
NULL,
};
static void el7xx_work_func_debug(struct work_struct *work)
{
struct debug_logger *logger;
struct el7xx_data *etspi;
logger = container_of(work, struct debug_logger, work_debug);
etspi = dev_get_drvdata(logger->dev);
pr_info("ldo: %d, sleep: %d, tz: %d, spi_value: 0x%x, type: %s\n",
etspi->ldo_enabled, gpio_get_value(etspi->sleepPin),
etspi->tz_mode, etspi->spi_value,
etspi->sensortype > 0 ? etspi->chipid : sensor_status[etspi->sensortype + 2]);
}
static struct el7xx_data *alloc_platformdata(struct device *dev)
{
struct el7xx_data *etspi;
etspi = devm_kzalloc(dev, sizeof(struct el7xx_data), GFP_KERNEL);
if (etspi == NULL)
return NULL;
etspi->clk_setting = devm_kzalloc(dev, sizeof(*etspi->clk_setting), GFP_KERNEL);
if (etspi->clk_setting == NULL)
return NULL;
etspi->boosting = devm_kzalloc(dev, sizeof(*etspi->boosting), GFP_KERNEL);
if (etspi->boosting == NULL)
return NULL;
etspi->logger = devm_kzalloc(dev, sizeof(*etspi->logger), GFP_KERNEL);
if (etspi->logger == NULL)
return NULL;
return etspi;
}
static struct class *el7xx_class;
static int el7xx_probe_common(struct device *dev, struct el7xx_data *etspi)
{
int retval;
unsigned long minor;
#ifndef ENABLE_SENSORS_FPRINT_SECURE
int retry = 0;
#endif
pr_info("Entry\n");
/* Initialize the driver data */
etspi->dev = dev;
etspi->logger->dev = dev;
dev_set_drvdata(dev, etspi);
spin_lock_init(&etspi->spi_lock);
mutex_init(&etspi->buf_lock);
mutex_init(&device_list_lock);
INIT_LIST_HEAD(&etspi->device_entry);
/* device tree call */
if (dev->of_node) {
retval = el7xx_parse_dt(dev, etspi);
if (retval) {
pr_err("Failed to parse DT\n");
goto el7xx_probe_parse_dt_failed;
}
}
/* platform init */
retval = el7xx_platformInit(etspi);
if (retval != 0) {
pr_err("platforminit failed\n");
goto el7xx_probe_platformInit_failed;
}
retval = spi_clk_register(etspi->clk_setting, dev);
if (retval < 0) {
pr_err("register spi clk failed\n");
goto el7xx_probe_spi_clk_register_failed;
}
etspi->reset_count = 0;
etspi->clk_setting->enabled_clk = false;
etspi->spi_value = 0;
etspi->clk_setting->spi_speed = (unsigned int)SLOW_BAUD_RATE;
#ifndef ENABLE_SENSORS_FPRINT_SECURE
do {
retval = el7xx_type_check(etspi);
pr_info("type (%u), retry (%d)\n", etspi->sensortype, retry);
} while (!etspi->sensortype && ++retry < 3);
if (retval == -ENODEV)
pr_info("type check fail\n");
#endif
/* If we can allocate a minor number, hook up this device.
* Reusing minors is fine so long as udev or mdev is working.
*/
mutex_lock(&device_list_lock);
minor = find_first_zero_bit(minors, N_SPI_MINORS);
if (minor < N_SPI_MINORS) {
struct device *dev_t;
etspi->devt = MKDEV(EL7XX_MAJOR, minor);
dev_t = device_create(el7xx_class, dev,
etspi->devt, etspi, "esfp0");
retval = IS_ERR(dev_t) ? PTR_ERR(dev_t) : 0;
} else {
pr_err("no minor number available!\n");
retval = -ENODEV;
mutex_unlock(&device_list_lock);
goto el7xx_device_create_failed;
}
if (retval == 0) {
set_bit(minor, minors);
list_add(&etspi->device_entry, &device_list);
}
mutex_unlock(&device_list_lock);
retval = fingerprint_register(etspi->fp_device,
etspi, fp_attrs, "fingerprint");
if (retval) {
pr_err("sysfs register failed\n");
goto el7xx_register_failed;
}
g_logger = etspi->logger;
retval = set_fp_debug_timer(etspi->logger, el7xx_work_func_debug);
if (retval)
goto el7xx_sysfs_failed;
enable_fp_debug_timer(etspi->logger);
pr_info("is successful\n");
return retval;
el7xx_sysfs_failed:
fingerprint_unregister(etspi->fp_device, fp_attrs);
el7xx_register_failed:
device_destroy(el7xx_class, etspi->devt);
class_destroy(el7xx_class);
el7xx_device_create_failed:
spi_clk_unregister(etspi->clk_setting);
el7xx_probe_spi_clk_register_failed:
el7xx_platformUninit(etspi);
el7xx_probe_platformInit_failed:
el7xx_probe_parse_dt_failed:
pr_err("is failed : %d\n", retval);
return retval;
}
#ifdef ENABLE_SENSORS_FPRINT_SECURE
static int el7xx_probe(struct platform_device *pdev)
{
int retval = -ENOMEM;
struct el7xx_data *etspi;
pr_info("Platform_device Entry\n");
etspi = alloc_platformdata(&pdev->dev);
if (etspi == NULL)
goto el7xx_platform_alloc_failed;
etspi->sensortype = SENSOR_UNKNOWN;
etspi->tz_mode = true;
retval = el7xx_probe_common(&pdev->dev, etspi);
if (retval)
goto el7xx_platform_probe_failed;
pr_info("is successful\n");
return retval;
el7xx_platform_probe_failed:
etspi = NULL;
el7xx_platform_alloc_failed:
pr_err("is failed : %d\n", retval);
return retval;
}
#else
static int el7xx_probe(struct spi_device *spi)
{
int retval = -ENOMEM;
struct el7xx_data *etspi;
pr_info("spi_device Entry\n");
etspi = alloc_platformdata(&spi->dev);
if (etspi == NULL)
goto el7xx_spi_alloc_failed;
spi->bits_per_word = 8;
etspi->prev_bits_per_word = 8;
spi->max_speed_hz = SLOW_BAUD_RATE;
spi->mode = SPI_MODE_0;
spi->chip_select = 0;
etspi->spi = spi;
etspi->tz_mode = false;
spi_get_ctrldata(spi);
retval = spi_setup(spi);
if (retval != 0) {
pr_err("spi_setup() is failed. status : %d\n", retval);
goto el7xx_spi_set_setup_failed;
}
/* init transfer buffer */
retval = el7xx_init_buffer(etspi);
if (retval < 0) {
pr_err("Failed to Init transfer buffer.\n");
goto el7xx_spi_init_buffer_failed;
}
retval = el7xx_probe_common(&spi->dev, etspi);
if (retval)
goto el7xx_spi_probe_failed;
pr_info("is successful\n");
return retval;
el7xx_spi_probe_failed:
el7xx_free_buffer(etspi);
el7xx_spi_init_buffer_failed:
el7xx_spi_set_setup_failed:
etspi = NULL;
el7xx_spi_alloc_failed:
pr_err("is failed : %d\n", retval);
return retval;
}
#endif
static int el7xx_remove_common(struct device *dev)
{
struct el7xx_data *etspi = dev_get_drvdata(dev);
pr_info("Entry\n");
if (etspi != NULL) {
disable_fp_debug_timer(etspi->logger);
el7xx_platformUninit(etspi);
spi_clk_unregister(etspi->clk_setting);
/* make sure ops on existing fds can abort cleanly */
spin_lock_irq(&etspi->spi_lock);
etspi->spi = NULL;
spin_unlock_irq(&etspi->spi_lock);
/* prevent new opens */
mutex_lock(&device_list_lock);
fingerprint_unregister(etspi->fp_device, fp_attrs);
list_del(&etspi->device_entry);
device_destroy(el7xx_class, etspi->devt);
clear_bit(MINOR(etspi->devt), minors);
if (etspi->users == 0)
etspi = NULL;
mutex_unlock(&device_list_lock);
}
return 0;
}
#ifndef ENABLE_SENSORS_FPRINT_SECURE
#if LINUX_VERSION_CODE > KERNEL_VERSION(6, 1, 0)
static void el7xx_remove(struct spi_device *spi)
{
struct el7xx_data *etspi = spi_get_drvdata(spi);
el7xx_free_buffer(etspi);
el7xx_remove_common(&spi->dev);
return;
}
#else
static int el7xx_remove(struct spi_device *spi)
{
struct el7xx_data *etspi = spi_get_drvdata(spi);
el7xx_free_buffer(etspi);
el7xx_remove_common(&spi->dev);
return 0;
}
#endif /* LINUX_VERSION_CODE */
#else
static int el7xx_remove(struct platform_device *pdev)
{
el7xx_remove_common(&pdev->dev);
return 0;
}
#endif /* ENABLE_SENSORS_FPRINT_SECURE */
static int el7xx_pm_suspend(struct device *dev)
{
struct el7xx_data *etspi = dev_get_drvdata(dev);
pr_info("Entry\n");
disable_fp_debug_timer(etspi->logger);
return 0;
}
static int el7xx_pm_resume(struct device *dev)
{
struct el7xx_data *etspi = dev_get_drvdata(dev);
pr_info("Entry\n");
enable_fp_debug_timer(etspi->logger);
return 0;
}
static const struct dev_pm_ops el7xx_pm_ops = {
.suspend = el7xx_pm_suspend,
.resume = el7xx_pm_resume
};
static const struct of_device_id el7xx_match_table[] = {
{.compatible = "etspi,el7xx",},
{},
};
#ifndef ENABLE_SENSORS_FPRINT_SECURE
static struct spi_driver el7xx_spi_driver = {
#else
static struct platform_driver el7xx_spi_driver = {
#endif
.driver = {
.name = "egis_fingerprint",
.owner = THIS_MODULE,
.pm = &el7xx_pm_ops,
.of_match_table = el7xx_match_table
},
.probe = el7xx_probe,
.remove = el7xx_remove,
};
/*-------------------------------------------------------------------------*/
static int __init el7xx_init(void)
{
int retval = 0;
pr_info("Entry\n");
/* Claim our 256 reserved device numbers. Then register a class
* that will key udev/mdev to add/remove /dev nodes. Last, register
* the driver which manages those device numbers.
*/
BUILD_BUG_ON(N_SPI_MINORS > 256);
retval = register_chrdev(EL7XX_MAJOR, "egis_fingerprint", &el7xx_fops);
if (retval < 0) {
pr_err("register_chrdev error.status:%d\n", retval);
return retval;
}
el7xx_class = class_create(THIS_MODULE, "egis_fingerprint");
if (IS_ERR(el7xx_class)) {
pr_err("class_create error.\n");
unregister_chrdev(EL7XX_MAJOR, el7xx_spi_driver.driver.name);
return PTR_ERR(el7xx_class);
}
#ifndef ENABLE_SENSORS_FPRINT_SECURE
retval = spi_register_driver(&el7xx_spi_driver);
#else
retval = platform_driver_register(&el7xx_spi_driver);
#endif
if (retval < 0) {
pr_err("register_driver error.\n");
class_destroy(el7xx_class);
unregister_chrdev(EL7XX_MAJOR, el7xx_spi_driver.driver.name);
return retval;
}
pr_info("is successful\n");
return retval;
}
static void __exit el7xx_exit(void)
{
pr_info("Entry\n");
#ifndef ENABLE_SENSORS_FPRINT_SECURE
spi_unregister_driver(&el7xx_spi_driver);
#else
platform_driver_unregister(&el7xx_spi_driver);
#endif
class_destroy(el7xx_class);
unregister_chrdev(EL7XX_MAJOR, el7xx_spi_driver.driver.name);
}
module_init(el7xx_init);
module_exit(el7xx_exit);
MODULE_AUTHOR("fp.sec@samsung.com");
MODULE_DESCRIPTION("Samsung Electronics Inc. EL7XX driver");
MODULE_LICENSE("GPL");