aubrey/kernel_samsung_a34x-permissive
1
0
Fork 0
Code Issues Pull requests Actions Packages Projects Releases Wiki Activity
kernel_samsung_a34x-permissive/drivers/nfc/ese_p3.c
Fede2782 6db4831e98
Import A346BXXU4BWK2 kernel source 
Android 14
2024-04-28 15:51:13 +02:00

1166 lines
27 KiB
C
Raw Blame History

/*
* Copyright (C) 2015 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 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.
*
* You should have received a copy of the GNU General Public License
* along with this program;
*
*/
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/slab.h>
#include <linux/init.h>
#include <linux/device.h>
#include <linux/list.h>
#include <linux/irq.h>
#include <linux/jiffies.h>
#include <linux/uaccess.h>
#include <linux/delay.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/platform_device.h>
#include <linux/gpio.h>
#include <linux/miscdevice.h>
#include <linux/spinlock.h>
#include <linux/spi/spi.h>
#include <linux/sched.h>
#include <linux/poll.h>
#include <linux/regulator/consumer.h>
#include <linux/ioctl.h>
#ifdef CONFIG_OF
#include <linux/of_gpio.h>
#endif
#include <linux/platform_data/spi-s3c64xx.h>
#include <linux/pm_runtime.h>
#include <linux/spi/spidev.h>
#include <linux/clk.h>
#ifdef CONFIG_ESE_USE_TZ_API
#include <linux/smc.h>
#include "../misc/tzdev/include/tzdev/tee_client_api.h"
#endif
#ifdef CONFIG_SPI_QCOM_GENI
#include <linux/spi/spi-geni-qcom.h>
#endif
#include "nfc_wakelock.h"
#include "ese_p3.h"
#ifdef CONFIG_SEC_NFC_LOGGER
#include "./nfc_logger/nfc_logger.h"
#endif
#define SPI_DEFAULT_SPEED 6500000L
static int ese_param_support = -1;
module_param(ese_param_support, int, 0440);
#if defined(CONFIG_ESE_SECURE) && defined(CONFIG_ESE_USE_TZ_API)
static TEEC_UUID ese_drv_uuid = {
0x00000000, 0x0000, 0x0000, {0x00, 0x00, 0x65, 0x73, 0x65, 0x44, 0x72, 0x76}
};
enum pm_mode {
PM_SUSPEND,
PM_RESUME,
SECURE_CHECK,
};
enum secure_state {
NOT_CHECKED,
ESE_SECURED,
ESE_NOT_SECURED,
};
#endif
/* size of maximum read/write buffer supported by driver */
#define MAX_BUFFER_SIZE 260U
/* Different driver debug lever */
enum P3_DEBUG_LEVEL {
P3_DEBUG_OFF,
P3_FULL_DEBUG
};
#ifdef CONFIG_SEC_NFC_LOGGER
/* Variable to store current debug level request by ioctl */
static unsigned char debug_level = P3_FULL_DEBUG;
#define P3_DBG_MSG(msg...) do { \
switch (debug_level) { \
case P3_DEBUG_OFF: \
break; \
case P3_FULL_DEBUG: \
NFC_LOG_INFO("[ESE-P3] : " msg); \
break; \
/*fallthrough*/ \
default: \
NFC_LOG_ERR("[ESE-P3] : debug level %d", debug_level);\
break; \
}; \
} while (0)
#define P3_ERR_MSG(msg...) NFC_LOG_ERR("[ESE-P3] : " msg)
#define P3_INFO_MSG(msg...) NFC_LOG_INFO("[ESE-P3] : " msg)
#else
/* Variable to store current debug level request by ioctl */
static unsigned char debug_level = P3_FULL_DEBUG;
#define P3_DBG_MSG(msg...) do { \
switch (debug_level) { \
case P3_DEBUG_OFF: \
break; \
case P3_FULL_DEBUG: \
pr_info("[ESE-P3] : " msg); \
break; \
/*fallthrough*/ \
default: \
pr_err("[ESE-P3] : debug level %d", debug_level);\
break; \
}; \
} while (0)
#define P3_ERR_MSG(msg...) pr_err("[ESE-P3] : " msg)
#define P3_INFO_MSG(msg...) pr_info("[ESE-P3] : " msg)
#endif
static DEFINE_MUTEX(device_list_lock);
/* Device specific macro and structure */
struct p3_data {
wait_queue_head_t read_wq; /* wait queue for read interrupt */
struct mutex buffer_mutex; /* buffer mutex */
struct spi_device *spi; /* spi device structure */
struct miscdevice p3_device; /* char device as misc driver */
unsigned int users;
bool device_opened;
#ifdef FEATURE_ESE_WAKELOCK
struct nfc_wake_lock ese_lock;
#endif
unsigned long speed;
const char *vdd_1p8;
#ifdef CONFIG_ESE_USE_TZ_API
int cs_gpio;
#ifdef CONFIG_ESE_SECURE
struct clk *ese_spi_pclk;
struct clk *ese_spi_sclk;
int ese_secure_check;
#endif
#endif
struct regulator *ese_pvdd;
unsigned char *tx_buffer;
unsigned char *rx_buffer;
bool pwr_always_on;
enum coldrst_type coldrst_type;
};
#ifdef CONFIG_MAKE_NODE_USING_PLATFORM_DEVICE
struct p3_data *g_p3_dev;
#endif
#ifndef CONFIG_ESE_SECURE
static void p3_pinctrl_config(struct p3_data *data, bool onoff)
{
struct spi_device *spi = data->spi;
struct device *spi_dev = spi->dev.parent->parent;
struct pinctrl *pinctrl = NULL;
P3_INFO_MSG("%s: %s\n", __func__, onoff ? "on" : "off");
if (onoff) {
/* ON */
pinctrl = devm_pinctrl_get_select(spi_dev, "ese_active");
if (IS_ERR_OR_NULL(pinctrl))
P3_ERR_MSG("%s: Failed to configure ese pin\n", __func__);
else
devm_pinctrl_put(pinctrl);
} else {
/* OFF */
pinctrl = devm_pinctrl_get_select(spi_dev, "ese_suspend");
if (IS_ERR_OR_NULL(pinctrl))
P3_ERR_MSG("%s: Failed to configure ese pin\n", __func__);
else
devm_pinctrl_put(pinctrl);
}
}
#endif
#ifdef CONFIG_ESE_USE_TZ_API
#ifdef CONFIG_ESE_SECURE
static uint32_t tz_tee_ese_drv(enum pm_mode mode)
{
TEEC_Context context;
TEEC_Session session;
TEEC_Result result;
uint32_t returnOrigin = TEEC_NONE;
result = TEEC_InitializeContext(NULL, &context);
if (result != TEEC_SUCCESS)
goto out;
result = TEEC_OpenSession(&context, &session, &ese_drv_uuid, TEEC_LOGIN_PUBLIC,
NULL, NULL, &returnOrigin);
if (result != TEEC_SUCCESS)
goto finalize_context;
/* test with valid cmd id, expected result : TEEC_SUCCESS */
result = TEEC_InvokeCommand(&session, mode, NULL, &returnOrigin);
if (result != TEEC_SUCCESS) {
P3_ERR_MSG("%s with cmd %d : FAIL\n", __func__, mode);
goto close_session;
}
P3_ERR_MSG("eSE tz_tee_dev return origin %d\n", returnOrigin);
close_session:
TEEC_CloseSession(&session);
finalize_context:
TEEC_FinalizeContext(&context);
out:
P3_INFO_MSG("cmd %s result=%#x origin=%#x\n", mode ? "Resume" : "Suspend ", result, returnOrigin);
return result;
}
extern int tz_tee_ese_secure_check(void);
int tz_tee_ese_secure_check(void)
{
return tz_tee_ese_drv(SECURE_CHECK);
}
static int p3_clk_control(struct p3_data *data, bool onoff)
{
static bool old_value;
if (old_value == onoff)
return 0;
if (onoff == true) {
clk_prepare_enable(data->ese_spi_pclk);
clk_prepare_enable(data->ese_spi_sclk);
/* There is a quarter-multiplier before the USI_v2 SPI */
clk_set_rate(data->ese_spi_sclk, data->speed * 4);
usleep_range(5000, 5100);
P3_DBG_MSG("%s clock:%lu\n", __func__, clk_get_rate(data->ese_spi_sclk));
} else {
clk_disable_unprepare(data->ese_spi_pclk);
clk_disable_unprepare(data->ese_spi_sclk);
}
old_value = onoff;
P3_INFO_MSG("clock %s\n", onoff ? "enabled" : "disabled");
return 0;
}
static int p3_clk_setup(struct device *dev, struct p3_data *data)
{
data->ese_spi_pclk = clk_get(dev, "pclk");
if (IS_ERR(data->ese_spi_pclk)) {
P3_ERR_MSG("Can't get %s\n", "pclk");
data->ese_spi_pclk = NULL;
goto err_pclk_get;
}
data->ese_spi_sclk = clk_get(dev, "sclk");
if (IS_ERR(data->ese_spi_sclk)) {
P3_ERR_MSG("Can't get %s\n", "sclk");
data->ese_spi_sclk = NULL;
goto err_sclk_get;
}
return 0;
err_sclk_get:
clk_put(data->ese_spi_pclk);
err_pclk_get:
return -EPERM;
}
#endif
#endif
static int p3_regulator_onoff(struct p3_data *data, int onoff)
{
int rc = 0;
struct regulator *regulator_ese_pvdd = data->ese_pvdd;
if (!regulator_ese_pvdd) {
P3_ERR_MSG("%s - null regulator!\n", __func__);
goto done;
}
P3_DBG_MSG("%s - onoff = %d\n", __func__, onoff);
if (onoff == 1) {
regulator_set_voltage(regulator_ese_pvdd, 1800000, 1800000);
rc = regulator_enable(regulator_ese_pvdd);
if (rc) {
P3_ERR_MSG("%s - enable vdd_1p8 failed, rc=%d\n",
__func__, rc);
goto done;
}
msleep(20);
} else {
rc = regulator_disable(regulator_ese_pvdd);
if (rc) {
P3_ERR_MSG("%s - disable vdd_1p8 failed, rc=%d\n",
__func__, rc);
goto done;
}
}
P3_DBG_MSG("success\n");
done:
return rc;
}
#ifndef CONFIG_ESE_SECURE
static int p3_xfer(struct p3_data *p3_device, struct p3_ioctl_transfer *tr)
{
int status = 0;
struct spi_message m;
struct spi_transfer t;
unsigned char *tx_buffer;
unsigned char *rx_buffer;
P3_DBG_MSG("%s\n", __func__);
if (p3_device == NULL || tr == NULL)
return -EFAULT;
tx_buffer = p3_device->tx_buffer;
rx_buffer = p3_device->rx_buffer;
memset(tx_buffer, 0x0, sizeof(char)*MAX_BUFFER_SIZE);
memset(rx_buffer, 0x0, sizeof(char)*MAX_BUFFER_SIZE);
if (tr->len > MAX_BUFFER_SIZE || !tr->len) {
P3_ERR_MSG("%s invalid size\n", __func__);
return -EMSGSIZE;
}
if (tr->tx_buffer != NULL) {
if (copy_from_user(tx_buffer,
tr->tx_buffer, tr->len) != 0)
return -EFAULT;
}
spi_message_init(&m);
memset(&t, 0, sizeof(t));
t.tx_buf = tx_buffer;
t.rx_buf = rx_buffer;
t.len = tr->len;
spi_message_add_tail(&t, &m);
status = spi_sync(p3_device->spi, &m);
if (status == 0) {
if (tr->rx_buffer != NULL) {
unsigned int missing = 0;
missing = (unsigned int)copy_to_user(tr->rx_buffer,
rx_buffer, tr->len);
if (missing != 0)
tr->len = tr->len - missing;
}
}
P3_INFO_MSG("%s, length=%d\n", __func__, tr->len);
return status;
} /* vfsspi_xfer */
static int p3_rw_spi_message(struct p3_data *p3_device,
unsigned long arg)
{
struct p3_ioctl_transfer *dup = NULL;
int err = 0;
dup = kmalloc(sizeof(struct p3_ioctl_transfer), GFP_KERNEL);
if (dup == NULL)
return -ENOMEM;
if (copy_from_user(dup, (void *)arg,
sizeof(struct p3_ioctl_transfer)) != 0) {
kfree(dup);
return -EFAULT;
}
err = p3_xfer(p3_device, dup);
if (err != 0) {
kfree(dup);
P3_ERR_MSG("%s xfer failed!\n", __func__);
return err;
}
/*P3_ERR_MSG("%s len:%u\n", __func__, dup->len);*/
if (copy_to_user((void *)arg, dup,
sizeof(struct p3_ioctl_transfer)) != 0) {
kfree(dup);
return -EFAULT;
}
kfree(dup);
return 0;
}
#endif
#ifdef CONFIG_ESE_COLDRESET
#if !IS_ENABLED(CONFIG_SAMSUNG_ESE_ONLY)
extern int trig_nfc_wakeup(void);
extern int trig_nfc_sleep(void);
#endif
#endif
static int spip3_open(struct inode *inode, struct file *filp)
{
#ifdef CONFIG_MAKE_NODE_USING_PLATFORM_DEVICE
struct p3_data *p3_dev = g_p3_dev;
#else
struct p3_data *p3_dev = container_of(filp->private_data, struct p3_data, p3_device);
#endif
int ret = 0;
if (p3_dev == NULL) {
P3_ERR_MSG("%s: spi probe is not called\n", __func__);
return -EAGAIN;
}
#if defined(CONFIG_ESE_SECURE) && defined(CONFIG_ESE_USE_TZ_API)
if (p3_dev->ese_secure_check == NOT_CHECKED) {
ret = tz_tee_ese_secure_check();
if (ret) {
p3_dev->ese_secure_check = ESE_NOT_SECURED;
P3_ERR_MSG("eSE spi is not Secured\n");
return -EBUSY;
}
p3_dev->ese_secure_check = ESE_SECURED;
} else if (p3_dev->ese_secure_check == ESE_NOT_SECURED) {
P3_ERR_MSG("eSE spi is not Secured\n");
return -EBUSY;
}
#endif
/* for defence MULTI-OPEN */
if (p3_dev->device_opened) {
P3_ERR_MSG("%s - ALREADY opened!\n", __func__);
return -EBUSY;
}
#ifdef CONFIG_ESE_COLDRESET
#if !IS_ENABLED(CONFIG_SAMSUNG_ESE_ONLY)
trig_nfc_wakeup();
#endif
#endif
mutex_lock(&device_list_lock);
p3_dev->device_opened = true;
P3_INFO_MSG("open\n");
#ifdef FEATURE_ESE_WAKELOCK
wake_lock(&p3_dev->ese_lock);
#endif
#ifdef CONFIG_ESE_USE_TZ_API
#ifdef CONFIG_ESE_SECURE
p3_clk_control(p3_dev, true);
tz_tee_ese_drv(PM_RESUME);
#else
p3_pinctrl_config(p3_dev, true);
#endif
#endif
if (!p3_dev->pwr_always_on) {
ret = p3_regulator_onoff(p3_dev, 1);
if (ret < 0)
P3_ERR_MSG("%s : failed to turn on LDO()\n", __func__);
usleep_range(2000, 2500);
}
filp->private_data = p3_dev;
p3_dev->users++;
mutex_unlock(&device_list_lock);
return 0;
}
static int spip3_release(struct inode *inode, struct file *filp)
{
struct p3_data *p3_dev = filp->private_data;
int ret = 0;
if (!p3_dev->device_opened) {
P3_ERR_MSG("%s - was NOT opened....\n", __func__);
return 0;
}
P3_INFO_MSG("%s\n", __func__);
mutex_lock(&device_list_lock);
#ifdef FEATURE_ESE_WAKELOCK
if (wake_lock_active(&p3_dev->ese_lock))
wake_unlock(&p3_dev->ese_lock);
#endif
filp->private_data = p3_dev;
p3_dev->users--;
if (!p3_dev->users) {
p3_dev->device_opened = false;
#ifdef CONFIG_ESE_USE_TZ_API
#ifdef CONFIG_ESE_SECURE
p3_clk_control(p3_dev, false);
tz_tee_ese_drv(PM_SUSPEND);
usleep_range(1000, 1500);
#else
p3_pinctrl_config(p3_dev, false);
#endif
#endif
if (!p3_dev->pwr_always_on) {
ret = p3_regulator_onoff(p3_dev, 0);
if (ret < 0)
P3_ERR_MSG("test: failed to turn off LDO()\n");
}
}
usleep_range(10000, 15000);
mutex_unlock(&device_list_lock);
#ifdef CONFIG_ESE_COLDRESET
#if !IS_ENABLED(CONFIG_SAMSUNG_ESE_ONLY)
trig_nfc_sleep();
#endif
#endif
P3_DBG_MSG("%s, users:%d, Major Minor No:%d %d\n", __func__,
p3_dev->users, imajor(inode), iminor(inode));
return 0;
}
#ifdef CONFIG_ESE_COLDRESET
#if !IS_ENABLED(CONFIG_SAMSUNG_ESE_ONLY)
extern int trig_cold_reset(void);
#endif
static void p3_power_reset(struct p3_data *data)
{
/*Add Reset Sequence here*/
P3_INFO_MSG("%s: start\n", __func__);
#if IS_ENABLED(CONFIG_SAMSUNG_ESE_ONLY)
if (data->coldrst_type == COLDRST_POWER_ONOFF) {
p3_regulator_onoff(data, 0);
msleep(100);
p3_regulator_onoff(data, 1);
}
#else
trig_cold_reset();
#endif
P3_DBG_MSG("%s: end\n", __func__);
}
#endif /* CONFIG_ESE_COLDRESET */
static long spip3_ioctl(struct file *filp, unsigned int cmd,
unsigned long arg)
{
int ret = 0;
struct p3_data *data = NULL;
if (_IOC_TYPE(cmd) != P3_MAGIC) {
P3_ERR_MSG("%s invalid magic. cmd=0x%X Received=0x%X Expected=0x%X\n",
__func__, cmd, _IOC_TYPE(cmd), P3_MAGIC);
return -ENOTTY;
}
data = filp->private_data;
mutex_lock(&data->buffer_mutex);
switch (cmd) {
case P3_SET_DBG:
debug_level = (unsigned char)arg;
P3_INFO_MSG(KERN_INFO"[NXP-P3] - Debug level %d", debug_level);
break;
case P3_ENABLE_SPI_CLK:
P3_INFO_MSG("%s P3_ENABLE_SPI_CLK\n", __func__);
#if defined(CONFIG_ESE_SECURE) && defined(CONFIG_ESE_USE_TZ_API)
ret = p3_clk_control(data, true);
if (ret < 0)
P3_ERR_MSG("%s: Unable to enable spi clk\n", __func__);
#endif
break;
case P3_DISABLE_SPI_CLK:
P3_INFO_MSG("%s P3_DISABLE_SPI_CLK\n", __func__);
#if defined(CONFIG_ESE_SECURE) && defined(CONFIG_ESE_USE_TZ_API)
ret = p3_clk_control(data, false);
if (ret < 0)
P3_ERR_MSG("%s: couldn't disable spi clks\n", __func__);
#endif
break;
#ifndef CONFIG_ESE_SECURE
case P3_RW_SPI_DATA:
ret = p3_rw_spi_message(data, arg);
if (ret < 0)
P3_ERR_MSG("%s P3_RW_SPI_DATA failed [%d].\n",
__func__, ret);
break;
#endif
case P3_SET_PWR:
case P3_SET_POLL:
case P3_SET_SPI_CLK:
case P3_ENABLE_SPI_CS:
case P3_DISABLE_SPI_CS:
case P3_ENABLE_CLK_CS:
case P3_DISABLE_CLK_CS:
case P3_SWING_CS:
P3_ERR_MSG("%s deprecated IOCTL:0x%X\n", __func__, cmd);
break;
#ifdef CONFIG_ESE_COLDRESET
case P3_WR_RESET:
P3_DBG_MSG(": %s: ese_ioctl (cmd: %d)\n", __func__, cmd);
p3_power_reset(data);
break;
#endif
default:
P3_DBG_MSG("%s no matching ioctl! 0x%X\n", __func__, cmd);
ret = -EINVAL;
}
mutex_unlock(&data->buffer_mutex);
return ret;
}
#ifndef CONFIG_ESE_SECURE
static ssize_t spip3_write(struct file *filp, const char *buf, size_t count,
loff_t *offset)
{
int ret = -1;
struct p3_data *p3_dev;
struct spi_message m;
struct spi_transfer t;
unsigned char *tx_buffer;
unsigned char *rx_buffer;
#ifdef FEATURE_ESE_SPI_DUMMY_ENABLE
int dummy = 0;
#endif
p3_dev = filp->private_data;
if (count > MAX_BUFFER_SIZE) {
P3_ERR_MSG("%s invalid size\n", __func__);
return -EMSGSIZE;
}
mutex_lock(&p3_dev->buffer_mutex);
tx_buffer = p3_dev->tx_buffer;
rx_buffer = p3_dev->rx_buffer;
memset(tx_buffer, 0, MAX_BUFFER_SIZE);
memset(rx_buffer, 0, MAX_BUFFER_SIZE);
if (copy_from_user(&tx_buffer[0], &buf[0], count)) {
P3_ERR_MSG("%s : failed to copy from user space\n", __func__);
mutex_unlock(&p3_dev->buffer_mutex);
return -EFAULT;
}
#ifdef FEATURE_ESE_SPI_DUMMY_ENABLE
/* if data size is not aligned, it makes spi clk gap.
* and it leads spi read failure.
* so, if data size is not aligned, add dummy data.
*/
{
int SPI_MAX_BYTES_PER_WORD = 4;
if (count % SPI_MAX_BYTES_PER_WORD) {
dummy = SPI_MAX_BYTES_PER_WORD - count % SPI_MAX_BYTES_PER_WORD;
if (count + dummy < MAX_BUFFER_SIZE) {
memset(tx_buffer + count, 0, dummy);
count += dummy;
P3_INFO_MSG("%s: %d byte dummy is added. count is changed to %zu\n",
__func__, dummy, count);
}
}
}
#endif
/* Write data */
spi_message_init(&m);
memset(&t, 0, sizeof(t));
t.tx_buf = tx_buffer;
t.rx_buf = rx_buffer;
t.len = count;
spi_message_add_tail(&t, &m);
#ifdef CONFIG_ESE_USE_TZ_API
gpio_set_value(p3_dev->cs_gpio, 0);
udelay(20);
#endif
ret = spi_sync(p3_dev->spi, &m);
#ifdef CONFIG_ESE_USE_TZ_API
gpio_set_value(p3_dev->cs_gpio, 1);
#endif
#ifdef FEATURE_ESE_SPI_DUMMY_ENABLE
count -= dummy;
#endif
if (ret < 0) {
P3_ERR_MSG("%s error %d\n", __func__, ret);
ret = -EIO;
} else {
ret = count;
P3_INFO_MSG("%s count %zu\n", __func__, count);
}
mutex_unlock(&p3_dev->buffer_mutex);
return ret;
}
static ssize_t spip3_read(struct file *filp, char *buf, size_t count,
loff_t *offset)
{
int ret = -EIO;
struct spi_message m;
struct spi_transfer t;
struct p3_data *p3_dev = filp->private_data;
unsigned char *tx_buffer;
unsigned char *rx_buffer;
if (count > MAX_BUFFER_SIZE) {
P3_ERR_MSG("%s invalid size\n", __func__);
return -EMSGSIZE;
}
mutex_lock(&p3_dev->buffer_mutex);
tx_buffer = p3_dev->tx_buffer;
rx_buffer = p3_dev->rx_buffer;
memset(tx_buffer, 0, MAX_BUFFER_SIZE);
memset(rx_buffer, 0, MAX_BUFFER_SIZE);
spi_message_init(&m);
memset(&t, 0, sizeof(t));
t.tx_buf = tx_buffer;
t.rx_buf = rx_buffer;
t.len = count;
spi_message_add_tail(&t, &m);
#ifdef CONFIG_ESE_USE_TZ_API
gpio_set_value(p3_dev->cs_gpio, 0);
#endif
udelay(20);
ret = spi_sync(p3_dev->spi, &m);
#ifdef CONFIG_ESE_USE_TZ_API
gpio_set_value(p3_dev->cs_gpio, 1);
#endif
if (ret < 0)
P3_ERR_MSG("%s error %d\n", __func__, ret);
if (copy_to_user(buf, &rx_buffer[0], count)) {
P3_ERR_MSG("%s : failed to copy to user space\n", __func__);
ret = -EFAULT;
goto fail;
}
if (count > 1 && rx_buffer[0])
P3_INFO_MSG("%s count=%zu, ret=%d\n", __func__, count, ret);
ret = count;
mutex_unlock(&p3_dev->buffer_mutex);
return ret;
fail:
mutex_unlock(&p3_dev->buffer_mutex);
return ret;
}
#endif
/* possible fops on the p3 device */
static const struct file_operations spip3_dev_fops = {
.owner = THIS_MODULE,
#ifndef CONFIG_ESE_SECURE
.read = spip3_read,
.write = spip3_write,
#endif
.open = spip3_open,
.release = spip3_release,
.unlocked_ioctl = spip3_ioctl,
#ifdef CONFIG_COMPAT
.compat_ioctl = spip3_ioctl,
#endif
};
#ifdef CONFIG_MAKE_NODE_USING_PLATFORM_DEVICE
static struct miscdevice p3_misc_device = {
.minor = MISC_DYNAMIC_MINOR,
.name = "p3",
.fops = &spip3_dev_fops,
};
#endif
static int p3_parse_dt(struct device *dev, struct p3_data *data)
{
struct device_node *np = dev->of_node;
const char *coldrst_type_str;
int ret = 0;
#ifdef CONFIG_ESE_USE_TZ_API
data->cs_gpio = of_get_named_gpio(np, "ese_p3,cs-gpio", 0);
P3_INFO_MSG("cs-gpio : %d\n", data->cs_gpio);
#endif
if (!of_property_read_string(np, "ese_p3,coldrst_type", &coldrst_type_str)) {
if (!strcmp(coldrst_type_str, "gpio"))
data->coldrst_type = COLDRST_GPIO;
else if (!strcmp(coldrst_type_str, "power_onoff"))
data->coldrst_type = COLDRST_POWER_ONOFF;
else
data->coldrst_type = COLDRST_NONE;
P3_INFO_MSG("coldrst type is %d\n", data->coldrst_type);
} else {
P3_INFO_MSG("coldrst type is not set\n");
}
data->ese_pvdd = regulator_get(dev, "p3-vdd");
if (IS_ERR(data->ese_pvdd)) {
P3_ERR_MSG("get ese_pvdd error\n");
data->ese_pvdd = NULL;
} else
P3_INFO_MSG("LDO ese_pvdd: %pK\n", data->ese_pvdd);
data->pwr_always_on = of_property_read_bool(np, "ese_p3,pwr_always_on");
return ret;
}
static int spip3_probe(struct spi_device *spi)
{
int ret = -1;
struct p3_data *data = NULL;
struct device_node *np = spi->dev.of_node;
struct property *prop;
int ese_support = 0;
#ifndef CONFIG_ESE_SECURE
#ifdef CONFIG_SPI_QCOM_GENI /*SDM845 Only*/
struct spi_geni_qcom_ctrl_data *delay_params = NULL;
#endif
#endif
P3_INFO_MSG("%s chip select : %d , bus number = %d\n",
__func__, spi->chip_select, spi->master->bus_num);
/*separate NFC / non NFC using GPIO*/
prop = of_find_property(np, "check_ese", NULL);
if (prop) {
ese_support = gpio_get_value(of_get_named_gpio(np, "check_ese", 0));
if (ese_support > 0) {
P3_ERR_MSG("%s : ese support model : %d\n", __func__, ese_support);
} else {
P3_ERR_MSG("%s : ese not support model : %d\n", __func__, ese_support);
#ifdef CONFIG_MAKE_NODE_USING_PLATFORM_DEVICE
misc_deregister(&p3_misc_device);
P3_ERR_MSG("Misc Deregister\n");
#endif
return -ENXIO;
}
}
data = kzalloc(sizeof(*data), GFP_KERNEL);
if (data == NULL) {
P3_ERR_MSG("failed to allocate memory for module data\n");
ret = -ENOMEM;
goto err_exit;
}
ret = p3_parse_dt(&spi->dev, data);
if (ret) {
P3_ERR_MSG("%s - Failed to parse DT\n", __func__);
goto p3_parse_dt_failed;
}
#if IS_ENABLED(CONFIG_BATTERY_SAMSUNG) && !defined(CONFIG_NFC_PVDD_LATE_ENABLE) && !IS_ENABLED(CONFIG_SAMSUNG_ESE_ONLY)
if (data->pwr_always_on && !lpcharge) {
#else
if (data->pwr_always_on) {
#endif
ret = p3_regulator_onoff(data, 1);
if (ret) {
P3_ERR_MSG("%s - Failed to enable regulator\n", __func__);
goto p3_parse_dt_failed;
}
}
#ifdef CONFIG_ESE_SECURE
#ifdef CONFIG_ESE_USE_TZ_API
ret = p3_clk_setup(&spi->dev, data);
if (ret) {
P3_ERR_MSG("%s - Failed to do clk_setup\n", __func__);
goto p3_parse_dt_failed;
}
#endif
#else
#ifdef CONFIG_SPI_QCOM_GENI /*SDM845 Only*/
delay_params = spi->controller_data;
if (spi->controller_data)
pr_err("%s ctrl data is not empty\n", __func__);
delay_params = devm_kzalloc(&spi->dev, sizeof(struct spi_geni_qcom_ctrl_data),
GFP_KERNEL);
pr_info("%s success alloc ctrl_data!\n", __func__);
delay_params->spi_cs_clk_delay = 133; /*clock cycles*/
delay_params->spi_inter_words_delay = 0;
spi->controller_data = delay_params;
#endif
spi->bits_per_word = 8;
spi->mode = SPI_MODE_0;
spi->max_speed_hz = SPI_DEFAULT_SPEED;
ret = spi_setup(spi);
if (ret < 0) {
P3_ERR_MSG("failed to do spi_setup()\n");
goto p3_parse_dt_failed;
}
#endif
data->speed = SPI_DEFAULT_SPEED;
data->spi = spi;
#ifndef CONFIG_MAKE_NODE_USING_PLATFORM_DEVICE
data->p3_device.minor = MISC_DYNAMIC_MINOR;
data->p3_device.name = "p3";
data->p3_device.fops = &spip3_dev_fops;
data->p3_device.parent = &spi->dev;
#endif
#if defined(CONFIG_ESE_SECURE) && defined(CONFIG_ESE_USE_TZ_API)
data->ese_secure_check = NOT_CHECKED;
#endif
dev_set_drvdata(&spi->dev, data);
/* init mutex and queues */
init_waitqueue_head(&data->read_wq);
mutex_init(&data->buffer_mutex);
#ifdef FEATURE_ESE_WAKELOCK
wake_lock_init(&data->ese_lock,
WAKE_LOCK_SUSPEND, "ese_wake_lock");
#endif
data->device_opened = false;
#ifndef CONFIG_MAKE_NODE_USING_PLATFORM_DEVICE
ret = misc_register(&data->p3_device);
if (ret < 0) {
P3_ERR_MSG("misc_register failed! %d\n", ret);
goto err_misc_regi;
}
#endif
#ifdef CONFIG_ESE_USE_TZ_API
ret = gpio_request(data->cs_gpio, "ese_cs");
if (ret)
P3_ERR_MSG("failed to get gpio cs-gpio\n");
#endif
#if !defined(CONFIG_ESE_SECURE)
p3_pinctrl_config(data, false);
#endif
data->tx_buffer = kzalloc(sizeof(unsigned char) * MAX_BUFFER_SIZE, GFP_KERNEL);
if (data->tx_buffer == NULL) {
P3_ERR_MSG("failed to allocate spi tx buf\n");
ret = -EINVAL;
goto err_alloc_tx_buf;
}
data->rx_buffer = kzalloc(sizeof(unsigned char) * MAX_BUFFER_SIZE, GFP_KERNEL);
if (data->rx_buffer == NULL) {
P3_ERR_MSG("failed to allocate spi rx buf\n");
ret = -EINVAL;
goto err_alloc_rx_buf;
}
#ifdef CONFIG_MAKE_NODE_USING_PLATFORM_DEVICE
g_p3_dev = data;
#endif
P3_INFO_MSG("%s finished...\n", __func__);
return ret;
err_alloc_rx_buf:
kfree(data->tx_buffer);
err_alloc_tx_buf:
#ifdef FEATURE_ESE_POWER_ON_OFF
err_ldo_off:
#ifndef CONFIG_MAKE_NODE_USING_PLATFORM_DEVICE
misc_deregister(&data->p3_device);
#endif
#endif
#ifndef CONFIG_MAKE_NODE_USING_PLATFORM_DEVICE
err_misc_regi:
#endif
#ifdef FEATURE_ESE_WAKELOCK
wake_lock_destroy(&data->ese_lock);
#endif
mutex_destroy(&data->buffer_mutex);
p3_parse_dt_failed:
kfree(data);
err_exit:
P3_ERR_MSG("ERROR: Exit : %s ret %d\n", __func__, ret);
return ret;
}
static int spip3_remove(struct spi_device *spi)
{
struct p3_data *p3_dev = dev_get_drvdata(&spi->dev);
P3_DBG_MSG("Entry : %s\n", __func__);
if (p3_dev == NULL) {
P3_ERR_MSG("%s p3_dev is null!\n", __func__);
return 0;
}
#ifdef FEATURE_ESE_WAKELOCK
wake_lock_destroy(&p3_dev->ese_lock);
#endif
mutex_destroy(&p3_dev->buffer_mutex);
#ifndef CONFIG_MAKE_NODE_USING_PLATFORM_DEVICE
misc_deregister(&p3_dev->p3_device);
#endif
kfree(p3_dev);
P3_DBG_MSG("Exit : %s\n", __func__);
return 0;
}
#ifdef CONFIG_OF
static const struct of_device_id p3_match_table[] = {
{ .compatible = "ese_p3",},
{},
};
#else
#define ese_match_table NULL
#endif
static struct spi_driver spip3_driver = {
.driver = {
.name = "p3",
.bus = &spi_bus_type,
.owner = THIS_MODULE,
#ifdef CONFIG_OF
.of_match_table = p3_match_table,
#endif
},
.probe = spip3_probe,
.remove = spip3_remove,
};
#if IS_MODULE(CONFIG_SAMSUNG_NFC)
#ifdef CONFIG_MAKE_NODE_USING_PLATFORM_DEVICE
static int p3_platform_probe(struct platform_device *pdev)
{
int ret = -1;
ret = misc_register(&p3_misc_device);
if (ret < 0)
P3_INFO_MSG("misc_register failed! %d\n", ret);
P3_INFO_MSG("%s: finished...\n", __func__);
return 0;
}
static int p3_platform_remove(struct platform_device *pdev)
{
P3_INFO_MSG("Entry : %s\n", __func__);
misc_deregister(&p3_misc_device);
return 0;
}
static const struct of_device_id p3_platform_match_table[] = {
{ .compatible = "p3_platform",},
{},
};
static struct platform_driver p3_platform_driver = {
.driver = {
.name = "p3_platform",
.owner = THIS_MODULE,
#ifdef CONFIG_OF
.of_match_table = p3_platform_match_table,
#endif
},
.probe = p3_platform_probe,
.remove = p3_platform_remove,
};
#endif
int spip3_dev_init(void)
{
P3_INFO_MSG("Entry : %s\n", __func__);
if (!ese_param_support) {
P3_INFO_MSG("%s, support : %d\n", __func__, ese_param_support);
return 0;
}
#ifdef CONFIG_MAKE_NODE_USING_PLATFORM_DEVICE
if (platform_driver_register(&p3_platform_driver))
P3_INFO_MSG("fail to register early\n");
#endif
return spi_register_driver(&spip3_driver);
}
EXPORT_SYMBOL(spip3_dev_init);
void spip3_dev_exit(void)
{
P3_INFO_MSG("Entry : %s\n", __func__);
#ifdef CONFIG_MAKE_NODE_USING_PLATFORM_DEVICE
platform_driver_unregister(&p3_platform_driver);
#endif
if (ese_param_support)
spi_unregister_driver(&spip3_driver);
}
EXPORT_SYMBOL(spip3_dev_exit);
#else
static int __init spip3_dev_init(void)
{
P3_INFO_MSG("Entry : %s\n", __func__);
if (!ese_param_support) {
P3_INFO_MSG("%s, support : %d\n", __func__, ese_param_support);
return 0;
}
return spi_register_driver(&spip3_driver);
}
static void __exit spip3_dev_exit(void)
{
P3_INFO_MSG("Entry : %s\n", __func__);
if (ese_param_support)
spi_unregister_driver(&spip3_driver);
}
module_init(spip3_dev_init);
module_exit(spip3_dev_exit);
MODULE_AUTHOR("Sec");
MODULE_DESCRIPTION("ese SPI driver");
MODULE_LICENSE("GPL");
#endif
/** @} */
Reference in a new issue View git blame Copy permalink