Loading...
1/*
2 * linux/drivers/mmc/core/sdio_io.c
3 *
4 * Copyright 2007-2008 Pierre Ossman
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or (at
9 * your option) any later version.
10 */
11
12#include <linux/export.h>
13#include <linux/mmc/host.h>
14#include <linux/mmc/card.h>
15#include <linux/mmc/sdio.h>
16#include <linux/mmc/sdio_func.h>
17
18#include "sdio_ops.h"
19
20/**
21 * sdio_claim_host - exclusively claim a bus for a certain SDIO function
22 * @func: SDIO function that will be accessed
23 *
24 * Claim a bus for a set of operations. The SDIO function given
25 * is used to figure out which bus is relevant.
26 */
27void sdio_claim_host(struct sdio_func *func)
28{
29 BUG_ON(!func);
30 BUG_ON(!func->card);
31
32 mmc_claim_host(func->card->host);
33}
34EXPORT_SYMBOL_GPL(sdio_claim_host);
35
36/**
37 * sdio_release_host - release a bus for a certain SDIO function
38 * @func: SDIO function that was accessed
39 *
40 * Release a bus, allowing others to claim the bus for their
41 * operations.
42 */
43void sdio_release_host(struct sdio_func *func)
44{
45 BUG_ON(!func);
46 BUG_ON(!func->card);
47
48 mmc_release_host(func->card->host);
49}
50EXPORT_SYMBOL_GPL(sdio_release_host);
51
52/**
53 * sdio_enable_func - enables a SDIO function for usage
54 * @func: SDIO function to enable
55 *
56 * Powers up and activates a SDIO function so that register
57 * access is possible.
58 */
59int sdio_enable_func(struct sdio_func *func)
60{
61 int ret;
62 unsigned char reg;
63 unsigned long timeout;
64
65 BUG_ON(!func);
66 BUG_ON(!func->card);
67
68 pr_debug("SDIO: Enabling device %s...\n", sdio_func_id(func));
69
70 ret = mmc_io_rw_direct(func->card, 0, 0, SDIO_CCCR_IOEx, 0, ®);
71 if (ret)
72 goto err;
73
74 reg |= 1 << func->num;
75
76 ret = mmc_io_rw_direct(func->card, 1, 0, SDIO_CCCR_IOEx, reg, NULL);
77 if (ret)
78 goto err;
79
80 timeout = jiffies + msecs_to_jiffies(func->enable_timeout);
81
82 while (1) {
83 ret = mmc_io_rw_direct(func->card, 0, 0, SDIO_CCCR_IORx, 0, ®);
84 if (ret)
85 goto err;
86 if (reg & (1 << func->num))
87 break;
88 ret = -ETIME;
89 if (time_after(jiffies, timeout))
90 goto err;
91 }
92
93 pr_debug("SDIO: Enabled device %s\n", sdio_func_id(func));
94
95 return 0;
96
97err:
98 pr_debug("SDIO: Failed to enable device %s\n", sdio_func_id(func));
99 return ret;
100}
101EXPORT_SYMBOL_GPL(sdio_enable_func);
102
103/**
104 * sdio_disable_func - disable a SDIO function
105 * @func: SDIO function to disable
106 *
107 * Powers down and deactivates a SDIO function. Register access
108 * to this function will fail until the function is reenabled.
109 */
110int sdio_disable_func(struct sdio_func *func)
111{
112 int ret;
113 unsigned char reg;
114
115 BUG_ON(!func);
116 BUG_ON(!func->card);
117
118 pr_debug("SDIO: Disabling device %s...\n", sdio_func_id(func));
119
120 ret = mmc_io_rw_direct(func->card, 0, 0, SDIO_CCCR_IOEx, 0, ®);
121 if (ret)
122 goto err;
123
124 reg &= ~(1 << func->num);
125
126 ret = mmc_io_rw_direct(func->card, 1, 0, SDIO_CCCR_IOEx, reg, NULL);
127 if (ret)
128 goto err;
129
130 pr_debug("SDIO: Disabled device %s\n", sdio_func_id(func));
131
132 return 0;
133
134err:
135 pr_debug("SDIO: Failed to disable device %s\n", sdio_func_id(func));
136 return -EIO;
137}
138EXPORT_SYMBOL_GPL(sdio_disable_func);
139
140/**
141 * sdio_set_block_size - set the block size of an SDIO function
142 * @func: SDIO function to change
143 * @blksz: new block size or 0 to use the default.
144 *
145 * The default block size is the largest supported by both the function
146 * and the host, with a maximum of 512 to ensure that arbitrarily sized
147 * data transfer use the optimal (least) number of commands.
148 *
149 * A driver may call this to override the default block size set by the
150 * core. This can be used to set a block size greater than the maximum
151 * that reported by the card; it is the driver's responsibility to ensure
152 * it uses a value that the card supports.
153 *
154 * Returns 0 on success, -EINVAL if the host does not support the
155 * requested block size, or -EIO (etc.) if one of the resultant FBR block
156 * size register writes failed.
157 *
158 */
159int sdio_set_block_size(struct sdio_func *func, unsigned blksz)
160{
161 int ret;
162
163 if (blksz > func->card->host->max_blk_size)
164 return -EINVAL;
165
166 if (blksz == 0) {
167 blksz = min(func->max_blksize, func->card->host->max_blk_size);
168 blksz = min(blksz, 512u);
169 }
170
171 ret = mmc_io_rw_direct(func->card, 1, 0,
172 SDIO_FBR_BASE(func->num) + SDIO_FBR_BLKSIZE,
173 blksz & 0xff, NULL);
174 if (ret)
175 return ret;
176 ret = mmc_io_rw_direct(func->card, 1, 0,
177 SDIO_FBR_BASE(func->num) + SDIO_FBR_BLKSIZE + 1,
178 (blksz >> 8) & 0xff, NULL);
179 if (ret)
180 return ret;
181 func->cur_blksize = blksz;
182 return 0;
183}
184EXPORT_SYMBOL_GPL(sdio_set_block_size);
185
186/*
187 * Calculate the maximum byte mode transfer size
188 */
189static inline unsigned int sdio_max_byte_size(struct sdio_func *func)
190{
191 unsigned mval = func->card->host->max_blk_size;
192
193 if (mmc_blksz_for_byte_mode(func->card))
194 mval = min(mval, func->cur_blksize);
195 else
196 mval = min(mval, func->max_blksize);
197
198 if (mmc_card_broken_byte_mode_512(func->card))
199 return min(mval, 511u);
200
201 return min(mval, 512u); /* maximum size for byte mode */
202}
203
204/**
205 * sdio_align_size - pads a transfer size to a more optimal value
206 * @func: SDIO function
207 * @sz: original transfer size
208 *
209 * Pads the original data size with a number of extra bytes in
210 * order to avoid controller bugs and/or performance hits
211 * (e.g. some controllers revert to PIO for certain sizes).
212 *
213 * If possible, it will also adjust the size so that it can be
214 * handled in just a single request.
215 *
216 * Returns the improved size, which might be unmodified.
217 */
218unsigned int sdio_align_size(struct sdio_func *func, unsigned int sz)
219{
220 unsigned int orig_sz;
221 unsigned int blk_sz, byte_sz;
222 unsigned chunk_sz;
223
224 orig_sz = sz;
225
226 /*
227 * Do a first check with the controller, in case it
228 * wants to increase the size up to a point where it
229 * might need more than one block.
230 */
231 sz = mmc_align_data_size(func->card, sz);
232
233 /*
234 * If we can still do this with just a byte transfer, then
235 * we're done.
236 */
237 if (sz <= sdio_max_byte_size(func))
238 return sz;
239
240 if (func->card->cccr.multi_block) {
241 /*
242 * Check if the transfer is already block aligned
243 */
244 if ((sz % func->cur_blksize) == 0)
245 return sz;
246
247 /*
248 * Realign it so that it can be done with one request,
249 * and recheck if the controller still likes it.
250 */
251 blk_sz = ((sz + func->cur_blksize - 1) /
252 func->cur_blksize) * func->cur_blksize;
253 blk_sz = mmc_align_data_size(func->card, blk_sz);
254
255 /*
256 * This value is only good if it is still just
257 * one request.
258 */
259 if ((blk_sz % func->cur_blksize) == 0)
260 return blk_sz;
261
262 /*
263 * We failed to do one request, but at least try to
264 * pad the remainder properly.
265 */
266 byte_sz = mmc_align_data_size(func->card,
267 sz % func->cur_blksize);
268 if (byte_sz <= sdio_max_byte_size(func)) {
269 blk_sz = sz / func->cur_blksize;
270 return blk_sz * func->cur_blksize + byte_sz;
271 }
272 } else {
273 /*
274 * We need multiple requests, so first check that the
275 * controller can handle the chunk size;
276 */
277 chunk_sz = mmc_align_data_size(func->card,
278 sdio_max_byte_size(func));
279 if (chunk_sz == sdio_max_byte_size(func)) {
280 /*
281 * Fix up the size of the remainder (if any)
282 */
283 byte_sz = orig_sz % chunk_sz;
284 if (byte_sz) {
285 byte_sz = mmc_align_data_size(func->card,
286 byte_sz);
287 }
288
289 return (orig_sz / chunk_sz) * chunk_sz + byte_sz;
290 }
291 }
292
293 /*
294 * The controller is simply incapable of transferring the size
295 * we want in decent manner, so just return the original size.
296 */
297 return orig_sz;
298}
299EXPORT_SYMBOL_GPL(sdio_align_size);
300
301/* Split an arbitrarily sized data transfer into several
302 * IO_RW_EXTENDED commands. */
303static int sdio_io_rw_ext_helper(struct sdio_func *func, int write,
304 unsigned addr, int incr_addr, u8 *buf, unsigned size)
305{
306 unsigned remainder = size;
307 unsigned max_blocks;
308 int ret;
309
310 /* Do the bulk of the transfer using block mode (if supported). */
311 if (func->card->cccr.multi_block && (size > sdio_max_byte_size(func))) {
312 /* Blocks per command is limited by host count, host transfer
313 * size and the maximum for IO_RW_EXTENDED of 511 blocks. */
314 max_blocks = min(func->card->host->max_blk_count, 511u);
315
316 while (remainder >= func->cur_blksize) {
317 unsigned blocks;
318
319 blocks = remainder / func->cur_blksize;
320 if (blocks > max_blocks)
321 blocks = max_blocks;
322 size = blocks * func->cur_blksize;
323
324 ret = mmc_io_rw_extended(func->card, write,
325 func->num, addr, incr_addr, buf,
326 blocks, func->cur_blksize);
327 if (ret)
328 return ret;
329
330 remainder -= size;
331 buf += size;
332 if (incr_addr)
333 addr += size;
334 }
335 }
336
337 /* Write the remainder using byte mode. */
338 while (remainder > 0) {
339 size = min(remainder, sdio_max_byte_size(func));
340
341 /* Indicate byte mode by setting "blocks" = 0 */
342 ret = mmc_io_rw_extended(func->card, write, func->num, addr,
343 incr_addr, buf, 0, size);
344 if (ret)
345 return ret;
346
347 remainder -= size;
348 buf += size;
349 if (incr_addr)
350 addr += size;
351 }
352 return 0;
353}
354
355/**
356 * sdio_readb - read a single byte from a SDIO function
357 * @func: SDIO function to access
358 * @addr: address to read
359 * @err_ret: optional status value from transfer
360 *
361 * Reads a single byte from the address space of a given SDIO
362 * function. If there is a problem reading the address, 0xff
363 * is returned and @err_ret will contain the error code.
364 */
365u8 sdio_readb(struct sdio_func *func, unsigned int addr, int *err_ret)
366{
367 int ret;
368 u8 val;
369
370 BUG_ON(!func);
371
372 if (err_ret)
373 *err_ret = 0;
374
375 ret = mmc_io_rw_direct(func->card, 0, func->num, addr, 0, &val);
376 if (ret) {
377 if (err_ret)
378 *err_ret = ret;
379 return 0xFF;
380 }
381
382 return val;
383}
384EXPORT_SYMBOL_GPL(sdio_readb);
385
386/**
387 * sdio_writeb - write a single byte to a SDIO function
388 * @func: SDIO function to access
389 * @b: byte to write
390 * @addr: address to write to
391 * @err_ret: optional status value from transfer
392 *
393 * Writes a single byte to the address space of a given SDIO
394 * function. @err_ret will contain the status of the actual
395 * transfer.
396 */
397void sdio_writeb(struct sdio_func *func, u8 b, unsigned int addr, int *err_ret)
398{
399 int ret;
400
401 BUG_ON(!func);
402
403 ret = mmc_io_rw_direct(func->card, 1, func->num, addr, b, NULL);
404 if (err_ret)
405 *err_ret = ret;
406}
407EXPORT_SYMBOL_GPL(sdio_writeb);
408
409/**
410 * sdio_writeb_readb - write and read a byte from SDIO function
411 * @func: SDIO function to access
412 * @write_byte: byte to write
413 * @addr: address to write to
414 * @err_ret: optional status value from transfer
415 *
416 * Performs a RAW (Read after Write) operation as defined by SDIO spec -
417 * single byte is written to address space of a given SDIO function and
418 * response is read back from the same address, both using single request.
419 * If there is a problem with the operation, 0xff is returned and
420 * @err_ret will contain the error code.
421 */
422u8 sdio_writeb_readb(struct sdio_func *func, u8 write_byte,
423 unsigned int addr, int *err_ret)
424{
425 int ret;
426 u8 val;
427
428 ret = mmc_io_rw_direct(func->card, 1, func->num, addr,
429 write_byte, &val);
430 if (err_ret)
431 *err_ret = ret;
432 if (ret)
433 val = 0xff;
434
435 return val;
436}
437EXPORT_SYMBOL_GPL(sdio_writeb_readb);
438
439/**
440 * sdio_memcpy_fromio - read a chunk of memory from a SDIO function
441 * @func: SDIO function to access
442 * @dst: buffer to store the data
443 * @addr: address to begin reading from
444 * @count: number of bytes to read
445 *
446 * Reads from the address space of a given SDIO function. Return
447 * value indicates if the transfer succeeded or not.
448 */
449int sdio_memcpy_fromio(struct sdio_func *func, void *dst,
450 unsigned int addr, int count)
451{
452 return sdio_io_rw_ext_helper(func, 0, addr, 1, dst, count);
453}
454EXPORT_SYMBOL_GPL(sdio_memcpy_fromio);
455
456/**
457 * sdio_memcpy_toio - write a chunk of memory to a SDIO function
458 * @func: SDIO function to access
459 * @addr: address to start writing to
460 * @src: buffer that contains the data to write
461 * @count: number of bytes to write
462 *
463 * Writes to the address space of a given SDIO function. Return
464 * value indicates if the transfer succeeded or not.
465 */
466int sdio_memcpy_toio(struct sdio_func *func, unsigned int addr,
467 void *src, int count)
468{
469 return sdio_io_rw_ext_helper(func, 1, addr, 1, src, count);
470}
471EXPORT_SYMBOL_GPL(sdio_memcpy_toio);
472
473/**
474 * sdio_readsb - read from a FIFO on a SDIO function
475 * @func: SDIO function to access
476 * @dst: buffer to store the data
477 * @addr: address of (single byte) FIFO
478 * @count: number of bytes to read
479 *
480 * Reads from the specified FIFO of a given SDIO function. Return
481 * value indicates if the transfer succeeded or not.
482 */
483int sdio_readsb(struct sdio_func *func, void *dst, unsigned int addr,
484 int count)
485{
486 return sdio_io_rw_ext_helper(func, 0, addr, 0, dst, count);
487}
488EXPORT_SYMBOL_GPL(sdio_readsb);
489
490/**
491 * sdio_writesb - write to a FIFO of a SDIO function
492 * @func: SDIO function to access
493 * @addr: address of (single byte) FIFO
494 * @src: buffer that contains the data to write
495 * @count: number of bytes to write
496 *
497 * Writes to the specified FIFO of a given SDIO function. Return
498 * value indicates if the transfer succeeded or not.
499 */
500int sdio_writesb(struct sdio_func *func, unsigned int addr, void *src,
501 int count)
502{
503 return sdio_io_rw_ext_helper(func, 1, addr, 0, src, count);
504}
505EXPORT_SYMBOL_GPL(sdio_writesb);
506
507/**
508 * sdio_readw - read a 16 bit integer from a SDIO function
509 * @func: SDIO function to access
510 * @addr: address to read
511 * @err_ret: optional status value from transfer
512 *
513 * Reads a 16 bit integer from the address space of a given SDIO
514 * function. If there is a problem reading the address, 0xffff
515 * is returned and @err_ret will contain the error code.
516 */
517u16 sdio_readw(struct sdio_func *func, unsigned int addr, int *err_ret)
518{
519 int ret;
520
521 if (err_ret)
522 *err_ret = 0;
523
524 ret = sdio_memcpy_fromio(func, func->tmpbuf, addr, 2);
525 if (ret) {
526 if (err_ret)
527 *err_ret = ret;
528 return 0xFFFF;
529 }
530
531 return le16_to_cpup((__le16 *)func->tmpbuf);
532}
533EXPORT_SYMBOL_GPL(sdio_readw);
534
535/**
536 * sdio_writew - write a 16 bit integer to a SDIO function
537 * @func: SDIO function to access
538 * @b: integer to write
539 * @addr: address to write to
540 * @err_ret: optional status value from transfer
541 *
542 * Writes a 16 bit integer to the address space of a given SDIO
543 * function. @err_ret will contain the status of the actual
544 * transfer.
545 */
546void sdio_writew(struct sdio_func *func, u16 b, unsigned int addr, int *err_ret)
547{
548 int ret;
549
550 *(__le16 *)func->tmpbuf = cpu_to_le16(b);
551
552 ret = sdio_memcpy_toio(func, addr, func->tmpbuf, 2);
553 if (err_ret)
554 *err_ret = ret;
555}
556EXPORT_SYMBOL_GPL(sdio_writew);
557
558/**
559 * sdio_readl - read a 32 bit integer from a SDIO function
560 * @func: SDIO function to access
561 * @addr: address to read
562 * @err_ret: optional status value from transfer
563 *
564 * Reads a 32 bit integer from the address space of a given SDIO
565 * function. If there is a problem reading the address,
566 * 0xffffffff is returned and @err_ret will contain the error
567 * code.
568 */
569u32 sdio_readl(struct sdio_func *func, unsigned int addr, int *err_ret)
570{
571 int ret;
572
573 if (err_ret)
574 *err_ret = 0;
575
576 ret = sdio_memcpy_fromio(func, func->tmpbuf, addr, 4);
577 if (ret) {
578 if (err_ret)
579 *err_ret = ret;
580 return 0xFFFFFFFF;
581 }
582
583 return le32_to_cpup((__le32 *)func->tmpbuf);
584}
585EXPORT_SYMBOL_GPL(sdio_readl);
586
587/**
588 * sdio_writel - write a 32 bit integer to a SDIO function
589 * @func: SDIO function to access
590 * @b: integer to write
591 * @addr: address to write to
592 * @err_ret: optional status value from transfer
593 *
594 * Writes a 32 bit integer to the address space of a given SDIO
595 * function. @err_ret will contain the status of the actual
596 * transfer.
597 */
598void sdio_writel(struct sdio_func *func, u32 b, unsigned int addr, int *err_ret)
599{
600 int ret;
601
602 *(__le32 *)func->tmpbuf = cpu_to_le32(b);
603
604 ret = sdio_memcpy_toio(func, addr, func->tmpbuf, 4);
605 if (err_ret)
606 *err_ret = ret;
607}
608EXPORT_SYMBOL_GPL(sdio_writel);
609
610/**
611 * sdio_f0_readb - read a single byte from SDIO function 0
612 * @func: an SDIO function of the card
613 * @addr: address to read
614 * @err_ret: optional status value from transfer
615 *
616 * Reads a single byte from the address space of SDIO function 0.
617 * If there is a problem reading the address, 0xff is returned
618 * and @err_ret will contain the error code.
619 */
620unsigned char sdio_f0_readb(struct sdio_func *func, unsigned int addr,
621 int *err_ret)
622{
623 int ret;
624 unsigned char val;
625
626 BUG_ON(!func);
627
628 if (err_ret)
629 *err_ret = 0;
630
631 ret = mmc_io_rw_direct(func->card, 0, 0, addr, 0, &val);
632 if (ret) {
633 if (err_ret)
634 *err_ret = ret;
635 return 0xFF;
636 }
637
638 return val;
639}
640EXPORT_SYMBOL_GPL(sdio_f0_readb);
641
642/**
643 * sdio_f0_writeb - write a single byte to SDIO function 0
644 * @func: an SDIO function of the card
645 * @b: byte to write
646 * @addr: address to write to
647 * @err_ret: optional status value from transfer
648 *
649 * Writes a single byte to the address space of SDIO function 0.
650 * @err_ret will contain the status of the actual transfer.
651 *
652 * Only writes to the vendor specific CCCR registers (0xF0 -
653 * 0xFF) are permiited; @err_ret will be set to -EINVAL for *
654 * writes outside this range.
655 */
656void sdio_f0_writeb(struct sdio_func *func, unsigned char b, unsigned int addr,
657 int *err_ret)
658{
659 int ret;
660
661 BUG_ON(!func);
662
663 if ((addr < 0xF0 || addr > 0xFF) && (!mmc_card_lenient_fn0(func->card))) {
664 if (err_ret)
665 *err_ret = -EINVAL;
666 return;
667 }
668
669 ret = mmc_io_rw_direct(func->card, 1, 0, addr, b, NULL);
670 if (err_ret)
671 *err_ret = ret;
672}
673EXPORT_SYMBOL_GPL(sdio_f0_writeb);
674
675/**
676 * sdio_get_host_pm_caps - get host power management capabilities
677 * @func: SDIO function attached to host
678 *
679 * Returns a capability bitmask corresponding to power management
680 * features supported by the host controller that the card function
681 * might rely upon during a system suspend. The host doesn't need
682 * to be claimed, nor the function active, for this information to be
683 * obtained.
684 */
685mmc_pm_flag_t sdio_get_host_pm_caps(struct sdio_func *func)
686{
687 BUG_ON(!func);
688 BUG_ON(!func->card);
689
690 return func->card->host->pm_caps;
691}
692EXPORT_SYMBOL_GPL(sdio_get_host_pm_caps);
693
694/**
695 * sdio_set_host_pm_flags - set wanted host power management capabilities
696 * @func: SDIO function attached to host
697 *
698 * Set a capability bitmask corresponding to wanted host controller
699 * power management features for the upcoming suspend state.
700 * This must be called, if needed, each time the suspend method of
701 * the function driver is called, and must contain only bits that
702 * were returned by sdio_get_host_pm_caps().
703 * The host doesn't need to be claimed, nor the function active,
704 * for this information to be set.
705 */
706int sdio_set_host_pm_flags(struct sdio_func *func, mmc_pm_flag_t flags)
707{
708 struct mmc_host *host;
709
710 BUG_ON(!func);
711 BUG_ON(!func->card);
712
713 host = func->card->host;
714
715 if (flags & ~host->pm_caps)
716 return -EINVAL;
717
718 /* function suspend methods are serialized, hence no lock needed */
719 host->pm_flags |= flags;
720 return 0;
721}
722EXPORT_SYMBOL_GPL(sdio_set_host_pm_flags);
1/*
2 * linux/drivers/mmc/core/sdio_io.c
3 *
4 * Copyright 2007-2008 Pierre Ossman
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or (at
9 * your option) any later version.
10 */
11
12#include <linux/export.h>
13#include <linux/mmc/host.h>
14#include <linux/mmc/card.h>
15#include <linux/mmc/sdio.h>
16#include <linux/mmc/sdio_func.h>
17
18#include "sdio_ops.h"
19#include "core.h"
20#include "card.h"
21
22/**
23 * sdio_claim_host - exclusively claim a bus for a certain SDIO function
24 * @func: SDIO function that will be accessed
25 *
26 * Claim a bus for a set of operations. The SDIO function given
27 * is used to figure out which bus is relevant.
28 */
29void sdio_claim_host(struct sdio_func *func)
30{
31 if (WARN_ON(!func))
32 return;
33
34 mmc_claim_host(func->card->host);
35}
36EXPORT_SYMBOL_GPL(sdio_claim_host);
37
38/**
39 * sdio_release_host - release a bus for a certain SDIO function
40 * @func: SDIO function that was accessed
41 *
42 * Release a bus, allowing others to claim the bus for their
43 * operations.
44 */
45void sdio_release_host(struct sdio_func *func)
46{
47 if (WARN_ON(!func))
48 return;
49
50 mmc_release_host(func->card->host);
51}
52EXPORT_SYMBOL_GPL(sdio_release_host);
53
54/**
55 * sdio_enable_func - enables a SDIO function for usage
56 * @func: SDIO function to enable
57 *
58 * Powers up and activates a SDIO function so that register
59 * access is possible.
60 */
61int sdio_enable_func(struct sdio_func *func)
62{
63 int ret;
64 unsigned char reg;
65 unsigned long timeout;
66
67 if (!func)
68 return -EINVAL;
69
70 pr_debug("SDIO: Enabling device %s...\n", sdio_func_id(func));
71
72 ret = mmc_io_rw_direct(func->card, 0, 0, SDIO_CCCR_IOEx, 0, ®);
73 if (ret)
74 goto err;
75
76 reg |= 1 << func->num;
77
78 ret = mmc_io_rw_direct(func->card, 1, 0, SDIO_CCCR_IOEx, reg, NULL);
79 if (ret)
80 goto err;
81
82 timeout = jiffies + msecs_to_jiffies(func->enable_timeout);
83
84 while (1) {
85 ret = mmc_io_rw_direct(func->card, 0, 0, SDIO_CCCR_IORx, 0, ®);
86 if (ret)
87 goto err;
88 if (reg & (1 << func->num))
89 break;
90 ret = -ETIME;
91 if (time_after(jiffies, timeout))
92 goto err;
93 }
94
95 pr_debug("SDIO: Enabled device %s\n", sdio_func_id(func));
96
97 return 0;
98
99err:
100 pr_debug("SDIO: Failed to enable device %s\n", sdio_func_id(func));
101 return ret;
102}
103EXPORT_SYMBOL_GPL(sdio_enable_func);
104
105/**
106 * sdio_disable_func - disable a SDIO function
107 * @func: SDIO function to disable
108 *
109 * Powers down and deactivates a SDIO function. Register access
110 * to this function will fail until the function is reenabled.
111 */
112int sdio_disable_func(struct sdio_func *func)
113{
114 int ret;
115 unsigned char reg;
116
117 if (!func)
118 return -EINVAL;
119
120 pr_debug("SDIO: Disabling device %s...\n", sdio_func_id(func));
121
122 ret = mmc_io_rw_direct(func->card, 0, 0, SDIO_CCCR_IOEx, 0, ®);
123 if (ret)
124 goto err;
125
126 reg &= ~(1 << func->num);
127
128 ret = mmc_io_rw_direct(func->card, 1, 0, SDIO_CCCR_IOEx, reg, NULL);
129 if (ret)
130 goto err;
131
132 pr_debug("SDIO: Disabled device %s\n", sdio_func_id(func));
133
134 return 0;
135
136err:
137 pr_debug("SDIO: Failed to disable device %s\n", sdio_func_id(func));
138 return -EIO;
139}
140EXPORT_SYMBOL_GPL(sdio_disable_func);
141
142/**
143 * sdio_set_block_size - set the block size of an SDIO function
144 * @func: SDIO function to change
145 * @blksz: new block size or 0 to use the default.
146 *
147 * The default block size is the largest supported by both the function
148 * and the host, with a maximum of 512 to ensure that arbitrarily sized
149 * data transfer use the optimal (least) number of commands.
150 *
151 * A driver may call this to override the default block size set by the
152 * core. This can be used to set a block size greater than the maximum
153 * that reported by the card; it is the driver's responsibility to ensure
154 * it uses a value that the card supports.
155 *
156 * Returns 0 on success, -EINVAL if the host does not support the
157 * requested block size, or -EIO (etc.) if one of the resultant FBR block
158 * size register writes failed.
159 *
160 */
161int sdio_set_block_size(struct sdio_func *func, unsigned blksz)
162{
163 int ret;
164
165 if (blksz > func->card->host->max_blk_size)
166 return -EINVAL;
167
168 if (blksz == 0) {
169 blksz = min(func->max_blksize, func->card->host->max_blk_size);
170 blksz = min(blksz, 512u);
171 }
172
173 ret = mmc_io_rw_direct(func->card, 1, 0,
174 SDIO_FBR_BASE(func->num) + SDIO_FBR_BLKSIZE,
175 blksz & 0xff, NULL);
176 if (ret)
177 return ret;
178 ret = mmc_io_rw_direct(func->card, 1, 0,
179 SDIO_FBR_BASE(func->num) + SDIO_FBR_BLKSIZE + 1,
180 (blksz >> 8) & 0xff, NULL);
181 if (ret)
182 return ret;
183 func->cur_blksize = blksz;
184 return 0;
185}
186EXPORT_SYMBOL_GPL(sdio_set_block_size);
187
188/*
189 * Calculate the maximum byte mode transfer size
190 */
191static inline unsigned int sdio_max_byte_size(struct sdio_func *func)
192{
193 unsigned mval = func->card->host->max_blk_size;
194
195 if (mmc_blksz_for_byte_mode(func->card))
196 mval = min(mval, func->cur_blksize);
197 else
198 mval = min(mval, func->max_blksize);
199
200 if (mmc_card_broken_byte_mode_512(func->card))
201 return min(mval, 511u);
202
203 return min(mval, 512u); /* maximum size for byte mode */
204}
205
206/**
207 * sdio_align_size - pads a transfer size to a more optimal value
208 * @func: SDIO function
209 * @sz: original transfer size
210 *
211 * Pads the original data size with a number of extra bytes in
212 * order to avoid controller bugs and/or performance hits
213 * (e.g. some controllers revert to PIO for certain sizes).
214 *
215 * If possible, it will also adjust the size so that it can be
216 * handled in just a single request.
217 *
218 * Returns the improved size, which might be unmodified.
219 */
220unsigned int sdio_align_size(struct sdio_func *func, unsigned int sz)
221{
222 unsigned int orig_sz;
223 unsigned int blk_sz, byte_sz;
224 unsigned chunk_sz;
225
226 orig_sz = sz;
227
228 /*
229 * Do a first check with the controller, in case it
230 * wants to increase the size up to a point where it
231 * might need more than one block.
232 */
233 sz = mmc_align_data_size(func->card, sz);
234
235 /*
236 * If we can still do this with just a byte transfer, then
237 * we're done.
238 */
239 if (sz <= sdio_max_byte_size(func))
240 return sz;
241
242 if (func->card->cccr.multi_block) {
243 /*
244 * Check if the transfer is already block aligned
245 */
246 if ((sz % func->cur_blksize) == 0)
247 return sz;
248
249 /*
250 * Realign it so that it can be done with one request,
251 * and recheck if the controller still likes it.
252 */
253 blk_sz = ((sz + func->cur_blksize - 1) /
254 func->cur_blksize) * func->cur_blksize;
255 blk_sz = mmc_align_data_size(func->card, blk_sz);
256
257 /*
258 * This value is only good if it is still just
259 * one request.
260 */
261 if ((blk_sz % func->cur_blksize) == 0)
262 return blk_sz;
263
264 /*
265 * We failed to do one request, but at least try to
266 * pad the remainder properly.
267 */
268 byte_sz = mmc_align_data_size(func->card,
269 sz % func->cur_blksize);
270 if (byte_sz <= sdio_max_byte_size(func)) {
271 blk_sz = sz / func->cur_blksize;
272 return blk_sz * func->cur_blksize + byte_sz;
273 }
274 } else {
275 /*
276 * We need multiple requests, so first check that the
277 * controller can handle the chunk size;
278 */
279 chunk_sz = mmc_align_data_size(func->card,
280 sdio_max_byte_size(func));
281 if (chunk_sz == sdio_max_byte_size(func)) {
282 /*
283 * Fix up the size of the remainder (if any)
284 */
285 byte_sz = orig_sz % chunk_sz;
286 if (byte_sz) {
287 byte_sz = mmc_align_data_size(func->card,
288 byte_sz);
289 }
290
291 return (orig_sz / chunk_sz) * chunk_sz + byte_sz;
292 }
293 }
294
295 /*
296 * The controller is simply incapable of transferring the size
297 * we want in decent manner, so just return the original size.
298 */
299 return orig_sz;
300}
301EXPORT_SYMBOL_GPL(sdio_align_size);
302
303/* Split an arbitrarily sized data transfer into several
304 * IO_RW_EXTENDED commands. */
305static int sdio_io_rw_ext_helper(struct sdio_func *func, int write,
306 unsigned addr, int incr_addr, u8 *buf, unsigned size)
307{
308 unsigned remainder = size;
309 unsigned max_blocks;
310 int ret;
311
312 if (!func || (func->num > 7))
313 return -EINVAL;
314
315 /* Do the bulk of the transfer using block mode (if supported). */
316 if (func->card->cccr.multi_block && (size > sdio_max_byte_size(func))) {
317 /* Blocks per command is limited by host count, host transfer
318 * size and the maximum for IO_RW_EXTENDED of 511 blocks. */
319 max_blocks = min(func->card->host->max_blk_count, 511u);
320
321 while (remainder >= func->cur_blksize) {
322 unsigned blocks;
323
324 blocks = remainder / func->cur_blksize;
325 if (blocks > max_blocks)
326 blocks = max_blocks;
327 size = blocks * func->cur_blksize;
328
329 ret = mmc_io_rw_extended(func->card, write,
330 func->num, addr, incr_addr, buf,
331 blocks, func->cur_blksize);
332 if (ret)
333 return ret;
334
335 remainder -= size;
336 buf += size;
337 if (incr_addr)
338 addr += size;
339 }
340 }
341
342 /* Write the remainder using byte mode. */
343 while (remainder > 0) {
344 size = min(remainder, sdio_max_byte_size(func));
345
346 /* Indicate byte mode by setting "blocks" = 0 */
347 ret = mmc_io_rw_extended(func->card, write, func->num, addr,
348 incr_addr, buf, 0, size);
349 if (ret)
350 return ret;
351
352 remainder -= size;
353 buf += size;
354 if (incr_addr)
355 addr += size;
356 }
357 return 0;
358}
359
360/**
361 * sdio_readb - read a single byte from a SDIO function
362 * @func: SDIO function to access
363 * @addr: address to read
364 * @err_ret: optional status value from transfer
365 *
366 * Reads a single byte from the address space of a given SDIO
367 * function. If there is a problem reading the address, 0xff
368 * is returned and @err_ret will contain the error code.
369 */
370u8 sdio_readb(struct sdio_func *func, unsigned int addr, int *err_ret)
371{
372 int ret;
373 u8 val;
374
375 if (!func) {
376 if (err_ret)
377 *err_ret = -EINVAL;
378 return 0xFF;
379 }
380
381 ret = mmc_io_rw_direct(func->card, 0, func->num, addr, 0, &val);
382 if (err_ret)
383 *err_ret = ret;
384 if (ret)
385 return 0xFF;
386
387 return val;
388}
389EXPORT_SYMBOL_GPL(sdio_readb);
390
391/**
392 * sdio_writeb - write a single byte to a SDIO function
393 * @func: SDIO function to access
394 * @b: byte to write
395 * @addr: address to write to
396 * @err_ret: optional status value from transfer
397 *
398 * Writes a single byte to the address space of a given SDIO
399 * function. @err_ret will contain the status of the actual
400 * transfer.
401 */
402void sdio_writeb(struct sdio_func *func, u8 b, unsigned int addr, int *err_ret)
403{
404 int ret;
405
406 if (!func) {
407 if (err_ret)
408 *err_ret = -EINVAL;
409 return;
410 }
411
412 ret = mmc_io_rw_direct(func->card, 1, func->num, addr, b, NULL);
413 if (err_ret)
414 *err_ret = ret;
415}
416EXPORT_SYMBOL_GPL(sdio_writeb);
417
418/**
419 * sdio_writeb_readb - write and read a byte from SDIO function
420 * @func: SDIO function to access
421 * @write_byte: byte to write
422 * @addr: address to write to
423 * @err_ret: optional status value from transfer
424 *
425 * Performs a RAW (Read after Write) operation as defined by SDIO spec -
426 * single byte is written to address space of a given SDIO function and
427 * response is read back from the same address, both using single request.
428 * If there is a problem with the operation, 0xff is returned and
429 * @err_ret will contain the error code.
430 */
431u8 sdio_writeb_readb(struct sdio_func *func, u8 write_byte,
432 unsigned int addr, int *err_ret)
433{
434 int ret;
435 u8 val;
436
437 ret = mmc_io_rw_direct(func->card, 1, func->num, addr,
438 write_byte, &val);
439 if (err_ret)
440 *err_ret = ret;
441 if (ret)
442 return 0xff;
443
444 return val;
445}
446EXPORT_SYMBOL_GPL(sdio_writeb_readb);
447
448/**
449 * sdio_memcpy_fromio - read a chunk of memory from a SDIO function
450 * @func: SDIO function to access
451 * @dst: buffer to store the data
452 * @addr: address to begin reading from
453 * @count: number of bytes to read
454 *
455 * Reads from the address space of a given SDIO function. Return
456 * value indicates if the transfer succeeded or not.
457 */
458int sdio_memcpy_fromio(struct sdio_func *func, void *dst,
459 unsigned int addr, int count)
460{
461 return sdio_io_rw_ext_helper(func, 0, addr, 1, dst, count);
462}
463EXPORT_SYMBOL_GPL(sdio_memcpy_fromio);
464
465/**
466 * sdio_memcpy_toio - write a chunk of memory to a SDIO function
467 * @func: SDIO function to access
468 * @addr: address to start writing to
469 * @src: buffer that contains the data to write
470 * @count: number of bytes to write
471 *
472 * Writes to the address space of a given SDIO function. Return
473 * value indicates if the transfer succeeded or not.
474 */
475int sdio_memcpy_toio(struct sdio_func *func, unsigned int addr,
476 void *src, int count)
477{
478 return sdio_io_rw_ext_helper(func, 1, addr, 1, src, count);
479}
480EXPORT_SYMBOL_GPL(sdio_memcpy_toio);
481
482/**
483 * sdio_readsb - read from a FIFO on a SDIO function
484 * @func: SDIO function to access
485 * @dst: buffer to store the data
486 * @addr: address of (single byte) FIFO
487 * @count: number of bytes to read
488 *
489 * Reads from the specified FIFO of a given SDIO function. Return
490 * value indicates if the transfer succeeded or not.
491 */
492int sdio_readsb(struct sdio_func *func, void *dst, unsigned int addr,
493 int count)
494{
495 return sdio_io_rw_ext_helper(func, 0, addr, 0, dst, count);
496}
497EXPORT_SYMBOL_GPL(sdio_readsb);
498
499/**
500 * sdio_writesb - write to a FIFO of a SDIO function
501 * @func: SDIO function to access
502 * @addr: address of (single byte) FIFO
503 * @src: buffer that contains the data to write
504 * @count: number of bytes to write
505 *
506 * Writes to the specified FIFO of a given SDIO function. Return
507 * value indicates if the transfer succeeded or not.
508 */
509int sdio_writesb(struct sdio_func *func, unsigned int addr, void *src,
510 int count)
511{
512 return sdio_io_rw_ext_helper(func, 1, addr, 0, src, count);
513}
514EXPORT_SYMBOL_GPL(sdio_writesb);
515
516/**
517 * sdio_readw - read a 16 bit integer from a SDIO function
518 * @func: SDIO function to access
519 * @addr: address to read
520 * @err_ret: optional status value from transfer
521 *
522 * Reads a 16 bit integer from the address space of a given SDIO
523 * function. If there is a problem reading the address, 0xffff
524 * is returned and @err_ret will contain the error code.
525 */
526u16 sdio_readw(struct sdio_func *func, unsigned int addr, int *err_ret)
527{
528 int ret;
529
530 ret = sdio_memcpy_fromio(func, func->tmpbuf, addr, 2);
531 if (err_ret)
532 *err_ret = ret;
533 if (ret)
534 return 0xFFFF;
535
536 return le16_to_cpup((__le16 *)func->tmpbuf);
537}
538EXPORT_SYMBOL_GPL(sdio_readw);
539
540/**
541 * sdio_writew - write a 16 bit integer to a SDIO function
542 * @func: SDIO function to access
543 * @b: integer to write
544 * @addr: address to write to
545 * @err_ret: optional status value from transfer
546 *
547 * Writes a 16 bit integer to the address space of a given SDIO
548 * function. @err_ret will contain the status of the actual
549 * transfer.
550 */
551void sdio_writew(struct sdio_func *func, u16 b, unsigned int addr, int *err_ret)
552{
553 int ret;
554
555 *(__le16 *)func->tmpbuf = cpu_to_le16(b);
556
557 ret = sdio_memcpy_toio(func, addr, func->tmpbuf, 2);
558 if (err_ret)
559 *err_ret = ret;
560}
561EXPORT_SYMBOL_GPL(sdio_writew);
562
563/**
564 * sdio_readl - read a 32 bit integer from a SDIO function
565 * @func: SDIO function to access
566 * @addr: address to read
567 * @err_ret: optional status value from transfer
568 *
569 * Reads a 32 bit integer from the address space of a given SDIO
570 * function. If there is a problem reading the address,
571 * 0xffffffff is returned and @err_ret will contain the error
572 * code.
573 */
574u32 sdio_readl(struct sdio_func *func, unsigned int addr, int *err_ret)
575{
576 int ret;
577
578 ret = sdio_memcpy_fromio(func, func->tmpbuf, addr, 4);
579 if (err_ret)
580 *err_ret = ret;
581 if (ret)
582 return 0xFFFFFFFF;
583
584 return le32_to_cpup((__le32 *)func->tmpbuf);
585}
586EXPORT_SYMBOL_GPL(sdio_readl);
587
588/**
589 * sdio_writel - write a 32 bit integer to a SDIO function
590 * @func: SDIO function to access
591 * @b: integer to write
592 * @addr: address to write to
593 * @err_ret: optional status value from transfer
594 *
595 * Writes a 32 bit integer to the address space of a given SDIO
596 * function. @err_ret will contain the status of the actual
597 * transfer.
598 */
599void sdio_writel(struct sdio_func *func, u32 b, unsigned int addr, int *err_ret)
600{
601 int ret;
602
603 *(__le32 *)func->tmpbuf = cpu_to_le32(b);
604
605 ret = sdio_memcpy_toio(func, addr, func->tmpbuf, 4);
606 if (err_ret)
607 *err_ret = ret;
608}
609EXPORT_SYMBOL_GPL(sdio_writel);
610
611/**
612 * sdio_f0_readb - read a single byte from SDIO function 0
613 * @func: an SDIO function of the card
614 * @addr: address to read
615 * @err_ret: optional status value from transfer
616 *
617 * Reads a single byte from the address space of SDIO function 0.
618 * If there is a problem reading the address, 0xff is returned
619 * and @err_ret will contain the error code.
620 */
621unsigned char sdio_f0_readb(struct sdio_func *func, unsigned int addr,
622 int *err_ret)
623{
624 int ret;
625 unsigned char val;
626
627 if (!func) {
628 if (err_ret)
629 *err_ret = -EINVAL;
630 return 0xFF;
631 }
632
633 ret = mmc_io_rw_direct(func->card, 0, 0, addr, 0, &val);
634 if (err_ret)
635 *err_ret = ret;
636 if (ret)
637 return 0xFF;
638
639 return val;
640}
641EXPORT_SYMBOL_GPL(sdio_f0_readb);
642
643/**
644 * sdio_f0_writeb - write a single byte to SDIO function 0
645 * @func: an SDIO function of the card
646 * @b: byte to write
647 * @addr: address to write to
648 * @err_ret: optional status value from transfer
649 *
650 * Writes a single byte to the address space of SDIO function 0.
651 * @err_ret will contain the status of the actual transfer.
652 *
653 * Only writes to the vendor specific CCCR registers (0xF0 -
654 * 0xFF) are permiited; @err_ret will be set to -EINVAL for *
655 * writes outside this range.
656 */
657void sdio_f0_writeb(struct sdio_func *func, unsigned char b, unsigned int addr,
658 int *err_ret)
659{
660 int ret;
661
662 if (!func) {
663 if (err_ret)
664 *err_ret = -EINVAL;
665 return;
666 }
667
668 if ((addr < 0xF0 || addr > 0xFF) && (!mmc_card_lenient_fn0(func->card))) {
669 if (err_ret)
670 *err_ret = -EINVAL;
671 return;
672 }
673
674 ret = mmc_io_rw_direct(func->card, 1, 0, addr, b, NULL);
675 if (err_ret)
676 *err_ret = ret;
677}
678EXPORT_SYMBOL_GPL(sdio_f0_writeb);
679
680/**
681 * sdio_get_host_pm_caps - get host power management capabilities
682 * @func: SDIO function attached to host
683 *
684 * Returns a capability bitmask corresponding to power management
685 * features supported by the host controller that the card function
686 * might rely upon during a system suspend. The host doesn't need
687 * to be claimed, nor the function active, for this information to be
688 * obtained.
689 */
690mmc_pm_flag_t sdio_get_host_pm_caps(struct sdio_func *func)
691{
692 if (!func)
693 return 0;
694
695 return func->card->host->pm_caps;
696}
697EXPORT_SYMBOL_GPL(sdio_get_host_pm_caps);
698
699/**
700 * sdio_set_host_pm_flags - set wanted host power management capabilities
701 * @func: SDIO function attached to host
702 *
703 * Set a capability bitmask corresponding to wanted host controller
704 * power management features for the upcoming suspend state.
705 * This must be called, if needed, each time the suspend method of
706 * the function driver is called, and must contain only bits that
707 * were returned by sdio_get_host_pm_caps().
708 * The host doesn't need to be claimed, nor the function active,
709 * for this information to be set.
710 */
711int sdio_set_host_pm_flags(struct sdio_func *func, mmc_pm_flag_t flags)
712{
713 struct mmc_host *host;
714
715 if (!func)
716 return -EINVAL;
717
718 host = func->card->host;
719
720 if (flags & ~host->pm_caps)
721 return -EINVAL;
722
723 /* function suspend methods are serialized, hence no lock needed */
724 host->pm_flags |= flags;
725 return 0;
726}
727EXPORT_SYMBOL_GPL(sdio_set_host_pm_flags);