[Feature] add GA346 baseline version
Change-Id: Ic62933698569507dcf98240cdf5d9931ae34348f
diff --git a/src/kernel/linux/v4.19/drivers/spi/spi-mt65xx-dev.c b/src/kernel/linux/v4.19/drivers/spi/spi-mt65xx-dev.c
new file mode 100644
index 0000000..a49a1a8
--- /dev/null
+++ b/src/kernel/linux/v4.19/drivers/spi/spi-mt65xx-dev.c
@@ -0,0 +1,306 @@
+// 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");