src/kernel/linux/v4.19/drivers/spi/spi-mt65xx-dev.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (c) 2019 MediaTek Inc.
 */

#include <linux/completion.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/spi/spi.h>
#include <linux/clk.h>
#include <linux/platform_data/spi-mt65xx.h>
#include <linux/random.h>
#include <linux/clk.h>
#include <linux/gpio/consumer.h>
#include <linux/kernel.h> /* printk */
#include <linux/pinctrl/consumer.h>


static bool spi_auto_test_flag;
static struct pinctrl *pinctrl_spi;
static struct pinctrl_state *default_spi;
#define SPI_DEBUG(fmt, args...) pr_info(fmt, ##args)

struct mtk_spi {
	void __iomem *base;
	u32 state;
	int pad_num;
	u32 *pad_sel;
	struct clk *parent_clk, *sel_clk, *spi_clk, *spare_clk;
	struct spi_transfer *cur_transfer;
	u32 xfer_len;
	u32 num_xfered;
	struct scatterlist *tx_sgl, *rx_sgl;
	u32 tx_sgl_len, rx_sgl_len;
	const struct mtk_spi_compatible *dev_comp;
};

static int secspi_enable_clk(struct spi_device *spidev)
{
	int ret;
	struct spi_master *master;
	struct mtk_spi *ms;

	master = spidev->master;
	ms = spi_master_get_devdata(master);

	ret = clk_prepare_enable(ms->spi_clk);
	
	if (ret < 0) {
		SPI_DEBUG("failed to enable spi_clk (%d)\n", ret);
		return ret;
	}

	if (!IS_ERR(ms->spare_clk)) {
		ret = clk_prepare_enable(ms->spare_clk);
		if (ret < 0) {
			clk_disable_unprepare(ms->spi_clk);
			SPI_DEBUG("failed to disable spi_clk (%d)\n", ret);
			return ret;
		}
	}

	return 0;
	
}

void secspi_disable_clk(struct spi_device *spidev)
{

	struct spi_master *master;
	struct mtk_spi *ms;

	master = spidev->master;
	ms = spi_master_get_devdata(master);

	clk_disable_unprepare(ms->spi_clk);
	if (!IS_ERR(ms->spare_clk))
		clk_disable_unprepare(ms->spare_clk);
}

void spi_transfer_malloc(struct spi_transfer *trans, int is2spis)
{
	int i;

	trans->tx_buf = kzalloc(trans->len, GFP_KERNEL);
	trans->rx_buf = kzalloc(trans->len, GFP_KERNEL);
	memset(trans->rx_buf, 0, trans->len);
/*zhengzhou 2021.03.03 modify  +++++ */
	//if (is2spis) {
	//	i = 1;
	//	*((char *)trans->tx_buf) = 0x55;
	//} else
/*zhengzhou 2021.03.03 modify  ------ */
		i = 0;

	for (; i < trans->len; i++)
		*((char *)trans->tx_buf + i) = i;
}

void spi_transfer_free(struct spi_transfer *trans)
{
	kfree(trans->tx_buf);
	kfree(trans->rx_buf);
}

static void debug_packet(char *name, u8 *ptr, int len)
{
	int i;

	SPI_DEBUG("%s: ", name);
	for (i = 0; i < len; i++)
		SPI_DEBUG(" %02x", ptr[i]);
	 SPI_DEBUG("\n");
}

int spi_loopback_check(struct spi_device *spi,
	struct spi_transfer *trans, int is2spis)
{
	int i, value, err = 0;

	//if (is2spis)//zhengzhou 2021.03.03 modify
	//	i = 1;//zhengzhou 2021.03.03 modify
	//else//zhengzhou 2021.03.03 modify
		i = 0;

	for (; i < trans->len; i++) {
		value = *((u8 *) trans->tx_buf + i);
		if (value != *((char *) trans->rx_buf + i))
			err++;
	}

	if (err) {
		SPI_DEBUG("spim_len:%d, err %d\n", trans->len, err);
		debug_packet("spim_tx_buf", (void *)trans->tx_buf, trans->len);
		debug_packet("spim_rx_buf", trans->rx_buf, trans->len);
		SPI_DEBUG("spim test fail.\n");
		spi_auto_test_flag = false;
	} else {
		SPI_DEBUG("spim_len:%d, err %d\n", trans->len, err);
		SPI_DEBUG("spim test pass.\n");
		spi_auto_test_flag = true;
	}

	if (err)
		return -1;
	else
		return 0;
}

