drivers/fingerprint/et7xx-spi_data_transfer.c

/*
 * 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 <linux/kernel.h>
#include <linux/uaccess.h>
#include <linux/delay.h>
#include <linux/gpio.h>
#include "et7xx.h"

int etspi_io_read_register(struct etspi_data *etspi, u8 *addr, u8 *buf)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status = 0;
	struct spi_message m;
	int read_len = 1;

	u8 val, addrval;

	struct spi_transfer xfer = {
		.tx_buf = etspi->buf,
		.rx_buf = etspi->buf,
		.len = 3,
	};

	memset(etspi->buf, 0, xfer.len);
	*etspi->buf = OP_REG_R;

	if (copy_from_user(&addrval, (const u8 __user *) (uintptr_t) addr
		, read_len)) {
		pr_err("%s buffer copy_from_user fail\n", __func__);
		status = -EFAULT;
		return status;
	}

	*(etspi->buf + 1) = addrval;

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s read data error status = %d\n", __func__, status);
		return status;
	}

	val = *(etspi->buf + 2);

	pr_debug("%s len = %d addr = %x val = %x\n", __func__,
			read_len, addrval, val);

	if (copy_to_user((u8 __user *) (uintptr_t) buf, &val, read_len)) {
		pr_err("%s buffer copy_to_user fail status\n", __func__);
		status = -EFAULT;
		return status;
	}

	return status;
#endif
}

int etspi_io_burst_read_register(struct etspi_data *etspi,
									struct egis_ioc_transfer *ioc)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status = 0;
	struct spi_message m;
	struct spi_transfer xfer = {
		.tx_buf = etspi->buf,
		.rx_buf = etspi->buf,
		.len = ioc->len + 2,
	};

	if (ioc->len <= 0 || ioc->len + 2 > etspi->bufsiz) {
		status = -ENOMEM;
		pr_err("%s error status = %d\n", __func__, status);
		goto end;
	}

	memset(etspi->buf, 0, xfer.len);
	*etspi->buf = OP_REG_R_S;
	if (copy_from_user(etspi->buf + 1,
			(const u8 __user *) (uintptr_t) ioc->tx_buf, 1)) {
		pr_err("%s buffer copy_from_user fail\n", __func__);
		status = -EFAULT;
		goto end;
	}
	pr_debug("%s tx_buf = %p op = %x reg = %x, len = %d\n", __func__,
			ioc->tx_buf, *etspi->buf, *(etspi->buf + 1), xfer.len);
	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);

	if (status < 0) {
		status = -ENOMEM;
		pr_err("%s error status = %d\n", __func__, status);
		goto end;
	}

	if (copy_to_user((u8 __user *) (uintptr_t)ioc->rx_buf, etspi->buf + 2,
				ioc->len)) {
		status = -EFAULT;
		pr_err("%s buffer copy_to_user fail status\n", __func__);
		goto end;
	}
end:
	return status;
#endif
}

int etspi_io_burst_read_register_backward(struct etspi_data *etspi,
											struct egis_ioc_transfer *ioc)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status = 0;
	struct spi_message m;
	struct spi_transfer xfer = {
		.tx_buf = etspi->buf,
		.rx_buf = etspi->buf,
		.len = ioc->len + 2,
	};

	if (ioc->len <= 0 || ioc->len + 2 > etspi->bufsiz) {
		status = -ENOMEM;
		pr_err("%s error status = %d\n", __func__, status);
		goto end;
	}

	memset(etspi->buf, 0, xfer.len);
	*etspi->buf = OP_REG_R_S_BW;
	if (copy_from_user(etspi->buf + 1,
			(const u8 __user *) (uintptr_t)ioc->tx_buf, 1)) {
		pr_err("%s buffer copy_from_user fail\n", __func__);
		status = -EFAULT;
		goto end;
	}
	pr_debug("%s tx_buf = %p op = %x reg = %x, len = %d\n", __func__,
			ioc->tx_buf, *etspi->buf, *(etspi->buf + 1), xfer.len);
	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);

	if (status < 0) {
		status = -ENOMEM;
		pr_err("%s error status = %d\n", __func__, status);
		goto end;
	}

	if (copy_to_user((u8 __user *) (uintptr_t)ioc->rx_buf, etspi->buf + 2,
			ioc->len)) {
		status = -EFAULT;
		pr_err("%s buffer copy_to_user fail status\n", __func__);
		goto end;
	}
end:
	return status;
#endif
}

int etspi_io_write_register(struct etspi_data *etspi, u8 *buf)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status = 0;
	int write_len = 2;
	struct spi_message m;

	u8 val[3];

	struct spi_transfer xfer = {
		.tx_buf = etspi->buf,
		.len = 3,
	};

	memset(etspi->buf, 0, xfer.len);
	*etspi->buf = OP_REG_W;

	if (copy_from_user(val, (const u8 __user *) (uintptr_t) buf,
			write_len)) {
		pr_err("%s buffer copy_from_user fail\n", __func__);
		status = -EFAULT;
		return status;
	}

	pr_debug("%s write_len = %d addr = %x data = %x\n", __func__,
			write_len, val[0], val[1]);

	*(etspi->buf + 1) = val[0];
	*(etspi->buf + 2) = val[1];

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s read data error status = %d\n", __func__, status);
		return status;
	}

	return status;
#endif
}

int etspi_io_burst_write_register(struct etspi_data *etspi,
									struct egis_ioc_transfer *ioc)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status = 0;
	struct spi_message m;
	struct spi_transfer xfer = {
		.tx_buf = etspi->buf,
		.len = ioc->len + 1,
	};

	if (ioc->len <= 0 || ioc->len + 2 > etspi->bufsiz) {
		status = -ENOMEM;
		pr_err("%s error status = %d\n", __func__, status);
		goto end;
	}

	memset(etspi->buf, 0, ioc->len + 1);
	*etspi->buf = OP_REG_W_S;
	if (copy_from_user(etspi->buf + 1,
			(const u8 __user *) (uintptr_t) ioc->tx_buf,
			ioc->len)) {
		pr_err("%s buffer copy_from_user fail\n", __func__);
		status = -EFAULT;
		goto end;
	}
	pr_debug("%s tx_buf = %p op = %x reg = %x, len = %d\n", __func__,
			ioc->tx_buf, *etspi->buf, *(etspi->buf + 1), xfer.len);
	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);

	if (status < 0) {
		pr_err("%s error status = %d\n", __func__, status);
		goto end;
	}
end:
	return status;
#endif
}

int etspi_io_burst_write_register_backward(struct etspi_data *etspi,
											struct egis_ioc_transfer *ioc)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status = 0;
	struct spi_message m;
	struct spi_transfer xfer = {
		.tx_buf = etspi->buf,
		.len = ioc->len + 1,
	};

	if (ioc->len <= 0 || ioc->len + 2 > etspi->bufsiz) {
		status = -ENOMEM;
		pr_err("%s error status = %d\n", __func__, status);
		goto end;
	}

	memset(etspi->buf, 0, ioc->len + 1);
	*etspi->buf = OP_REG_W_S_BW;
	if (copy_from_user(etspi->buf + 1,
		(const u8 __user *) (uintptr_t)ioc->tx_buf, ioc->len)) {
		pr_err("%s buffer copy_from_user fail\n", __func__);
		status = -EFAULT;
		goto end;
	}
	pr_debug("%s tx_buf = %p op = %x reg = %x, len = %d\n", __func__,
		ioc->tx_buf, *etspi->buf, *(etspi->buf + 1), xfer.len);
	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);

	if (status < 0) {
		pr_err("%s error status = %d\n", __func__, status);
		goto end;
	}
end:
	return status;
#endif
}

int etspi_io_read_efuse(struct etspi_data *etspi, struct egis_ioc_transfer *ioc)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status;
	struct spi_message m;
	u8 *buf = NULL;

	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = ioc->len + 1,
	};

	if (xfer.len >= LARGE_SPI_TRANSFER_BUFFER) {
		if ((xfer.len) % DIVISION_OF_IMAGE != 0)
			xfer.len = xfer.len + (DIVISION_OF_IMAGE -
					(xfer.len % DIVISION_OF_IMAGE));
	}

	buf = kzalloc(xfer.len, GFP_KERNEL);

	if (buf == NULL)
		return -ENOMEM;

	xfer.tx_buf = xfer.rx_buf = buf;
	buf[0] = OP_EF_R;

	pr_debug("%s len = %d, xfer.len = %d, buf = %p, rx_buf = %p\n",
			__func__, ioc->len, xfer.len, buf, ioc->rx_buf);

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s read data error status = %d\n", __func__, status);
		goto end;
	}

	if (copy_to_user((u8 __user *) (uintptr_t) ioc->rx_buf, buf + 1,
			ioc->len)) {
		pr_err("%s buffer copy_to_user fail status\n", __func__);
		status = -EFAULT;
	}
end:
	kfree(buf);
	return status;
#endif
}

int etspi_io_write_efuse(struct etspi_data *etspi,
							struct egis_ioc_transfer *ioc)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status;
	struct spi_message m;
	u8 *buf = NULL;

	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = ioc->len + 1,
	};

	if (xfer.len >= LARGE_SPI_TRANSFER_BUFFER) {
		if ((xfer.len) % DIVISION_OF_IMAGE != 0)
			xfer.len = xfer.len + (DIVISION_OF_IMAGE -
					(xfer.len % DIVISION_OF_IMAGE));
	}

	buf = kzalloc(xfer.len, GFP_KERNEL);
	if (buf == NULL)
		return -ENOMEM;

	if (copy_from_user((u8 __user *) (uintptr_t) buf + 1, ioc->tx_buf,
			ioc->len)) {
		pr_err("buffer copy_from_user fail status\n");
		status = -EFAULT;
		goto end;
	}

	xfer.tx_buf = xfer.rx_buf = buf;
	buf[0] = OP_EF_W;

	pr_debug("%s len = %d, xfer.len = %d, buf = %p, tx_buf = %p\n",
			 __func__, ioc->len, xfer.len, buf, ioc->tx_buf);

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);

	if (status < 0)
		pr_err("%s write data error status = %d\n", __func__, status);
end:
	kfree(buf);
	return status;
#endif
}

int etspi_io_get_frame(struct etspi_data *etspi, u8 *fr, u32 size)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status;
	struct spi_message m;
	u8 *buf = NULL;

	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = size + 1,
	};

	if (xfer.len >= LARGE_SPI_TRANSFER_BUFFER) {
		if ((xfer.len) % DIVISION_OF_IMAGE != 0)
			xfer.len = xfer.len + (DIVISION_OF_IMAGE -
					(xfer.len % DIVISION_OF_IMAGE));
	}

	buf = kzalloc(xfer.len, GFP_KERNEL);

	if (buf == NULL)
		return -ENOMEM;

	xfer.tx_buf = xfer.rx_buf = buf;
	buf[0] = OP_FB_R;

	pr_debug("%s size = %d, xfer.len = %d, buf = %p, fr = %p\n", __func__,
		size, xfer.len, buf, fr);

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s read data error status = %d\n", __func__, status);
		goto end;
	}

	if (copy_to_user((u8 __user *) (uintptr_t) fr, buf + 1, size)) {
		pr_err("%s buffer copy_to_user fail status\n", __func__);
		status = -EFAULT;
	}
end:
	kfree(buf);
	return status;
#endif
}

int etspi_io_write_frame(struct etspi_data *etspi, u8 *fr, u32 size)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status;
	struct spi_message m;
	u8 *buf = NULL;

	struct spi_transfer xfer = {
	    .tx_buf = NULL,
	    .rx_buf = NULL,
	    .len = size + 1,
	};

	if (xfer.len >= LARGE_SPI_TRANSFER_BUFFER) {
		if ((xfer.len) % DIVISION_OF_IMAGE != 0)
			xfer.len = xfer.len + (DIVISION_OF_IMAGE -
					(xfer.len % DIVISION_OF_IMAGE));
	}

	buf = kzalloc(xfer.len, GFP_KERNEL);

	if (buf == NULL)
		return -ENOMEM;

	if (copy_from_user((u8 __user *)(uintptr_t)buf + 1, fr, size)) {
		pr_err("buffer copy_from_user fail status\n");
		status = -EFAULT;
		goto end;
	}

	xfer.tx_buf = xfer.rx_buf = buf;
	buf[0] = OP_FB_W;

	pr_debug("%s size = %d, xfer.len = %d, buf = %p, fr = %p\n", __func__,
		size, xfer.len, buf, fr);

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);

	if (status < 0)
		pr_err("%s write data error status = %d\n", __func__, status);

end:
	kfree(buf);
	return status;
#endif
}

int etspi_io_get_zone_average(struct etspi_data *etspi, u8 *fr, u32 size)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status;
	struct spi_message m;
	u8 *buf = NULL;

	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = size + 1,
	};

	if (xfer.len >= LARGE_SPI_TRANSFER_BUFFER) {
		if ((xfer.len) % DIVISION_OF_IMAGE != 0)
			xfer.len = xfer.len + (DIVISION_OF_IMAGE -
					(xfer.len % DIVISION_OF_IMAGE));
	}

	buf = kzalloc(xfer.len, GFP_KERNEL);

	if (buf == NULL)
		return -ENOMEM;

	xfer.tx_buf = xfer.rx_buf = buf;
	buf[0] = OP_ZAVG_R;

	pr_debug("%s size = %d, xfer.len = %d, buf = %p, fr = %p\n", __func__,
		size, xfer.len, buf, fr);

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s read data error status = %d\n", __func__, status);
		goto end;
	}

	if (copy_to_user((u8 __user *) (uintptr_t) fr, buf + 1, size)) {
		pr_err("%s buffer copy_to_user fail status\n", __func__);
		status = -EFAULT;
	}
end:
	kfree(buf);
	return status;
#endif
}

int etspi_io_get_histogram(struct etspi_data *etspi, u8 *fr, u32 size)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status;
	struct spi_message m;
	u8 *buf = NULL;

	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = size + 1,
	};

	if (xfer.len >= LARGE_SPI_TRANSFER_BUFFER) {
		if ((xfer.len) % DIVISION_OF_IMAGE != 0)
			xfer.len = xfer.len + (DIVISION_OF_IMAGE -
					(xfer.len % DIVISION_OF_IMAGE));
	}

	buf = kzalloc(xfer.len, GFP_KERNEL);

	if (buf == NULL)
		return -ENOMEM;

	xfer.tx_buf = xfer.rx_buf = buf;
	buf[0] = OP_HSTG_R;

	pr_debug("%s size = %d, xfer.len = %d, buf = %p, fr = %p\n", __func__,
		size, xfer.len, buf, fr);

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s read data error status = %d\n", __func__, status);
		goto end;
	}

	if (copy_to_user((u8 __user *) (uintptr_t) fr, buf + 1, size)) {
		pr_err("%s buffer copy_to_user fail status\n", __func__);
		status = -EFAULT;
	}
end:
	kfree(buf);
	return status;
#endif
}

int etspi_io_read_cis_register(struct etspi_data *etspi, u8 *addr, u8 *buf)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
#define CIS_READ_TIMEOUT 1000
	int status = 0, read_len = 2, try_time = 0;
	struct spi_message m;

	u8 tr[] = { OP_CIS_ADDR_R, 0x24, 0x00, 0x00, 0x00, 0x00};
	u8 val;

	struct spi_transfer xfer_addr = {
		.tx_buf = tr,
		.len = 6,
	};
	struct spi_transfer xfer_data = {
		.rx_buf = tr,
		.len = 1,
	};

	if (copy_from_user(&tr[2], (const u8 __user *) (uintptr_t) addr
		, read_len)) {
		pr_err("%s buffer copy_from_user fail. addr(%p)\n"
				, __func__, addr);
		status = -EFAULT;
		return status;
	}
	tr[5] = tr[0] + tr[1] + tr[2] + tr[3] + tr[4];
	pr_info("%s len(%d) addr(%p) i2c(%x) addrH(%x) addrL(%x) crc(%x) buf(%p)\n",
		__func__, read_len, addr, tr[1], tr[2], tr[3], tr[5], buf);
	spi_message_init(&m);
	spi_message_add_tail(&xfer_addr, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s read data (0x71) error status = %d\n"
				, __func__, status);
		return status;
	}

	while (try_time < CIS_READ_TIMEOUT) {
		tr[0] = 0x00;
		spi_message_init(&m);
		spi_message_add_tail(&xfer_data, &m);
		status = spi_sync(etspi->spi, &m);
		if (status < 0) {
			pr_err("%s read data error status = %d\n"
					, __func__, status);
			return status;
		}
		if (tr[0] == 0xAA) {
			pr_info("%s tr[0] = %x, try_time(%d)\n",
						__func__, tr[0], try_time);
			break;
		}
		usleep_range(10, 20);
		try_time++;
	}
	if (try_time >= CIS_READ_TIMEOUT)
		pr_err("%s TIMEOUT!! try_time >= CIS_READ_TIMEOUT(1000)\n", __func__);

	tr[0] = 0x81;
	tr[1] = 0x24;
	tr[2] = 0x00;
	tr[3] = 0x00;
	tr[4] = 0x00;
	tr[5] = tr[0] + tr[1] + tr[2] + tr[3] + tr[4];
	pr_info("%s op(%d) i2c(%x) crc(%d)\n", __func__, tr[0], tr[1], tr[5]);
	spi_message_init(&m);
	spi_message_add_tail(&xfer_addr, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s read data (0x81) error status = %d\n"
				, __func__, status);
		return status;
	}

	tr[0] = 0x00;
	pr_info("%s get data(0x81) tr[0] = %x\n", __func__, tr[0]);
	spi_message_init(&m);
	spi_message_add_tail(&xfer_data, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s read data error status = %d\n"
				, __func__, status);
		return status;
	}

	val = tr[0];
	pr_info("%s val = %x\n", __func__, val);
	if (copy_to_user((u8 __user *) (uintptr_t) buf, &val, 1)) {
		pr_err("%s buffer copy_to_user fail status\n", __func__);
		status = -EFAULT;
		return status;
	}

	if (try_time >= CIS_READ_TIMEOUT)
		return -ETIME;
	else
		return status;
#endif
}

int etspi_io_write_cis_register(struct etspi_data *etspi, u8 *buf)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status = 0, write_len = 3, try_time = 0;
	struct spi_message m;
	u8 tx[] = {OP_CIS_REG_W, 0x24, 0x00, 0x00, 0x00, 0x00}, val[3];

	struct spi_transfer xfer = {
		.tx_buf = tx,
		.len = 6,
	};

	struct spi_transfer xfer_data = {
		.rx_buf = tx,
		.len = 1,
	};

	if (copy_from_user(val, (const u8 __user *) (uintptr_t) buf
		, write_len)) {
		pr_err("%s buffer copy_from_user fail. buf(%p)\n",
				__func__, buf);
		status = -EFAULT;
		return status;
	}
	pr_info("%s write_len = %d addrH = %x addrL = %x data = %x buf = %p\n",
		__func__, write_len, val[0], val[1], val[2], buf);

	tx[2] = val[0];
	tx[3] = val[1];
	tx[4] = val[2];
	tx[5] = tx[0] + tx[1] + tx[2] + tx[3] + tx[4];

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s write data (0x70) error status = %d\n",
				__func__, status);
		return status;
	}

	while (try_time < 2000) {
		tx[0] = 0x00;
		spi_message_init(&m);
		spi_message_add_tail(&xfer_data, &m);
		status = spi_sync(etspi->spi, &m);
		if (status < 0) {
			pr_err("%s read data error status = %d\n"
					, __func__, status);
			return status;
		}
		if (tx[0] == 0xAA) {
			pr_info("%s tx[0] == 0xAA, try_time = %d\n", __func__, try_time);
			break;
		}
		usleep_range(10, 20);
		try_time++;
	}
	if (try_time >= 2000)
		pr_err("%s -------------    try_time >= 2000    ---------------\n",
				__func__);

	return status;
#endif
}

int etspi_io_pre_capture(struct etspi_data *etspi)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status = 0;
	struct spi_message m;
	u8 tx[] = {OP_PRE_CAPTURE, 0x00, 0x00, 0x00, 0x00, 0x00};
	int try_time = 0;

	struct spi_transfer xfer = {
		.tx_buf = tx,
		.len = 6,
	};
	struct spi_transfer xfer_data = {
		.rx_buf = tx,
		.len = 1,
	};

	pr_info("%s tx[0] = %d\n", __func__, tx[0]);

	tx[5] = tx[0] + tx[1] + tx[2] + tx[3] + tx[4];

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s set pre capture error status = %d\n",
				__func__, status);
		return status;
	}

	while (try_time < 8000) {
		tx[0] = 0x00;
		//pr_info("%s tr[0] = %x\n", __func__, tr[0]);
		spi_message_init(&m);
		spi_message_add_tail(&xfer_data, &m);
		status = spi_sync(etspi->spi, &m);
		if (status < 0) {
			pr_err("%s read data error status = %d\n"
					, __func__, status);
			return status;
		}
		if (tx[0] == 0xAA) {
			pr_info("%s tx[0] == 0xAA, try_time = %d\n", __func__, try_time);
			break;
		}
		usleep_range(10, 20);
		try_time++;
	}
	if (try_time >= 8000) {
		pr_err("%s -------------    try_time >= 8000    ---------------\n",
				__func__);
		return -ETIME;
	}


	return status;
#endif
}

int etspi_io_get_cis_frame(struct etspi_data *etspi, u8 *fr, u32 size)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status;
	struct spi_message m;
	u8 *buf = NULL;
	u8 tx[] = { OP_GET_FRAME, 0x00, 0x00, 0x00, 0x00, 0x00};
	u32 size_et736 = 0;

	struct spi_transfer xfer_op = {
		.tx_buf = tx,
		.len = 6,
	};
	struct spi_transfer xfer_data = {
		.rx_buf = NULL,
	};

	size_et736 = ((324 * 324) / 1024) * 1024 + 1024;

	buf = kzalloc(size_et736, GFP_KERNEL);
	if (buf == NULL)
		return -ENOMEM;

	pr_info("%s size = %d,  buf = %p, fr = %p\n", __func__, size, buf, fr);
	/*read sector 0.*/
	xfer_data.rx_buf = buf;
	xfer_data.len = 60*1024;

	tx[4] = 60;
	tx[5] = tx[0] + tx[1] + tx[2] + tx[3] + tx[4];
	pr_info("%s (0) xfer_data.len = %d, rx_buf = %p, tx[2](%x), tx[3](%x), tx[4](%x)\n",
		__func__, xfer_data.len,
		xfer_data.rx_buf, tx[2], tx[3], tx[4]);

	spi_message_init(&m);
	spi_message_add_tail(&xfer_op, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s set sector(0) error status = %d\n",
			       __func__, status);
		goto end;
	}

	/*read sector 0.*/
	spi_message_init(&m);
	spi_message_add_tail(&xfer_data, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s read data(0) error status = %d\n", __func__, status);
		goto end;
	}

	tx[2] = 60;
	tx[4] = 43;
	tx[5] = tx[0] + tx[1] + tx[2] + tx[3] + tx[4];
	pr_info("%s (1) xfer_data.len = %d, rx_buf = %p, tx[2](%x), tx[3](%x), tx[4](%x)\n",
		__func__, size_et736 - 60 * 1024,
		buf + 60 * 1024, tx[2], tx[3], tx[4]);
	usleep_range(10 * 1000, 12 * 1000);
	spi_message_init(&m);
	spi_message_add_tail(&xfer_op, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s set sector(0) error status = %d\n",
			       __func__, status);
		goto end;
	}

	/* read sector 1 */
	xfer_data.rx_buf = buf + 60 * 1024;
	xfer_data.len = size_et736 - 60 * 1024;

	spi_message_init(&m);
	spi_message_add_tail(&xfer_data, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s read data(0) error status = %d\n", __func__, status);
		goto end;
	}

	pr_info("%s (1) xfer_data.len = %d, rx_buf = %p, tx[1](%x), tx[2](%x), tx[3](%x)\n",
			__func__, xfer_data.len,
			xfer_data.rx_buf, tx[1], tx[2], tx[3]);

	if (copy_to_user((u8 __user *) (uintptr_t) fr, buf, size)) {
		pr_err("buffer copy_to_user fail.\n");
		status = -EFAULT;
	}
