xref: /openbsd-src/sys/dev/fdt/imxspi.c (revision 0f9e9ec23bb2b65cc62a3d17df12827a45dae80c)
1*0f9e9ec2Sjsg /* $OpenBSD: imxspi.c,v 1.5 2024/05/13 01:15:50 jsg Exp $ */
2f1906b62Spatrick /*
3f1906b62Spatrick  * Copyright (c) 2018 Patrick Wildt <patrick@blueri.se>
4f1906b62Spatrick  *
5f1906b62Spatrick  * Permission to use, copy, modify, and distribute this software for any
6f1906b62Spatrick  * purpose with or without fee is hereby granted, provided that the above
7f1906b62Spatrick  * copyright notice and this permission notice appear in all copies.
8f1906b62Spatrick  *
9f1906b62Spatrick  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
10f1906b62Spatrick  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
11f1906b62Spatrick  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
12f1906b62Spatrick  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
13f1906b62Spatrick  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
14f1906b62Spatrick  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
15f1906b62Spatrick  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
16f1906b62Spatrick  */
17f1906b62Spatrick 
18f1906b62Spatrick #include <sys/param.h>
19f1906b62Spatrick #include <sys/systm.h>
20f1906b62Spatrick #include <sys/kernel.h>
21f1906b62Spatrick #include <sys/device.h>
22f1906b62Spatrick #include <sys/malloc.h>
23f1906b62Spatrick #include <sys/stdint.h>
24f1906b62Spatrick 
25f1906b62Spatrick #include <machine/bus.h>
26f1906b62Spatrick #include <machine/fdt.h>
27f1906b62Spatrick 
28f1906b62Spatrick #include <dev/spi/spivar.h>
29f1906b62Spatrick #include <dev/ofw/openfirm.h>
30f1906b62Spatrick #include <dev/ofw/ofw_clock.h>
31f1906b62Spatrick #include <dev/ofw/ofw_gpio.h>
32f1906b62Spatrick #include <dev/ofw/ofw_pinctrl.h>
33f1906b62Spatrick #include <dev/ofw/fdt.h>
34f1906b62Spatrick 
35f1906b62Spatrick /* registers */
36f1906b62Spatrick #define SPI_RXDATA			0x00
37f1906b62Spatrick #define SPI_TXDATA			0x04
38f1906b62Spatrick #define SPI_CONREG			0x08
39f1906b62Spatrick #define  SPI_CONREG_EN				(1 << 0)
40f1906b62Spatrick #define  SPI_CONREG_HT				(1 << 1)
41f1906b62Spatrick #define  SPI_CONREG_XCH				(1 << 2)
42f1906b62Spatrick #define  SPI_CONREG_SMC				(1 << 3)
43f1906b62Spatrick #define  SPI_CONREG_CHANNEL_MASTER		(0xf << 4)
44f1906b62Spatrick #define  SPI_CONREG_POST_DIVIDER_SHIFT		8
45f1906b62Spatrick #define  SPI_CONREG_POST_DIVIDER_MASK		0xf
46f1906b62Spatrick #define  SPI_CONREG_PRE_DIVIDER_SHIFT		12
47f1906b62Spatrick #define  SPI_CONREG_PRE_DIVIDER_MASK		0xf
48f1906b62Spatrick #define  SPI_CONREG_DRCTL_SHIFT			16
49f1906b62Spatrick #define  SPI_CONREG_DRCTL_MASK			0x3
50f1906b62Spatrick #define  SPI_CONREG_CHANNEL_SELECT(x)		((x) << 18)
51f1906b62Spatrick #define  SPI_CONREG_BURST_LENGTH(x)		((x) << 20)
52f1906b62Spatrick #define SPI_CONFIGREG			0x0c
53f1906b62Spatrick #define  SPI_CONFIGREG_SCLK_PHA(x)		(1 << (0 + (x)))
54f1906b62Spatrick #define  SPI_CONFIGREG_SCLK_POL(x)		(1 << (4 + (x)))
55f1906b62Spatrick #define  SPI_CONFIGREG_SS_CTL(x)		(1 << (8 + (x)))
56f1906b62Spatrick #define  SPI_CONFIGREG_SS_POL(x)		(1 << (12 + (x)))
57f1906b62Spatrick #define  SPI_CONFIGREG_DATA_CTL(x)		(1 << (16 + (x)))
58f1906b62Spatrick #define  SPI_CONFIGREG_SCLK_CTL(x)		(1 << (20 + (x)))
59f1906b62Spatrick #define  SPI_CONFIGREG_HT_LENGTH(x)		(((x) & 0x1f) << 24)
60f1906b62Spatrick #define SPI_INTREG			0x10
61f1906b62Spatrick #define  SPI_INTREG_TEEN			(1 << 0)
62f1906b62Spatrick #define  SPI_INTREG_TDREN			(1 << 1)
63f1906b62Spatrick #define  SPI_INTREG_TFEN			(1 << 2)
64f1906b62Spatrick #define  SPI_INTREG_RREN			(1 << 3)
65f1906b62Spatrick #define  SPI_INTREG_RDREN			(1 << 4)
66f1906b62Spatrick #define  SPI_INTREG_RFEN			(1 << 5)
67f1906b62Spatrick #define  SPI_INTREG_ROEN			(1 << 6)
68f1906b62Spatrick #define  SPI_INTREG_TCEN			(1 << 7)
69f1906b62Spatrick #define SPI_DMAREG			0x14
70f1906b62Spatrick #define SPI_STATREG			0x18
71f1906b62Spatrick #define  SPI_STATREG_TE				(1 << 0)
72f1906b62Spatrick #define  SPI_STATREG_TDR			(1 << 1)
73f1906b62Spatrick #define  SPI_STATREG_TF				(1 << 2)
74f1906b62Spatrick #define  SPI_STATREG_RR				(1 << 3)
75f1906b62Spatrick #define  SPI_STATREG_RDR			(1 << 4)
76f1906b62Spatrick #define  SPI_STATREG_RF				(1 << 5)
77f1906b62Spatrick #define  SPI_STATREG_RO				(1 << 6)
78f1906b62Spatrick #define  SPI_STATREG_TC				(1 << 7)
79f1906b62Spatrick #define SPI_PERIODREG			0x1c
80f1906b62Spatrick #define SPI_TESTREG			0x20
81f1906b62Spatrick #define  SPI_TESTREG_LBC			(1U << 31)
82f1906b62Spatrick #define SPI_MSGDATA			0x40
83f1906b62Spatrick 
84f1906b62Spatrick #define DEVNAME(sc)	((sc)->sc_dev.dv_xname)
85f1906b62Spatrick 
86f1906b62Spatrick struct imxspi_softc {
87f1906b62Spatrick 	struct device		 sc_dev;
88f1906b62Spatrick 	bus_space_tag_t		 sc_iot;
89f1906b62Spatrick 	bus_space_handle_t	 sc_ioh;
90f1906b62Spatrick 	bus_size_t		 sc_ios;
91f1906b62Spatrick 	int			 sc_node;
92f1906b62Spatrick 
93f1906b62Spatrick 	uint32_t		*sc_gpio;
9436defc4bSjsg 	int			 sc_gpiolen;
95f1906b62Spatrick 
96f1906b62Spatrick 	struct rwlock		 sc_buslock;
97f1906b62Spatrick 	struct spi_controller	 sc_tag;
98f1906b62Spatrick 
99f1906b62Spatrick 	int			 sc_ridx;
100f1906b62Spatrick 	int			 sc_widx;
101f1906b62Spatrick 	int			 sc_cs;
102fe922775Skettenis 	u_int			 sc_cs_delay;
103f1906b62Spatrick };
104f1906b62Spatrick 
105f1906b62Spatrick int	 imxspi_match(struct device *, void *, void *);
106f1906b62Spatrick void	 imxspi_attach(struct device *, struct device *, void *);
107f1906b62Spatrick void	 imxspi_attachhook(struct device *);
108f1906b62Spatrick int	 imxspi_detach(struct device *, int);
109f1906b62Spatrick 
110f1906b62Spatrick void	 imxspi_config(void *, struct spi_config *);
111f1906b62Spatrick uint32_t imxspi_clkdiv(struct imxspi_softc *, uint32_t);
112fe922775Skettenis int	 imxspi_transfer(void *, char *, char *, int, int);
113f1906b62Spatrick int	 imxspi_acquire_bus(void *, int);
114f1906b62Spatrick void	 imxspi_release_bus(void *, int);
115f1906b62Spatrick 
116f1906b62Spatrick void	*imxspi_find_cs_gpio(struct imxspi_softc *, int);
117f1906b62Spatrick int	 imxspi_wait_state(struct imxspi_softc *, uint32_t, uint32_t);
118f1906b62Spatrick 
119f1906b62Spatrick void	 imxspi_scan(struct imxspi_softc *);
120f1906b62Spatrick 
121f1906b62Spatrick #define HREAD4(sc, reg)							\
122f1906b62Spatrick 	(bus_space_read_4((sc)->sc_iot, (sc)->sc_ioh, (reg)))
123f1906b62Spatrick #define HWRITE4(sc, reg, val)						\
124f1906b62Spatrick 	bus_space_write_4((sc)->sc_iot, (sc)->sc_ioh, (reg), (val))
125f1906b62Spatrick #define HSET4(sc, reg, bits)						\
126f1906b62Spatrick 	HWRITE4((sc), (reg), HREAD4((sc), (reg)) | (bits))
127f1906b62Spatrick #define HCLR4(sc, reg, bits)						\
128f1906b62Spatrick 	HWRITE4((sc), (reg), HREAD4((sc), (reg)) & ~(bits))
129f1906b62Spatrick 
1309fdf0c62Smpi const struct cfattach imxspi_ca = {
131f1906b62Spatrick 	sizeof(struct imxspi_softc), imxspi_match, imxspi_attach,
132f1906b62Spatrick 	imxspi_detach
133f1906b62Spatrick };
134f1906b62Spatrick 
135f1906b62Spatrick struct cfdriver imxspi_cd = {
136f1906b62Spatrick 	NULL, "imxspi", DV_DULL
137f1906b62Spatrick };
138f1906b62Spatrick 
139f1906b62Spatrick int
imxspi_match(struct device * parent,void * match,void * aux)140f1906b62Spatrick imxspi_match(struct device *parent, void *match, void *aux)
141f1906b62Spatrick {
142f1906b62Spatrick 	struct fdt_attach_args *faa = aux;
143f1906b62Spatrick 
144f1906b62Spatrick 	return OF_is_compatible(faa->fa_node, "fsl,imx51-ecspi");
145f1906b62Spatrick }
146f1906b62Spatrick 
147f1906b62Spatrick void
imxspi_attach(struct device * parent,struct device * self,void * aux)148f1906b62Spatrick imxspi_attach(struct device *parent, struct device *self, void *aux)
149f1906b62Spatrick {
150f1906b62Spatrick 	struct imxspi_softc *sc = (struct imxspi_softc *)self;
151f1906b62Spatrick 	struct fdt_attach_args *faa = aux;
152f1906b62Spatrick 
153f1906b62Spatrick 	if (faa->fa_nreg < 1)
154f1906b62Spatrick 		return;
155f1906b62Spatrick 
156f1906b62Spatrick 	sc->sc_iot = faa->fa_iot;
157f1906b62Spatrick 	sc->sc_ios = faa->fa_reg[0].size;
158f1906b62Spatrick 	sc->sc_node = faa->fa_node;
159f1906b62Spatrick 	if (bus_space_map(sc->sc_iot, faa->fa_reg[0].addr,
160f1906b62Spatrick 	    faa->fa_reg[0].size, 0, &sc->sc_ioh)) {
161f1906b62Spatrick 		printf(": can't map registers\n");
162f1906b62Spatrick 		return;
163f1906b62Spatrick 	}
164f1906b62Spatrick 
165f1906b62Spatrick 	printf("\n");
166f1906b62Spatrick 
167f1906b62Spatrick 	config_mountroot(self, imxspi_attachhook);
168f1906b62Spatrick }
169f1906b62Spatrick 
170f1906b62Spatrick void
imxspi_attachhook(struct device * self)171f1906b62Spatrick imxspi_attachhook(struct device *self)
172f1906b62Spatrick {
173f1906b62Spatrick 	struct imxspi_softc *sc = (struct imxspi_softc *)self;
174f1906b62Spatrick 	uint32_t *gpio;
175f1906b62Spatrick 	int i;
176f1906b62Spatrick 
177f1906b62Spatrick 	pinctrl_byname(sc->sc_node, "default");
178f1906b62Spatrick 	clock_enable(sc->sc_node, NULL);
179f1906b62Spatrick 
180f1906b62Spatrick 	sc->sc_gpiolen = OF_getproplen(sc->sc_node, "cs-gpios");
18136defc4bSjsg 	if (sc->sc_gpiolen > 0) {
182f1906b62Spatrick 		sc->sc_gpio = malloc(sc->sc_gpiolen, M_DEVBUF, M_WAITOK);
183f1906b62Spatrick 		OF_getpropintarray(sc->sc_node, "cs-gpios",
184f1906b62Spatrick 		    sc->sc_gpio, sc->sc_gpiolen);
185f1906b62Spatrick 		for (i = 0; i < 4; i++) {
186f1906b62Spatrick 			gpio = imxspi_find_cs_gpio(sc, i);
187f1906b62Spatrick 			if (gpio == NULL)
188f1906b62Spatrick 				break;
189f1906b62Spatrick 			gpio_controller_config_pin(gpio,
190f1906b62Spatrick 			    GPIO_CONFIG_OUTPUT);
191f1906b62Spatrick 			gpio_controller_set_pin(gpio, 1);
192f1906b62Spatrick 		}
193f1906b62Spatrick 	}
194f1906b62Spatrick 
195f1906b62Spatrick 	/* disable interrupts */
196f1906b62Spatrick 	HWRITE4(sc, SPI_INTREG, 0);
197f1906b62Spatrick 	HWRITE4(sc, SPI_STATREG, SPI_STATREG_TC);
198f1906b62Spatrick 
199f1906b62Spatrick 	/* drain input buffer */
200f1906b62Spatrick 	while (HREAD4(sc, SPI_STATREG) & SPI_STATREG_RR)
201f1906b62Spatrick 		HREAD4(sc, SPI_RXDATA);
202f1906b62Spatrick 
203f1906b62Spatrick 	rw_init(&sc->sc_buslock, sc->sc_dev.dv_xname);
204f1906b62Spatrick 
205f1906b62Spatrick 	sc->sc_tag.sc_cookie = sc;
206f1906b62Spatrick 	sc->sc_tag.sc_config = imxspi_config;
207f1906b62Spatrick 	sc->sc_tag.sc_transfer = imxspi_transfer;
208f1906b62Spatrick 	sc->sc_tag.sc_acquire_bus = imxspi_acquire_bus;
209f1906b62Spatrick 	sc->sc_tag.sc_release_bus = imxspi_release_bus;
210f1906b62Spatrick 
211f1906b62Spatrick 	imxspi_scan(sc);
212f1906b62Spatrick }
213f1906b62Spatrick 
214f1906b62Spatrick int
imxspi_detach(struct device * self,int flags)215f1906b62Spatrick imxspi_detach(struct device *self, int flags)
216f1906b62Spatrick {
217f1906b62Spatrick 	struct imxspi_softc *sc = (struct imxspi_softc *)self;
218f1906b62Spatrick 
219f1906b62Spatrick 	HWRITE4(sc, SPI_CONREG, 0);
220f1906b62Spatrick 	bus_space_unmap(sc->sc_iot, sc->sc_ioh, sc->sc_ios);
221f1906b62Spatrick 	free(sc->sc_gpio, M_DEVBUF, sc->sc_gpiolen);
222f1906b62Spatrick 	return 0;
223f1906b62Spatrick }
224f1906b62Spatrick 
225f1906b62Spatrick void
imxspi_config(void * cookie,struct spi_config * conf)226f1906b62Spatrick imxspi_config(void *cookie, struct spi_config *conf)
227f1906b62Spatrick {
228f1906b62Spatrick 	struct imxspi_softc *sc = cookie;
229f1906b62Spatrick 	uint32_t conreg, configreg;
230f1906b62Spatrick 	int cs;
231f1906b62Spatrick 
232f1906b62Spatrick 	cs = conf->sc_cs;
233f1906b62Spatrick 	if (cs > 4) {
234f1906b62Spatrick 		printf("%s: invalid chip-select (%d)\n", DEVNAME(sc), cs);
235f1906b62Spatrick 		return;
236f1906b62Spatrick 	}
237f1906b62Spatrick 	sc->sc_cs = cs;
238fe922775Skettenis 	sc->sc_cs_delay = conf->sc_cs_delay;
239f1906b62Spatrick 
240f1906b62Spatrick 	conreg = SPI_CONREG_EN;
241f1906b62Spatrick 	conreg |= SPI_CONREG_CHANNEL_MASTER;
242f1906b62Spatrick 	conreg |= imxspi_clkdiv(sc, conf->sc_freq);
243f1906b62Spatrick 	conreg |= SPI_CONREG_CHANNEL_SELECT(cs);
244f1906b62Spatrick 	conreg |= SPI_CONREG_BURST_LENGTH(conf->sc_bpw - 1);
245f1906b62Spatrick 
246f1906b62Spatrick 	configreg = HREAD4(sc, SPI_CONFIGREG);
247f1906b62Spatrick 	configreg &= ~SPI_CONFIGREG_SCLK_PHA(cs);
248f1906b62Spatrick 	if (conf->sc_flags & SPI_CONFIG_CPHA)
249f1906b62Spatrick 		configreg |= SPI_CONFIGREG_SCLK_PHA(cs);
250f1906b62Spatrick 	configreg &= ~SPI_CONFIGREG_SCLK_POL(cs);
251f1906b62Spatrick 	configreg &= ~SPI_CONFIGREG_SCLK_CTL(cs);
252f1906b62Spatrick 	if (conf->sc_flags & SPI_CONFIG_CPOL) {
253f1906b62Spatrick 		configreg |= SPI_CONFIGREG_SCLK_POL(cs);
254f1906b62Spatrick 		configreg |= SPI_CONFIGREG_SCLK_CTL(cs);
255f1906b62Spatrick 	}
256f1906b62Spatrick 	configreg |= SPI_CONFIGREG_SS_CTL(cs);
257f1906b62Spatrick 	configreg &= ~SPI_CONFIGREG_SS_POL(cs);
258f1906b62Spatrick 	if (conf->sc_flags & SPI_CONFIG_CS_HIGH)
259f1906b62Spatrick 		configreg |= SPI_CONFIGREG_SS_POL(cs);
260f1906b62Spatrick 
261f1906b62Spatrick 	HWRITE4(sc, SPI_CONREG, conreg);
262f1906b62Spatrick 	HWRITE4(sc, SPI_TESTREG, HREAD4(sc, SPI_TESTREG) &
263f1906b62Spatrick 	    ~SPI_TESTREG_LBC);
264f1906b62Spatrick 	HWRITE4(sc, SPI_CONFIGREG, configreg);
265f1906b62Spatrick 	delay(1000);
266f1906b62Spatrick }
267f1906b62Spatrick 
268f1906b62Spatrick uint32_t
imxspi_clkdiv(struct imxspi_softc * sc,uint32_t freq)269f1906b62Spatrick imxspi_clkdiv(struct imxspi_softc *sc, uint32_t freq)
270f1906b62Spatrick {
271f1906b62Spatrick 	uint32_t pre, post;
272f1906b62Spatrick 	uint32_t pfreq;
273f1906b62Spatrick 
274f1906b62Spatrick 	pfreq = clock_get_frequency(sc->sc_node, "per");
275f1906b62Spatrick 
276f1906b62Spatrick 	pre = 0, post = 0;
277f1906b62Spatrick 	while ((freq * (1 << post) * 16) < pfreq)
278f1906b62Spatrick 		post++;
279f1906b62Spatrick 	while ((freq * (1 << post) * (pre + 1)) < pfreq)
280f1906b62Spatrick 		pre++;
281f1906b62Spatrick 	if (post >= 16 || pre >= 16) {
282f1906b62Spatrick 		printf("%s: clock frequency too high\n",
283f1906b62Spatrick 		    DEVNAME(sc));
284f1906b62Spatrick 		return 0;
285f1906b62Spatrick 	}
286f1906b62Spatrick 
287f1906b62Spatrick 	return (pre << SPI_CONREG_PRE_DIVIDER_SHIFT |
288f1906b62Spatrick 	    post << SPI_CONREG_POST_DIVIDER_SHIFT);
289f1906b62Spatrick }
290f1906b62Spatrick 
291f1906b62Spatrick int
imxspi_wait_state(struct imxspi_softc * sc,uint32_t mask,uint32_t value)292f1906b62Spatrick imxspi_wait_state(struct imxspi_softc *sc, uint32_t mask, uint32_t value)
293f1906b62Spatrick {
294f1906b62Spatrick 	uint32_t state;
295f1906b62Spatrick 	int timeout;
296f1906b62Spatrick 	state = HREAD4(sc, SPI_STATREG);
297f1906b62Spatrick 	for (timeout = 1000; timeout > 0; timeout--) {
298f1906b62Spatrick 		if (((state = HREAD4(sc, SPI_STATREG)) & mask) == value)
299f1906b62Spatrick 			return 0;
300f1906b62Spatrick 		delay(10);
301f1906b62Spatrick 	}
302f1906b62Spatrick 	printf("%s: timeout mask %x value %x\n", __func__, mask, value);
303f1906b62Spatrick 	return ETIMEDOUT;
304f1906b62Spatrick }
305f1906b62Spatrick 
306f1906b62Spatrick void *
imxspi_find_cs_gpio(struct imxspi_softc * sc,int cs)307f1906b62Spatrick imxspi_find_cs_gpio(struct imxspi_softc *sc, int cs)
308f1906b62Spatrick {
309f1906b62Spatrick 	uint32_t *gpio;
310f1906b62Spatrick 
311f1906b62Spatrick 	if (sc->sc_gpio == NULL)
312f1906b62Spatrick 		return NULL;
313f1906b62Spatrick 
314f1906b62Spatrick 	gpio = sc->sc_gpio;
315f1906b62Spatrick 	while (gpio < sc->sc_gpio + (sc->sc_gpiolen / 4)) {
316f1906b62Spatrick 		if (cs == 0)
317f1906b62Spatrick 			return gpio;
318f1906b62Spatrick 		gpio = gpio_controller_next_pin(gpio);
319f1906b62Spatrick 		cs--;
320f1906b62Spatrick 	}
321f1906b62Spatrick 
322f1906b62Spatrick 	return NULL;
323f1906b62Spatrick }
324f1906b62Spatrick 
325f1906b62Spatrick int
imxspi_transfer(void * cookie,char * out,char * in,int len,int flags)326fe922775Skettenis imxspi_transfer(void *cookie, char *out, char *in, int len, int flags)
327f1906b62Spatrick {
328f1906b62Spatrick 	struct imxspi_softc *sc = cookie;
329f1906b62Spatrick 	uint32_t *gpio;
330f1906b62Spatrick 	int i;
331f1906b62Spatrick 
332f1906b62Spatrick 	sc->sc_ridx = sc->sc_widx = 0;
333f1906b62Spatrick 
334f1906b62Spatrick 	gpio = imxspi_find_cs_gpio(sc, sc->sc_cs);
335f1906b62Spatrick 	if (gpio) {
336f1906b62Spatrick 		gpio_controller_set_pin(gpio, 0);
337f1906b62Spatrick 		delay(1);
338f1906b62Spatrick 	}
339fe922775Skettenis 	delay(sc->sc_cs_delay);
340f1906b62Spatrick 
341f1906b62Spatrick 	/* drain input buffer */
342f1906b62Spatrick 	while (HREAD4(sc, SPI_STATREG) & SPI_STATREG_RR)
343f1906b62Spatrick 		HREAD4(sc, SPI_RXDATA);
344f1906b62Spatrick 
345f1906b62Spatrick 	while (sc->sc_ridx < len || sc->sc_widx < len) {
346f1906b62Spatrick 		for (i = sc->sc_widx; i < len; i++) {
347f1906b62Spatrick 			if (imxspi_wait_state(sc, SPI_STATREG_TF, 0))
348f1906b62Spatrick 				goto err;
349f1906b62Spatrick 			if (out)
350f1906b62Spatrick 				HWRITE4(sc, SPI_TXDATA, out[i]);
351f1906b62Spatrick 			else
352f1906b62Spatrick 				HWRITE4(sc, SPI_TXDATA, 0xff);
353f1906b62Spatrick 			sc->sc_widx++;
354f1906b62Spatrick 			if (HREAD4(sc, SPI_STATREG) & SPI_STATREG_TF)
355f1906b62Spatrick 				break;
356f1906b62Spatrick 		}
357f1906b62Spatrick 
358f1906b62Spatrick 		HSET4(sc, SPI_CONREG, SPI_CONREG_XCH);
359f1906b62Spatrick 		if (imxspi_wait_state(sc, SPI_STATREG_TC, SPI_STATREG_TC))
360f1906b62Spatrick 			goto err;
361f1906b62Spatrick 
362f1906b62Spatrick 		for (i = sc->sc_ridx; i < sc->sc_widx; i++) {
363f1906b62Spatrick 			if (imxspi_wait_state(sc, SPI_STATREG_RR, SPI_STATREG_RR))
364f1906b62Spatrick 				goto err;
365f1906b62Spatrick 			if (in)
366f1906b62Spatrick 				in[i] = HREAD4(sc, SPI_RXDATA);
367f1906b62Spatrick 			else
368f1906b62Spatrick 				HREAD4(sc, SPI_RXDATA);
369f1906b62Spatrick 			sc->sc_ridx++;
370f1906b62Spatrick 		}
371f1906b62Spatrick 
372f1906b62Spatrick 		HWRITE4(sc, SPI_STATREG, SPI_STATREG_TC);
373f1906b62Spatrick 	}
374f1906b62Spatrick 
375fe922775Skettenis 	if (!ISSET(flags, SPI_KEEP_CS)) {
376f1906b62Spatrick 		gpio = imxspi_find_cs_gpio(sc, sc->sc_cs);
377f1906b62Spatrick 		if (gpio) {
378f1906b62Spatrick 			gpio_controller_set_pin(gpio, 1);
379f1906b62Spatrick 			delay(1);
380f1906b62Spatrick 		}
381fe922775Skettenis 	}
382f1906b62Spatrick 
383f1906b62Spatrick 	return 0;
384f1906b62Spatrick err:
385f1906b62Spatrick 	HWRITE4(sc, SPI_CONREG, 0);
386f1906b62Spatrick 	HWRITE4(sc, SPI_STATREG, SPI_STATREG_TC);
387f1906b62Spatrick 	return ETIMEDOUT;
388f1906b62Spatrick }
389f1906b62Spatrick 
390f1906b62Spatrick int
imxspi_acquire_bus(void * cookie,int flags)391f1906b62Spatrick imxspi_acquire_bus(void *cookie, int flags)
392f1906b62Spatrick {
393f1906b62Spatrick 	struct imxspi_softc *sc = cookie;
394f1906b62Spatrick 
395f1906b62Spatrick 	rw_enter(&sc->sc_buslock, RW_WRITE);
396f1906b62Spatrick 	return 0;
397f1906b62Spatrick }
398f1906b62Spatrick 
399f1906b62Spatrick void
imxspi_release_bus(void * cookie,int flags)400f1906b62Spatrick imxspi_release_bus(void *cookie, int flags)
401f1906b62Spatrick {
402f1906b62Spatrick 	struct imxspi_softc *sc = cookie;
403f1906b62Spatrick 
404f1906b62Spatrick 	rw_exit(&sc->sc_buslock);
405f1906b62Spatrick }
406f1906b62Spatrick 
407f1906b62Spatrick void
imxspi_scan(struct imxspi_softc * sc)408f1906b62Spatrick imxspi_scan(struct imxspi_softc *sc)
409f1906b62Spatrick {
410f1906b62Spatrick 	struct spi_attach_args sa;
411f1906b62Spatrick 	uint32_t reg[1];
412f1906b62Spatrick 	char name[32];
413f1906b62Spatrick 	int node;
414f1906b62Spatrick 
415f1906b62Spatrick 	for (node = OF_child(sc->sc_node); node; node = OF_peer(node)) {
416f1906b62Spatrick 		memset(name, 0, sizeof(name));
417f1906b62Spatrick 		memset(reg, 0, sizeof(reg));
418f1906b62Spatrick 
419f1906b62Spatrick 		if (OF_getprop(node, "compatible", name, sizeof(name)) == -1)
420f1906b62Spatrick 			continue;
421f1906b62Spatrick 		if (name[0] == '\0')
422f1906b62Spatrick 			continue;
423f1906b62Spatrick 
424f1906b62Spatrick 		if (OF_getprop(node, "reg", &reg, sizeof(reg)) != sizeof(reg))
425f1906b62Spatrick 			continue;
426f1906b62Spatrick 
427f1906b62Spatrick 		memset(&sa, 0, sizeof(sa));
428f1906b62Spatrick 		sa.sa_tag = &sc->sc_tag;
429f1906b62Spatrick 		sa.sa_name = name;
430f1906b62Spatrick 		sa.sa_cookie = &node;
431f1906b62Spatrick 
432f1906b62Spatrick 		config_found(&sc->sc_dev, &sa, NULL);
433f1906b62Spatrick 	}
434f1906b62Spatrick }
435