int spi_loopback_transfer(struct spi_device *spi, int len, int is2spis)
{
	struct spi_transfer trans;
	struct spi_message msg;
	int ret = 0;

	memset(&trans, 0, sizeof(struct spi_transfer));
	spi_message_init(&msg);

	if (is2spis) {
		trans.speed_hz = 13000000;
		trans.len = len;//zhengzhou 2021.03.03 modify
	} else
		trans.len = len;
	trans.cs_change = 0;
	spi_transfer_malloc(&trans, is2spis);
	spi_message_add_tail(&trans, &msg);
	ret = spi_sync(spi, &msg);
	if (ret < 0)
		SPI_DEBUG("Message transfer err,line(%d):%d\n", __LINE__, ret);
	spi_loopback_check(spi, &trans, is2spis);
	spi_transfer_free(&trans);

	return ret;
}

static ssize_t spi_show(struct device *dev,
			 struct device_attribute *attr, char *buf)
{
	char *bp = buf;

	if (spi_auto_test_flag)
		bp += sprintf(bp, "spim talk with spis pass\n");
	else
		bp += sprintf(bp, "spim talk with spis fail\n");

	*bp++ = '\n';

	return bp - buf;
}

static ssize_t spi_store(struct device *dev,
			 struct device_attribute *attr,
			 const char *buf, size_t count)
{
	int len;
	struct spi_device *spi;

	spi = container_of(dev, struct spi_device, dev);

	if (!strncmp(buf, "-w", 2)) {
		buf += 3;

		if (!strncmp(buf, "len=", 4) &&
		    (sscanf(buf + 4, "%d", &len) == 1)) {
			spi_loopback_transfer(spi, len, 0);
		}
	}

	if (!strncmp(buf, "spim2spis", 9)) {
		buf += 10;

		if (!strncmp(buf, "len=", 4) &&
			(sscanf(buf + 4, "%d", &len) == 1)) {
			spi_loopback_transfer(spi, len, 1);
		}
	}

	if (!strncmp(buf, "enableclk", 9))
		secspi_enable_clk(spi);
	if (!strncmp(buf, "disableclk", 10))
		secspi_disable_clk(spi);

	return count;
}

static DEVICE_ATTR_RW(spi);

static struct device_attribute *spi_attribute[] = {
	&dev_attr_spi,
};

static int spi_create_attribute(struct device *dev)
{
	int i, size, idx;
	int res = 0;

	size = ARRAY_SIZE(spi_attribute);
	for (idx = 0; idx < size; idx++) {
		res = device_create_file(dev, spi_attribute[idx]);
		if (res)
			goto err;
	}
	return res;
err:
	for (i = 0; i < idx; i++)
		device_remove_file(dev, spi_attribute[idx]);
	return res;
}
//zhengzhou 2021.03.03 modify +++++
static int spi_get_pinctrl_info(struct spi_device *spi)
{
	int ret;

	pinctrl_spi = devm_pinctrl_get(&spi->dev);
	if (IS_ERR(pinctrl_spi)) {
		ret = PTR_ERR(pinctrl_spi);
		pr_notice("Cannot find pinctrl_spi!\n");
		return ret;
	}

	default_spi = pinctrl_lookup_state(pinctrl_spi, "default");
	if (IS_ERR(default_spi)) {
		ret = PTR_ERR(default_spi);
		pr_notice("Cannot find pinctrl default %d!\n", ret);
	}

	//spi_gpio = pinctrl_lookup_state(pinctrl_spi, "spi_gpio_mode");
	//if (IS_ERR(spi_gpio)) {
	//	ret = PTR_ERR(spi_gpio);
	//	pr_notice("Cannot find pinctrl spi_gpio_mode %d!\n", ret);
	//}

	return 0;
}
//zhengzhou 2021.03.03 modify ------
static int spi_mt65xx_dev_probe(struct spi_device *spi)
{
	spi_get_pinctrl_info(spi);//zhengzhou 2021.03.03 modify +++++
	spi_create_attribute(&spi->dev);
	return 0;
}

static int spi_mt65xx_dev_remove(struct spi_device *spi)
{
	return 0;
}

static const struct of_device_id spi_mt65xx_dev_dt_ids[] = {
	{ .compatible = "mediatek,spi-mt65xx-dev" },//zhengzhou 2021.03.03 modify 
	{ .compatible = "mediatek,spi-slave-autotest" },//zhengzhou 2021.03.03 modify 
	{},
};
MODULE_DEVICE_TABLE(of, spi_mt65xx_dev_dt_ids);

static struct spi_driver spi_mt65xx_dev_driver = {
	.driver = {
		.name	= "spi-mt65xx-dev",
		.of_match_table = of_match_ptr(spi_mt65xx_dev_dt_ids),
	},
	.probe		= spi_mt65xx_dev_probe,
	.remove		= spi_mt65xx_dev_remove,
};
module_spi_driver(spi_mt65xx_dev_driver);

MODULE_AUTHOR("Mediatek");
MODULE_LICENSE("GPL v2");