end:
	kfree(buf);
	return status;
#endif
}

int etspi_io_transfer_command(struct etspi_data *etspi, u8 *tx, u8 *rx,
								u32 size)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status = 0;
	struct spi_message m;
	u8 *tr;

	struct spi_transfer xfer = {
	    .len = size,
	};

	pr_info("%s tx(%p), rx(%p), size(%d)\n", __func__, tx, rx, size);
	tr = kzalloc(size, GFP_KERNEL);
	if (tr == NULL)
		return -ENOMEM;

	xfer.tx_buf = xfer.rx_buf = tr;

	if (copy_from_user(tr, (const u8 __user *)(uintptr_t)tx, size)) {
		pr_err("%s buffer copy_from_user fail. tr(%p), tx(%p)\n", __func__, tr,
		       tx);
		status = -EFAULT;
		goto out;
	}

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s status = %d\n", __func__, status);
		goto out;
	}

	if (copy_to_user(rx, (const u8 __user *)(uintptr_t)tr, size)) {
		pr_err("%s buffer copy_to_user fail. tr(%p) rx(%p)\n", __func__, tr,
		       rx);
		status = -EFAULT;
		goto out;
	}

out:
	kfree(tr);
	return status;
#endif
}

int etspi_write_register(struct etspi_data *etspi, u8 addr, u8 buf)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status;
	struct spi_message m;

	u8 tx[] = {OP_REG_W, addr, buf};

	struct spi_transfer xfer = {
		.tx_buf = tx,
		.rx_buf	= NULL,
		.len = 3,
	};

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);

	if (status == 0) {
		DEBUG_PRINT("%s address = %x result = %x %x\n"
					__func__, addr, result[1], result[2]);
	} else {
		pr_err("%s read data error status = %d\n", __func__, status);
	}

	return status;
