scimci.c revision 1.1 1 /* $NetBSD: scimci.c,v 1.1 2010/04/06 15:54:31 nonaka Exp $ */
2
3 /*-
4 * Copyright (c) 2009 NONAKA Kimihiro <nonaka (at) netbsd.org>
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. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28
29 /*
30 * Serial Peripheral interface driver to access MMC card
31 */
32
33 #include <sys/cdefs.h>
34 __KERNEL_RCSID(0, "$NetBSD: scimci.c,v 1.1 2010/04/06 15:54:31 nonaka Exp $");
35
36 #include <sys/param.h>
37 #include <sys/device.h>
38 #include <sys/systm.h>
39 #include <sys/malloc.h>
40 #include <sys/kernel.h>
41 #include <sys/proc.h>
42 #include <sys/bus.h>
43 #include <sys/intr.h>
44
45 #include <sh3/devreg.h>
46 #include <sh3/pfcreg.h>
47 #include <sh3/scireg.h>
48
49 #include <dev/sdmmc/sdmmcvar.h>
50 #include <dev/sdmmc/sdmmcchip.h>
51
52 #include <evbsh3/t_sh7706lan/t_sh7706lanvar.h>
53
54 #ifdef SCIMCI_DEBUG
55 int scimci_debug = 1;
56 #define DPRINTF(n,s) do { if ((n) <= scimci_debug) printf s; } while (0)
57 #else
58 #define DPRINTF(n,s) do {} while (0)
59 #endif
60
61 static int scimci_host_reset(sdmmc_chipset_handle_t);
62 static uint32_t scimci_host_ocr(sdmmc_chipset_handle_t);
63 static int scimci_host_maxblklen(sdmmc_chipset_handle_t);
64 static int scimci_card_detect(sdmmc_chipset_handle_t);
65 static int scimci_write_protect(sdmmc_chipset_handle_t);
66 static int scimci_bus_power(sdmmc_chipset_handle_t, uint32_t);
67 static int scimci_bus_clock(sdmmc_chipset_handle_t, int);
68 static int scimci_bus_width(sdmmc_chipset_handle_t, int);
69 static void scimci_exec_command(sdmmc_chipset_handle_t,
70 struct sdmmc_command *);
71
72 static struct sdmmc_chip_functions scimci_chip_functions = {
73 /* host controller reset */
74 .host_reset = scimci_host_reset,
75
76 /* host controller capabilities */
77 .host_ocr = scimci_host_ocr,
78 .host_maxblklen = scimci_host_maxblklen,
79
80 /* card detection */
81 .card_detect = scimci_card_detect,
82
83 /* write protect */
84 .write_protect = scimci_write_protect,
85
86 /* bus power, clock frequency, width */
87 .bus_power = scimci_bus_power,
88 .bus_clock = scimci_bus_clock,
89 .bus_width = scimci_bus_width,
90
91 /* command execution */
92 .exec_command = scimci_exec_command,
93
94 /* card interrupt */
95 .card_enable_intr = NULL,
96 .card_intr_ack = NULL,
97 };
98
99 static void scimci_spi_initialize(sdmmc_chipset_handle_t);
100
101 static struct sdmmc_spi_chip_functions scimci_spi_chip_functions = {
102 .initialize = scimci_spi_initialize,
103 };
104
105 #define CSR_SET_1(reg,set,mask) \
106 do { \
107 uint8_t _r; \
108 _r = _reg_read_1((reg)); \
109 _r &= ~(mask); \
110 _r |= (set); \
111 _reg_write_1((reg), _r); \
112 } while (/*CONSTCOND*/0)
113
114 #define CSR_SET_2(reg,set,mask) \
115 do { \
116 uint16_t _r; \
117 _r = _reg_read_2((reg)); \
118 _r &= ~(mask); \
119 _r |= (set); \
120 _reg_write_2((reg), _r); \
121 } while (/*CONSTCOND*/0)
122
123 #define CSR_CLR_1(reg,clr) \
124 do { \
125 uint8_t _r; \
126 _r = _reg_read_1((reg)); \
127 _r &= ~(clr); \
128 _reg_write_1((reg), _r); \
129 } while (/*CONSTCOND*/0)
130
131 #define CSR_CLR_2(reg,clr) \
132 do { \
133 uint16_t _r; \
134 _r = _reg_read_2((reg)); \
135 _r &= ~(clr); \
136 _reg_write_2((reg), _r); \
137 } while (/*CONSTCOND*/0)
138
139 #define SCPCR_CLK_MASK 0x000C
140 #define SCPCR_CLK_IN 0x000C
141 #define SCPCR_CLK_OUT 0x0004
142 #define SCPDR_CLK 0x02
143 #define SCPCR_DAT_MASK 0x0003
144 #define SCPCR_DAT_IN 0x0003
145 #define SCPCR_DAT_OUT 0x0001
146 #define SCPDR_DAT 0x01
147 #define SCPCR_CMD_MASK 0x0030
148 #define SCPCR_CMD_IN 0x0030
149 #define SCPCR_CMD_OUT 0x0010
150 #define SCPDR_CMD 0x04
151 #define SCPCR_CS_MASK 0x00C0
152 #define SCPCR_CS_IN 0x00C0
153 #define SCPCR_CS_OUT 0x0040
154 #define SCPDR_CS 0x08
155 #define PGCR_EJECT 0x0300
156 #define PGDR_EJECT 0x10
157
158 /* SCSCR */
159 #define SCSCR_SCK_OUT 0
160 #define SCSCR_SCK_IN (SCSCR_CKE1)
161
162 #define LOW_SPEED 144
163 #define MID_SPEED 48
164 #define MMC_TIME_OVER 1000
165
166 struct scimci_softc {
167 device_t sc_dev;
168 device_t sc_sdmmc;
169 };
170
171 static int scimci_match(device_t, cfdata_t, void *);
172 static void scimci_attach(device_t, device_t, void *);
173
174 CFATTACH_DECL_NEW(scimci, sizeof(struct scimci_softc),
175 scimci_match, scimci_attach, NULL, NULL);
176
177 static void scimci_putc(int);
178 static void scimci_putc_sw(void);
179 static int scimci_getc(void);
180 static void scimci_getc_sw(void);
181 static void scimci_cmd_cfgread(struct scimci_softc *, struct sdmmc_command *);
182 static void scimci_cmd_read(struct scimci_softc *, struct sdmmc_command *);
183 static void scimci_cmd_write(struct scimci_softc *, struct sdmmc_command *);
184
185 void scimci_read_buffer(u_char *buf);
186 void scimci_write_buffer(const u_char *buf);
187
188 /*ARGSUSED*/
189 static int
190 scimci_match(device_t parent, cfdata_t cf, void *aux)
191 {
192
193 if (IS_SH7706LSR)
194 return 0;
195 return 1;
196 }
197
198 /*ARGSUSED*/
199 static void
200 scimci_attach(device_t parent, device_t self, void *aux)
201 {
202 struct scimci_softc *sc = device_private(self);
203 struct sdmmcbus_attach_args saa;
204
205 sc->sc_dev = self;
206
207 aprint_naive("\n");
208 aprint_normal(": SCI MMC controller\n");
209
210 /* Setup */
211 CSR_SET_2(SH7709_SCPCR, SCPCR_CLK_OUT | SCPCR_CMD_OUT,
212 SCPCR_CLK_MASK | SCPCR_CMD_MASK);
213 CSR_CLR_2(SH7709_SCPCR, SCPCR_CMD_MASK);
214 CSR_SET_1(SH7709_SCPDR, SCPDR_CLK | SCPDR_CMD, 0);
215 CSR_SET_2(SH7709_SCPCR, SCPCR_CS_OUT, SCPCR_CS_MASK);
216
217 SHREG_SCSCR = 0x00;
218 SHREG_SCSSR = 0x00;
219 SHREG_SCSCMR = 0xfa; /* MSB first */
220 SHREG_SCSMR = SCSMR_CA; /* clock sync mode */
221 SHREG_SCBRR = LOW_SPEED;
222 delay(1000); /* wait 1ms */
223
224 /*
225 * Attach the generic SD/MMC bus driver. (The bus driver must
226 * not invoke any chipset functions before it is attached.)
227 */
228 memset(&saa, 0, sizeof(saa));
229 saa.saa_busname = "sdmmc";
230 saa.saa_sct = &scimci_chip_functions;
231 saa.saa_spi_sct = &scimci_spi_chip_functions;
232 saa.saa_sch = sc;
233 saa.saa_clkmin = 4000 / (LOW_SPEED + 1);
234 saa.saa_clkmax = 4000 / (MID_SPEED + 1);
235 saa.saa_caps = SMC_CAPS_SPI_MODE
236 | SMC_CAPS_SINGLE_ONLY
237 | SMC_CAPS_POLL_CARD_DET;
238
239 sc->sc_sdmmc = config_found(sc->sc_dev, &saa, NULL);
240 if (sc->sc_sdmmc == NULL)
241 aprint_error_dev(sc->sc_dev, "couldn't attach bus\n");
242 }
243
244 /*
245 * SCI access functions
246 */
247 static void
248 scimci_putc(int c)
249 {
250
251 CSR_SET_2(SH7709_SCPCR, SCPCR_CLK_OUT, SCPCR_CLK_MASK);
252 SHREG_SCSCR = SCSCR_TE | SCSCR_SCK_OUT;
253 while ((SHREG_SCSSR & SCSSR_TDRE) == 0)
254 continue;
255 CSR_CLR_2(SH7709_SCPCR, SCPCR_CLK_MASK);
256 SHREG_SCTDR = (uint8_t)c;
257 (void) SHREG_SCSSR;
258 SHREG_SCSSR = 0;
259 }
260
261 static void
262 scimci_putc_sw(void)
263 {
264
265 while ((SHREG_SCSSR & SCSSR_TEND) == 0)
266 continue;
267
268 CSR_SET_2(SH7709_SCPCR, SCPCR_CLK_IN, 0);
269 SHREG_SCSCR |= SCSCR_SCK_IN;
270 CSR_CLR_2(SH7709_SCPCR, SCPCR_CLK_MASK);
271 SHREG_SCSMR = 0;
272 SHREG_SCSCR = SCSCR_SCK_OUT;
273 SHREG_SCSSR = 0;
274 SHREG_SCSMR = SCSMR_CA;
275 }
276
277 static int
278 scimci_getc(void)
279 {
280 int c;
281
282 SHREG_SCSCR = SCSCR_RE | SCSCR_SCK_OUT;
283 if (SHREG_SCSSR & SCSSR_ORER) {
284 SHREG_SCSSR &= ~SCSSR_ORER;
285 return -1;
286 }
287 CSR_CLR_2(SH7709_SCPCR, SCPCR_CLK_MASK);
288 while ((SHREG_SCSSR & SCSSR_RDRF) == 0)
289 continue;
290 c = SHREG_SCRDR;
291 (void) SHREG_SCSSR;
292 SHREG_SCSSR = 0;
293
294 return (uint8_t)c;
295 }
296
297 static void
298 scimci_getc_sw(void)
299 {
300
301 SHREG_SCBRR = LOW_SPEED;
302 while ((SHREG_SCSSR & SCSSR_RDRF) == 0)
303 continue;
304 (void) SHREG_SCRDR;
305
306 CSR_SET_2(SH7709_SCPCR, SCPCR_CLK_IN, 0);
307 SHREG_SCSCR |= SCSCR_SCK_IN;
308 CSR_CLR_2(SH7709_SCPCR, SCPCR_CLK_MASK);
309 SHREG_SCSMR = 0;
310 SHREG_SCSCR = SCSCR_SCK_OUT;
311 SHREG_SCSSR = 0;
312 SHREG_SCSMR = SCSMR_CA;
313 }
314
315 /*
316 * Reset the host controller. Called during initialization, when
317 * cards are removed, upon resume, and during error recovery.
318 */
319 /*ARGSUSED*/
320 static int
321 scimci_host_reset(sdmmc_chipset_handle_t sch)
322 {
323
324 return 0;
325 }
326
327 /*ARGSUSED*/
328 static uint32_t
329 scimci_host_ocr(sdmmc_chipset_handle_t sch)
330 {
331
332 return MMC_OCR_3_2V_3_3V|MMC_OCR_3_3V_3_4V;
333 }
334
335 /*ARGSUSED*/
336 static int
337 scimci_host_maxblklen(sdmmc_chipset_handle_t sch)
338 {
339
340 return 512;
341 }
342
343 /*ARGSUSED*/
344 static int
345 scimci_card_detect(sdmmc_chipset_handle_t sch)
346 {
347 uint8_t reg;
348 int s;
349
350 s = splserial();
351 CSR_SET_2(SH7709_PGCR, PGCR_EJECT, 0);
352 reg = _reg_read_1(SH7709_PGDR);
353 splx(s);
354
355 return !(reg & PGDR_EJECT);
356 }
357
358 /*ARGSUSED*/
359 static int
360 scimci_write_protect(sdmmc_chipset_handle_t sch)
361 {
362
363 return 0; /* non-protect */
364 }
365
366 /*
367 * Set or change SD bus voltage and enable or disable SD bus power.
368 * Return zero on success.
369 */
370 /*ARGSUSED*/
371 static int
372 scimci_bus_power(sdmmc_chipset_handle_t sch, uint32_t ocr)
373 {
374
375 if ((ocr & (MMC_OCR_3_2V_3_3V|MMC_OCR_3_3V_3_4V)) == 0)
376 return 1;
377
378 /*XXX???*/
379 return 0;
380 }
381
382 /*
383 * Set or change MMCLK frequency or disable the MMC clock.
384 * Return zero on success.
385 */
386 /*ARGSUSED*/
387 static int
388 scimci_bus_clock(sdmmc_chipset_handle_t sch, int freq)
389 {
390
391 return 0;
392 }
393
394 /*ARGSUSED*/
395 static int
396 scimci_bus_width(sdmmc_chipset_handle_t sch, int width)
397 {
398
399 if (width != 1)
400 return 1;
401 return 0;
402 }
403
404 /*ARGSUSED*/
405 static void
406 scimci_spi_initialize(sdmmc_chipset_handle_t sch)
407 {
408 int i, s;
409
410 s = splserial();
411 CSR_SET_1(SH7709_SCPDR, SCPDR_CS, 0);
412 for (i = 0; i < 20; i++)
413 scimci_putc(0xff);
414 scimci_putc_sw();
415 CSR_CLR_1(SH7709_SCPDR, SCPDR_CS);
416 splx(s);
417 }
418
419 static void
420 scimci_exec_command(sdmmc_chipset_handle_t sch, struct sdmmc_command *cmd)
421 {
422 struct scimci_softc *sc = (struct scimci_softc *)sch;
423 uint16_t resp;
424 int timo;
425 int s;
426
427 DPRINTF(1,("%s: start cmd %d arg=%#x data=%p dlen=%d flags=%#x "
428 "proc=%p \"%s\"\n", device_xname(sc->sc_dev),
429 cmd->c_opcode, cmd->c_arg, cmd->c_data, cmd->c_datalen,
430 cmd->c_flags, curproc, curproc ? curproc->p_comm : ""));
431
432 s = splhigh();
433
434 if (cmd->c_opcode == MMC_GO_IDLE_STATE)
435 SHREG_SCBRR = LOW_SPEED;
436 else
437 SHREG_SCBRR = MID_SPEED;
438
439 scimci_putc(0xff);
440 scimci_putc(0x40 | (cmd->c_opcode & 0x3f));
441 scimci_putc((cmd->c_arg >> 24) & 0xff);
442 scimci_putc((cmd->c_arg >> 16) & 0xff);
443 scimci_putc((cmd->c_arg >> 8) & 0xff);
444 scimci_putc((cmd->c_arg >> 0) & 0xff);
445 scimci_putc((cmd->c_opcode == MMC_GO_IDLE_STATE) ? 0x95 :
446 (cmd->c_opcode == SD_SEND_IF_COND) ? 0x87 : 0); /* CRC */
447 scimci_putc(0xff);
448 scimci_putc_sw();
449
450 timo = MMC_TIME_OVER;
451 while ((resp = scimci_getc()) & 0x80) {
452 if(--timo == 0) {
453 DPRINTF(1, ("%s: response timeout\n",
454 device_xname(sc->sc_dev)));
455 scimci_getc_sw();
456 cmd->c_error = ETIMEDOUT;
457 goto out;
458 }
459 }
460 if (ISSET(cmd->c_flags, SCF_RSP_SPI_S2)) {
461 resp |= (uint16_t)scimci_getc() << 8;
462 } else if (ISSET(cmd->c_flags, SCF_RSP_SPI_B4)) {
463 cmd->c_resp[1] = (uint32_t) scimci_getc() << 24;
464 cmd->c_resp[1] |= (uint32_t) scimci_getc() << 16;
465 cmd->c_resp[1] |= (uint32_t) scimci_getc() << 8;
466 cmd->c_resp[1] |= (uint32_t) scimci_getc();
467 DPRINTF(1, ("R3 resp: %#x\n", cmd->c_resp[1]));
468 }
469 scimci_getc_sw();
470
471 cmd->c_resp[0] = resp;
472 if (resp != 0 && resp != R1_SPI_IDLE) {
473 DPRINTF(1, ("%s: response error: %#x\n",
474 device_xname(sc->sc_dev), resp));
475 cmd->c_error = EIO;
476 goto out;
477 }
478 DPRINTF(1, ("R1 resp: %#x\n", resp));
479
480 if (cmd->c_datalen > 0) {
481 if (ISSET(cmd->c_flags, SCF_CMD_READ)) {
482 /* XXX: swap in this place? */
483 if (cmd->c_opcode == MMC_SEND_CID ||
484 cmd->c_opcode == MMC_SEND_CSD) {
485 sdmmc_response res;
486 uint32_t *p = cmd->c_data;
487
488 scimci_cmd_cfgread(sc, cmd);
489 res[0] = be32toh(p[3]);
490 res[1] = be32toh(p[2]);
491 res[2] = be32toh(p[1]);
492 res[3] = be32toh(p[0]);
493 memcpy(p, &res, sizeof(res));
494 } else {
495 scimci_cmd_read(sc, cmd);
496 }
497 } else {
498 scimci_cmd_write(sc, cmd);
499 }
500 }
501
502 out:
503 SET(cmd->c_flags, SCF_ITSDONE);
504 splx(s);
505
506 DPRINTF(1,("%s: cmd %d done (flags=%#x error=%d)\n",
507 device_xname(sc->sc_dev), cmd->c_opcode, cmd->c_flags, cmd->c_error));
508 }
509
510 static void
511 scimci_cmd_cfgread(struct scimci_softc *sc, struct sdmmc_command *cmd)
512 {
513 u_char *data = cmd->c_data;
514 int timo;
515 int c;
516 int i;
517
518 /* wait data token */
519 for (timo = MMC_TIME_OVER; timo > 0; timo--) {
520 c = scimci_getc();
521 if (c < 0) {
522 aprint_error_dev(sc->sc_dev, "cfg read i/o error\n");
523 cmd->c_error = EIO;
524 return;
525 }
526 if (c != 0xff)
527 break;
528 }
529 if (timo == 0) {
530 aprint_error_dev(sc->sc_dev, "cfg read timeout\n");
531 cmd->c_error = ETIMEDOUT;
532 return;
533 }
534 if (c != 0xfe) {
535 aprint_error_dev(sc->sc_dev, "cfg read error (data=%#x)\n", c);
536 cmd->c_error = EIO;
537 return;
538 }
539
540 /* data read */
541 SHREG_SCSCR = SCSCR_RE | SCSCR_SCK_OUT;
542 data[0] = '\0'; /* XXXFIXME!!! */
543 for (i = 1 /* XXXFIXME!!!*/ ; i < cmd->c_datalen; i++) {
544 while ((SHREG_SCSSR & SCSSR_RDRF) == 0)
545 continue;
546 data[i] = SHREG_SCRDR;
547 (void) SHREG_SCSSR;
548 SHREG_SCSSR = 0;
549 }
550
551 SHREG_SCBRR = LOW_SPEED;
552 (void) scimci_getc();
553 (void) scimci_getc();
554 (void) scimci_getc();
555 scimci_getc_sw();
556
557 #ifdef SCIMCI_DEBUG
558 sdmmc_dump_data(NULL, cmd->c_data, cmd->c_datalen);
559 #endif
560 }
561
562 static void
563 scimci_cmd_read(struct scimci_softc *sc, struct sdmmc_command *cmd)
564 {
565 u_char *data = cmd->c_data;
566 int timo;
567 int c;
568 int i;
569
570 /* wait data token */
571 for (timo = MMC_TIME_OVER; timo > 0; timo--) {
572 c = scimci_getc();
573 if (c < 0) {
574 aprint_error_dev(sc->sc_dev, "read i/o error\n");
575 cmd->c_error = EIO;
576 return;
577 }
578 if (c != 0xff)
579 break;
580 }
581 if (timo == 0) {
582 aprint_error_dev(sc->sc_dev, "read timeout\n");
583 cmd->c_error = ETIMEDOUT;
584 return;
585 }
586 if (c != 0xfe) {
587 aprint_error_dev(sc->sc_dev, "read error (data=%#x)\n", c);
588 cmd->c_error = EIO;
589 return;
590 }
591
592 /* data read */
593 SHREG_SCBRR = MID_SPEED;
594 SHREG_SCSCR = SCSCR_RE | SCSCR_SCK_OUT;
595 for (i = 0; i < cmd->c_datalen; i++) {
596 while ((SHREG_SCSSR & SCSSR_RDRF) == 0)
597 continue;
598 data[i] = SHREG_SCRDR;
599 (void) SHREG_SCSSR;
600 SHREG_SCSSR = 0;
601 }
602
603 SHREG_SCBRR = LOW_SPEED;
604 (void) scimci_getc();
605 (void) scimci_getc();
606 (void) scimci_getc();
607 scimci_getc_sw();
608
609 #ifdef SCIMCI_DEBUG
610 sdmmc_dump_data(NULL, cmd->c_data, cmd->c_datalen);
611 #endif
612 }
613
614 static void
615 scimci_cmd_write(struct scimci_softc *sc, struct sdmmc_command *cmd)
616 {
617 char *data = cmd->c_data;
618 int timo;
619 int c;
620 int i;
621
622 scimci_putc(0xff);
623 scimci_putc(0xfe);
624
625 /* data write */
626 SHREG_SCBRR = MID_SPEED;
627 SHREG_SCSCR = SCSCR_TE | SCSCR_SCK_OUT;
628 for (i = 0; i < cmd->c_datalen; i++) {
629 while ((SHREG_SCSSR & SCSSR_TDRE) == 0)
630 continue;
631 SHREG_SCTDR = data[i];
632 (void) SHREG_SCSSR;
633 SHREG_SCSSR = 0;
634 }
635
636 SHREG_SCBRR = LOW_SPEED;
637 scimci_putc(0);
638 scimci_putc(0);
639 scimci_putc(0);
640 scimci_putc_sw();
641
642 for (timo = MMC_TIME_OVER; timo > 0; timo--) {
643 c = scimci_getc();
644 if (c < 0) {
645 aprint_error_dev(sc->sc_dev, "write i/o error\n");
646 cmd->c_error = EIO;
647 scimci_getc_sw();
648 return;
649 }
650 if (c == 0xff)
651 break;
652 }
653 if (timo == 0) {
654 aprint_error_dev(sc->sc_dev, "write timeout\n");
655 cmd->c_error = ETIMEDOUT;
656 }
657 scimci_getc_sw();
658 }
659