xref: /freebsd/sys/dev/flash/cqspi.c (revision 18250ec6c089c0c50cbd9fd87d78e03ff89916df)
1eb69ed7fSRuslan Bukin /*-
2eb69ed7fSRuslan Bukin  * Copyright (c) 2017-2018 Ruslan Bukin <br@bsdpad.com>
3eb69ed7fSRuslan Bukin  * All rights reserved.
4eb69ed7fSRuslan Bukin  *
5eb69ed7fSRuslan Bukin  * This software was developed by SRI International and the University of
6eb69ed7fSRuslan Bukin  * Cambridge Computer Laboratory under DARPA/AFRL contract FA8750-10-C-0237
7eb69ed7fSRuslan Bukin  * ("CTSRD"), as part of the DARPA CRASH research programme.
8eb69ed7fSRuslan Bukin  *
9eb69ed7fSRuslan Bukin  * Redistribution and use in source and binary forms, with or without
10eb69ed7fSRuslan Bukin  * modification, are permitted provided that the following conditions
11eb69ed7fSRuslan Bukin  * are met:
12eb69ed7fSRuslan Bukin  * 1. Redistributions of source code must retain the above copyright
13eb69ed7fSRuslan Bukin  *    notice, this list of conditions and the following disclaimer.
14eb69ed7fSRuslan Bukin  * 2. Redistributions in binary form must reproduce the above copyright
15eb69ed7fSRuslan Bukin  *    notice, this list of conditions and the following disclaimer in the
16eb69ed7fSRuslan Bukin  *    documentation and/or other materials provided with the distribution.
17eb69ed7fSRuslan Bukin  *
18eb69ed7fSRuslan Bukin  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
19eb69ed7fSRuslan Bukin  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20eb69ed7fSRuslan Bukin  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21eb69ed7fSRuslan Bukin  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22eb69ed7fSRuslan Bukin  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23eb69ed7fSRuslan Bukin  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24eb69ed7fSRuslan Bukin  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25eb69ed7fSRuslan Bukin  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26eb69ed7fSRuslan Bukin  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27eb69ed7fSRuslan Bukin  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28eb69ed7fSRuslan Bukin  * SUCH DAMAGE.
29eb69ed7fSRuslan Bukin  */
30eb69ed7fSRuslan Bukin 
31eb69ed7fSRuslan Bukin /*
32eb69ed7fSRuslan Bukin  * Cadence Quad SPI Flash Controller driver.
33eb69ed7fSRuslan Bukin  * 4B-addressing mode supported only.
34eb69ed7fSRuslan Bukin  */
35eb69ed7fSRuslan Bukin 
36eb69ed7fSRuslan Bukin #include <sys/cdefs.h>
37eb69ed7fSRuslan Bukin #include "opt_platform.h"
38eb69ed7fSRuslan Bukin 
39eb69ed7fSRuslan Bukin #include <sys/param.h>
40eb69ed7fSRuslan Bukin #include <sys/systm.h>
41eb69ed7fSRuslan Bukin #include <sys/bio.h>
42eb69ed7fSRuslan Bukin #include <sys/bus.h>
43eb69ed7fSRuslan Bukin #include <sys/conf.h>
44eb69ed7fSRuslan Bukin #include <sys/kernel.h>
45eb69ed7fSRuslan Bukin #include <sys/kthread.h>
46eb69ed7fSRuslan Bukin #include <sys/lock.h>
47eb69ed7fSRuslan Bukin #include <sys/mbuf.h>
48eb69ed7fSRuslan Bukin #include <sys/malloc.h>
49eb69ed7fSRuslan Bukin #include <sys/module.h>
50eb69ed7fSRuslan Bukin #include <sys/mutex.h>
51e2448a81SIan Lepore #include <sys/rman.h>
52eb69ed7fSRuslan Bukin #include <geom/geom_disk.h>
53eb69ed7fSRuslan Bukin 
54eb69ed7fSRuslan Bukin #include <machine/bus.h>
55eb69ed7fSRuslan Bukin 
56eb69ed7fSRuslan Bukin #include <dev/fdt/simplebus.h>
57eb69ed7fSRuslan Bukin #include <dev/fdt/fdt_common.h>
58eb69ed7fSRuslan Bukin #include <dev/ofw/ofw_bus_subr.h>
59eb69ed7fSRuslan Bukin #include <dev/ofw/openfirm.h>
60eb69ed7fSRuslan Bukin 
61eb69ed7fSRuslan Bukin #include <dev/flash/cqspi.h>
62eb69ed7fSRuslan Bukin #include <dev/flash/mx25lreg.h>
63eb69ed7fSRuslan Bukin #include <dev/xdma/xdma.h>
64eb69ed7fSRuslan Bukin 
65eb69ed7fSRuslan Bukin #include "qspi_if.h"
66eb69ed7fSRuslan Bukin 
67eb69ed7fSRuslan Bukin #define CQSPI_DEBUG
68eb69ed7fSRuslan Bukin #undef CQSPI_DEBUG
69eb69ed7fSRuslan Bukin 
70eb69ed7fSRuslan Bukin #ifdef CQSPI_DEBUG
71eb69ed7fSRuslan Bukin #define dprintf(fmt, ...)  printf(fmt, ##__VA_ARGS__)
72eb69ed7fSRuslan Bukin #else
73eb69ed7fSRuslan Bukin #define dprintf(fmt, ...)
74eb69ed7fSRuslan Bukin #endif
75eb69ed7fSRuslan Bukin 
76eb69ed7fSRuslan Bukin #define	CQSPI_SECTORSIZE	512
77eb69ed7fSRuslan Bukin #define	TX_QUEUE_SIZE		16
78eb69ed7fSRuslan Bukin #define	RX_QUEUE_SIZE		16
79eb69ed7fSRuslan Bukin 
80eb69ed7fSRuslan Bukin #define	READ4(_sc, _reg) bus_read_4((_sc)->res[0], _reg)
81eb69ed7fSRuslan Bukin #define	READ2(_sc, _reg) bus_read_2((_sc)->res[0], _reg)
82eb69ed7fSRuslan Bukin #define	READ1(_sc, _reg) bus_read_1((_sc)->res[0], _reg)
83eb69ed7fSRuslan Bukin #define	WRITE4(_sc, _reg, _val) bus_write_4((_sc)->res[0], _reg, _val)
84eb69ed7fSRuslan Bukin #define	WRITE2(_sc, _reg, _val) bus_write_2((_sc)->res[0], _reg, _val)
85eb69ed7fSRuslan Bukin #define	WRITE1(_sc, _reg, _val) bus_write_1((_sc)->res[0], _reg, _val)
86eb69ed7fSRuslan Bukin #define	READ_DATA_4(_sc, _reg) bus_read_4((_sc)->res[1], _reg)
87eb69ed7fSRuslan Bukin #define	READ_DATA_1(_sc, _reg) bus_read_1((_sc)->res[1], _reg)
88eb69ed7fSRuslan Bukin #define	WRITE_DATA_4(_sc, _reg, _val) bus_write_4((_sc)->res[1], _reg, _val)
89eb69ed7fSRuslan Bukin #define	WRITE_DATA_1(_sc, _reg, _val) bus_write_1((_sc)->res[1], _reg, _val)
90eb69ed7fSRuslan Bukin 
91eb69ed7fSRuslan Bukin struct cqspi_softc {
92eb69ed7fSRuslan Bukin 	device_t		dev;
93eb69ed7fSRuslan Bukin 
94eb69ed7fSRuslan Bukin 	struct resource		*res[3];
95eb69ed7fSRuslan Bukin 	bus_space_tag_t		bst;
96eb69ed7fSRuslan Bukin 	bus_space_handle_t	bsh;
97eb69ed7fSRuslan Bukin 	void			*ih;
98eb69ed7fSRuslan Bukin 	uint8_t			read_op_done;
99eb69ed7fSRuslan Bukin 	uint8_t			write_op_done;
100eb69ed7fSRuslan Bukin 
101eb69ed7fSRuslan Bukin 	uint32_t		fifo_depth;
102eb69ed7fSRuslan Bukin 	uint32_t		fifo_width;
103eb69ed7fSRuslan Bukin 	uint32_t		trigger_address;
104eb69ed7fSRuslan Bukin 	uint32_t		sram_phys;
105eb69ed7fSRuslan Bukin 
106eb69ed7fSRuslan Bukin 	/* xDMA */
107eb69ed7fSRuslan Bukin 	xdma_controller_t	*xdma_tx;
108eb69ed7fSRuslan Bukin 	xdma_channel_t		*xchan_tx;
109eb69ed7fSRuslan Bukin 	void			*ih_tx;
110eb69ed7fSRuslan Bukin 
111eb69ed7fSRuslan Bukin 	xdma_controller_t	*xdma_rx;
112eb69ed7fSRuslan Bukin 	xdma_channel_t		*xchan_rx;
113eb69ed7fSRuslan Bukin 	void			*ih_rx;
114eb69ed7fSRuslan Bukin 
115eb69ed7fSRuslan Bukin 	struct intr_config_hook	config_intrhook;
116eb69ed7fSRuslan Bukin 	struct mtx		sc_mtx;
117eb69ed7fSRuslan Bukin };
118eb69ed7fSRuslan Bukin 
119eb69ed7fSRuslan Bukin #define	CQSPI_LOCK(_sc)		mtx_lock(&(_sc)->sc_mtx)
120eb69ed7fSRuslan Bukin #define	CQSPI_UNLOCK(_sc)	mtx_unlock(&(_sc)->sc_mtx)
121eb69ed7fSRuslan Bukin #define CQSPI_LOCK_INIT(_sc)					\
122eb69ed7fSRuslan Bukin 	mtx_init(&_sc->sc_mtx, device_get_nameunit(_sc->dev),	\
123eb69ed7fSRuslan Bukin 	    "cqspi", MTX_DEF)
124eb69ed7fSRuslan Bukin #define CQSPI_LOCK_DESTROY(_sc)	mtx_destroy(&_sc->sc_mtx);
125eb69ed7fSRuslan Bukin #define CQSPI_ASSERT_LOCKED(_sc)				\
126eb69ed7fSRuslan Bukin 	mtx_assert(&_sc->sc_mtx, MA_OWNED);
127eb69ed7fSRuslan Bukin #define CQSPI_ASSERT_UNLOCKED(_sc)				\
128eb69ed7fSRuslan Bukin 	mtx_assert(&_sc->sc_mtx, MA_NOTOWNED);
129eb69ed7fSRuslan Bukin 
130eb69ed7fSRuslan Bukin static struct resource_spec cqspi_spec[] = {
131eb69ed7fSRuslan Bukin 	{ SYS_RES_MEMORY,	0,	RF_ACTIVE },
132eb69ed7fSRuslan Bukin 	{ SYS_RES_MEMORY,	1,	RF_ACTIVE },
133eb69ed7fSRuslan Bukin 	{ SYS_RES_IRQ,		0,	RF_ACTIVE },
134eb69ed7fSRuslan Bukin 	{ -1, 0 }
135eb69ed7fSRuslan Bukin };
136eb69ed7fSRuslan Bukin 
137eb69ed7fSRuslan Bukin static struct ofw_compat_data compat_data[] = {
138eb69ed7fSRuslan Bukin 	{ "cdns,qspi-nor",	1 },
139eb69ed7fSRuslan Bukin 	{ NULL,			0 },
140eb69ed7fSRuslan Bukin };
141eb69ed7fSRuslan Bukin 
142eb69ed7fSRuslan Bukin static void
cqspi_intr(void * arg)143eb69ed7fSRuslan Bukin cqspi_intr(void *arg)
144eb69ed7fSRuslan Bukin {
145eb69ed7fSRuslan Bukin 	struct cqspi_softc *sc;
146eb69ed7fSRuslan Bukin 	uint32_t pending;
147eb69ed7fSRuslan Bukin 
148eb69ed7fSRuslan Bukin 	sc = arg;
149eb69ed7fSRuslan Bukin 
150eb69ed7fSRuslan Bukin 	pending = READ4(sc, CQSPI_IRQSTAT);
151eb69ed7fSRuslan Bukin 
152eb69ed7fSRuslan Bukin 	dprintf("%s: IRQSTAT %x\n", __func__, pending);
153eb69ed7fSRuslan Bukin 
154eb69ed7fSRuslan Bukin 	if (pending & (IRQMASK_INDOPDONE | IRQMASK_INDXFRLVL |
155eb69ed7fSRuslan Bukin 	    IRQMASK_INDSRAMFULL)) {
156eb69ed7fSRuslan Bukin 		/* TODO: PIO operation done */
157eb69ed7fSRuslan Bukin 	}
158eb69ed7fSRuslan Bukin 
159eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_IRQSTAT, pending);
160eb69ed7fSRuslan Bukin }
161eb69ed7fSRuslan Bukin 
162eb69ed7fSRuslan Bukin static int
cqspi_xdma_tx_intr(void * arg,xdma_transfer_status_t * status)163eb69ed7fSRuslan Bukin cqspi_xdma_tx_intr(void *arg, xdma_transfer_status_t *status)
164eb69ed7fSRuslan Bukin {
165eb69ed7fSRuslan Bukin 	struct xdma_transfer_status st;
166eb69ed7fSRuslan Bukin 	struct cqspi_softc *sc;
167eb69ed7fSRuslan Bukin 	struct bio *bp;
168eb69ed7fSRuslan Bukin 	int ret;
169eb69ed7fSRuslan Bukin 	int deq;
170eb69ed7fSRuslan Bukin 
171eb69ed7fSRuslan Bukin 	sc = arg;
172eb69ed7fSRuslan Bukin 
173eb69ed7fSRuslan Bukin 	dprintf("%s\n", __func__);
174eb69ed7fSRuslan Bukin 
175eb69ed7fSRuslan Bukin 	deq = 0;
176eb69ed7fSRuslan Bukin 
177eb69ed7fSRuslan Bukin 	while (1) {
178eb69ed7fSRuslan Bukin 		ret = xdma_dequeue_bio(sc->xchan_tx, &bp, &st);
179eb69ed7fSRuslan Bukin 		if (ret != 0) {
180eb69ed7fSRuslan Bukin 			break;
181eb69ed7fSRuslan Bukin 		}
182eb69ed7fSRuslan Bukin 		sc->write_op_done = 1;
183eb69ed7fSRuslan Bukin 		deq++;
184eb69ed7fSRuslan Bukin 	}
185eb69ed7fSRuslan Bukin 
186eb69ed7fSRuslan Bukin 	if (deq > 1)
187eb69ed7fSRuslan Bukin 		device_printf(sc->dev,
188eb69ed7fSRuslan Bukin 		    "Warning: more than 1 tx bio dequeued\n");
189eb69ed7fSRuslan Bukin 
190eb69ed7fSRuslan Bukin 	wakeup(&sc->xdma_tx);
191eb69ed7fSRuslan Bukin 
192eb69ed7fSRuslan Bukin 	return (0);
193eb69ed7fSRuslan Bukin }
194eb69ed7fSRuslan Bukin 
195eb69ed7fSRuslan Bukin static int
cqspi_xdma_rx_intr(void * arg,xdma_transfer_status_t * status)196eb69ed7fSRuslan Bukin cqspi_xdma_rx_intr(void *arg, xdma_transfer_status_t *status)
197eb69ed7fSRuslan Bukin {
198eb69ed7fSRuslan Bukin 	struct xdma_transfer_status st;
199eb69ed7fSRuslan Bukin 	struct cqspi_softc *sc;
200eb69ed7fSRuslan Bukin 	struct bio *bp;
201eb69ed7fSRuslan Bukin 	int ret;
202eb69ed7fSRuslan Bukin 	int deq;
203eb69ed7fSRuslan Bukin 
204eb69ed7fSRuslan Bukin 	sc = arg;
205eb69ed7fSRuslan Bukin 
206eb69ed7fSRuslan Bukin 	dprintf("%s\n", __func__);
207eb69ed7fSRuslan Bukin 
208eb69ed7fSRuslan Bukin 	deq = 0;
209eb69ed7fSRuslan Bukin 
210eb69ed7fSRuslan Bukin 	while (1) {
211eb69ed7fSRuslan Bukin 		ret = xdma_dequeue_bio(sc->xchan_rx, &bp, &st);
212eb69ed7fSRuslan Bukin 		if (ret != 0) {
213eb69ed7fSRuslan Bukin 			break;
214eb69ed7fSRuslan Bukin 		}
215eb69ed7fSRuslan Bukin 		sc->read_op_done = 1;
216eb69ed7fSRuslan Bukin 		deq++;
217eb69ed7fSRuslan Bukin 	}
218eb69ed7fSRuslan Bukin 
219eb69ed7fSRuslan Bukin 	if (deq > 1)
220eb69ed7fSRuslan Bukin 		device_printf(sc->dev,
221eb69ed7fSRuslan Bukin 		    "Warning: more than 1 rx bio dequeued\n");
222eb69ed7fSRuslan Bukin 
223eb69ed7fSRuslan Bukin 	wakeup(&sc->xdma_rx);
224eb69ed7fSRuslan Bukin 
225eb69ed7fSRuslan Bukin 	return (0);
226eb69ed7fSRuslan Bukin }
227eb69ed7fSRuslan Bukin 
228eb69ed7fSRuslan Bukin static int
cqspi_wait_for_completion(struct cqspi_softc * sc)229eb69ed7fSRuslan Bukin cqspi_wait_for_completion(struct cqspi_softc *sc)
230eb69ed7fSRuslan Bukin {
231eb69ed7fSRuslan Bukin 	int timeout;
232eb69ed7fSRuslan Bukin 	int i;
233eb69ed7fSRuslan Bukin 
234eb69ed7fSRuslan Bukin 	timeout = 10000;
235eb69ed7fSRuslan Bukin 
236eb69ed7fSRuslan Bukin 	for (i = timeout; i > 0; i--) {
237eb69ed7fSRuslan Bukin 		if ((READ4(sc, CQSPI_FLASHCMD) & FLASHCMD_CMDEXECSTAT) == 0) {
238eb69ed7fSRuslan Bukin 			break;
239eb69ed7fSRuslan Bukin 		}
240eb69ed7fSRuslan Bukin 	}
241eb69ed7fSRuslan Bukin 
242eb69ed7fSRuslan Bukin 	if (i == 0) {
243eb69ed7fSRuslan Bukin 		device_printf(sc->dev, "%s: cmd timed out: %x\n",
244eb69ed7fSRuslan Bukin 		    __func__, READ4(sc, CQSPI_FLASHCMD));
245eb69ed7fSRuslan Bukin 		return (-1);
246eb69ed7fSRuslan Bukin 	}
247eb69ed7fSRuslan Bukin 
248eb69ed7fSRuslan Bukin 	return (0);
249eb69ed7fSRuslan Bukin }
250eb69ed7fSRuslan Bukin 
251eb69ed7fSRuslan Bukin static int
cqspi_cmd_write_addr(struct cqspi_softc * sc,uint8_t cmd,uint32_t addr,uint32_t len)252eb69ed7fSRuslan Bukin cqspi_cmd_write_addr(struct cqspi_softc *sc, uint8_t cmd,
253eb69ed7fSRuslan Bukin     uint32_t addr, uint32_t len)
254eb69ed7fSRuslan Bukin {
255eb69ed7fSRuslan Bukin 	uint32_t reg;
256eb69ed7fSRuslan Bukin 	int ret;
257eb69ed7fSRuslan Bukin 
258eb69ed7fSRuslan Bukin 	dprintf("%s: %x\n", __func__, cmd);
259eb69ed7fSRuslan Bukin 
260eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_FLASHCMDADDR, addr);
261eb69ed7fSRuslan Bukin 	reg = (cmd << FLASHCMD_CMDOPCODE_S);
262eb69ed7fSRuslan Bukin 	reg |= (FLASHCMD_ENCMDADDR);
263eb69ed7fSRuslan Bukin 	reg |= ((len - 1) << FLASHCMD_NUMADDRBYTES_S);
264eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_FLASHCMD, reg);
265eb69ed7fSRuslan Bukin 
266eb69ed7fSRuslan Bukin 	reg |= FLASHCMD_EXECCMD;
267eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_FLASHCMD, reg);
268eb69ed7fSRuslan Bukin 
269eb69ed7fSRuslan Bukin 	ret = cqspi_wait_for_completion(sc);
270eb69ed7fSRuslan Bukin 
271eb69ed7fSRuslan Bukin 	return (ret);
272eb69ed7fSRuslan Bukin }
273eb69ed7fSRuslan Bukin 
274eb69ed7fSRuslan Bukin static int
cqspi_cmd_write(struct cqspi_softc * sc,uint8_t cmd,uint8_t * addr,uint32_t len)275eb69ed7fSRuslan Bukin cqspi_cmd_write(struct cqspi_softc *sc, uint8_t cmd,
276eb69ed7fSRuslan Bukin     uint8_t *addr, uint32_t len)
277eb69ed7fSRuslan Bukin {
278eb69ed7fSRuslan Bukin 	uint32_t reg;
279eb69ed7fSRuslan Bukin 	int ret;
280eb69ed7fSRuslan Bukin 
281eb69ed7fSRuslan Bukin 	reg = (cmd << FLASHCMD_CMDOPCODE_S);
282eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_FLASHCMD, reg);
283eb69ed7fSRuslan Bukin 	reg |= FLASHCMD_EXECCMD;
284eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_FLASHCMD, reg);
285eb69ed7fSRuslan Bukin 
286eb69ed7fSRuslan Bukin 	ret = cqspi_wait_for_completion(sc);
287eb69ed7fSRuslan Bukin 
288eb69ed7fSRuslan Bukin 	return (ret);
289eb69ed7fSRuslan Bukin }
290eb69ed7fSRuslan Bukin 
291eb69ed7fSRuslan Bukin static int
cqspi_cmd_read(struct cqspi_softc * sc,uint8_t cmd,uint8_t * addr,uint32_t len)292eb69ed7fSRuslan Bukin cqspi_cmd_read(struct cqspi_softc *sc, uint8_t cmd,
293eb69ed7fSRuslan Bukin     uint8_t *addr, uint32_t len)
294eb69ed7fSRuslan Bukin {
295eb69ed7fSRuslan Bukin 	uint32_t data;
296eb69ed7fSRuslan Bukin 	uint32_t reg;
297eb69ed7fSRuslan Bukin 	uint8_t *buf;
298eb69ed7fSRuslan Bukin 	int ret;
299eb69ed7fSRuslan Bukin 	int i;
300eb69ed7fSRuslan Bukin 
301eb69ed7fSRuslan Bukin 	if (len > 8) {
302eb69ed7fSRuslan Bukin 		device_printf(sc->dev, "Failed to read data\n");
303eb69ed7fSRuslan Bukin 		return (-1);
304eb69ed7fSRuslan Bukin 	}
305eb69ed7fSRuslan Bukin 
306eb69ed7fSRuslan Bukin 	dprintf("%s: %x\n", __func__, cmd);
307eb69ed7fSRuslan Bukin 
308eb69ed7fSRuslan Bukin 	buf = (uint8_t *)addr;
309eb69ed7fSRuslan Bukin 
310eb69ed7fSRuslan Bukin 	reg = (cmd << FLASHCMD_CMDOPCODE_S);
311eb69ed7fSRuslan Bukin 	reg |= ((len - 1) << FLASHCMD_NUMRDDATABYTES_S);
312eb69ed7fSRuslan Bukin 	reg |= FLASHCMD_ENRDDATA;
313eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_FLASHCMD, reg);
314eb69ed7fSRuslan Bukin 
315eb69ed7fSRuslan Bukin 	reg |= FLASHCMD_EXECCMD;
316eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_FLASHCMD, reg);
317eb69ed7fSRuslan Bukin 
318eb69ed7fSRuslan Bukin 	ret = cqspi_wait_for_completion(sc);
319eb69ed7fSRuslan Bukin 	if (ret != 0) {
320eb69ed7fSRuslan Bukin 		device_printf(sc->dev, "%s: cmd failed: %x\n",
321eb69ed7fSRuslan Bukin 		    __func__, cmd);
322eb69ed7fSRuslan Bukin 		return (ret);
323eb69ed7fSRuslan Bukin 	}
324eb69ed7fSRuslan Bukin 
325eb69ed7fSRuslan Bukin 	data = READ4(sc, CQSPI_FLASHCMDRDDATALO);
326eb69ed7fSRuslan Bukin 
327eb69ed7fSRuslan Bukin 	for (i = 0; i < len; i++)
328eb69ed7fSRuslan Bukin 		buf[i] = (data >> (i * 8)) & 0xff;
329eb69ed7fSRuslan Bukin 
330eb69ed7fSRuslan Bukin 	return (0);
331eb69ed7fSRuslan Bukin }
332eb69ed7fSRuslan Bukin 
333eb69ed7fSRuslan Bukin static int
cqspi_wait_ready(struct cqspi_softc * sc)334eb69ed7fSRuslan Bukin cqspi_wait_ready(struct cqspi_softc *sc)
335eb69ed7fSRuslan Bukin {
336eb69ed7fSRuslan Bukin 	uint8_t data;
337eb69ed7fSRuslan Bukin 
338eb69ed7fSRuslan Bukin 	do {
339ead64e84SJohn Baldwin 		cqspi_cmd_read(sc, CMD_READ_STATUS, &data, 1);
340eb69ed7fSRuslan Bukin 	} while (data & STATUS_WIP);
341eb69ed7fSRuslan Bukin 
342eb69ed7fSRuslan Bukin 	return (0);
343eb69ed7fSRuslan Bukin }
344eb69ed7fSRuslan Bukin 
345eb69ed7fSRuslan Bukin static int
cqspi_write_reg(device_t dev,device_t child,uint8_t opcode,uint8_t * addr,uint32_t len)346eb69ed7fSRuslan Bukin cqspi_write_reg(device_t dev, device_t child,
347eb69ed7fSRuslan Bukin     uint8_t opcode, uint8_t *addr, uint32_t len)
348eb69ed7fSRuslan Bukin {
349eb69ed7fSRuslan Bukin 	struct cqspi_softc *sc;
350eb69ed7fSRuslan Bukin 	int ret;
351eb69ed7fSRuslan Bukin 
352eb69ed7fSRuslan Bukin 	sc = device_get_softc(dev);
353eb69ed7fSRuslan Bukin 
354eb69ed7fSRuslan Bukin 	ret = cqspi_cmd_write(sc, opcode, addr, len);
355eb69ed7fSRuslan Bukin 
356eb69ed7fSRuslan Bukin 	return (ret);
357eb69ed7fSRuslan Bukin }
358eb69ed7fSRuslan Bukin 
359eb69ed7fSRuslan Bukin static int
cqspi_read_reg(device_t dev,device_t child,uint8_t opcode,uint8_t * addr,uint32_t len)360eb69ed7fSRuslan Bukin cqspi_read_reg(device_t dev, device_t child,
361eb69ed7fSRuslan Bukin     uint8_t opcode, uint8_t *addr, uint32_t len)
362eb69ed7fSRuslan Bukin {
363eb69ed7fSRuslan Bukin 	struct cqspi_softc *sc;
364eb69ed7fSRuslan Bukin 	int ret;
365eb69ed7fSRuslan Bukin 
366eb69ed7fSRuslan Bukin 	sc = device_get_softc(dev);
367eb69ed7fSRuslan Bukin 
368eb69ed7fSRuslan Bukin 	ret = cqspi_cmd_read(sc, opcode, addr, len);
369eb69ed7fSRuslan Bukin 
370eb69ed7fSRuslan Bukin 	return (ret);
371eb69ed7fSRuslan Bukin }
372eb69ed7fSRuslan Bukin 
373eb69ed7fSRuslan Bukin static int
cqspi_wait_idle(struct cqspi_softc * sc)374eb69ed7fSRuslan Bukin cqspi_wait_idle(struct cqspi_softc *sc)
375eb69ed7fSRuslan Bukin {
376eb69ed7fSRuslan Bukin 	uint32_t reg;
377eb69ed7fSRuslan Bukin 
378eb69ed7fSRuslan Bukin 	do {
379eb69ed7fSRuslan Bukin 		reg = READ4(sc, CQSPI_CFG);
380eb69ed7fSRuslan Bukin 		if (reg & CFG_IDLE) {
381eb69ed7fSRuslan Bukin 			break;
382eb69ed7fSRuslan Bukin 		}
383eb69ed7fSRuslan Bukin 	} while (1);
384eb69ed7fSRuslan Bukin 
385eb69ed7fSRuslan Bukin 	return (0);
386eb69ed7fSRuslan Bukin }
387eb69ed7fSRuslan Bukin 
388eb69ed7fSRuslan Bukin static int
cqspi_erase(device_t dev,device_t child,off_t offset)389eb69ed7fSRuslan Bukin cqspi_erase(device_t dev, device_t child, off_t offset)
390eb69ed7fSRuslan Bukin {
391eb69ed7fSRuslan Bukin 	struct cqspi_softc *sc;
392eb69ed7fSRuslan Bukin 
393eb69ed7fSRuslan Bukin 	sc = device_get_softc(dev);
394eb69ed7fSRuslan Bukin 
395eb69ed7fSRuslan Bukin 	cqspi_wait_idle(sc);
396eb69ed7fSRuslan Bukin 	cqspi_wait_ready(sc);
397ead64e84SJohn Baldwin 	cqspi_cmd_write(sc, CMD_WRITE_ENABLE, 0, 0);
398eb69ed7fSRuslan Bukin 
399eb69ed7fSRuslan Bukin 	cqspi_wait_idle(sc);
400eb69ed7fSRuslan Bukin 	cqspi_wait_ready(sc);
401ead64e84SJohn Baldwin 	cqspi_cmd_write_addr(sc, CMD_QUAD_SECTOR_ERASE, offset, 4);
402eb69ed7fSRuslan Bukin 
403eb69ed7fSRuslan Bukin 	cqspi_wait_idle(sc);
404eb69ed7fSRuslan Bukin 
405eb69ed7fSRuslan Bukin 	return (0);
406eb69ed7fSRuslan Bukin }
407eb69ed7fSRuslan Bukin 
408eb69ed7fSRuslan Bukin static int
cqspi_write(device_t dev,device_t child,struct bio * bp,off_t offset,caddr_t data,off_t count)409eb69ed7fSRuslan Bukin cqspi_write(device_t dev, device_t child, struct bio *bp,
410eb69ed7fSRuslan Bukin     off_t offset, caddr_t data, off_t count)
411eb69ed7fSRuslan Bukin {
412eb69ed7fSRuslan Bukin 	struct cqspi_softc *sc;
413eb69ed7fSRuslan Bukin 	uint32_t reg;
414eb69ed7fSRuslan Bukin 
415eb69ed7fSRuslan Bukin 	dprintf("%s: offset 0x%llx count %lld bytes\n",
416eb69ed7fSRuslan Bukin 	    __func__, offset, count);
417eb69ed7fSRuslan Bukin 
418eb69ed7fSRuslan Bukin 	sc = device_get_softc(dev);
419eb69ed7fSRuslan Bukin 
420eb69ed7fSRuslan Bukin 	cqspi_wait_ready(sc);
421ead64e84SJohn Baldwin 	cqspi_cmd_write(sc, CMD_WRITE_ENABLE, 0, 0);
422eb69ed7fSRuslan Bukin 
423eb69ed7fSRuslan Bukin 	cqspi_wait_idle(sc);
424eb69ed7fSRuslan Bukin 	cqspi_wait_ready(sc);
425eb69ed7fSRuslan Bukin 	cqspi_wait_idle(sc);
426eb69ed7fSRuslan Bukin 
427eb69ed7fSRuslan Bukin 	reg = DMAPER_NUMSGLREQBYTES_4;
428eb69ed7fSRuslan Bukin 	reg |= DMAPER_NUMBURSTREQBYTES_4;
429eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_DMAPER, reg);
430eb69ed7fSRuslan Bukin 
431eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_INDWRWATER, 64);
432eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_INDWR, INDRD_IND_OPS_DONE_STATUS);
433eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_INDWR, 0);
434eb69ed7fSRuslan Bukin 
435eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_INDWRCNT, count);
436eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_INDWRSTADDR, offset);
437eb69ed7fSRuslan Bukin 
438eb69ed7fSRuslan Bukin 	reg = (0 << DEVWR_DUMMYWRCLKS_S);
439eb69ed7fSRuslan Bukin 	reg |= DEVWR_DATA_WIDTH_QUAD;
440eb69ed7fSRuslan Bukin 	reg |= DEVWR_ADDR_WIDTH_SINGLE;
441eb69ed7fSRuslan Bukin 	reg |= (CMD_QUAD_PAGE_PROGRAM << DEVWR_WROPCODE_S);
442eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_DEVWR, reg);
443eb69ed7fSRuslan Bukin 
444eb69ed7fSRuslan Bukin 	reg = DEVRD_DATA_WIDTH_QUAD;
445eb69ed7fSRuslan Bukin 	reg |= DEVRD_ADDR_WIDTH_SINGLE;
446eb69ed7fSRuslan Bukin 	reg |= DEVRD_INST_WIDTH_SINGLE;
447eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_DEVRD, reg);
448eb69ed7fSRuslan Bukin 
449eb69ed7fSRuslan Bukin 	xdma_enqueue_bio(sc->xchan_tx, &bp,
450eb69ed7fSRuslan Bukin 	    sc->sram_phys, 4, 4, XDMA_MEM_TO_DEV);
451eb69ed7fSRuslan Bukin 	xdma_queue_submit(sc->xchan_tx);
452eb69ed7fSRuslan Bukin 
453eb69ed7fSRuslan Bukin 	sc->write_op_done = 0;
454eb69ed7fSRuslan Bukin 
455eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_INDWR, INDRD_START);
456eb69ed7fSRuslan Bukin 
457eb69ed7fSRuslan Bukin 	while (sc->write_op_done == 0)
458eb69ed7fSRuslan Bukin 		tsleep(&sc->xdma_tx, PCATCH | PZERO, "spi", hz/2);
459eb69ed7fSRuslan Bukin 
460eb69ed7fSRuslan Bukin 	cqspi_wait_idle(sc);
461eb69ed7fSRuslan Bukin 
462eb69ed7fSRuslan Bukin 	return (0);
463eb69ed7fSRuslan Bukin }
464eb69ed7fSRuslan Bukin 
465eb69ed7fSRuslan Bukin static int
cqspi_read(device_t dev,device_t child,struct bio * bp,off_t offset,caddr_t data,off_t count)466eb69ed7fSRuslan Bukin cqspi_read(device_t dev, device_t child, struct bio *bp,
467eb69ed7fSRuslan Bukin     off_t offset, caddr_t data, off_t count)
468eb69ed7fSRuslan Bukin {
469eb69ed7fSRuslan Bukin 	struct cqspi_softc *sc;
470eb69ed7fSRuslan Bukin 	uint32_t reg;
471eb69ed7fSRuslan Bukin 
472eb69ed7fSRuslan Bukin 	sc = device_get_softc(dev);
473eb69ed7fSRuslan Bukin 
474eb69ed7fSRuslan Bukin 	dprintf("%s: offset 0x%llx count %lld bytes\n",
475eb69ed7fSRuslan Bukin 	    __func__, offset, count);
476eb69ed7fSRuslan Bukin 
477eb69ed7fSRuslan Bukin 	cqspi_wait_idle(sc);
478eb69ed7fSRuslan Bukin 
479eb69ed7fSRuslan Bukin 	reg = DMAPER_NUMSGLREQBYTES_4;
480eb69ed7fSRuslan Bukin 	reg |= DMAPER_NUMBURSTREQBYTES_4;
481eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_DMAPER, reg);
482eb69ed7fSRuslan Bukin 
483eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_INDRDWATER, 64);
484eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_INDRD, INDRD_IND_OPS_DONE_STATUS);
485eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_INDRD, 0);
486eb69ed7fSRuslan Bukin 
487eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_INDRDCNT, count);
488eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_INDRDSTADDR, offset);
489eb69ed7fSRuslan Bukin 
490eb69ed7fSRuslan Bukin 	reg = (0 << DEVRD_DUMMYRDCLKS_S);
491eb69ed7fSRuslan Bukin 	reg |= DEVRD_DATA_WIDTH_QUAD;
492eb69ed7fSRuslan Bukin 	reg |= DEVRD_ADDR_WIDTH_SINGLE;
493eb69ed7fSRuslan Bukin 	reg |= DEVRD_INST_WIDTH_SINGLE;
494eb69ed7fSRuslan Bukin 	reg |= DEVRD_ENMODEBITS;
495eb69ed7fSRuslan Bukin 	reg |= (CMD_READ_4B_QUAD_OUTPUT << DEVRD_RDOPCODE_S);
496eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_DEVRD, reg);
497eb69ed7fSRuslan Bukin 
498eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_MODEBIT, 0xff);
499eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_IRQMASK, 0);
500eb69ed7fSRuslan Bukin 
501eb69ed7fSRuslan Bukin 	xdma_enqueue_bio(sc->xchan_rx, &bp, sc->sram_phys, 4, 4,
502eb69ed7fSRuslan Bukin 	    XDMA_DEV_TO_MEM);
503eb69ed7fSRuslan Bukin 	xdma_queue_submit(sc->xchan_rx);
504eb69ed7fSRuslan Bukin 
505eb69ed7fSRuslan Bukin 	sc->read_op_done = 0;
506eb69ed7fSRuslan Bukin 
507eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_INDRD, INDRD_START);
508eb69ed7fSRuslan Bukin 
509eb69ed7fSRuslan Bukin 	while (sc->read_op_done == 0)
510eb69ed7fSRuslan Bukin 		tsleep(&sc->xdma_rx, PCATCH | PZERO, "spi", hz/2);
511eb69ed7fSRuslan Bukin 
512eb69ed7fSRuslan Bukin 	cqspi_wait_idle(sc);
513eb69ed7fSRuslan Bukin 
514eb69ed7fSRuslan Bukin 	return (0);
515eb69ed7fSRuslan Bukin }
516eb69ed7fSRuslan Bukin 
517eb69ed7fSRuslan Bukin static int
cqspi_init(struct cqspi_softc * sc)518eb69ed7fSRuslan Bukin cqspi_init(struct cqspi_softc *sc)
519eb69ed7fSRuslan Bukin {
520eb69ed7fSRuslan Bukin 	pcell_t dts_value[1];
521eb69ed7fSRuslan Bukin 	phandle_t node;
522eb69ed7fSRuslan Bukin 	uint32_t reg;
523eb69ed7fSRuslan Bukin 	int len;
524eb69ed7fSRuslan Bukin 
525eb69ed7fSRuslan Bukin 	device_printf(sc->dev, "Module ID %x\n",
526eb69ed7fSRuslan Bukin 	    READ4(sc, CQSPI_MODULEID));
527eb69ed7fSRuslan Bukin 
528eb69ed7fSRuslan Bukin 	if ((node = ofw_bus_get_node(sc->dev)) == -1) {
529eb69ed7fSRuslan Bukin 		return (ENXIO);
530eb69ed7fSRuslan Bukin 	}
531eb69ed7fSRuslan Bukin 
532eb69ed7fSRuslan Bukin 	if ((len = OF_getproplen(node, "cdns,fifo-depth")) <= 0) {
533eb69ed7fSRuslan Bukin 		return (ENXIO);
534eb69ed7fSRuslan Bukin 	}
535eb69ed7fSRuslan Bukin 	OF_getencprop(node, "cdns,fifo-depth", dts_value, len);
536eb69ed7fSRuslan Bukin 	sc->fifo_depth = dts_value[0];
537eb69ed7fSRuslan Bukin 
538eb69ed7fSRuslan Bukin 	if ((len = OF_getproplen(node, "cdns,fifo-width")) <= 0) {
539eb69ed7fSRuslan Bukin 		return (ENXIO);
540eb69ed7fSRuslan Bukin 	}
541eb69ed7fSRuslan Bukin 	OF_getencprop(node, "cdns,fifo-width", dts_value, len);
542eb69ed7fSRuslan Bukin 	sc->fifo_width = dts_value[0];
543eb69ed7fSRuslan Bukin 
544eb69ed7fSRuslan Bukin 	if ((len = OF_getproplen(node, "cdns,trigger-address")) <= 0) {
545eb69ed7fSRuslan Bukin 		return (ENXIO);
546eb69ed7fSRuslan Bukin 	}
547eb69ed7fSRuslan Bukin 	OF_getencprop(node, "cdns,trigger-address", dts_value, len);
548eb69ed7fSRuslan Bukin 	sc->trigger_address = dts_value[0];
549eb69ed7fSRuslan Bukin 
550eb69ed7fSRuslan Bukin 	/* Disable controller */
551eb69ed7fSRuslan Bukin 	reg = READ4(sc, CQSPI_CFG);
552eb69ed7fSRuslan Bukin 	reg &= ~(CFG_EN);
553eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_CFG, reg);
554eb69ed7fSRuslan Bukin 
555eb69ed7fSRuslan Bukin 	reg = READ4(sc, CQSPI_DEVSZ);
556eb69ed7fSRuslan Bukin 	reg &= ~(DEVSZ_NUMADDRBYTES_M);
557eb69ed7fSRuslan Bukin 	reg |= ((4 - 1) - DEVSZ_NUMADDRBYTES_S);
558eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_DEVSZ, reg);
559eb69ed7fSRuslan Bukin 
560eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_SRAMPART, sc->fifo_depth/2);
561eb69ed7fSRuslan Bukin 
562eb69ed7fSRuslan Bukin 	/* TODO: calculate baud rate and delay values. */
563eb69ed7fSRuslan Bukin 
564eb69ed7fSRuslan Bukin 	reg = READ4(sc, CQSPI_CFG);
565eb69ed7fSRuslan Bukin 	/* Configure baud rate */
566eb69ed7fSRuslan Bukin 	reg &= ~(CFG_BAUD_M);
567eb69ed7fSRuslan Bukin 	reg |= CFG_BAUD12;
568eb69ed7fSRuslan Bukin 	reg |= CFG_ENDMA;
569eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_CFG, reg);
570eb69ed7fSRuslan Bukin 
571eb69ed7fSRuslan Bukin 	reg = (3 << DELAY_NSS_S);
572eb69ed7fSRuslan Bukin 	reg |= (3  << DELAY_BTWN_S);
573eb69ed7fSRuslan Bukin 	reg |= (1 << DELAY_AFTER_S);
574eb69ed7fSRuslan Bukin 	reg |= (1 << DELAY_INIT_S);
575eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_DELAY, reg);
576eb69ed7fSRuslan Bukin 
577eb69ed7fSRuslan Bukin 	READ4(sc, CQSPI_RDDATACAP);
578eb69ed7fSRuslan Bukin 	reg &= ~(RDDATACAP_DELAY_M);
579eb69ed7fSRuslan Bukin 	reg |= (1 << RDDATACAP_DELAY_S);
580eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_RDDATACAP, reg);
581eb69ed7fSRuslan Bukin 
582eb69ed7fSRuslan Bukin 	/* Enable controller */
583eb69ed7fSRuslan Bukin 	reg = READ4(sc, CQSPI_CFG);
584eb69ed7fSRuslan Bukin 	reg |= (CFG_EN);
585eb69ed7fSRuslan Bukin 	WRITE4(sc, CQSPI_CFG, reg);
586eb69ed7fSRuslan Bukin 
587eb69ed7fSRuslan Bukin 	return (0);
588eb69ed7fSRuslan Bukin }
589eb69ed7fSRuslan Bukin 
590eb69ed7fSRuslan Bukin static int
cqspi_add_devices(device_t dev)591eb69ed7fSRuslan Bukin cqspi_add_devices(device_t dev)
592eb69ed7fSRuslan Bukin {
593eb69ed7fSRuslan Bukin 	phandle_t child, node;
594eb69ed7fSRuslan Bukin 	device_t child_dev;
595eb69ed7fSRuslan Bukin 	int error;
596eb69ed7fSRuslan Bukin 
597eb69ed7fSRuslan Bukin 	node = ofw_bus_get_node(dev);
598eb69ed7fSRuslan Bukin 
599eb69ed7fSRuslan Bukin 	for (child = OF_child(node); child != 0; child = OF_peer(child)) {
600eb69ed7fSRuslan Bukin 		child_dev =
601eb69ed7fSRuslan Bukin 		    simplebus_add_device(dev, child, 0, NULL, -1, NULL);
602eb69ed7fSRuslan Bukin 		if (child_dev == NULL) {
603eb69ed7fSRuslan Bukin 			return (ENXIO);
604eb69ed7fSRuslan Bukin 		}
605eb69ed7fSRuslan Bukin 
606eb69ed7fSRuslan Bukin 		error = device_probe_and_attach(child_dev);
607eb69ed7fSRuslan Bukin 		if (error != 0) {
608eb69ed7fSRuslan Bukin 			printf("can't probe and attach: %d\n", error);
609eb69ed7fSRuslan Bukin 		}
610eb69ed7fSRuslan Bukin 	}
611eb69ed7fSRuslan Bukin 
612eb69ed7fSRuslan Bukin 	return (0);
613eb69ed7fSRuslan Bukin }
614eb69ed7fSRuslan Bukin 
615eb69ed7fSRuslan Bukin static void
cqspi_delayed_attach(void * arg)616eb69ed7fSRuslan Bukin cqspi_delayed_attach(void *arg)
617eb69ed7fSRuslan Bukin {
618eb69ed7fSRuslan Bukin 	struct cqspi_softc *sc;
619eb69ed7fSRuslan Bukin 
620eb69ed7fSRuslan Bukin 	sc = arg;
621eb69ed7fSRuslan Bukin 
622eb69ed7fSRuslan Bukin 	cqspi_add_devices(sc->dev);
623*18250ec6SJohn Baldwin 	bus_attach_children(sc->dev);
624eb69ed7fSRuslan Bukin 
625eb69ed7fSRuslan Bukin 	config_intrhook_disestablish(&sc->config_intrhook);
626eb69ed7fSRuslan Bukin }
627eb69ed7fSRuslan Bukin 
628eb69ed7fSRuslan Bukin static int
cqspi_probe(device_t dev)629eb69ed7fSRuslan Bukin cqspi_probe(device_t dev)
630eb69ed7fSRuslan Bukin {
631eb69ed7fSRuslan Bukin 
632eb69ed7fSRuslan Bukin 	if (!ofw_bus_status_okay(dev)) {
633eb69ed7fSRuslan Bukin 		return (ENXIO);
634eb69ed7fSRuslan Bukin 	}
635eb69ed7fSRuslan Bukin 
636eb69ed7fSRuslan Bukin 	if (!ofw_bus_search_compatible(dev, compat_data)->ocd_data) {
637eb69ed7fSRuslan Bukin 		return (ENXIO);
638eb69ed7fSRuslan Bukin 	}
639eb69ed7fSRuslan Bukin 
640eb69ed7fSRuslan Bukin 	device_set_desc(dev, "Cadence Quad SPI controller");
641eb69ed7fSRuslan Bukin 
642eb69ed7fSRuslan Bukin 	return (0);
643eb69ed7fSRuslan Bukin }
644eb69ed7fSRuslan Bukin 
645eb69ed7fSRuslan Bukin static int
cqspi_attach(device_t dev)646eb69ed7fSRuslan Bukin cqspi_attach(device_t dev)
647eb69ed7fSRuslan Bukin {
648eb69ed7fSRuslan Bukin 	struct cqspi_softc *sc;
649eb69ed7fSRuslan Bukin 	uint32_t caps;
650eb69ed7fSRuslan Bukin 	int error;
651eb69ed7fSRuslan Bukin 
652eb69ed7fSRuslan Bukin 	sc = device_get_softc(dev);
653eb69ed7fSRuslan Bukin 	sc->dev = dev;
654eb69ed7fSRuslan Bukin 
655eb69ed7fSRuslan Bukin 	if (bus_alloc_resources(dev, cqspi_spec, sc->res)) {
656eb69ed7fSRuslan Bukin 		device_printf(dev, "could not allocate resources\n");
657eb69ed7fSRuslan Bukin 		return (ENXIO);
658eb69ed7fSRuslan Bukin 	}
659eb69ed7fSRuslan Bukin 
660eb69ed7fSRuslan Bukin 	/* Memory interface */
661eb69ed7fSRuslan Bukin 	sc->bst = rman_get_bustag(sc->res[0]);
662eb69ed7fSRuslan Bukin 	sc->bsh = rman_get_bushandle(sc->res[0]);
663eb69ed7fSRuslan Bukin 
664eb69ed7fSRuslan Bukin 	sc->sram_phys = rman_get_start(sc->res[1]);
665eb69ed7fSRuslan Bukin 
666eb69ed7fSRuslan Bukin 	/* Setup interrupt handlers */
667eb69ed7fSRuslan Bukin 	if (bus_setup_intr(sc->dev, sc->res[2], INTR_TYPE_BIO | INTR_MPSAFE,
668eb69ed7fSRuslan Bukin 	    NULL, cqspi_intr, sc, &sc->ih)) {
669eb69ed7fSRuslan Bukin 		device_printf(sc->dev, "Unable to setup intr\n");
670eb69ed7fSRuslan Bukin 		return (ENXIO);
671eb69ed7fSRuslan Bukin 	}
672eb69ed7fSRuslan Bukin 
673eb69ed7fSRuslan Bukin 	CQSPI_LOCK_INIT(sc);
674eb69ed7fSRuslan Bukin 
675eb69ed7fSRuslan Bukin 	caps = 0;
676eb69ed7fSRuslan Bukin 
677eb69ed7fSRuslan Bukin 	/* Get xDMA controller. */
678eb69ed7fSRuslan Bukin 	sc->xdma_tx = xdma_ofw_get(sc->dev, "tx");
679eb69ed7fSRuslan Bukin 	if (sc->xdma_tx == NULL) {
680eb69ed7fSRuslan Bukin 		device_printf(dev, "Can't find DMA controller.\n");
681eb69ed7fSRuslan Bukin 		return (ENXIO);
682eb69ed7fSRuslan Bukin 	}
683eb69ed7fSRuslan Bukin 
684eb69ed7fSRuslan Bukin 	sc->xdma_rx = xdma_ofw_get(sc->dev, "rx");
685eb69ed7fSRuslan Bukin 	if (sc->xdma_rx == NULL) {
686eb69ed7fSRuslan Bukin 		device_printf(dev, "Can't find DMA controller.\n");
687eb69ed7fSRuslan Bukin 		return (ENXIO);
688eb69ed7fSRuslan Bukin 	}
689eb69ed7fSRuslan Bukin 
690eb69ed7fSRuslan Bukin 	/* Alloc xDMA virtual channels. */
691eb69ed7fSRuslan Bukin 	sc->xchan_tx = xdma_channel_alloc(sc->xdma_tx, caps);
692eb69ed7fSRuslan Bukin 	if (sc->xchan_tx == NULL) {
693eb69ed7fSRuslan Bukin 		device_printf(dev, "Can't alloc virtual DMA channel.\n");
694eb69ed7fSRuslan Bukin 		return (ENXIO);
695eb69ed7fSRuslan Bukin 	}
696eb69ed7fSRuslan Bukin 
697eb69ed7fSRuslan Bukin 	sc->xchan_rx = xdma_channel_alloc(sc->xdma_rx, caps);
698eb69ed7fSRuslan Bukin 	if (sc->xchan_rx == NULL) {
699eb69ed7fSRuslan Bukin 		device_printf(dev, "Can't alloc virtual DMA channel.\n");
700eb69ed7fSRuslan Bukin 		return (ENXIO);
701eb69ed7fSRuslan Bukin 	}
702eb69ed7fSRuslan Bukin 
703eb69ed7fSRuslan Bukin 	/* Setup xDMA interrupt handlers. */
704d987842dSRuslan Bukin 	error = xdma_setup_intr(sc->xchan_tx, 0, cqspi_xdma_tx_intr,
705eb69ed7fSRuslan Bukin 	    sc, &sc->ih_tx);
706eb69ed7fSRuslan Bukin 	if (error) {
707eb69ed7fSRuslan Bukin 		device_printf(sc->dev,
708eb69ed7fSRuslan Bukin 		    "Can't setup xDMA interrupt handler.\n");
709eb69ed7fSRuslan Bukin 		return (ENXIO);
710eb69ed7fSRuslan Bukin 	}
711eb69ed7fSRuslan Bukin 
712d987842dSRuslan Bukin 	error = xdma_setup_intr(sc->xchan_rx, 0, cqspi_xdma_rx_intr,
713eb69ed7fSRuslan Bukin 	    sc, &sc->ih_rx);
714eb69ed7fSRuslan Bukin 	if (error) {
715eb69ed7fSRuslan Bukin 		device_printf(sc->dev,
716eb69ed7fSRuslan Bukin 		    "Can't setup xDMA interrupt handler.\n");
717eb69ed7fSRuslan Bukin 		return (ENXIO);
718eb69ed7fSRuslan Bukin 	}
719eb69ed7fSRuslan Bukin 
720cd853791SKonstantin Belousov 	xdma_prep_sg(sc->xchan_tx, TX_QUEUE_SIZE, maxphys, 8, 16, 0,
721eb69ed7fSRuslan Bukin 	    BUS_SPACE_MAXADDR_32BIT, BUS_SPACE_MAXADDR);
722cd853791SKonstantin Belousov 	xdma_prep_sg(sc->xchan_rx, TX_QUEUE_SIZE, maxphys, 8, 16, 0,
723eb69ed7fSRuslan Bukin 	    BUS_SPACE_MAXADDR_32BIT, BUS_SPACE_MAXADDR);
724eb69ed7fSRuslan Bukin 
725eb69ed7fSRuslan Bukin 	cqspi_init(sc);
726eb69ed7fSRuslan Bukin 
727eb69ed7fSRuslan Bukin 	sc->config_intrhook.ich_func = cqspi_delayed_attach;
728eb69ed7fSRuslan Bukin 	sc->config_intrhook.ich_arg = sc;
729eb69ed7fSRuslan Bukin 	if (config_intrhook_establish(&sc->config_intrhook) != 0) {
730eb69ed7fSRuslan Bukin 		device_printf(dev, "config_intrhook_establish failed\n");
731eb69ed7fSRuslan Bukin 		return (ENOMEM);
732eb69ed7fSRuslan Bukin 	}
733eb69ed7fSRuslan Bukin 
734eb69ed7fSRuslan Bukin 	return (0);
735eb69ed7fSRuslan Bukin }
736eb69ed7fSRuslan Bukin 
737eb69ed7fSRuslan Bukin static int
cqspi_detach(device_t dev)738eb69ed7fSRuslan Bukin cqspi_detach(device_t dev)
739eb69ed7fSRuslan Bukin {
740eb69ed7fSRuslan Bukin 
741eb69ed7fSRuslan Bukin 	return (ENXIO);
742eb69ed7fSRuslan Bukin }
743eb69ed7fSRuslan Bukin 
744eb69ed7fSRuslan Bukin static device_method_t cqspi_methods[] = {
745eb69ed7fSRuslan Bukin 	/* Device interface */
746eb69ed7fSRuslan Bukin 	DEVMETHOD(device_probe,		cqspi_probe),
747eb69ed7fSRuslan Bukin 	DEVMETHOD(device_attach,	cqspi_attach),
748eb69ed7fSRuslan Bukin 	DEVMETHOD(device_detach,	cqspi_detach),
749eb69ed7fSRuslan Bukin 
750eb69ed7fSRuslan Bukin 	/* Quad SPI Flash Interface */
751eb69ed7fSRuslan Bukin 	DEVMETHOD(qspi_read_reg,	cqspi_read_reg),
752eb69ed7fSRuslan Bukin 	DEVMETHOD(qspi_write_reg,	cqspi_write_reg),
753eb69ed7fSRuslan Bukin 	DEVMETHOD(qspi_read,		cqspi_read),
754eb69ed7fSRuslan Bukin 	DEVMETHOD(qspi_write,		cqspi_write),
755eb69ed7fSRuslan Bukin 	DEVMETHOD(qspi_erase,		cqspi_erase),
756eb69ed7fSRuslan Bukin 
757eb69ed7fSRuslan Bukin 	{ 0, 0 }
758eb69ed7fSRuslan Bukin };
759eb69ed7fSRuslan Bukin 
760eb69ed7fSRuslan Bukin DEFINE_CLASS_1(cqspi, cqspi_driver, cqspi_methods,
761eb69ed7fSRuslan Bukin     sizeof(struct cqspi_softc), simplebus_driver);
762eb69ed7fSRuslan Bukin 
7630d95fe04SJohn Baldwin DRIVER_MODULE(cqspi, simplebus, cqspi_driver, 0, 0);
764