#endif
}

int etspi_read_register(struct etspi_data *etspi, u8 addr, u8 *buf)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status;
	struct spi_message m;

	u8 read_value[] = {OP_REG_R, addr, 0x00};
	u8 result[] = {0xFF, 0xFF, 0xFF};

	struct spi_transfer xfer = {
		.tx_buf = read_value,
		.rx_buf	= result,
		.len = 3,
	};

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);

	if (status == 0) {
		*buf = result[2];
		DEBUG_PRINT("%s address = %x result = %x %x\n"
					__func__, addr, result[1], result[2]);
	} else {
		pr_err("%s read data error status = %d\n", __func__, status);
	}

	return status;
#endif
}

/* For microchip sst */
/* microchip sst communication opcode */
#define MICROCHIP_SST_PAGE_PROGRAM 0x02 /* To program up to 256 Bytes */
#define MICROCHIP_SST_READ 0x03 /* Read Memory */
#define MICROCHIP_SST_WRDI 0x04 /* Write-Disable */
#define MICROCHIP_SST_RDSR 0x05 /* Read-Status-Register */
#define MICROCHIP_SST_WREN 0x06 /* Write-Enable */
#define MICROCHIP_SST_CHIP_ERASE 0x60 /* Erase Full Memory Array */
#define MICROCHIP_SST_SECTOR_ERASE 0xD7 /* Erase 4 KByle sector */
#define MICROCHIP_SST_BLOCK_ERASE 0xD8 /* Erase 64 KByle block */

