From: Sascha Hauer <s.ha...@pengutronix.de>
Signed-off-by: Sascha Hauer <s.ha...@pengutronix.de>
---
drivers/spi/spi_imx.c | 123 +++++++++++++++++++++++++++++++++++++++++++++++-
1 files changed, 120 insertions(+), 3 deletions(-)
diff --git a/drivers/spi/spi_imx.c b/drivers/spi/spi_imx.c
index 7972e90..5ee2699 100644
--- a/drivers/spi/spi_imx.c
+++ b/drivers/spi/spi_imx.c
@@ -155,6 +155,117 @@ static unsigned int spi_imx_clkdiv_2(unsigned int fin,
return 7;
}
+/* MX51 */
+static unsigned int spi_imx_clkdiv_3(unsigned int fin,
+ unsigned int fspi)
+{
+ unsigned int div = 4, post = 0, pre = 0, res;
+
+ div = fin / fspi;
+
+ res = fin;
+ while (res > (fspi * 16)) {
+ post++;
+ res = fin / (1 << post);
+ }
+
+ pre = fin / (1 << post) / fspi;
+
+ return (post & 0xf) | ((pre & 0xf) << 4);
+}
+
+#define MX51_CSPIRXDATA 0x00
+#define MX51_CSPITXDATA 0x04
+#define MX51_CSPICTRL 0x08
+#define MX51_CSPICONFIG 0x0c
+#define MX51_CSPIINT 0x10
+#define MX51_CSPIDMA 0x14
+#define MX51_CSPISTATUS 0x18
+#define MX51_CSPIPERIOD 0x1c
+#define MX51_CSPITEST 0x20
+
+#define MX51_INTREG_TEEN (1 << 0)
+#define MX51_INTREG_RREN (1 << 3)
+
+#define MX51_CSPICTRL_ENABLE (1 << 0)
+#define MX51_CSPICTRL_XCH (1 << 2)
+#define MX51_CSPICTRL_DIV_SHIFT 8
+#define MX51_CSPICTRL_MASTER(cs) ((1 << (cs)) << 4)
+#define MX51_CSPICTRL_BL_SHIFT 20
+#define MX51_CSPICTRL_CS(cs) ((cs) << 18)
+
+#define MX51_CSPICONFIG_PHA(cs) ((1 << (cs)) << 0)
+#define MX51_CSPICONFIG_POL(cs) ((1 << (cs)) << 4)
+#define MX51_CSPICONFIG_SSBCTRL(cs) ((1 << (cs)) << 8)
+#define MX51_CSPICONFIG_SSBPOL(cs) ((1 << (cs)) << 12)
+#define MX51_CSPICONFIG_DATACTRL(cs) ((1 << (cs)) << 16)
+#define MX51_CSPICONFIG_SCLKCTRL(cs) ((1 << (cs)) << 20)
+
+#define MX51_STATUS_RR (1 << 3)
+
+#define MX51_CSPITEST_LBC (1 << 31)
+
+static void mx51_intctrl(struct spi_imx_data *spi_imx, int enable)
+{
+ unsigned int val = 0;
+
+ if (enable & MXC_INT_TE)
+ val |= MX51_INTREG_TEEN;
+ if (enable & MXC_INT_RR)
+ val |= MX51_INTREG_RREN;
+
+ writel(val, spi_imx->base + MX51_CSPIINT);
+}
+
+static void mx51_trigger(struct spi_imx_data *spi_imx)
+{
+ unsigned int reg;
+
+ reg = readl(spi_imx->base + MXC_CSPICTRL);
+ reg |= MX51_CSPICTRL_XCH;
+ writel(reg, spi_imx->base + MXC_CSPICTRL);
+}
+
+static int mx51_config(struct spi_imx_data *spi_imx,
+ struct spi_imx_config *config)
+{
+ int cs;
+ u32 ctrl;
+ u32 cfg = 0;
+
+#ifdef INTERNAL_LOOPBACK
+ writel(MX51_CSPITEST_LBC, spi_imx->base + MX51_CSPITEST);
+#endif
+ if (config->cs < 0)
+ cs = config->cs + 32;
+ else
+ cs = 0;
+
+ ctrl = MX51_CSPICTRL_MASTER(cs) | MX51_CSPICTRL_ENABLE;
+ ctrl |= spi_imx_clkdiv_3(spi_imx->spi_clk, config->speed_hz) <<
+ MX51_CSPICTRL_DIV_SHIFT;
+
+ ctrl |= (config->bpw - 1) << MX51_CSPICTRL_BL_SHIFT;
+ cfg |= MX51_CSPICONFIG_SSBCTRL(cs);
+ if (config->mode & SPI_CPHA)
+ cfg |= MX51_CSPICONFIG_PHA(cs);
+ if (config->mode & SPI_CPOL)
+ cfg |= MX51_CSPICONFIG_POL(cs) | MX51_CSPICONFIG_SCLKCTRL(cs);
+ if (config->mode & SPI_CS_HIGH)
+ cfg |= MX51_CSPICONFIG_SSBPOL(cs);
+ ctrl |= MX51_CSPICTRL_CS(cs);
+
+ writel(ctrl, spi_imx->base + MX51_CSPICTRL);
+ writel(cfg, spi_imx->base + MX51_CSPICONFIG);
+
+ return 0;
+}
+
+static int mx51_rx_available(struct spi_imx_data *spi_imx)
+{
+ return readl(spi_imx->base + MX51_CSPISTATUS) & MX51_STATUS_RR;
+}
+
#define MX31_INTREG_TEEN (1 << 0)
#define MX31_INTREG_RREN (1 << 3)
@@ -209,7 +320,7 @@ static int mx31_config(struct spi_imx_data *spi_imx,
if (cpu_is_mx31())
reg |= (config->bpw - 1) << MX31_CSPICTRL_BC_SHIFT;
- else if (cpu_is_mx25() || cpu_is_mx35()) {
+ else if (cpu_is_mx25() || cpu_is_mx35() || cpu_is_mx51()) {
reg |= (config->bpw - 1) << MX35_CSPICTRL_BL_SHIFT;
reg |= MX31_CSPICTRL_SSCTL;
}
@@ -223,7 +334,7 @@ static int mx31_config(struct spi_imx_data *spi_imx,
if (config->cs < 0) {
if (cpu_is_mx31())
reg |= (config->cs + 32) << MX31_CSPICTRL_CS_SHIFT;
- else if (cpu_is_mx25() || cpu_is_mx35())
+ else if (cpu_is_mx25() || cpu_is_mx35() || cpu_is_mx51())
reg |= (config->cs + 32) << MX35_CSPICTRL_CS_SHIFT;
}
@@ -567,7 +678,8 @@ static int __devinit spi_imx_probe(struct platform_device
*pdev)
goto out_iounmap;
}
- if (cpu_is_mx25() || cpu_is_mx31() || cpu_is_mx35()) {
+ if (cpu_is_mx25() || cpu_is_mx31() || cpu_is_mx35() ||
+ (cpu_is_mx51() && pdev->id == 2)) {
spi_imx->intctrl = mx31_intctrl;
spi_imx->config = mx31_config;
spi_imx->trigger = mx31_trigger;
@@ -582,6 +694,11 @@ static int __devinit spi_imx_probe(struct platform_device
*pdev)
spi_imx->config = mx1_config;
spi_imx->trigger = mx1_trigger;
spi_imx->rx_available = mx1_rx_available;
+ } else if (cpu_is_mx51()) {
+ spi_imx->intctrl = mx51_intctrl;
+ spi_imx->config = mx51_config;
+ spi_imx->trigger = mx51_trigger;
+ spi_imx->rx_available = mx51_rx_available;
} else
BUG();
--
1.7.1
------------------------------------------------------------------------------
This SF.net Dev2Dev email is sponsored by:
Show off your parallel programming skills.
Enter the Intel(R) Threading Challenge 2010.
http://p.sf.net/sfu/intel-thread-sfd
_______________________________________________
spi-devel-general mailing list
spi-devel-general@lists.sourceforge.net
https://lists.sourceforge.net/lists/listinfo/spi-devel-general
