|
@@ -85,7 +85,7 @@ struct mtk_spi {
|
|
|
void __iomem *base;
|
|
|
u32 state;
|
|
|
u32 pad_sel;
|
|
|
- struct clk *spi_clk, *parent_clk;
|
|
|
+ struct clk *parent_clk, *sel_clk, *spi_clk;
|
|
|
struct spi_transfer *cur_transfer;
|
|
|
u32 xfer_len;
|
|
|
struct scatterlist *tx_sgl, *rx_sgl;
|
|
@@ -173,22 +173,6 @@ static void mtk_spi_config(struct mtk_spi *mdata,
|
|
|
writel(mdata->pad_sel, mdata->base + SPI_PAD_SEL_REG);
|
|
|
}
|
|
|
|
|
|
-static int mtk_spi_prepare_hardware(struct spi_master *master)
|
|
|
-{
|
|
|
- struct spi_transfer *trans;
|
|
|
- struct mtk_spi *mdata = spi_master_get_devdata(master);
|
|
|
- struct spi_message *msg = master->cur_msg;
|
|
|
-
|
|
|
- trans = list_first_entry(&msg->transfers, struct spi_transfer,
|
|
|
- transfer_list);
|
|
|
- if (!trans->cs_change) {
|
|
|
- mdata->state = MTK_SPI_IDLE;
|
|
|
- mtk_spi_reset(mdata);
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
static int mtk_spi_prepare_message(struct spi_master *master,
|
|
|
struct spi_message *msg)
|
|
|
{
|
|
@@ -228,11 +212,15 @@ static void mtk_spi_set_cs(struct spi_device *spi, bool enable)
|
|
|
struct mtk_spi *mdata = spi_master_get_devdata(spi->master);
|
|
|
|
|
|
reg_val = readl(mdata->base + SPI_CMD_REG);
|
|
|
- if (!enable)
|
|
|
+ if (!enable) {
|
|
|
reg_val |= SPI_CMD_PAUSE_EN;
|
|
|
- else
|
|
|
+ writel(reg_val, mdata->base + SPI_CMD_REG);
|
|
|
+ } else {
|
|
|
reg_val &= ~SPI_CMD_PAUSE_EN;
|
|
|
- writel(reg_val, mdata->base + SPI_CMD_REG);
|
|
|
+ writel(reg_val, mdata->base + SPI_CMD_REG);
|
|
|
+ mdata->state = MTK_SPI_IDLE;
|
|
|
+ mtk_spi_reset(mdata);
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
static void mtk_spi_prepare_transfer(struct spi_master *master,
|
|
@@ -509,7 +497,6 @@ static int mtk_spi_probe(struct platform_device *pdev)
|
|
|
master->mode_bits = SPI_CPOL | SPI_CPHA;
|
|
|
|
|
|
master->set_cs = mtk_spi_set_cs;
|
|
|
- master->prepare_transfer_hardware = mtk_spi_prepare_hardware;
|
|
|
master->prepare_message = mtk_spi_prepare_message;
|
|
|
master->transfer_one = mtk_spi_transfer_one;
|
|
|
master->can_dma = mtk_spi_can_dma;
|
|
@@ -576,13 +563,6 @@ static int mtk_spi_probe(struct platform_device *pdev)
|
|
|
goto err_put_master;
|
|
|
}
|
|
|
|
|
|
- mdata->spi_clk = devm_clk_get(&pdev->dev, "spi-clk");
|
|
|
- if (IS_ERR(mdata->spi_clk)) {
|
|
|
- ret = PTR_ERR(mdata->spi_clk);
|
|
|
- dev_err(&pdev->dev, "failed to get spi-clk: %d\n", ret);
|
|
|
- goto err_put_master;
|
|
|
- }
|
|
|
-
|
|
|
mdata->parent_clk = devm_clk_get(&pdev->dev, "parent-clk");
|
|
|
if (IS_ERR(mdata->parent_clk)) {
|
|
|
ret = PTR_ERR(mdata->parent_clk);
|
|
@@ -590,13 +570,27 @@ static int mtk_spi_probe(struct platform_device *pdev)
|
|
|
goto err_put_master;
|
|
|
}
|
|
|
|
|
|
+ mdata->sel_clk = devm_clk_get(&pdev->dev, "sel-clk");
|
|
|
+ if (IS_ERR(mdata->sel_clk)) {
|
|
|
+ ret = PTR_ERR(mdata->sel_clk);
|
|
|
+ dev_err(&pdev->dev, "failed to get sel-clk: %d\n", ret);
|
|
|
+ goto err_put_master;
|
|
|
+ }
|
|
|
+
|
|
|
+ mdata->spi_clk = devm_clk_get(&pdev->dev, "spi-clk");
|
|
|
+ if (IS_ERR(mdata->spi_clk)) {
|
|
|
+ ret = PTR_ERR(mdata->spi_clk);
|
|
|
+ dev_err(&pdev->dev, "failed to get spi-clk: %d\n", ret);
|
|
|
+ goto err_put_master;
|
|
|
+ }
|
|
|
+
|
|
|
ret = clk_prepare_enable(mdata->spi_clk);
|
|
|
if (ret < 0) {
|
|
|
dev_err(&pdev->dev, "failed to enable spi_clk (%d)\n", ret);
|
|
|
goto err_put_master;
|
|
|
}
|
|
|
|
|
|
- ret = clk_set_parent(mdata->spi_clk, mdata->parent_clk);
|
|
|
+ ret = clk_set_parent(mdata->sel_clk, mdata->parent_clk);
|
|
|
if (ret < 0) {
|
|
|
dev_err(&pdev->dev, "failed to clk_set_parent (%d)\n", ret);
|
|
|
goto err_disable_clk;
|
|
@@ -630,7 +624,6 @@ static int mtk_spi_remove(struct platform_device *pdev)
|
|
|
pm_runtime_disable(&pdev->dev);
|
|
|
|
|
|
mtk_spi_reset(mdata);
|
|
|
- clk_disable_unprepare(mdata->spi_clk);
|
|
|
spi_master_put(master);
|
|
|
|
|
|
return 0;
|