#define MICROCHIP_SST_ADDRESS_SIZE 3
#define MICROCHIP_SST_RW_OFFSET 4 /* OP code 8 bits and address 32bits */
/* The programmed data must be between 1 to 256 Bytes and in whole byte
 * increments; sending less than a full byte will cause the partial byte to
 * be ignored.
 */
#define MICROCHIP_SST_PAGE_PROGRAM_LIMITATION 256
#define MICROCHIP_SST_HIGH_SPEED_READ_DUMMY_LEN 1
/* Wait to write/erase finish */
#define MICROCHIP_SST_STATUS_MAX_RETRY_COUNT 100

int etspi_eeprom_rdsr(struct etspi_data *etspi, u8 *eeprom_status)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status;
	struct spi_message m;
	u8 buf[2];

	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = 2,
	};

	xfer.tx_buf = xfer.rx_buf = buf;
	buf[0] = MICROCHIP_SST_RDSR;

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s spi_sync error status = %d\n", __func__, status);
	} else {
		if (copy_to_user((u8 __user *) (uintptr_t) eeprom_status,
				buf + 1, 1)) {
			pr_err("%s buffer copy_to_user fail\n", __func__);
			status = -EFAULT;
		}
		pr_info("%s eeprom_status  = %d\n", __func__, buf[1]);
	}

	return status;
