udf: improve error management in udf_CS0toUTF8()
[linux/fpc-iii.git] / drivers / spi / spi-fsl-lib.c
blobcb35d2f0d0e63cf0d5dcf2d7aaddb22c54590c4a
1 /*
2 * Freescale SPI/eSPI controller driver library.
4 * Maintainer: Kumar Gala
6 * Copyright (C) 2006 Polycom, Inc.
8 * CPM SPI and QE buffer descriptors mode support:
9 * Copyright (c) 2009 MontaVista Software, Inc.
10 * Author: Anton Vorontsov <avorontsov@ru.mvista.com>
12 * Copyright 2010 Freescale Semiconductor, Inc.
14 * This program is free software; you can redistribute it and/or modify it
15 * under the terms of the GNU General Public License as published by the
16 * Free Software Foundation; either version 2 of the License, or (at your
17 * option) any later version.
19 #include <linux/dma-mapping.h>
20 #include <linux/fsl_devices.h>
21 #include <linux/interrupt.h>
22 #include <linux/kernel.h>
23 #include <linux/mm.h>
24 #include <linux/module.h>
25 #include <linux/of_platform.h>
26 #include <linux/spi/spi.h>
27 #ifdef CONFIG_FSL_SOC
28 #include <sysdev/fsl_soc.h>
29 #endif
31 #include "spi-fsl-lib.h"
33 #define MPC8XXX_SPI_RX_BUF(type) \
34 void mpc8xxx_spi_rx_buf_##type(u32 data, struct mpc8xxx_spi *mpc8xxx_spi) \
35 { \
36 type *rx = mpc8xxx_spi->rx; \
37 *rx++ = (type)(data >> mpc8xxx_spi->rx_shift); \
38 mpc8xxx_spi->rx = rx; \
39 } \
40 EXPORT_SYMBOL_GPL(mpc8xxx_spi_rx_buf_##type);
42 #define MPC8XXX_SPI_TX_BUF(type) \
43 u32 mpc8xxx_spi_tx_buf_##type(struct mpc8xxx_spi *mpc8xxx_spi) \
44 { \
45 u32 data; \
46 const type *tx = mpc8xxx_spi->tx; \
47 if (!tx) \
48 return 0; \
49 data = *tx++ << mpc8xxx_spi->tx_shift; \
50 mpc8xxx_spi->tx = tx; \
51 return data; \
52 } \
53 EXPORT_SYMBOL_GPL(mpc8xxx_spi_tx_buf_##type);
55 MPC8XXX_SPI_RX_BUF(u8)
56 MPC8XXX_SPI_RX_BUF(u16)
57 MPC8XXX_SPI_RX_BUF(u32)
58 MPC8XXX_SPI_TX_BUF(u8)
59 MPC8XXX_SPI_TX_BUF(u16)
60 MPC8XXX_SPI_TX_BUF(u32)
62 struct mpc8xxx_spi_probe_info *to_of_pinfo(struct fsl_spi_platform_data *pdata)
64 return container_of(pdata, struct mpc8xxx_spi_probe_info, pdata);
66 EXPORT_SYMBOL_GPL(to_of_pinfo);
68 const char *mpc8xxx_spi_strmode(unsigned int flags)
70 if (flags & SPI_QE_CPU_MODE) {
71 return "QE CPU";
72 } else if (flags & SPI_CPM_MODE) {
73 if (flags & SPI_QE)
74 return "QE";
75 else if (flags & SPI_CPM2)
76 return "CPM2";
77 else
78 return "CPM1";
80 return "CPU";
82 EXPORT_SYMBOL_GPL(mpc8xxx_spi_strmode);
84 void mpc8xxx_spi_probe(struct device *dev, struct resource *mem,
85 unsigned int irq)
87 struct fsl_spi_platform_data *pdata = dev_get_platdata(dev);
88 struct spi_master *master;
89 struct mpc8xxx_spi *mpc8xxx_spi;
91 master = dev_get_drvdata(dev);
93 /* the spi->mode bits understood by this driver: */
94 master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_CS_HIGH
95 | SPI_LSB_FIRST | SPI_LOOP;
97 master->dev.of_node = dev->of_node;
99 mpc8xxx_spi = spi_master_get_devdata(master);
100 mpc8xxx_spi->dev = dev;
101 mpc8xxx_spi->get_rx = mpc8xxx_spi_rx_buf_u8;
102 mpc8xxx_spi->get_tx = mpc8xxx_spi_tx_buf_u8;
103 mpc8xxx_spi->flags = pdata->flags;
104 mpc8xxx_spi->spibrg = pdata->sysclk;
105 mpc8xxx_spi->irq = irq;
107 mpc8xxx_spi->rx_shift = 0;
108 mpc8xxx_spi->tx_shift = 0;
110 master->bus_num = pdata->bus_num;
111 master->num_chipselect = pdata->max_chipselect;
113 init_completion(&mpc8xxx_spi->done);
115 EXPORT_SYMBOL_GPL(mpc8xxx_spi_probe);
117 int mpc8xxx_spi_remove(struct device *dev)
119 struct mpc8xxx_spi *mpc8xxx_spi;
120 struct spi_master *master;
122 master = dev_get_drvdata(dev);
123 mpc8xxx_spi = spi_master_get_devdata(master);
125 spi_unregister_master(master);
127 free_irq(mpc8xxx_spi->irq, mpc8xxx_spi);
129 if (mpc8xxx_spi->spi_remove)
130 mpc8xxx_spi->spi_remove(mpc8xxx_spi);
132 return 0;
134 EXPORT_SYMBOL_GPL(mpc8xxx_spi_remove);
136 int of_mpc8xxx_spi_probe(struct platform_device *ofdev)
138 struct device *dev = &ofdev->dev;
139 struct device_node *np = ofdev->dev.of_node;
140 struct mpc8xxx_spi_probe_info *pinfo;
141 struct fsl_spi_platform_data *pdata;
142 const void *prop;
143 int ret = -ENOMEM;
145 pinfo = devm_kzalloc(&ofdev->dev, sizeof(*pinfo), GFP_KERNEL);
146 if (!pinfo)
147 return ret;
149 pdata = &pinfo->pdata;
150 dev->platform_data = pdata;
152 /* Allocate bus num dynamically. */
153 pdata->bus_num = -1;
155 #ifdef CONFIG_FSL_SOC
156 /* SPI controller is either clocked from QE or SoC clock. */
157 pdata->sysclk = get_brgfreq();
158 if (pdata->sysclk == -1) {
159 pdata->sysclk = fsl_get_sys_freq();
160 if (pdata->sysclk == -1)
161 return -ENODEV;
163 #else
164 ret = of_property_read_u32(np, "clock-frequency", &pdata->sysclk);
165 if (ret)
166 return ret;
167 #endif
169 prop = of_get_property(np, "mode", NULL);
170 if (prop && !strcmp(prop, "cpu-qe"))
171 pdata->flags = SPI_QE_CPU_MODE;
172 else if (prop && !strcmp(prop, "qe"))
173 pdata->flags = SPI_CPM_MODE | SPI_QE;
174 else if (of_device_is_compatible(np, "fsl,cpm2-spi"))
175 pdata->flags = SPI_CPM_MODE | SPI_CPM2;
176 else if (of_device_is_compatible(np, "fsl,cpm1-spi"))
177 pdata->flags = SPI_CPM_MODE | SPI_CPM1;
179 return 0;
181 EXPORT_SYMBOL_GPL(of_mpc8xxx_spi_probe);
183 MODULE_LICENSE("GPL");