xref: /netbsd-src/sys/dev/ic/w83l518d_sdmmc.c (revision 7aed42c4ee10a835c0eb72dc6c6356bd83de9159)
1 /* $NetBSD: w83l518d_sdmmc.c,v 1.7 2023/05/10 00:11:08 riastradh Exp $ */
2 
3 /*
4  * Copyright (c) 2009 Jared D. McNeill <jmcneill@invisible.ca>
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer.
12  * 2. The name of the author may not be used to endorse or promote products
13  *    derived from this software without specific prior written permission.
14  *
15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
20  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
21  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
22  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
23  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25  * SUCH DAMAGE.
26  */
27 
28 #include <sys/cdefs.h>
29 __KERNEL_RCSID(0, "$NetBSD: w83l518d_sdmmc.c,v 1.7 2023/05/10 00:11:08 riastradh Exp $");
30 
31 #include <sys/param.h>
32 #include <sys/kernel.h>
33 #include <sys/systm.h>
34 #include <sys/errno.h>
35 #include <sys/ioctl.h>
36 #include <sys/syslog.h>
37 #include <sys/device.h>
38 #include <sys/proc.h>
39 
40 #include <sys/bus.h>
41 
42 #include <dev/sdmmc/sdmmcvar.h>
43 #include <dev/sdmmc/sdmmcchip.h>
44 #include <dev/sdmmc/sdmmc_ioreg.h>
45 
46 #include <dev/ic/w83l518dreg.h>
47 #include <dev/ic/w83l518dvar.h>
48 #include <dev/ic/w83l518d_sdmmc.h>
49 
50 /* #define WB_SDMMC_DEBUG */
51 
52 #ifdef WB_SDMMC_DEBUG
53 static int wb_sdmmc_debug = 1;
54 #else
55 static int wb_sdmmc_debug = 0;
56 #endif
57 
58 #if defined(__NetBSD__) && __NetBSD_Version__ < 599000600
59 #define	snprintb(b, l, f, v) bitmask_snprintf((v), (f), (b), (l))
60 #endif
61 
62 #define REPORT(_wb, ...)					\
63 	if (wb_sdmmc_debug > 0)					\
64 		aprint_normal_dev(((struct wb_softc *)(_wb))->wb_dev, \
65 				  __VA_ARGS__)
66 
67 static int	wb_sdmmc_host_reset(sdmmc_chipset_handle_t);
68 static uint32_t	wb_sdmmc_host_ocr(sdmmc_chipset_handle_t);
69 static int	wb_sdmmc_host_maxblklen(sdmmc_chipset_handle_t);
70 static int	wb_sdmmc_card_detect(sdmmc_chipset_handle_t);
71 static int	wb_sdmmc_write_protect(sdmmc_chipset_handle_t);
72 static int	wb_sdmmc_bus_power(sdmmc_chipset_handle_t, uint32_t);
73 static int	wb_sdmmc_bus_clock(sdmmc_chipset_handle_t, int);
74 static int	wb_sdmmc_bus_width(sdmmc_chipset_handle_t, int);
75 static int	wb_sdmmc_bus_rod(sdmmc_chipset_handle_t, int);
76 static void	wb_sdmmc_exec_command(sdmmc_chipset_handle_t,
77 				      struct sdmmc_command *);
78 static void	wb_sdmmc_card_enable_intr(sdmmc_chipset_handle_t, int);
79 static void	wb_sdmmc_card_intr_ack(sdmmc_chipset_handle_t);
80 
81 static struct sdmmc_chip_functions wb_sdmmc_chip_functions = {
82 	.host_reset = wb_sdmmc_host_reset,
83 	.host_ocr = wb_sdmmc_host_ocr,
84 	.host_maxblklen = wb_sdmmc_host_maxblklen,
85 	.card_detect = wb_sdmmc_card_detect,
86 	.write_protect = wb_sdmmc_write_protect,
87 	.bus_power = wb_sdmmc_bus_power,
88 	.bus_clock = wb_sdmmc_bus_clock,
89 	.bus_width = wb_sdmmc_bus_width,
90 	.bus_rod = wb_sdmmc_bus_rod,
91 	.exec_command = wb_sdmmc_exec_command,
92 	.card_enable_intr = wb_sdmmc_card_enable_intr,
93 	.card_intr_ack = wb_sdmmc_card_intr_ack,
94 };
95 
96 static void
wb_sdmmc_read_data(struct wb_softc * wb,uint8_t * data,int len)97 wb_sdmmc_read_data(struct wb_softc *wb, uint8_t *data, int len)
98 {
99 	bus_space_read_multi_1(wb->wb_iot, wb->wb_ioh, WB_SD_FIFO, data, len);
100 }
101 
102 static void
wb_sdmmc_write_data(struct wb_softc * wb,uint8_t * data,int len)103 wb_sdmmc_write_data(struct wb_softc *wb, uint8_t *data, int len)
104 {
105 	bus_space_write_multi_1(wb->wb_iot, wb->wb_ioh, WB_SD_FIFO, data, len);
106 }
107 
108 static void
wb_sdmmc_discover(void * opaque)109 wb_sdmmc_discover(void *opaque)
110 {
111 	struct wb_softc *wb = opaque;
112 
113 	REPORT(wb, "TRACE: discover(wb)\n");
114 
115 	sdmmc_needs_discover(wb->wb_sdmmc_dev);
116 }
117 
118 static bool
wb_sdmmc_enable(struct wb_softc * wb)119 wb_sdmmc_enable(struct wb_softc *wb)
120 {
121 	int i = 5000;
122 
123 	REPORT(wb, "TRACE: enable(wb)\n");
124 
125 	/* put the device in a known state */
126 	wb_idx_write(wb, WB_INDEX_SETUP, WB_SETUP_SOFT_RST);
127 	while (--i > 0 && wb_idx_read(wb, WB_INDEX_SETUP) & WB_SETUP_SOFT_RST)
128 		delay(100);
129 	if (i == 0) {
130 		aprint_error_dev(wb->wb_dev, "timeout resetting device\n");
131 		return false;
132 	}
133 	wb_idx_write(wb, WB_INDEX_CLK, wb->wb_sdmmc_clk);
134 	wb_idx_write(wb, WB_INDEX_FIFOEN, 0);
135 	wb_idx_write(wb, WB_INDEX_DMA, 0);
136 	wb_idx_write(wb, WB_INDEX_PBSMSB, 0);
137 	wb_idx_write(wb, WB_INDEX_PBSLSB, 0);
138 	/* drain FIFO */
139 	while ((wb_read(wb, WB_SD_FIFOSTS) & WB_FIFO_EMPTY) == 0)
140 		wb_read(wb, WB_SD_FIFO);
141 
142 	wb_write(wb, WB_SD_CSR, 0);
143 
144 	wb_write(wb, WB_SD_INTCTL, WB_INT_DEFAULT);
145 
146 	wb_sdmmc_card_detect(wb);
147 
148 	return true;
149 }
150 
151 static bool
wb_sdmmc_disable(struct wb_softc * wb)152 wb_sdmmc_disable(struct wb_softc *wb)
153 {
154 	uint8_t val;
155 
156 	REPORT(wb, "TRACE: disable(wb)\n");
157 
158 	val = wb_read(wb, WB_SD_CSR);
159 	val |= WB_CSR_POWER_N;
160 	wb_write(wb, WB_SD_CSR, val);
161 
162 	return true;
163 }
164 
165 void
wb_sdmmc_attach(struct wb_softc * wb)166 wb_sdmmc_attach(struct wb_softc *wb)
167 {
168 	struct sdmmcbus_attach_args saa;
169 
170 	callout_init(&wb->wb_sdmmc_callout, 0);
171 	callout_setfunc(&wb->wb_sdmmc_callout, wb_sdmmc_discover, wb);
172 
173 	wb->wb_sdmmc_width = 1;
174 	wb->wb_sdmmc_clk = WB_CLK_375K;
175 
176 	if (wb_sdmmc_enable(wb) == false)
177 		return;
178 
179 	memset(&saa, 0, sizeof(saa));
180 	saa.saa_busname = "sdmmc";
181 	saa.saa_sct = &wb_sdmmc_chip_functions;
182 	saa.saa_sch = wb;
183 	saa.saa_clkmin = 375;
184 	saa.saa_clkmax = 24000;
185 	if (!ISSET(wb->wb_quirks, WB_QUIRK_1BIT))
186 		saa.saa_caps = SMC_CAPS_4BIT_MODE;
187 
188 	wb->wb_sdmmc_dev = config_found(wb->wb_dev, &saa, NULL, CFARGS_NONE);
189 }
190 
191 int
wb_sdmmc_detach(struct wb_softc * wb,int flags)192 wb_sdmmc_detach(struct wb_softc *wb, int flags)
193 {
194 	int error;
195 
196 	error = config_detach_children(wb->wb_dev, flags);
197 	if (error)
198 		return error;
199 	wb_sdmmc_disable(wb);
200 
201 	callout_halt(&wb->wb_sdmmc_callout, NULL);
202 	callout_destroy(&wb->wb_sdmmc_callout);
203 
204 	return 0;
205 }
206 
207 /*
208  * SD/MMC interface
209  */
210 static int
wb_sdmmc_host_reset(sdmmc_chipset_handle_t sch)211 wb_sdmmc_host_reset(sdmmc_chipset_handle_t sch)
212 {
213 	REPORT(sch, "TRACE: sdmmc/host_reset(wb)\n");
214 
215 	return 0;
216 }
217 
218 static uint32_t
wb_sdmmc_host_ocr(sdmmc_chipset_handle_t sch)219 wb_sdmmc_host_ocr(sdmmc_chipset_handle_t sch)
220 {
221 	REPORT(sch, "TRACE: sdmmc/host_ocr(wb)\n");
222 
223 	return MMC_OCR_3_2V_3_3V | MMC_OCR_3_3V_3_4V;
224 }
225 
226 static int
wb_sdmmc_host_maxblklen(sdmmc_chipset_handle_t sch)227 wb_sdmmc_host_maxblklen(sdmmc_chipset_handle_t sch)
228 {
229 	REPORT(sch, "TRACE: sdmmc/host_maxblklen(wb)\n");
230 
231 	return 512;	/* XXX */
232 }
233 
234 static int
wb_sdmmc_card_detect(sdmmc_chipset_handle_t sch)235 wb_sdmmc_card_detect(sdmmc_chipset_handle_t sch)
236 {
237 	struct wb_softc *wb = sch;
238 	int rv;
239 
240 	wb_led(wb, true);
241 	rv = (wb_read(wb, WB_SD_CSR) & WB_CSR_CARD_PRESENT) ? 1 : 0;
242 	wb_led(wb, false);
243 
244 	REPORT(wb, "TRACE: sdmmc/card_detect(wb) -> %d\n", rv);
245 
246 	return rv;
247 }
248 
249 static int
wb_sdmmc_write_protect(sdmmc_chipset_handle_t sch)250 wb_sdmmc_write_protect(sdmmc_chipset_handle_t sch)
251 {
252 	struct wb_softc *wb = sch;
253 	int rv;
254 
255 	wb_led(wb, true);
256 	rv = (wb_read(wb, WB_SD_CSR) & WB_CSR_WRITE_PROTECT) ? 1 : 0;
257 	wb_led(wb, false);
258 
259 	REPORT(wb, "TRACE: sdmmc/write_protect(wb) -> %d\n", rv);
260 
261 	return rv;
262 }
263 
264 static int
wb_sdmmc_bus_power(sdmmc_chipset_handle_t sch,uint32_t ocr)265 wb_sdmmc_bus_power(sdmmc_chipset_handle_t sch, uint32_t ocr)
266 {
267 	REPORT(sch, "TRACE: sdmmc/bus_power(wb, ocr=%x)\n", ocr);
268 
269 	return 0;
270 }
271 
272 static int
wb_sdmmc_bus_clock(sdmmc_chipset_handle_t sch,int freq)273 wb_sdmmc_bus_clock(sdmmc_chipset_handle_t sch, int freq)
274 {
275 	struct wb_softc *wb = sch;
276 	uint8_t clk;
277 
278 	REPORT(wb, "TRACE: sdmmc/bus_clock(wb, freq=%d)\n", freq);
279 
280 	if (freq >= 24000)
281 		clk = WB_CLK_24M;
282 	else if (freq >= 16000)
283 		clk = WB_CLK_16M;
284 	else if (freq >= 12000)
285 		clk = WB_CLK_12M;
286 	else
287 		clk = WB_CLK_375K;
288 
289 	wb->wb_sdmmc_clk = clk;
290 
291 	if (wb_idx_read(wb, WB_INDEX_CLK) != clk)
292 		wb_idx_write(wb, WB_INDEX_CLK, clk);
293 
294 	return 0;
295 }
296 
297 static int
wb_sdmmc_bus_width(sdmmc_chipset_handle_t sch,int width)298 wb_sdmmc_bus_width(sdmmc_chipset_handle_t sch, int width)
299 {
300 	struct wb_softc *wb = sch;
301 
302 	REPORT(wb, "TRACE: sdmmc/bus_width(wb, width=%d)\n", width);
303 
304 	if (width != 1 && width != 4)
305 		return 1;
306 
307 	wb->wb_sdmmc_width = width;
308 
309 	return 0;
310 }
311 
312 static int
wb_sdmmc_bus_rod(sdmmc_chipset_handle_t sch,int on)313 wb_sdmmc_bus_rod(sdmmc_chipset_handle_t sch, int on)
314 {
315 
316 	/* Not support */
317 	return -1;
318 }
319 
320 
321 static void
wb_sdmmc_rsp_read_long(struct wb_softc * wb,struct sdmmc_command * cmd)322 wb_sdmmc_rsp_read_long(struct wb_softc *wb, struct sdmmc_command *cmd)
323 {
324 	uint8_t *p = (uint8_t *)cmd->c_resp;
325 	int i;
326 
327 	if (wb_idx_read(wb, WB_INDEX_RESPLEN) != 1) {
328 		cmd->c_error = ENXIO;
329 		return;
330 	}
331 
332 	for (i = 12; i >= 0; i -= 4) {
333 #if BYTE_ORDER == LITTLE_ENDIAN
334 		p[3] = wb_idx_read(wb, WB_INDEX_RESP(i + 0));
335 		p[2] = wb_idx_read(wb, WB_INDEX_RESP(i + 1));
336 		p[1] = wb_idx_read(wb, WB_INDEX_RESP(i + 2));
337 		p[0] = wb_idx_read(wb, WB_INDEX_RESP(i + 3));
338 #else
339 		p[0] = wb_idx_read(wb, WB_INDEX_RESP(i + 0));
340 		p[1] = wb_idx_read(wb, WB_INDEX_RESP(i + 1));
341 		p[2] = wb_idx_read(wb, WB_INDEX_RESP(i + 2));
342 		p[3] = wb_idx_read(wb, WB_INDEX_RESP(i + 3));
343 #endif
344 		REPORT(wb, "TRACE: sdmmc/read_long (%d) 0x%08x\n",
345 		    (12 - i) / 4, cmd->c_resp[(12 - i) / 4]);
346 		p += 4;
347 	}
348 }
349 
350 static void
wb_sdmmc_rsp_read_short(struct wb_softc * wb,struct sdmmc_command * cmd)351 wb_sdmmc_rsp_read_short(struct wb_softc *wb, struct sdmmc_command *cmd)
352 {
353 	uint8_t *p = (uint8_t *)cmd->c_resp;
354 
355 	if (wb_idx_read(wb, WB_INDEX_RESPLEN) != 0) {
356 		cmd->c_error = ENXIO;
357 		return;
358 	}
359 
360 #if BYTE_ORDER == LITTLE_ENDIAN
361 	p[3] = wb_idx_read(wb, WB_INDEX_RESP(12));
362 	p[2] = wb_idx_read(wb, WB_INDEX_RESP(13));
363 	p[1] = wb_idx_read(wb, WB_INDEX_RESP(14));
364 	p[0] = wb_idx_read(wb, WB_INDEX_RESP(15));
365 #else
366 	p[0] = wb_idx_read(wb, WB_INDEX_RESP(12));
367 	p[1] = wb_idx_read(wb, WB_INDEX_RESP(13));
368 	p[2] = wb_idx_read(wb, WB_INDEX_RESP(14));
369 	p[3] = wb_idx_read(wb, WB_INDEX_RESP(15));
370 #endif
371 	REPORT(wb, "TRACE: sdmmc/read_short 0x%08x\n",
372 	    cmd->c_resp[0]);
373 }
374 
375 static int
wb_sdmmc_transfer_data(struct wb_softc * wb,struct sdmmc_command * cmd)376 wb_sdmmc_transfer_data(struct wb_softc *wb, struct sdmmc_command *cmd)
377 {
378 	uint8_t fifosts;
379 	int datalen, retry = 5000;
380 
381 	if (wb->wb_sdmmc_intsts & WB_INT_CARD)
382 		return EIO;
383 
384 	fifosts = wb_read(wb, WB_SD_FIFOSTS);
385 	if (ISSET(cmd->c_flags, SCF_CMD_READ)) {
386 		if (fifosts & WB_FIFO_EMPTY) {
387 			while (--retry > 0) {
388 				fifosts = wb_read(wb, WB_SD_FIFOSTS);
389 				if ((fifosts & WB_FIFO_EMPTY) == 0)
390 					break;
391 				delay(100);
392 			}
393 			if (retry == 0)
394 				return EBUSY;
395 		}
396 
397 		if (fifosts & WB_FIFO_FULL)
398 			datalen = 16;
399 		else
400 			datalen = fifosts & WB_FIFO_DEPTH_MASK;
401 	} else {
402 		if (fifosts & WB_FIFO_FULL) {
403 			while (--retry > 0) {
404 				fifosts = wb_read(wb, WB_SD_FIFOSTS);
405 				if ((fifosts & WB_FIFO_FULL) == 0)
406 					break;
407 				delay(100);
408 			}
409 			if (retry == 0)
410 				return EBUSY;
411 		}
412 
413 		if (fifosts & WB_FIFO_EMPTY)
414 			datalen = 16;
415 		else
416 			datalen = 16 - (fifosts & WB_FIFO_DEPTH_MASK);
417 	}
418 
419 	datalen = MIN(datalen, cmd->c_resid);
420 	if (datalen > 0) {
421 		if (ISSET(cmd->c_flags, SCF_CMD_READ))
422 			wb_sdmmc_read_data(wb, cmd->c_buf, datalen);
423 		else
424 			wb_sdmmc_write_data(wb, cmd->c_buf, datalen);
425 
426 		cmd->c_buf += datalen;
427 		cmd->c_resid -= datalen;
428 	}
429 
430 	return 0;
431 }
432 
433 static void
wb_sdmmc_exec_command(sdmmc_chipset_handle_t sch,struct sdmmc_command * cmd)434 wb_sdmmc_exec_command(sdmmc_chipset_handle_t sch, struct sdmmc_command *cmd)
435 {
436 	static const int opcodes[] = {
437 		11, 17, 18, 20, 24, 25, 26, 27, 30, 42, 51, 56
438 	};
439 	struct wb_softc *wb = sch;
440 	uint8_t val;
441 	int blklen;
442 	int error;
443 	int i, retry;
444 	int s;
445 
446 	REPORT(wb, "TRACE: sdmmc/exec_command(wb, cmd) "
447 	    "opcode %d flags 0x%x data %p datalen %d arg 0x%08x\n",
448 	    cmd->c_opcode, cmd->c_flags, cmd->c_data, cmd->c_datalen,
449 	    cmd->c_arg);
450 
451 	if (cmd->c_datalen > 0) {
452 		/* controller only supports a select number of data opcodes */
453 		for (i = 0; i < __arraycount(opcodes); i++)
454 			if (opcodes[i] == cmd->c_opcode)
455 				break;
456 		if (i == __arraycount(opcodes)) {
457 			cmd->c_error = ENOTSUP;
458 			aprint_debug_dev(wb->wb_dev,
459 			    "unsupported opcode %d\n", cmd->c_opcode);
460 			goto done;
461 		}
462 
463 		/* Fragment the data into proper blocks */
464 		blklen = MIN(cmd->c_datalen, cmd->c_blklen);
465 
466 		if (cmd->c_datalen % blklen > 0) {
467 			aprint_error_dev(wb->wb_dev,
468 			    "data is not a multiple of %u bytes\n", blklen);
469 			cmd->c_error = EINVAL;
470 			goto done;
471 		}
472 
473 		/* setup block size registers */
474 		blklen = blklen + 2 * wb->wb_sdmmc_width;
475 		wb_idx_write(wb, WB_INDEX_PBSMSB,
476 		    ((blklen >> 4) & 0xf0) | (wb->wb_sdmmc_width / 4));
477 		wb_idx_write(wb, WB_INDEX_PBSLSB, blklen & 0xff);
478 
479 		/* clear FIFO */
480 		val = wb_idx_read(wb, WB_INDEX_SETUP);
481 		val |= WB_SETUP_FIFO_RST;
482 		wb_idx_write(wb, WB_INDEX_SETUP, val);
483 		while (wb_idx_read(wb, WB_INDEX_SETUP) & WB_SETUP_FIFO_RST)
484 			;
485 
486 		cmd->c_resid = cmd->c_datalen;
487 		cmd->c_buf = cmd->c_data;
488 
489 		/* setup FIFO thresholds */
490 		if (ISSET(cmd->c_flags, SCF_CMD_READ))
491 			wb_idx_write(wb, WB_INDEX_FIFOEN, WB_FIFOEN_FULL | 8);
492 		else {
493 			wb_idx_write(wb, WB_INDEX_FIFOEN, WB_FIFOEN_EMPTY | 8);
494 
495 			/* pre-fill the FIFO on write */
496 			error = wb_sdmmc_transfer_data(wb, cmd);
497 			if (error) {
498 				cmd->c_error = error;
499 				goto done;
500 			}
501 		}
502 	}
503 
504 	s = splsdmmc();
505 	wb->wb_sdmmc_intsts = 0;
506 	wb_write(wb, WB_SD_COMMAND, cmd->c_opcode);
507 	wb_write(wb, WB_SD_COMMAND, (cmd->c_arg >> 24) & 0xff);
508 	wb_write(wb, WB_SD_COMMAND, (cmd->c_arg >> 16) & 0xff);
509 	wb_write(wb, WB_SD_COMMAND, (cmd->c_arg >> 8) & 0xff);
510 	wb_write(wb, WB_SD_COMMAND, (cmd->c_arg >> 0) & 0xff);
511 	splx(s);
512 
513 	retry = 100000;
514 	while (wb_idx_read(wb, WB_INDEX_STATUS) & WB_STATUS_CARD_TRAFFIC) {
515 		if (--retry == 0)
516 			break;
517 		delay(1);
518 	}
519 	if (wb_idx_read(wb, WB_INDEX_STATUS) & WB_STATUS_CARD_TRAFFIC) {
520 		REPORT(wb,
521 		    "command timed out, WB_INDEX_STATUS = 0x%02x\n",
522 		    wb_idx_read(wb, WB_INDEX_STATUS));
523 		cmd->c_error = ETIMEDOUT;
524 		goto done;
525 	}
526 
527 	if (ISSET(cmd->c_flags, SCF_RSP_PRESENT)) {
528 		if (wb->wb_sdmmc_intsts & WB_INT_TIMEOUT) {
529 			cmd->c_error = ETIMEDOUT;
530 			goto done;
531 		}
532 
533 		if (ISSET(cmd->c_flags, SCF_RSP_136))
534 			wb_sdmmc_rsp_read_long(wb, cmd);
535 		else
536 			wb_sdmmc_rsp_read_short(wb, cmd);
537 	}
538 
539 	if (cmd->c_error == 0 && cmd->c_datalen > 0) {
540 		wb_led(wb, true);
541 		while (cmd->c_resid > 0) {
542 			error = wb_sdmmc_transfer_data(wb, cmd);
543 			if (error) {
544 				cmd->c_error = error;
545 				break;
546 			}
547 		}
548 		wb_led(wb, false);
549 	}
550 
551 done:
552 	SET(cmd->c_flags, SCF_ITSDONE);
553 
554 	if (cmd->c_error) {
555 		REPORT(wb,
556 		    "cmd error = %d, op = %d [%s] "
557 		    "blklen %d datalen %d resid %d\n",
558 		    cmd->c_error, cmd->c_opcode,
559 		    ISSET(cmd->c_flags, SCF_CMD_READ) ? "rd" : "wr",
560 		    cmd->c_blklen, cmd->c_datalen, cmd->c_resid);
561 	}
562 }
563 
564 static void
wb_sdmmc_card_enable_intr(sdmmc_chipset_handle_t sch,int enable)565 wb_sdmmc_card_enable_intr(sdmmc_chipset_handle_t sch, int enable)
566 {
567 	REPORT(sch, "TRACE: sdmmc/card_enable_intr(wb, enable=%d)\n", enable);
568 }
569 
570 static void
wb_sdmmc_card_intr_ack(sdmmc_chipset_handle_t sch)571 wb_sdmmc_card_intr_ack(sdmmc_chipset_handle_t sch)
572 {
573 	REPORT(sch, "TRACE: sdmmc/card_intr_ack(wb)\n");
574 }
575 
576 /*
577  * intr handler
578  */
579 int
wb_sdmmc_intr(struct wb_softc * wb)580 wb_sdmmc_intr(struct wb_softc *wb)
581 {
582 	uint8_t val;
583 
584 	val = wb_read(wb, WB_SD_INTSTS);
585 	if (val == 0xff || val == 0x00)
586 		return 0;
587 
588 	if (wb->wb_sdmmc_dev == NULL)
589 		return 1;
590 
591 	wb->wb_sdmmc_intsts |= val;
592 
593 	if (wb_sdmmc_debug) {
594 		char buf[64];
595 		snprintb(buf, sizeof(buf),
596 		    "\20\1TC\2BUSYEND\3PROGEND\4TIMEOUT"
597 		    "\5CRC\6FIFO\7CARD\010PENDING",
598 		    val);
599 		REPORT(wb, "WB_SD_INTSTS = %s\n", buf);
600 	}
601 
602 	if (val & WB_INT_CARD)
603 		callout_schedule(&wb->wb_sdmmc_callout, hz / 4);
604 
605 	return 1;
606 }
607 
608 /*
609  * pmf
610  */
611 bool
wb_sdmmc_suspend(struct wb_softc * wb)612 wb_sdmmc_suspend(struct wb_softc *wb)
613 {
614 	return wb_sdmmc_disable(wb);
615 }
616 
617 bool
wb_sdmmc_resume(struct wb_softc * wb)618 wb_sdmmc_resume(struct wb_softc *wb)
619 {
620 	uint8_t val;
621 
622 	val = wb_read(wb, WB_SD_CSR);
623 	val &= ~WB_CSR_POWER_N;
624 	wb_write(wb, WB_SD_CSR, val);
625 
626 	if (wb_sdmmc_enable(wb) == false)
627 		return false;
628 
629 	if (wb_idx_read(wb, WB_INDEX_CLK) != wb->wb_sdmmc_clk)
630 		wb_idx_write(wb, WB_INDEX_CLK, wb->wb_sdmmc_clk);
631 
632 	return true;
633 }
634