#endif
}

int etspi_eeprom_read_status_internal(struct etspi_data *etspi, u8 *eeprom_status)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status;
	struct spi_message m;
	u8 buf[2];

	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = 2,
	};

	xfer.tx_buf = xfer.rx_buf = buf;
	buf[0] = MICROCHIP_SST_RDSR;

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s spi_sync error status = %d\n", __func__, status);
	} else {
		*eeprom_status = buf[1];
		pr_info("%s eeprom_status  = %d\n", __func__, *eeprom_status);
	}

	return status;
#endif
}

int etspi_eeprom_chip_erase(struct etspi_data *etspi)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status;
	struct spi_message m;
	u8 buf[1];

	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = 1,
	};

	xfer.tx_buf = buf;
	buf[0] = MICROCHIP_SST_CHIP_ERASE;

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0)
		pr_err("%s spi_sync error status = %d\n",
			__func__, status);

	return status;
#endif
}

int etspi_eeprom_sector_erase(struct etspi_data *etspi, struct egis_ioc_transfer *ioc)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	struct spi_message m;
	int status;
	u8 *buf = NULL;
	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = 0,
	};

	if (ioc->len > MICROCHIP_SST_PAGE_PROGRAM_LIMITATION) {
		pr_err("%s len EINVAL\n", __func__);
		status = -EINVAL;
	}

	buf = kzalloc(ioc->len + 1, GFP_KERNEL);
	if (buf == NULL) {
		pr_err("%s buf kzalloc fail\n", __func__);
		status = -ENOMEM;
		goto end;
	}

	if (copy_from_user(buf + 1, (const u8 __user *) (uintptr_t) ioc->tx_buf
		, ioc->len)) {
		pr_err("%s buffer copy_from_user fail\n", __func__);
		status = -EFAULT;
		goto end;
	}

	pr_info("%s Init ioc->len = %d, buf[1] = 0x%x buf[2] = 0x%x, buf[3] = 0x%x\n",
		__func__, ioc->len, buf[1], buf[2], buf[3]);

	xfer.len = ioc->len + 1; /* OP code */
	xfer.tx_buf = buf;
	xfer.rx_buf = NULL;
	buf[0] = MICROCHIP_SST_SECTOR_ERASE;

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);

