Commit | Line | Data |
---|---|---|
5c4e6f13 PO |
1 | /* |
2 | * linux/drivers/mmc/sdio_ops.c | |
3 | * | |
4 | * Copyright 2006-2007 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 | ||
112c9db9 PO |
12 | #include <linux/scatterlist.h> |
13 | ||
5c4e6f13 | 14 | #include <linux/mmc/host.h> |
b2bcc798 | 15 | #include <linux/mmc/card.h> |
5c4e6f13 PO |
16 | #include <linux/mmc/mmc.h> |
17 | #include <linux/mmc/sdio.h> | |
18 | ||
19 | #include "core.h" | |
e70aa3fa | 20 | #include "sdio_ops.h" |
5c4e6f13 PO |
21 | |
22 | int mmc_send_io_op_cond(struct mmc_host *host, u32 ocr, u32 *rocr) | |
23 | { | |
1278dba1 | 24 | struct mmc_command cmd = {0}; |
5c4e6f13 PO |
25 | int i, err = 0; |
26 | ||
5c4e6f13 PO |
27 | cmd.opcode = SD_IO_SEND_OP_COND; |
28 | cmd.arg = ocr; | |
af517150 | 29 | cmd.flags = MMC_RSP_SPI_R4 | MMC_RSP_R4 | MMC_CMD_BCR; |
5c4e6f13 PO |
30 | |
31 | for (i = 100; i; i--) { | |
32 | err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES); | |
33 | if (err) | |
34 | break; | |
35 | ||
af517150 DB |
36 | /* if we're just probing, do a single pass */ |
37 | if (ocr == 0) | |
5c4e6f13 PO |
38 | break; |
39 | ||
af517150 DB |
40 | /* otherwise wait until reset completes */ |
41 | if (mmc_host_is_spi(host)) { | |
42 | /* | |
43 | * Both R1_SPI_IDLE and MMC_CARD_BUSY indicate | |
44 | * an initialized card under SPI, but some cards | |
45 | * (Marvell's) only behave when looking at this | |
46 | * one. | |
47 | */ | |
48 | if (cmd.resp[1] & MMC_CARD_BUSY) | |
49 | break; | |
50 | } else { | |
51 | if (cmd.resp[0] & MMC_CARD_BUSY) | |
52 | break; | |
53 | } | |
54 | ||
5c4e6f13 PO |
55 | err = -ETIMEDOUT; |
56 | ||
57 | mmc_delay(10); | |
58 | } | |
59 | ||
60 | if (rocr) | |
af517150 | 61 | *rocr = cmd.resp[mmc_host_is_spi(host) ? 1 : 0]; |
5c4e6f13 PO |
62 | |
63 | return err; | |
64 | } | |
65 | ||
516a8242 AH |
66 | static int mmc_io_rw_direct_host(struct mmc_host *host, int write, unsigned fn, |
67 | unsigned addr, u8 in, u8 *out) | |
b2bcc798 | 68 | { |
1278dba1 | 69 | struct mmc_command cmd = {0}; |
b2bcc798 PO |
70 | int err; |
71 | ||
be1f970b SL |
72 | if (fn > 7) |
73 | return -EINVAL; | |
b2bcc798 | 74 | |
be6f19fc PO |
75 | /* sanity check */ |
76 | if (addr & ~0x1FFFF) | |
77 | return -EINVAL; | |
78 | ||
b2bcc798 PO |
79 | cmd.opcode = SD_IO_RW_DIRECT; |
80 | cmd.arg = write ? 0x80000000 : 0x00000000; | |
81 | cmd.arg |= fn << 28; | |
82 | cmd.arg |= (write && out) ? 0x08000000 : 0x00000000; | |
83 | cmd.arg |= addr << 9; | |
84 | cmd.arg |= in; | |
af517150 | 85 | cmd.flags = MMC_RSP_SPI_R5 | MMC_RSP_R5 | MMC_CMD_AC; |
b2bcc798 | 86 | |
516a8242 | 87 | err = mmc_wait_for_cmd(host, &cmd, 0); |
b2bcc798 PO |
88 | if (err) |
89 | return err; | |
90 | ||
516a8242 | 91 | if (mmc_host_is_spi(host)) { |
af517150 DB |
92 | /* host driver already reported errors */ |
93 | } else { | |
94 | if (cmd.resp[0] & R5_ERROR) | |
95 | return -EIO; | |
96 | if (cmd.resp[0] & R5_FUNCTION_NUMBER) | |
97 | return -EINVAL; | |
98 | if (cmd.resp[0] & R5_OUT_OF_RANGE) | |
99 | return -ERANGE; | |
100 | } | |
b2bcc798 | 101 | |
af517150 | 102 | if (out) { |
516a8242 | 103 | if (mmc_host_is_spi(host)) |
af517150 DB |
104 | *out = (cmd.resp[0] >> 8) & 0xFF; |
105 | else | |
106 | *out = cmd.resp[0] & 0xFF; | |
107 | } | |
b2bcc798 PO |
108 | |
109 | return 0; | |
110 | } | |
111 | ||
516a8242 AH |
112 | int mmc_io_rw_direct(struct mmc_card *card, int write, unsigned fn, |
113 | unsigned addr, u8 in, u8 *out) | |
114 | { | |
516a8242 AH |
115 | return mmc_io_rw_direct_host(card->host, write, fn, addr, in, out); |
116 | } | |
117 | ||
112c9db9 | 118 | int mmc_io_rw_extended(struct mmc_card *card, int write, unsigned fn, |
eb659468 | 119 | unsigned addr, int incr_addr, u8 *buf, unsigned blocks, unsigned blksz) |
112c9db9 | 120 | { |
ad5fd972 | 121 | struct mmc_request mrq = {NULL}; |
1278dba1 | 122 | struct mmc_command cmd = {0}; |
a61ad2b4 | 123 | struct mmc_data data = {0}; |
968a64ea KK |
124 | struct scatterlist sg, *sg_ptr; |
125 | struct sg_table sgtable; | |
126 | unsigned int nents, left_size, i; | |
127 | unsigned int seg_size = card->host->max_seg_size; | |
112c9db9 | 128 | |
eb659468 | 129 | WARN_ON(blksz == 0); |
112c9db9 | 130 | |
be6f19fc PO |
131 | /* sanity check */ |
132 | if (addr & ~0x1FFFF) | |
133 | return -EINVAL; | |
134 | ||
112c9db9 PO |
135 | mrq.cmd = &cmd; |
136 | mrq.data = &data; | |
137 | ||
138 | cmd.opcode = SD_IO_RW_EXTENDED; | |
139 | cmd.arg = write ? 0x80000000 : 0x00000000; | |
140 | cmd.arg |= fn << 28; | |
eb659468 | 141 | cmd.arg |= incr_addr ? 0x04000000 : 0x00000000; |
112c9db9 | 142 | cmd.arg |= addr << 9; |
052d81da SNX |
143 | if (blocks == 0) |
144 | cmd.arg |= (blksz == 512) ? 0 : blksz; /* byte mode */ | |
eb659468 DV |
145 | else |
146 | cmd.arg |= 0x08000000 | blocks; /* block mode */ | |
af517150 | 147 | cmd.flags = MMC_RSP_SPI_R5 | MMC_RSP_R5 | MMC_CMD_ADTC; |
112c9db9 | 148 | |
eb659468 | 149 | data.blksz = blksz; |
052d81da SNX |
150 | /* Code in host drivers/fwk assumes that "blocks" always is >=1 */ |
151 | data.blocks = blocks ? blocks : 1; | |
112c9db9 | 152 | data.flags = write ? MMC_DATA_WRITE : MMC_DATA_READ; |
112c9db9 | 153 | |
968a64ea KK |
154 | left_size = data.blksz * data.blocks; |
155 | nents = (left_size - 1) / seg_size + 1; | |
156 | if (nents > 1) { | |
157 | if (sg_alloc_table(&sgtable, nents, GFP_KERNEL)) | |
158 | return -ENOMEM; | |
159 | ||
160 | data.sg = sgtable.sgl; | |
161 | data.sg_len = nents; | |
162 | ||
163 | for_each_sg(data.sg, sg_ptr, data.sg_len, i) { | |
164 | sg_set_page(sg_ptr, virt_to_page(buf + (i * seg_size)), | |
165 | min(seg_size, left_size), | |
166 | offset_in_page(buf + (i * seg_size))); | |
167 | left_size = left_size - seg_size; | |
168 | } | |
169 | } else { | |
170 | data.sg = &sg; | |
171 | data.sg_len = 1; | |
172 | ||
173 | sg_init_one(&sg, buf, left_size); | |
174 | } | |
112c9db9 PO |
175 | |
176 | mmc_set_data_timeout(&data, card); | |
177 | ||
178 | mmc_wait_for_req(card->host, &mrq); | |
179 | ||
968a64ea KK |
180 | if (nents > 1) |
181 | sg_free_table(&sgtable); | |
182 | ||
112c9db9 PO |
183 | if (cmd.error) |
184 | return cmd.error; | |
185 | if (data.error) | |
186 | return data.error; | |
187 | ||
af517150 DB |
188 | if (mmc_host_is_spi(card->host)) { |
189 | /* host driver already reported errors */ | |
190 | } else { | |
191 | if (cmd.resp[0] & R5_ERROR) | |
192 | return -EIO; | |
193 | if (cmd.resp[0] & R5_FUNCTION_NUMBER) | |
194 | return -EINVAL; | |
195 | if (cmd.resp[0] & R5_OUT_OF_RANGE) | |
196 | return -ERANGE; | |
197 | } | |
112c9db9 PO |
198 | |
199 | return 0; | |
200 | } | |
201 | ||
516a8242 AH |
202 | int sdio_reset(struct mmc_host *host) |
203 | { | |
204 | int ret; | |
205 | u8 abort; | |
206 | ||
207 | /* SDIO Simplified Specification V2.0, 4.4 Reset for SDIO */ | |
208 | ||
209 | ret = mmc_io_rw_direct_host(host, 0, 0, SDIO_CCCR_ABORT, 0, &abort); | |
210 | if (ret) | |
211 | abort = 0x08; | |
212 | else | |
213 | abort |= 0x08; | |
214 | ||
0899e741 | 215 | return mmc_io_rw_direct_host(host, 1, 0, SDIO_CCCR_ABORT, abort, NULL); |
516a8242 AH |
216 | } |
217 |