877 lines
20 KiB
C
877 lines
20 KiB
C
|
/*
|
||
|
* 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>
|
||
|
#include <linux/wakelock.h>
|
||
|
#include <linux/smc.h>
|
||
|
|
||
|
#include "ese_p3.h"
|
||
|
|
||
|
/* Undef if want to keep eSE Power LDO ALWAYS ON */
|
||
|
#define FEATURE_ESE_POWER_ON_OFF
|
||
|
|
||
|
#define SPI_DEFAULT_SPEED 6500000L
|
||
|
|
||
|
/* 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
|
||
|
};
|
||
|
|
||
|
/* 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)
|
||
|
|
||
|
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 wake_lock ese_lock;
|
||
|
#endif
|
||
|
int cs_gpio;
|
||
|
unsigned long speed;
|
||
|
const char *vdd_1p8;
|
||
|
int vdd_1p8_gpio;
|
||
|
#ifdef CONFIG_ESE_SECURE
|
||
|
struct clk *ese_spi_pclk;
|
||
|
struct clk *ese_spi_sclk;
|
||
|
#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: pinctrol - %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_SECURE
|
||
|
static int p3_suspend(void)
|
||
|
{
|
||
|
u64 r0 = 0, r1 = 0, r2 = 0, r3 = 0;
|
||
|
int ret = 0;
|
||
|
|
||
|
r0 = (0x83000032);
|
||
|
ret = exynos_smc(r0, r1, r2, r3);
|
||
|
|
||
|
if (ret)
|
||
|
P3_ERR_MSG("P3 check suspend status! 0x%X\n", ret);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int p3_resume(void)
|
||
|
{
|
||
|
u64 r0 = 0, r1 = 0, r2 = 0, r3 = 0;
|
||
|
int ret = 0;
|
||
|
|
||
|
r0 = (0x83000033);
|
||
|
ret = exynos_smc(r0, r1, r2, r3);
|
||
|
|
||
|
if (ret)
|
||
|
P3_ERR_MSG("P3 check resume status! 0x%X\n", ret);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
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
|
||
|
|
||
|
static int p3_ldo_onoff(struct p3_data *data, int onoff)
|
||
|
{
|
||
|
int ret = 0;
|
||
|
|
||
|
ret = gpio_request(data->vdd_1p8_gpio, "ese_vdd_1p8_gpio");
|
||
|
if (ret) {
|
||
|
P3_ERR_MSG("%s - failed to request ese_vdd_1p8_gpio\n", __func__);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
ret = gpio_direction_output(data->vdd_1p8_gpio, onoff);
|
||
|
if (ret) {
|
||
|
P3_ERR_MSG("%s - failed to direction_output ese_vdd_1p8_gpio\n", __func__);
|
||
|
} else {
|
||
|
P3_INFO_MSG("%s: use external LDO %d\n", __func__, onoff);
|
||
|
}
|
||
|
gpio_free(data->vdd_1p8_gpio);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int p3_regulator_onoff(struct p3_data *data, int onoff)
|
||
|
{
|
||
|
int rc = 0;
|
||
|
struct regulator *regulator_vdd_1p8;
|
||
|
|
||
|
if (!data->vdd_1p8) {
|
||
|
if (data->vdd_1p8_gpio) {
|
||
|
rc = p3_ldo_onoff(data, onoff);
|
||
|
msleep(10);
|
||
|
return rc;
|
||
|
} else {
|
||
|
P3_ERR_MSG("%s No vdd LDO name!\n", __func__);
|
||
|
return -ENODEV;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
regulator_vdd_1p8 = regulator_get(NULL, data->vdd_1p8);
|
||
|
pr_err("%s %s\n", __func__, data->vdd_1p8);
|
||
|
|
||
|
if (IS_ERR(regulator_vdd_1p8) || regulator_vdd_1p8 == NULL) {
|
||
|
P3_ERR_MSG("%s - vdd_1p8 regulator_get fail\n", __func__);
|
||
|
return -ENODEV;
|
||
|
}
|
||
|
|
||
|
P3_DBG_MSG("%s - onoff = %d\n", __func__, onoff);
|
||
|
if (onoff == 1) {
|
||
|
rc = regulator_enable(regulator_vdd_1p8);
|
||
|
if (rc) {
|
||
|
P3_ERR_MSG("%s - enable vdd_1p8 failed, rc=%d\n",
|
||
|
__func__, rc);
|
||
|
goto done;
|
||
|
}
|
||
|
msleep(20);
|
||
|
} else {
|
||
|
rc = regulator_disable(regulator_vdd_1p8);
|
||
|
if (rc) {
|
||
|
P3_ERR_MSG("%s - disable vdd_1p8 failed, rc=%d\n",
|
||
|
__func__, rc);
|
||
|
goto done;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/*data->regulator_is_enable = (u8)onoff;*/
|
||
|
|
||
|
done:
|
||
|
regulator_put(regulator_vdd_1p8);
|
||
|
|
||
|
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[MAX_BUFFER_SIZE] = {0x0, };
|
||
|
unsigned char rx_buffer[MAX_BUFFER_SIZE] = {0x0, };
|
||
|
|
||
|
P3_DBG_MSG("%s\n", __func__);
|
||
|
|
||
|
if (p3_device == NULL || tr == NULL)
|
||
|
return -EFAULT;
|
||
|
|
||
|
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;
|
||
|
}
|
||
|
}
|
||
|
pr_debug("%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)
|
||
|
return -EFAULT;
|
||
|
kfree(dup);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
#if 0 //def CONFIG_COMPAT
|
||
|
static int p3_rw_spi_message_32(struct p3_data *p3_device, unsigned long arg)
|
||
|
{
|
||
|
struct p3_ioctl_transfer dup;
|
||
|
struct spip3_ioc_transfer_32 p3transfr_32;
|
||
|
int err = 0;
|
||
|
|
||
|
if (__copy_from_user(&p3transfr_32, (void __user *)arg,
|
||
|
sizeof(struct spip3_ioc_transfer_32))) {
|
||
|
P3_ERR_MSG("%s, failed to copy from user\n", __func__);
|
||
|
return -EFAULT;
|
||
|
}
|
||
|
|
||
|
dup.tx_buffer = (unsigned char *)(unsigned long)(p3transfr_32.tx_buffer);
|
||
|
dup.rx_buffer = (unsigned char *)(unsigned long)(p3transfr_32.rx_buffer);
|
||
|
dup.len = p3transfr_32.len;
|
||
|
|
||
|
err = p3_xfer(p3_device, &dup);
|
||
|
if (err != 0) {
|
||
|
P3_ERR_MSG("%s xfer failed!\n", __func__);
|
||
|
return err;
|
||
|
}
|
||
|
P3_DBG_MSG("%s len:%u\n", __func__, dup.len);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
#endif
|
||
|
#endif
|
||
|
|
||
|
static int spip3_open(struct inode *inode, struct file *filp)
|
||
|
{
|
||
|
struct p3_data *p3_dev = container_of(filp->private_data,
|
||
|
struct p3_data, p3_device);
|
||
|
int ret = 0;
|
||
|
|
||
|
/* for defence MULTI-OPEN */
|
||
|
if (p3_dev->device_opened) {
|
||
|
P3_ERR_MSG("%s - ALREADY opened!\n", __func__);
|
||
|
return -EBUSY;
|
||
|
}
|
||
|
|
||
|
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_SECURE
|
||
|
p3_clk_control(p3_dev, true);
|
||
|
p3_resume();
|
||
|
#else
|
||
|
p3_pinctrl_config(p3_dev, true);
|
||
|
#endif
|
||
|
|
||
|
#ifdef FEATURE_ESE_POWER_ON_OFF
|
||
|
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);
|
||
|
#endif
|
||
|
|
||
|
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;
|
||
|
}
|
||
|
|
||
|
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_SECURE
|
||
|
p3_clk_control(p3_dev, false);
|
||
|
p3_suspend();
|
||
|
usleep_range(1000, 1500);
|
||
|
#else
|
||
|
p3_pinctrl_config(p3_dev, false);
|
||
|
#endif
|
||
|
#ifdef FEATURE_ESE_POWER_ON_OFF
|
||
|
ret = p3_regulator_onoff(p3_dev, 0);
|
||
|
if (ret < 0)
|
||
|
P3_ERR_MSG(" test: failed to turn off LDO()\n");
|
||
|
|
||
|
#endif
|
||
|
}
|
||
|
mutex_unlock(&device_list_lock);
|
||
|
|
||
|
P3_DBG_MSG("%s, users:%d, Major Minor No:%d %d\n", __func__,
|
||
|
p3_dev->users, imajor(inode), iminor(inode));
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
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_DBG_MSG(KERN_INFO"[NXP-P3] - Debug level %d", debug_level);
|
||
|
break;
|
||
|
case P3_ENABLE_SPI_CLK:
|
||
|
P3_DBG_MSG("%s P3_ENABLE_SPI_CLK\n", __func__);
|
||
|
#ifdef CONFIG_ESE_SECURE
|
||
|
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_DBG_MSG("%s P3_DISABLE_SPI_CLK\n", __func__);
|
||
|
#ifdef CONFIG_ESE_SECURE
|
||
|
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
|
||
|
#if 0 //def CONFIG_COMPAT
|
||
|
case P3_RW_SPI_DATA_32:
|
||
|
ret = p3_rw_spi_message_32(data, arg);
|
||
|
if (ret < 0)
|
||
|
P3_ERR_MSG("%s P3_RW_SPI_DATA_32 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;
|
||
|
|
||
|
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[MAX_BUFFER_SIZE] = {0x0, };
|
||
|
unsigned char rx_buffer[MAX_BUFFER_SIZE] = {0x0, };
|
||
|
|
||
|
P3_INFO_MSG("spip3_write -Enter count %zu\n", count);
|
||
|
|
||
|
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);
|
||
|
|
||
|
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;
|
||
|
}
|
||
|
|
||
|
/* 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);
|
||
|
|
||
|
gpio_set_value(p3_dev->cs_gpio, 0);
|
||
|
ret = spi_sync(p3_dev->spi, &m);
|
||
|
gpio_set_value(p3_dev->cs_gpio, 1);
|
||
|
if (ret < 0)
|
||
|
ret = -EIO;
|
||
|
else
|
||
|
ret = count;
|
||
|
|
||
|
mutex_unlock(&p3_dev->buffer_mutex);
|
||
|
P3_DBG_MSG(KERN_ALERT "spip3_write ret %d- Exit\n", ret);
|
||
|
|
||
|
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[MAX_BUFFER_SIZE] = {0x0, };
|
||
|
unsigned char rx_buffer[MAX_BUFFER_SIZE] = {0x0, };
|
||
|
|
||
|
if (count > MAX_BUFFER_SIZE) {
|
||
|
P3_ERR_MSG("%s invalid size\n", __func__);
|
||
|
return -EMSGSIZE;
|
||
|
}
|
||
|
P3_INFO_MSG("spip3_read count %zu - Enter\n", count);
|
||
|
mutex_lock(&p3_dev->buffer_mutex);
|
||
|
|
||
|
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);
|
||
|
|
||
|
gpio_set_value(p3_dev->cs_gpio, 0);
|
||
|
ret = spi_sync(p3_dev->spi, &m);
|
||
|
gpio_set_value(p3_dev->cs_gpio, 1);
|
||
|
|
||
|
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;
|
||
|
}
|
||
|
ret = count;
|
||
|
P3_DBG_MSG("%s ret %d Exit\n", __func__, ret);
|
||
|
|
||
|
mutex_unlock(&p3_dev->buffer_mutex);
|
||
|
|
||
|
return ret;
|
||
|
|
||
|
fail:
|
||
|
P3_ERR_MSG("Error %s ret %d Exit\n", __func__, ret);
|
||
|
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
|
||
|
};
|
||
|
|
||
|
static int p3_parse_dt(struct device *dev, struct p3_data *data)
|
||
|
{
|
||
|
struct device_node *np = dev->of_node;
|
||
|
int ret = 0;
|
||
|
|
||
|
data->cs_gpio = of_get_named_gpio(np, "ese_p3,cs-gpio", 0);
|
||
|
P3_INFO_MSG("cs-gpio : %d\n:", data->cs_gpio);
|
||
|
|
||
|
if (of_property_read_string(np, "p3-vdd-1p8",
|
||
|
&data->vdd_1p8) < 0) {
|
||
|
P3_ERR_MSG("%s - getting vdd_1p8 error\n", __func__);
|
||
|
data->vdd_1p8 = NULL;
|
||
|
data->vdd_1p8_gpio = of_get_named_gpio(np, "p3-vdd_1p8-gpio", 0);
|
||
|
if (gpio_is_valid(data->vdd_1p8_gpio)) {
|
||
|
P3_INFO_MSG("%s success vdd-gpio:%d\n", __func__, data->vdd_1p8_gpio);
|
||
|
} else {
|
||
|
data->vdd_1p8_gpio = 0;
|
||
|
}
|
||
|
} else {
|
||
|
P3_INFO_MSG("%s success vdd:%s\n", __func__, data->vdd_1p8);
|
||
|
}
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int spip3_probe(struct spi_device *spi)
|
||
|
{
|
||
|
int ret = -1;
|
||
|
struct p3_data *data = NULL;
|
||
|
|
||
|
P3_INFO_MSG("%s chip select : %d , bus number = %d\n",
|
||
|
__func__, spi->chip_select, spi->master->bus_num);
|
||
|
|
||
|
#ifdef CONFIG_ESE_SECURE
|
||
|
if (p3_suspend() == EBUSY) {
|
||
|
P3_ERR_MSG("eSE spi Secure fail!\n");
|
||
|
return -EBUSY;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
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;
|
||
|
}
|
||
|
|
||
|
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
|
||
|
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;
|
||
|
}
|
||
|
#else
|
||
|
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;
|
||
|
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;
|
||
|
|
||
|
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;
|
||
|
|
||
|
ret = misc_register(&data->p3_device);
|
||
|
if (ret < 0) {
|
||
|
P3_ERR_MSG("misc_register failed! %d\n", ret);
|
||
|
goto err_misc_regi;
|
||
|
}
|
||
|
|
||
|
ret = gpio_request(data->cs_gpio, "ese_cs");
|
||
|
if (ret)
|
||
|
P3_ERR_MSG("failed to get gpio cs-gpio\n");
|
||
|
|
||
|
#ifdef FEATURE_ESE_POWER_ON_OFF
|
||
|
ret = p3_regulator_onoff(data, 0);
|
||
|
if (ret < 0) {
|
||
|
P3_ERR_MSG("%s failed to turn off LDO. [%d]\n", __func__, ret);
|
||
|
goto err_ldo_off;
|
||
|
}
|
||
|
#endif
|
||
|
#ifdef CONFIG_ESE_SECURE
|
||
|
p3_suspend();
|
||
|
#else
|
||
|
p3_pinctrl_config(data, false);
|
||
|
#endif
|
||
|
|
||
|
P3_INFO_MSG("%s finished...\n", __func__);
|
||
|
return ret;
|
||
|
|
||
|
#ifdef FEATURE_ESE_POWER_ON_OFF
|
||
|
err_ldo_off:
|
||
|
misc_deregister(&data->p3_device);
|
||
|
#endif
|
||
|
err_misc_regi:
|
||
|
#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_DBG_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);
|
||
|
misc_deregister(&p3_dev->p3_device);
|
||
|
|
||
|
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,
|
||
|
};
|
||
|
|
||
|
static int __init spip3_dev_init(void)
|
||
|
{
|
||
|
debug_level = P3_FULL_DEBUG;
|
||
|
|
||
|
P3_INFO_MSG("Entry : %s\n", __func__);
|
||
|
#if (!defined(CONFIG_ESE_FACTORY_ONLY) || defined(CONFIG_SEC_FACTORY))
|
||
|
return spi_register_driver(&spip3_driver);
|
||
|
#else
|
||
|
return -1;
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
static void __exit spip3_dev_exit(void)
|
||
|
{
|
||
|
P3_INFO_MSG("Entry : %s\n", __func__);
|
||
|
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");
|
||
|
|
||
|
/** @} */
|