end:

	if (buf)
		kfree(buf);

	return status;

#endif
}

int etspi_eeprom_block_erase(struct etspi_data *etspi, struct egis_ioc_transfer *ioc)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	struct spi_message m;
	int status;
	u8 *buf = NULL;
	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = 0,
	};

	if (ioc->len > MICROCHIP_SST_PAGE_PROGRAM_LIMITATION) {
		pr_err("%s len EINVAL\n", __func__);
		status = -EINVAL;
	}

	buf = kzalloc(ioc->len + 1, GFP_KERNEL);
	if (buf == NULL) {
		pr_err("%s buf kzalloc fail\n", __func__);
		status = -ENOMEM;
		goto end;
	}

	if (copy_from_user(buf + 1, (const u8 __user *) (uintptr_t) ioc->tx_buf
		, ioc->len)) {
		pr_err("%s buffer copy_from_user fail\n", __func__);
		status = -EFAULT;
		goto end;
	}

	pr_info("%s Init ioc->len = %d, buf[1] = 0x%x buf[2] = 0x%x, buf[3] = 0x%x\n",
		__func__, ioc->len, buf[1], buf[2], buf[3]);

	xfer.len = ioc->len + 1; /* OP code */
	xfer.tx_buf = buf;
	xfer.rx_buf = NULL;
	buf[0] = MICROCHIP_SST_BLOCK_ERASE;

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);

end:

	if (buf)
		kfree(buf);

	return status;

#endif
}

int etspi_eeprom_write_controller(struct etspi_data *etspi, int enable)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	int status;
	struct spi_message m;
	u8 buf[1];
	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = 1,
	};

	xfer.tx_buf = xfer.rx_buf = buf;
	if (enable > 0)
		buf[0] = MICROCHIP_SST_WREN;
	else
		buf[0] = MICROCHIP_SST_WRDI;

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0)
		pr_err("%s spi_sync error status = %d\n", __func__, status);

	return status;
#endif
}

int etspi_eeprom_read(struct etspi_data *etspi, struct egis_ioc_transfer *ioc)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	struct spi_message m;
	int status;
	u8 *buf = NULL, addr[MICROCHIP_SST_ADDRESS_SIZE];
	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = 0,
	};

	pr_info("%s Version is 1128-3", __func__);

	if (copy_from_user(addr, (const u8 __user *) (uintptr_t) ioc->tx_buf
		, MICROCHIP_SST_ADDRESS_SIZE)) {
		pr_err("%s buffer copy_from_user fail\n", __func__);
		status = -EFAULT;
		return status;
	}

	xfer.len = ioc->len + MICROCHIP_SST_RW_OFFSET;
	if (xfer.len >= LARGE_SPI_TRANSFER_BUFFER) {
		if ((xfer.len) % DIVISION_OF_IMAGE != 0)
			xfer.len = xfer.len + (DIVISION_OF_IMAGE -
				(xfer.len % DIVISION_OF_IMAGE));
	}

	pr_info("%s xfer.len = %d, addr[0] = 0x%x addr[1] = 0x%x, addr[2] = 0x%x\n",
		__func__, xfer.len, addr[0], addr[1], addr[2]);

	buf = kzalloc(xfer.len, GFP_KERNEL);
	if (buf == NULL) {
		pr_err("%s buf kzalloc fail\n", __func__);
		return -ENOMEM;
	}
	memset(buf, 0x0, xfer.len);

	xfer.tx_buf = xfer.rx_buf = buf;
	buf[0] = MICROCHIP_SST_READ;
	memcpy(buf + 1, addr, MICROCHIP_SST_ADDRESS_SIZE);

	pr_info("%s ioc->len = %d, xfer.len = %d, buf = %p ", __func__,
		ioc->len, xfer.len, buf);

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s spi_sync error status = %d\n", __func__,
			status);
		goto end;
	}

	if (copy_to_user((u8 __user *) (uintptr_t) ioc->rx_buf,
			buf + MICROCHIP_SST_RW_OFFSET, ioc->len)) {
		pr_err("%s buffer copy_to_user fail\n", __func__);
		status = -EFAULT;
	}

end:

	if (buf)
		kfree(buf);

	return status;
#endif
}

int etspi_eeprom_high_speed_read(struct etspi_data *etspi, struct egis_ioc_transfer *ioc)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	struct spi_message m;
	int status;
	u8 *buf = NULL, addr[MICROCHIP_SST_ADDRESS_SIZE];
	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = 0,
	};

	pr_info("%s Version is 1124-5", __func__);

	if (copy_from_user(addr, (const u8 __user *) (uintptr_t) ioc->tx_buf
		, MICROCHIP_SST_ADDRESS_SIZE)) {
		pr_err("%s buffer copy_from_user fail\n", __func__);
		status = -EFAULT;
		return status;
	}

	xfer.len = ioc->len + MICROCHIP_SST_RW_OFFSET;
	if (xfer.len >= LARGE_SPI_TRANSFER_BUFFER) {
		if ((xfer.len) % DIVISION_OF_IMAGE != 0)
			xfer.len = xfer.len + (DIVISION_OF_IMAGE -
				(xfer.len % DIVISION_OF_IMAGE));
	}

	pr_info("%s xfer.len = %d, addr[0] = 0x%x addr[1] = 0x%x, addr[2] = 0x%x\n",
		__func__, xfer.len, addr[0], addr[1], addr[2]);

	buf = kzalloc(xfer.len + MICROCHIP_SST_HIGH_SPEED_READ_DUMMY_LEN,
		GFP_KERNEL);
	if (buf == NULL) {
		pr_err("%s buf kzalloc fail\n", __func__);
		return -ENOMEM;
	}
	memset(buf, 0x0, xfer.len);

	xfer.tx_buf = xfer.rx_buf = buf;
	buf[0] = MICROCHIP_SST_READ;
	memcpy(buf + 1, addr, MICROCHIP_SST_ADDRESS_SIZE);

	pr_info("%s ioc->len = %d, xfer.len = %d, buf = %p ", __func__,
		ioc->len, xfer.len, buf);

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	if (status < 0) {
		pr_err("%s spi_sync error status = %d\n", __func__,
			status);
		goto end;
	}

	if (copy_to_user((u8 __user *) (uintptr_t) ioc->rx_buf,
			buf + MICROCHIP_SST_RW_OFFSET +
			MICROCHIP_SST_HIGH_SPEED_READ_DUMMY_LEN, ioc->len)) {
		pr_err("%s buffer copy_to_user fail\n", __func__);
		status = -EFAULT;
	}

end:

	if (buf)
		kfree(buf);

	return status;
#endif
}

int etspi_eeprom_write(struct etspi_data *etspi, struct egis_ioc_transfer *ioc)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	struct spi_message m;
	int status;
	u8 *buf = NULL;
	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = 0,
	};

	if (ioc->len > MICROCHIP_SST_PAGE_PROGRAM_LIMITATION) {
		pr_err("%s len EINVAL\n", __func__);
		status = -EINVAL;
	}

	buf = kzalloc(ioc->len + 1, GFP_KERNEL);
	if (buf == NULL) {
		pr_err("%s buf kzalloc fail\n", __func__);
		status = -ENOMEM;
		goto end;
	}

	if (copy_from_user(buf + 1, (const u8 __user *) (uintptr_t) ioc->tx_buf
		, ioc->len)) {
		pr_err("%s buffer copy_from_user fail\n", __func__);
		status = -EFAULT;
		goto end;
	}

	pr_info("%s Init ioc->len = %d, buf[1] = 0x%x buf[2] = 0x%x, buf[3] = 0x%x\n",
		__func__, ioc->len, buf[1], buf[2], buf[3]);

	xfer.len = ioc->len + 1; /* OP code */
	xfer.tx_buf = buf;
	xfer.rx_buf = NULL;
	buf[0] = MICROCHIP_SST_PAGE_PROGRAM;

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);

end:

	if (buf)
		kfree(buf);

	return status;

#endif
}

void etspi_eeprom_finish_operation(struct etspi_data *etspi)
{
	pr_info("%s\n", __func__);
	gpio_set_value(etspi->sleepPin, 1);
	usleep_range(1050, 1100);
	gpio_set_value(etspi->sleepPin, 0);
}

int etspi_eeprom_write_in_non_tz(struct etspi_data *etspi, struct egis_ioc_transfer *ioc)
{
#ifdef ENABLE_SENSORS_FPRINT_SECURE
	return 0;
#else
	struct spi_message m;
	int status, page_count, index = 0, address_64bits, current_len,
		status_retry_count = 0;
	u8 *buf = NULL, *data = NULL, eeprom_status = 0x0;
	struct spi_transfer xfer = {
		.tx_buf = NULL,
		.rx_buf = NULL,
		.len = 0,
	};

	etspi_eeprom_finish_operation(etspi);

	status = etspi_eeprom_write_controller(etspi, 1);
	if (status < 0) {
		pr_err("%s Write enable fail status = %d\n", __func__,
			status);
		return status;
	}

	etspi_eeprom_finish_operation(etspi);

	status = etspi_eeprom_chip_erase(etspi);
	if (status < 0) {
		pr_err("%s erase full fail status = %d\n", __func__,
			status);
		return status;
	}

	etspi_eeprom_finish_operation(etspi);

	do {
		usleep_range(500, 1000);
		status = etspi_eeprom_read_status_internal(etspi, &eeprom_status);
		etspi_eeprom_finish_operation(etspi);
		if (status < 0) {
			pr_err("%s get eeprom status fail status = %d\n",
				__func__, status);
			goto end;
		}

		if (++status_retry_count > MICROCHIP_SST_STATUS_MAX_RETRY_COUNT) {
			pr_err("%s not finish erase eeprom\n", __func__);
			break;
		}
	} while ((eeprom_status & 0x01) != 0);

	status = etspi_eeprom_write_controller(etspi, 0);
	if (status < 0) {
		pr_err("%s Write disable fail status = %d\n",
			__func__, status);
		return status;
	}

	etspi_eeprom_finish_operation(etspi);

	data = kzalloc(ioc->len, GFP_KERNEL);
	if (data == NULL) {
		pr_err("%s data kzalloc fail\n", __func__);
		status = -ENOMEM;
		return status;
	}

	buf = kzalloc(MICROCHIP_SST_RW_OFFSET +
		MICROCHIP_SST_PAGE_PROGRAM_LIMITATION, GFP_KERNEL);
	if (buf == NULL) {
		pr_err("%s buf kzalloc fail\n", __func__);
		status = -ENOMEM;
		goto end;
	}

	if (copy_from_user(data, (const u8 __user *) (uintptr_t) ioc->tx_buf
		, ioc->len)) {
		pr_err("%s buffer copy_from_user fail\n", __func__);
		status = -EFAULT;
		goto end;
	}

	address_64bits = (data[0] << 16) + (data[1] << 8) + data[2];
	page_count = (ioc->len - MICROCHIP_SST_ADDRESS_SIZE) /
		MICROCHIP_SST_PAGE_PROGRAM_LIMITATION;
	if ((ioc->len - MICROCHIP_SST_ADDRESS_SIZE) %
		MICROCHIP_SST_PAGE_PROGRAM_LIMITATION != 0)
		page_count++;

	pr_info("%s Init data : ioc->len = %d, page_count = %d\n",
		__func__, ioc->len, page_count);
	pr_info("%s Init ioc->len = %d, address = 0x%x address[1] = 0x%x address[2] = 0x%x, address[3] = 0x%x\n",
		__func__, ioc->len, address_64bits, data[0], data[1], data[2]);

write_eeprom:

	status = etspi_eeprom_write_controller(etspi, 1);
	if (status < 0) {
		pr_err("%s Write enable fail status = %d\n", __func__,
			status);
		goto end;
	}

	etspi_eeprom_finish_operation(etspi);

	if (index >= (page_count - 1)) {
		current_len = (ioc->len - MICROCHIP_SST_ADDRESS_SIZE) %
			MICROCHIP_SST_PAGE_PROGRAM_LIMITATION;
		if (current_len == 0)
			current_len = MICROCHIP_SST_PAGE_PROGRAM_LIMITATION;
	} else {
		current_len = MICROCHIP_SST_PAGE_PROGRAM_LIMITATION;
	}

	pr_info("%s Run data : ioc->len = %d, page_count = %d\n",
		__func__, ioc->len, page_count);

	xfer.len = MICROCHIP_SST_RW_OFFSET + current_len;
	xfer.tx_buf = buf;
	xfer.rx_buf = NULL;
	buf[0] = MICROCHIP_SST_PAGE_PROGRAM;
	buf[1] = (address_64bits & 0xff0000) >> 16;
	buf[2] = (address_64bits & 0x00ff00) >> 8;
	buf[3] = (address_64bits & 0x0000ff);
	memcpy(buf + MICROCHIP_SST_RW_OFFSET, data + MICROCHIP_SST_ADDRESS_SIZE +
		(index * MICROCHIP_SST_PAGE_PROGRAM_LIMITATION), current_len);

	pr_info("%s Run index = %d page_count = %d current_len = %d, xfer.len = %d\n",
		__func__, index, page_count, current_len, xfer.len);
	pr_info("%s Run address = 0x%x address[1] = 0x%x address[2] = 0x%x, address[3] = 0x%x\n",
		__func__, address_64bits, buf[1], buf[2], buf[3]);

	spi_message_init(&m);
	spi_message_add_tail(&xfer, &m);
	status = spi_sync(etspi->spi, &m);
	etspi_eeprom_finish_operation(etspi);
	if (status < 0) {
		pr_err("%s spi_sync error status = %d\n", __func__,
			status);
		goto end;
	}

	status_retry_count = 0;
	eeprom_status = 0x0;
	do {
		usleep_range(500, 1000);
		status = etspi_eeprom_read_status_internal(etspi, &eeprom_status);
		etspi_eeprom_finish_operation(etspi);
		if (status < 0) {
			pr_err("%s get eeprom status fail status = %d\n",
				__func__, status);
			goto end;
		}

		if (++status_retry_count > MICROCHIP_SST_STATUS_MAX_RETRY_COUNT) {
			pr_err("%s not finish writing eeprom\n", __func__);
			break;
		}
	} while ((eeprom_status & 0x01) != 0);

	status = etspi_eeprom_write_controller(etspi, 0);
	if (status < 0) {
		pr_err("%s Write disable fail status = %d\n",
			__func__, status);
		goto end;
	}

	etspi_eeprom_finish_operation(etspi);

	if (++index < page_count) {
		address_64bits += MICROCHIP_SST_PAGE_PROGRAM_LIMITATION;
		goto write_eeprom;
	}

end:

	gpio_set_value(etspi->sleepPin, 1);

	if (buf)
		kfree(buf);

	if (data)
		kfree(data);

	return status;
#endif
}