xref: /openbmc/u-boot/drivers/mmc/mmc.c (revision 998be3dd59ed0af4bec38324047fecfa88ac45db)
1272cc70bSAndy Fleming /*
2272cc70bSAndy Fleming  * Copyright 2008, Freescale Semiconductor, Inc
3272cc70bSAndy Fleming  * Andy Fleming
4272cc70bSAndy Fleming  *
5272cc70bSAndy Fleming  * Based vaguely on the Linux code
6272cc70bSAndy Fleming  *
7272cc70bSAndy Fleming  * See file CREDITS for list of people who contributed to this
8272cc70bSAndy Fleming  * project.
9272cc70bSAndy Fleming  *
10272cc70bSAndy Fleming  * This program is free software; you can redistribute it and/or
11272cc70bSAndy Fleming  * modify it under the terms of the GNU General Public License as
12272cc70bSAndy Fleming  * published by the Free Software Foundation; either version 2 of
13272cc70bSAndy Fleming  * the License, or (at your option) any later version.
14272cc70bSAndy Fleming  *
15272cc70bSAndy Fleming  * This program is distributed in the hope that it will be useful,
16272cc70bSAndy Fleming  * but WITHOUT ANY WARRANTY; without even the implied warranty of
17272cc70bSAndy Fleming  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18272cc70bSAndy Fleming  * GNU General Public License for more details.
19272cc70bSAndy Fleming  *
20272cc70bSAndy Fleming  * You should have received a copy of the GNU General Public License
21272cc70bSAndy Fleming  * along with this program; if not, write to the Free Software
22272cc70bSAndy Fleming  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
23272cc70bSAndy Fleming  * MA 02111-1307 USA
24272cc70bSAndy Fleming  */
25272cc70bSAndy Fleming 
26272cc70bSAndy Fleming #include <config.h>
27272cc70bSAndy Fleming #include <common.h>
28272cc70bSAndy Fleming #include <command.h>
29272cc70bSAndy Fleming #include <mmc.h>
30272cc70bSAndy Fleming #include <part.h>
31272cc70bSAndy Fleming #include <malloc.h>
32272cc70bSAndy Fleming #include <linux/list.h>
33272cc70bSAndy Fleming #include <mmc.h>
349b1f942cSRabin Vincent #include <div64.h>
35272cc70bSAndy Fleming 
36272cc70bSAndy Fleming static struct list_head mmc_devices;
37272cc70bSAndy Fleming static int cur_dev_num = -1;
38272cc70bSAndy Fleming 
39272cc70bSAndy Fleming int mmc_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd, struct mmc_data *data)
40272cc70bSAndy Fleming {
41272cc70bSAndy Fleming 	return mmc->send_cmd(mmc, cmd, data);
42272cc70bSAndy Fleming }
43272cc70bSAndy Fleming 
44272cc70bSAndy Fleming int mmc_set_blocklen(struct mmc *mmc, int len)
45272cc70bSAndy Fleming {
46272cc70bSAndy Fleming 	struct mmc_cmd cmd;
47272cc70bSAndy Fleming 
48272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_SET_BLOCKLEN;
49272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
50272cc70bSAndy Fleming 	cmd.cmdarg = len;
51272cc70bSAndy Fleming 	cmd.flags = 0;
52272cc70bSAndy Fleming 
53272cc70bSAndy Fleming 	return mmc_send_cmd(mmc, &cmd, NULL);
54272cc70bSAndy Fleming }
55272cc70bSAndy Fleming 
56272cc70bSAndy Fleming struct mmc *find_mmc_device(int dev_num)
57272cc70bSAndy Fleming {
58272cc70bSAndy Fleming 	struct mmc *m;
59272cc70bSAndy Fleming 	struct list_head *entry;
60272cc70bSAndy Fleming 
61272cc70bSAndy Fleming 	list_for_each(entry, &mmc_devices) {
62272cc70bSAndy Fleming 		m = list_entry(entry, struct mmc, link);
63272cc70bSAndy Fleming 
64272cc70bSAndy Fleming 		if (m->block_dev.dev == dev_num)
65272cc70bSAndy Fleming 			return m;
66272cc70bSAndy Fleming 	}
67272cc70bSAndy Fleming 
68272cc70bSAndy Fleming 	printf("MMC Device %d not found\n", dev_num);
69272cc70bSAndy Fleming 
70272cc70bSAndy Fleming 	return NULL;
71272cc70bSAndy Fleming }
72272cc70bSAndy Fleming 
73272cc70bSAndy Fleming static ulong
74272cc70bSAndy Fleming mmc_bwrite(int dev_num, ulong start, lbaint_t blkcnt, const void*src)
75272cc70bSAndy Fleming {
76272cc70bSAndy Fleming 	struct mmc_cmd cmd;
77272cc70bSAndy Fleming 	struct mmc_data data;
78272cc70bSAndy Fleming 	int err;
79272cc70bSAndy Fleming 	int stoperr = 0;
80272cc70bSAndy Fleming 	struct mmc *mmc = find_mmc_device(dev_num);
81272cc70bSAndy Fleming 	int blklen;
82272cc70bSAndy Fleming 
83272cc70bSAndy Fleming 	if (!mmc)
84272cc70bSAndy Fleming 		return -1;
85272cc70bSAndy Fleming 
86272cc70bSAndy Fleming 	blklen = mmc->write_bl_len;
87272cc70bSAndy Fleming 
88272cc70bSAndy Fleming 	err = mmc_set_blocklen(mmc, mmc->write_bl_len);
89272cc70bSAndy Fleming 
90272cc70bSAndy Fleming 	if (err) {
91272cc70bSAndy Fleming 		printf("set write bl len failed\n\r");
92272cc70bSAndy Fleming 		return err;
93272cc70bSAndy Fleming 	}
94272cc70bSAndy Fleming 
95272cc70bSAndy Fleming 	if (blkcnt > 1)
96272cc70bSAndy Fleming 		cmd.cmdidx = MMC_CMD_WRITE_MULTIPLE_BLOCK;
97272cc70bSAndy Fleming 	else
98272cc70bSAndy Fleming 		cmd.cmdidx = MMC_CMD_WRITE_SINGLE_BLOCK;
99272cc70bSAndy Fleming 
100272cc70bSAndy Fleming 	if (mmc->high_capacity)
101272cc70bSAndy Fleming 		cmd.cmdarg = start;
102272cc70bSAndy Fleming 	else
103272cc70bSAndy Fleming 		cmd.cmdarg = start * blklen;
104272cc70bSAndy Fleming 
105272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
106272cc70bSAndy Fleming 	cmd.flags = 0;
107272cc70bSAndy Fleming 
108272cc70bSAndy Fleming 	data.src = src;
109272cc70bSAndy Fleming 	data.blocks = blkcnt;
110272cc70bSAndy Fleming 	data.blocksize = blklen;
111272cc70bSAndy Fleming 	data.flags = MMC_DATA_WRITE;
112272cc70bSAndy Fleming 
113272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, &data);
114272cc70bSAndy Fleming 
115272cc70bSAndy Fleming 	if (err) {
116272cc70bSAndy Fleming 		printf("mmc write failed\n\r");
117272cc70bSAndy Fleming 		return err;
118272cc70bSAndy Fleming 	}
119272cc70bSAndy Fleming 
120272cc70bSAndy Fleming 	if (blkcnt > 1) {
121272cc70bSAndy Fleming 		cmd.cmdidx = MMC_CMD_STOP_TRANSMISSION;
122272cc70bSAndy Fleming 		cmd.cmdarg = 0;
123272cc70bSAndy Fleming 		cmd.resp_type = MMC_RSP_R1b;
124272cc70bSAndy Fleming 		cmd.flags = 0;
125272cc70bSAndy Fleming 		stoperr = mmc_send_cmd(mmc, &cmd, NULL);
126272cc70bSAndy Fleming 	}
127272cc70bSAndy Fleming 
128272cc70bSAndy Fleming 	return blkcnt;
129272cc70bSAndy Fleming }
130272cc70bSAndy Fleming 
131272cc70bSAndy Fleming int mmc_read_block(struct mmc *mmc, void *dst, uint blocknum)
132272cc70bSAndy Fleming {
133272cc70bSAndy Fleming 	struct mmc_cmd cmd;
134272cc70bSAndy Fleming 	struct mmc_data data;
135272cc70bSAndy Fleming 
136272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_READ_SINGLE_BLOCK;
137272cc70bSAndy Fleming 
138272cc70bSAndy Fleming 	if (mmc->high_capacity)
139272cc70bSAndy Fleming 		cmd.cmdarg = blocknum;
140272cc70bSAndy Fleming 	else
141272cc70bSAndy Fleming 		cmd.cmdarg = blocknum * mmc->read_bl_len;
142272cc70bSAndy Fleming 
143272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
144272cc70bSAndy Fleming 	cmd.flags = 0;
145272cc70bSAndy Fleming 
146272cc70bSAndy Fleming 	data.dest = dst;
147272cc70bSAndy Fleming 	data.blocks = 1;
148272cc70bSAndy Fleming 	data.blocksize = mmc->read_bl_len;
149272cc70bSAndy Fleming 	data.flags = MMC_DATA_READ;
150272cc70bSAndy Fleming 
151272cc70bSAndy Fleming 	return mmc_send_cmd(mmc, &cmd, &data);
152272cc70bSAndy Fleming }
153272cc70bSAndy Fleming 
154272cc70bSAndy Fleming int mmc_read(struct mmc *mmc, u64 src, uchar *dst, int size)
155272cc70bSAndy Fleming {
156272cc70bSAndy Fleming 	char *buffer;
157272cc70bSAndy Fleming 	int i;
158272cc70bSAndy Fleming 	int blklen = mmc->read_bl_len;
1599b1f942cSRabin Vincent 	int startblock = lldiv(src, mmc->read_bl_len);
1609b1f942cSRabin Vincent 	int endblock = lldiv(src + size - 1, mmc->read_bl_len);
161272cc70bSAndy Fleming 	int err = 0;
162272cc70bSAndy Fleming 
163272cc70bSAndy Fleming 	/* Make a buffer big enough to hold all the blocks we might read */
164272cc70bSAndy Fleming 	buffer = malloc(blklen);
165272cc70bSAndy Fleming 
166272cc70bSAndy Fleming 	if (!buffer) {
167272cc70bSAndy Fleming 		printf("Could not allocate buffer for MMC read!\n");
168272cc70bSAndy Fleming 		return -1;
169272cc70bSAndy Fleming 	}
170272cc70bSAndy Fleming 
171272cc70bSAndy Fleming 	/* We always do full block reads from the card */
172272cc70bSAndy Fleming 	err = mmc_set_blocklen(mmc, mmc->read_bl_len);
173272cc70bSAndy Fleming 
174272cc70bSAndy Fleming 	if (err)
175272cc70bSAndy Fleming 		return err;
176272cc70bSAndy Fleming 
177272cc70bSAndy Fleming 	for (i = startblock; i <= endblock; i++) {
178272cc70bSAndy Fleming 		int segment_size;
179272cc70bSAndy Fleming 		int offset;
180272cc70bSAndy Fleming 
181272cc70bSAndy Fleming 		err = mmc_read_block(mmc, buffer, i);
182272cc70bSAndy Fleming 
183272cc70bSAndy Fleming 		if (err)
184272cc70bSAndy Fleming 			goto free_buffer;
185272cc70bSAndy Fleming 
186272cc70bSAndy Fleming 		/*
187272cc70bSAndy Fleming 		 * The first block may not be aligned, so we
188272cc70bSAndy Fleming 		 * copy from the desired point in the block
189272cc70bSAndy Fleming 		 */
190272cc70bSAndy Fleming 		offset = (src & (blklen - 1));
191272cc70bSAndy Fleming 		segment_size = MIN(blklen - offset, size);
192272cc70bSAndy Fleming 
193272cc70bSAndy Fleming 		memcpy(dst, buffer + offset, segment_size);
194272cc70bSAndy Fleming 
195272cc70bSAndy Fleming 		dst += segment_size;
196272cc70bSAndy Fleming 		src += segment_size;
197272cc70bSAndy Fleming 		size -= segment_size;
198272cc70bSAndy Fleming 	}
199272cc70bSAndy Fleming 
200272cc70bSAndy Fleming free_buffer:
201272cc70bSAndy Fleming 	free(buffer);
202272cc70bSAndy Fleming 
203272cc70bSAndy Fleming 	return err;
204272cc70bSAndy Fleming }
205272cc70bSAndy Fleming 
206272cc70bSAndy Fleming static ulong mmc_bread(int dev_num, ulong start, lbaint_t blkcnt, void *dst)
207272cc70bSAndy Fleming {
208272cc70bSAndy Fleming 	int err;
209272cc70bSAndy Fleming 	int i;
210272cc70bSAndy Fleming 	struct mmc *mmc = find_mmc_device(dev_num);
211272cc70bSAndy Fleming 
212272cc70bSAndy Fleming 	if (!mmc)
213272cc70bSAndy Fleming 		return 0;
214272cc70bSAndy Fleming 
215272cc70bSAndy Fleming 	/* We always do full block reads from the card */
216272cc70bSAndy Fleming 	err = mmc_set_blocklen(mmc, mmc->read_bl_len);
217272cc70bSAndy Fleming 
218272cc70bSAndy Fleming 	if (err) {
219272cc70bSAndy Fleming 		return 0;
220272cc70bSAndy Fleming 	}
221272cc70bSAndy Fleming 
222272cc70bSAndy Fleming 	for (i = start; i < start + blkcnt; i++, dst += mmc->read_bl_len) {
223272cc70bSAndy Fleming 		err = mmc_read_block(mmc, dst, i);
224272cc70bSAndy Fleming 
225272cc70bSAndy Fleming 		if (err) {
226272cc70bSAndy Fleming 			printf("block read failed: %d\n", err);
227272cc70bSAndy Fleming 			return i - start;
228272cc70bSAndy Fleming 		}
229272cc70bSAndy Fleming 	}
230272cc70bSAndy Fleming 
231272cc70bSAndy Fleming 	return blkcnt;
232272cc70bSAndy Fleming }
233272cc70bSAndy Fleming 
234272cc70bSAndy Fleming int mmc_go_idle(struct mmc* mmc)
235272cc70bSAndy Fleming {
236272cc70bSAndy Fleming 	struct mmc_cmd cmd;
237272cc70bSAndy Fleming 	int err;
238272cc70bSAndy Fleming 
239272cc70bSAndy Fleming 	udelay(1000);
240272cc70bSAndy Fleming 
241272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_GO_IDLE_STATE;
242272cc70bSAndy Fleming 	cmd.cmdarg = 0;
243272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_NONE;
244272cc70bSAndy Fleming 	cmd.flags = 0;
245272cc70bSAndy Fleming 
246272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
247272cc70bSAndy Fleming 
248272cc70bSAndy Fleming 	if (err)
249272cc70bSAndy Fleming 		return err;
250272cc70bSAndy Fleming 
251272cc70bSAndy Fleming 	udelay(2000);
252272cc70bSAndy Fleming 
253272cc70bSAndy Fleming 	return 0;
254272cc70bSAndy Fleming }
255272cc70bSAndy Fleming 
256272cc70bSAndy Fleming int
257272cc70bSAndy Fleming sd_send_op_cond(struct mmc *mmc)
258272cc70bSAndy Fleming {
259272cc70bSAndy Fleming 	int timeout = 1000;
260272cc70bSAndy Fleming 	int err;
261272cc70bSAndy Fleming 	struct mmc_cmd cmd;
262272cc70bSAndy Fleming 
263272cc70bSAndy Fleming 	do {
264272cc70bSAndy Fleming 		cmd.cmdidx = MMC_CMD_APP_CMD;
265272cc70bSAndy Fleming 		cmd.resp_type = MMC_RSP_R1;
266272cc70bSAndy Fleming 		cmd.cmdarg = 0;
267272cc70bSAndy Fleming 		cmd.flags = 0;
268272cc70bSAndy Fleming 
269272cc70bSAndy Fleming 		err = mmc_send_cmd(mmc, &cmd, NULL);
270272cc70bSAndy Fleming 
271272cc70bSAndy Fleming 		if (err)
272272cc70bSAndy Fleming 			return err;
273272cc70bSAndy Fleming 
274272cc70bSAndy Fleming 		cmd.cmdidx = SD_CMD_APP_SEND_OP_COND;
275272cc70bSAndy Fleming 		cmd.resp_type = MMC_RSP_R3;
276272cc70bSAndy Fleming 		cmd.cmdarg = mmc->voltages;
277272cc70bSAndy Fleming 
278272cc70bSAndy Fleming 		if (mmc->version == SD_VERSION_2)
279272cc70bSAndy Fleming 			cmd.cmdarg |= OCR_HCS;
280272cc70bSAndy Fleming 
281272cc70bSAndy Fleming 		err = mmc_send_cmd(mmc, &cmd, NULL);
282272cc70bSAndy Fleming 
283272cc70bSAndy Fleming 		if (err)
284272cc70bSAndy Fleming 			return err;
285272cc70bSAndy Fleming 
286272cc70bSAndy Fleming 		udelay(1000);
287272cc70bSAndy Fleming 	} while ((!(cmd.response[0] & OCR_BUSY)) && timeout--);
288272cc70bSAndy Fleming 
289272cc70bSAndy Fleming 	if (timeout <= 0)
290272cc70bSAndy Fleming 		return UNUSABLE_ERR;
291272cc70bSAndy Fleming 
292272cc70bSAndy Fleming 	if (mmc->version != SD_VERSION_2)
293272cc70bSAndy Fleming 		mmc->version = SD_VERSION_1_0;
294272cc70bSAndy Fleming 
295*998be3ddSRabin Vincent 	mmc->ocr = cmd.response[0];
296272cc70bSAndy Fleming 
297272cc70bSAndy Fleming 	mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
298272cc70bSAndy Fleming 	mmc->rca = 0;
299272cc70bSAndy Fleming 
300272cc70bSAndy Fleming 	return 0;
301272cc70bSAndy Fleming }
302272cc70bSAndy Fleming 
303272cc70bSAndy Fleming int mmc_send_op_cond(struct mmc *mmc)
304272cc70bSAndy Fleming {
305272cc70bSAndy Fleming 	int timeout = 1000;
306272cc70bSAndy Fleming 	struct mmc_cmd cmd;
307272cc70bSAndy Fleming 	int err;
308272cc70bSAndy Fleming 
309272cc70bSAndy Fleming 	/* Some cards seem to need this */
310272cc70bSAndy Fleming 	mmc_go_idle(mmc);
311272cc70bSAndy Fleming 
312272cc70bSAndy Fleming 	do {
313272cc70bSAndy Fleming 		cmd.cmdidx = MMC_CMD_SEND_OP_COND;
314272cc70bSAndy Fleming 		cmd.resp_type = MMC_RSP_R3;
315272cc70bSAndy Fleming 		cmd.cmdarg = OCR_HCS | mmc->voltages;
316272cc70bSAndy Fleming 		cmd.flags = 0;
317272cc70bSAndy Fleming 
318272cc70bSAndy Fleming 		err = mmc_send_cmd(mmc, &cmd, NULL);
319272cc70bSAndy Fleming 
320272cc70bSAndy Fleming 		if (err)
321272cc70bSAndy Fleming 			return err;
322272cc70bSAndy Fleming 
323272cc70bSAndy Fleming 		udelay(1000);
324272cc70bSAndy Fleming 	} while (!(cmd.response[0] & OCR_BUSY) && timeout--);
325272cc70bSAndy Fleming 
326272cc70bSAndy Fleming 	if (timeout <= 0)
327272cc70bSAndy Fleming 		return UNUSABLE_ERR;
328272cc70bSAndy Fleming 
329272cc70bSAndy Fleming 	mmc->version = MMC_VERSION_UNKNOWN;
330*998be3ddSRabin Vincent 	mmc->ocr = cmd.response[0];
331272cc70bSAndy Fleming 
332272cc70bSAndy Fleming 	mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
333272cc70bSAndy Fleming 	mmc->rca = 0;
334272cc70bSAndy Fleming 
335272cc70bSAndy Fleming 	return 0;
336272cc70bSAndy Fleming }
337272cc70bSAndy Fleming 
338272cc70bSAndy Fleming 
339272cc70bSAndy Fleming int mmc_send_ext_csd(struct mmc *mmc, char *ext_csd)
340272cc70bSAndy Fleming {
341272cc70bSAndy Fleming 	struct mmc_cmd cmd;
342272cc70bSAndy Fleming 	struct mmc_data data;
343272cc70bSAndy Fleming 	int err;
344272cc70bSAndy Fleming 
345272cc70bSAndy Fleming 	/* Get the Card Status Register */
346272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_SEND_EXT_CSD;
347272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
348272cc70bSAndy Fleming 	cmd.cmdarg = 0;
349272cc70bSAndy Fleming 	cmd.flags = 0;
350272cc70bSAndy Fleming 
351272cc70bSAndy Fleming 	data.dest = ext_csd;
352272cc70bSAndy Fleming 	data.blocks = 1;
353272cc70bSAndy Fleming 	data.blocksize = 512;
354272cc70bSAndy Fleming 	data.flags = MMC_DATA_READ;
355272cc70bSAndy Fleming 
356272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, &data);
357272cc70bSAndy Fleming 
358272cc70bSAndy Fleming 	return err;
359272cc70bSAndy Fleming }
360272cc70bSAndy Fleming 
361272cc70bSAndy Fleming 
362272cc70bSAndy Fleming int mmc_switch(struct mmc *mmc, u8 set, u8 index, u8 value)
363272cc70bSAndy Fleming {
364272cc70bSAndy Fleming 	struct mmc_cmd cmd;
365272cc70bSAndy Fleming 
366272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_SWITCH;
367272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1b;
368272cc70bSAndy Fleming 	cmd.cmdarg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
369272cc70bSAndy Fleming 		(index << 16) |
370272cc70bSAndy Fleming 		(value << 8);
371272cc70bSAndy Fleming 	cmd.flags = 0;
372272cc70bSAndy Fleming 
373272cc70bSAndy Fleming 	return mmc_send_cmd(mmc, &cmd, NULL);
374272cc70bSAndy Fleming }
375272cc70bSAndy Fleming 
376272cc70bSAndy Fleming int mmc_change_freq(struct mmc *mmc)
377272cc70bSAndy Fleming {
378272cc70bSAndy Fleming 	char ext_csd[512];
379272cc70bSAndy Fleming 	char cardtype;
380272cc70bSAndy Fleming 	int err;
381272cc70bSAndy Fleming 
382272cc70bSAndy Fleming 	mmc->card_caps = 0;
383272cc70bSAndy Fleming 
384272cc70bSAndy Fleming 	/* Only version 4 supports high-speed */
385272cc70bSAndy Fleming 	if (mmc->version < MMC_VERSION_4)
386272cc70bSAndy Fleming 		return 0;
387272cc70bSAndy Fleming 
388272cc70bSAndy Fleming 	mmc->card_caps |= MMC_MODE_4BIT;
389272cc70bSAndy Fleming 
390272cc70bSAndy Fleming 	err = mmc_send_ext_csd(mmc, ext_csd);
391272cc70bSAndy Fleming 
392272cc70bSAndy Fleming 	if (err)
393272cc70bSAndy Fleming 		return err;
394272cc70bSAndy Fleming 
395272cc70bSAndy Fleming 	if (ext_csd[212] || ext_csd[213] || ext_csd[214] || ext_csd[215])
396272cc70bSAndy Fleming 		mmc->high_capacity = 1;
397272cc70bSAndy Fleming 
398272cc70bSAndy Fleming 	cardtype = ext_csd[196] & 0xf;
399272cc70bSAndy Fleming 
400272cc70bSAndy Fleming 	err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_HS_TIMING, 1);
401272cc70bSAndy Fleming 
402272cc70bSAndy Fleming 	if (err)
403272cc70bSAndy Fleming 		return err;
404272cc70bSAndy Fleming 
405272cc70bSAndy Fleming 	/* Now check to see that it worked */
406272cc70bSAndy Fleming 	err = mmc_send_ext_csd(mmc, ext_csd);
407272cc70bSAndy Fleming 
408272cc70bSAndy Fleming 	if (err)
409272cc70bSAndy Fleming 		return err;
410272cc70bSAndy Fleming 
411272cc70bSAndy Fleming 	/* No high-speed support */
412272cc70bSAndy Fleming 	if (!ext_csd[185])
413272cc70bSAndy Fleming 		return 0;
414272cc70bSAndy Fleming 
415272cc70bSAndy Fleming 	/* High Speed is set, there are two types: 52MHz and 26MHz */
416272cc70bSAndy Fleming 	if (cardtype & MMC_HS_52MHZ)
417272cc70bSAndy Fleming 		mmc->card_caps |= MMC_MODE_HS_52MHz | MMC_MODE_HS;
418272cc70bSAndy Fleming 	else
419272cc70bSAndy Fleming 		mmc->card_caps |= MMC_MODE_HS;
420272cc70bSAndy Fleming 
421272cc70bSAndy Fleming 	return 0;
422272cc70bSAndy Fleming }
423272cc70bSAndy Fleming 
424272cc70bSAndy Fleming int sd_switch(struct mmc *mmc, int mode, int group, u8 value, u8 *resp)
425272cc70bSAndy Fleming {
426272cc70bSAndy Fleming 	struct mmc_cmd cmd;
427272cc70bSAndy Fleming 	struct mmc_data data;
428272cc70bSAndy Fleming 
429272cc70bSAndy Fleming 	/* Switch the frequency */
430272cc70bSAndy Fleming 	cmd.cmdidx = SD_CMD_SWITCH_FUNC;
431272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
432272cc70bSAndy Fleming 	cmd.cmdarg = (mode << 31) | 0xffffff;
433272cc70bSAndy Fleming 	cmd.cmdarg &= ~(0xf << (group * 4));
434272cc70bSAndy Fleming 	cmd.cmdarg |= value << (group * 4);
435272cc70bSAndy Fleming 	cmd.flags = 0;
436272cc70bSAndy Fleming 
437272cc70bSAndy Fleming 	data.dest = (char *)resp;
438272cc70bSAndy Fleming 	data.blocksize = 64;
439272cc70bSAndy Fleming 	data.blocks = 1;
440272cc70bSAndy Fleming 	data.flags = MMC_DATA_READ;
441272cc70bSAndy Fleming 
442272cc70bSAndy Fleming 	return mmc_send_cmd(mmc, &cmd, &data);
443272cc70bSAndy Fleming }
444272cc70bSAndy Fleming 
445272cc70bSAndy Fleming 
446272cc70bSAndy Fleming int sd_change_freq(struct mmc *mmc)
447272cc70bSAndy Fleming {
448272cc70bSAndy Fleming 	int err;
449272cc70bSAndy Fleming 	struct mmc_cmd cmd;
450272cc70bSAndy Fleming 	uint scr[2];
451272cc70bSAndy Fleming 	uint switch_status[16];
452272cc70bSAndy Fleming 	struct mmc_data data;
453272cc70bSAndy Fleming 	int timeout;
454272cc70bSAndy Fleming 
455272cc70bSAndy Fleming 	mmc->card_caps = 0;
456272cc70bSAndy Fleming 
457272cc70bSAndy Fleming 	/* Read the SCR to find out if this card supports higher speeds */
458272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_APP_CMD;
459272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
460272cc70bSAndy Fleming 	cmd.cmdarg = mmc->rca << 16;
461272cc70bSAndy Fleming 	cmd.flags = 0;
462272cc70bSAndy Fleming 
463272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
464272cc70bSAndy Fleming 
465272cc70bSAndy Fleming 	if (err)
466272cc70bSAndy Fleming 		return err;
467272cc70bSAndy Fleming 
468272cc70bSAndy Fleming 	cmd.cmdidx = SD_CMD_APP_SEND_SCR;
469272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
470272cc70bSAndy Fleming 	cmd.cmdarg = 0;
471272cc70bSAndy Fleming 	cmd.flags = 0;
472272cc70bSAndy Fleming 
473272cc70bSAndy Fleming 	timeout = 3;
474272cc70bSAndy Fleming 
475272cc70bSAndy Fleming retry_scr:
476272cc70bSAndy Fleming 	data.dest = (char *)&scr;
477272cc70bSAndy Fleming 	data.blocksize = 8;
478272cc70bSAndy Fleming 	data.blocks = 1;
479272cc70bSAndy Fleming 	data.flags = MMC_DATA_READ;
480272cc70bSAndy Fleming 
481272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, &data);
482272cc70bSAndy Fleming 
483272cc70bSAndy Fleming 	if (err) {
484272cc70bSAndy Fleming 		if (timeout--)
485272cc70bSAndy Fleming 			goto retry_scr;
486272cc70bSAndy Fleming 
487272cc70bSAndy Fleming 		return err;
488272cc70bSAndy Fleming 	}
489272cc70bSAndy Fleming 
490272cc70bSAndy Fleming 	mmc->scr[0] = scr[0];
491272cc70bSAndy Fleming 	mmc->scr[1] = scr[1];
492272cc70bSAndy Fleming 
493272cc70bSAndy Fleming 	switch ((mmc->scr[0] >> 24) & 0xf) {
494272cc70bSAndy Fleming 		case 0:
495272cc70bSAndy Fleming 			mmc->version = SD_VERSION_1_0;
496272cc70bSAndy Fleming 			break;
497272cc70bSAndy Fleming 		case 1:
498272cc70bSAndy Fleming 			mmc->version = SD_VERSION_1_10;
499272cc70bSAndy Fleming 			break;
500272cc70bSAndy Fleming 		case 2:
501272cc70bSAndy Fleming 			mmc->version = SD_VERSION_2;
502272cc70bSAndy Fleming 			break;
503272cc70bSAndy Fleming 		default:
504272cc70bSAndy Fleming 			mmc->version = SD_VERSION_1_0;
505272cc70bSAndy Fleming 			break;
506272cc70bSAndy Fleming 	}
507272cc70bSAndy Fleming 
508272cc70bSAndy Fleming 	/* Version 1.0 doesn't support switching */
509272cc70bSAndy Fleming 	if (mmc->version == SD_VERSION_1_0)
510272cc70bSAndy Fleming 		return 0;
511272cc70bSAndy Fleming 
512272cc70bSAndy Fleming 	timeout = 4;
513272cc70bSAndy Fleming 	while (timeout--) {
514272cc70bSAndy Fleming 		err = sd_switch(mmc, SD_SWITCH_CHECK, 0, 1,
515272cc70bSAndy Fleming 				(u8 *)&switch_status);
516272cc70bSAndy Fleming 
517272cc70bSAndy Fleming 		if (err)
518272cc70bSAndy Fleming 			return err;
519272cc70bSAndy Fleming 
520272cc70bSAndy Fleming 		/* The high-speed function is busy.  Try again */
521272cc70bSAndy Fleming 		if (!switch_status[7] & SD_HIGHSPEED_BUSY)
522272cc70bSAndy Fleming 			break;
523272cc70bSAndy Fleming 	}
524272cc70bSAndy Fleming 
525272cc70bSAndy Fleming 	if (mmc->scr[0] & SD_DATA_4BIT)
526272cc70bSAndy Fleming 		mmc->card_caps |= MMC_MODE_4BIT;
527272cc70bSAndy Fleming 
528272cc70bSAndy Fleming 	/* If high-speed isn't supported, we return */
529272cc70bSAndy Fleming 	if (!(switch_status[3] & SD_HIGHSPEED_SUPPORTED))
530272cc70bSAndy Fleming 		return 0;
531272cc70bSAndy Fleming 
532272cc70bSAndy Fleming 	err = sd_switch(mmc, SD_SWITCH_SWITCH, 0, 1, (u8 *)&switch_status);
533272cc70bSAndy Fleming 
534272cc70bSAndy Fleming 	if (err)
535272cc70bSAndy Fleming 		return err;
536272cc70bSAndy Fleming 
537272cc70bSAndy Fleming 	if ((switch_status[4] & 0x0f000000) == 0x01000000)
538272cc70bSAndy Fleming 		mmc->card_caps |= MMC_MODE_HS;
539272cc70bSAndy Fleming 
540272cc70bSAndy Fleming 	return 0;
541272cc70bSAndy Fleming }
542272cc70bSAndy Fleming 
543272cc70bSAndy Fleming /* frequency bases */
544272cc70bSAndy Fleming /* divided by 10 to be nice to platforms without floating point */
545272cc70bSAndy Fleming int fbase[] = {
546272cc70bSAndy Fleming 	10000,
547272cc70bSAndy Fleming 	100000,
548272cc70bSAndy Fleming 	1000000,
549272cc70bSAndy Fleming 	10000000,
550272cc70bSAndy Fleming };
551272cc70bSAndy Fleming 
552272cc70bSAndy Fleming /* Multiplier values for TRAN_SPEED.  Multiplied by 10 to be nice
553272cc70bSAndy Fleming  * to platforms without floating point.
554272cc70bSAndy Fleming  */
555272cc70bSAndy Fleming int multipliers[] = {
556272cc70bSAndy Fleming 	0,	/* reserved */
557272cc70bSAndy Fleming 	10,
558272cc70bSAndy Fleming 	12,
559272cc70bSAndy Fleming 	13,
560272cc70bSAndy Fleming 	15,
561272cc70bSAndy Fleming 	20,
562272cc70bSAndy Fleming 	25,
563272cc70bSAndy Fleming 	30,
564272cc70bSAndy Fleming 	35,
565272cc70bSAndy Fleming 	40,
566272cc70bSAndy Fleming 	45,
567272cc70bSAndy Fleming 	50,
568272cc70bSAndy Fleming 	55,
569272cc70bSAndy Fleming 	60,
570272cc70bSAndy Fleming 	70,
571272cc70bSAndy Fleming 	80,
572272cc70bSAndy Fleming };
573272cc70bSAndy Fleming 
574272cc70bSAndy Fleming void mmc_set_ios(struct mmc *mmc)
575272cc70bSAndy Fleming {
576272cc70bSAndy Fleming 	mmc->set_ios(mmc);
577272cc70bSAndy Fleming }
578272cc70bSAndy Fleming 
579272cc70bSAndy Fleming void mmc_set_clock(struct mmc *mmc, uint clock)
580272cc70bSAndy Fleming {
581272cc70bSAndy Fleming 	if (clock > mmc->f_max)
582272cc70bSAndy Fleming 		clock = mmc->f_max;
583272cc70bSAndy Fleming 
584272cc70bSAndy Fleming 	if (clock < mmc->f_min)
585272cc70bSAndy Fleming 		clock = mmc->f_min;
586272cc70bSAndy Fleming 
587272cc70bSAndy Fleming 	mmc->clock = clock;
588272cc70bSAndy Fleming 
589272cc70bSAndy Fleming 	mmc_set_ios(mmc);
590272cc70bSAndy Fleming }
591272cc70bSAndy Fleming 
592272cc70bSAndy Fleming void mmc_set_bus_width(struct mmc *mmc, uint width)
593272cc70bSAndy Fleming {
594272cc70bSAndy Fleming 	mmc->bus_width = width;
595272cc70bSAndy Fleming 
596272cc70bSAndy Fleming 	mmc_set_ios(mmc);
597272cc70bSAndy Fleming }
598272cc70bSAndy Fleming 
599272cc70bSAndy Fleming int mmc_startup(struct mmc *mmc)
600272cc70bSAndy Fleming {
601272cc70bSAndy Fleming 	int err;
602272cc70bSAndy Fleming 	uint mult, freq;
603272cc70bSAndy Fleming 	u64 cmult, csize;
604272cc70bSAndy Fleming 	struct mmc_cmd cmd;
605272cc70bSAndy Fleming 
606272cc70bSAndy Fleming 	/* Put the Card in Identify Mode */
607272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_ALL_SEND_CID;
608272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R2;
609272cc70bSAndy Fleming 	cmd.cmdarg = 0;
610272cc70bSAndy Fleming 	cmd.flags = 0;
611272cc70bSAndy Fleming 
612272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
613272cc70bSAndy Fleming 
614272cc70bSAndy Fleming 	if (err)
615272cc70bSAndy Fleming 		return err;
616272cc70bSAndy Fleming 
617272cc70bSAndy Fleming 	memcpy(mmc->cid, cmd.response, 16);
618272cc70bSAndy Fleming 
619272cc70bSAndy Fleming 	/*
620272cc70bSAndy Fleming 	 * For MMC cards, set the Relative Address.
621272cc70bSAndy Fleming 	 * For SD cards, get the Relatvie Address.
622272cc70bSAndy Fleming 	 * This also puts the cards into Standby State
623272cc70bSAndy Fleming 	 */
624272cc70bSAndy Fleming 	cmd.cmdidx = SD_CMD_SEND_RELATIVE_ADDR;
625272cc70bSAndy Fleming 	cmd.cmdarg = mmc->rca << 16;
626272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R6;
627272cc70bSAndy Fleming 	cmd.flags = 0;
628272cc70bSAndy Fleming 
629272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
630272cc70bSAndy Fleming 
631272cc70bSAndy Fleming 	if (err)
632272cc70bSAndy Fleming 		return err;
633272cc70bSAndy Fleming 
634272cc70bSAndy Fleming 	if (IS_SD(mmc))
635*998be3ddSRabin Vincent 		mmc->rca = (cmd.response[0] >> 16) & 0xffff;
636272cc70bSAndy Fleming 
637272cc70bSAndy Fleming 	/* Get the Card-Specific Data */
638272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_SEND_CSD;
639272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R2;
640272cc70bSAndy Fleming 	cmd.cmdarg = mmc->rca << 16;
641272cc70bSAndy Fleming 	cmd.flags = 0;
642272cc70bSAndy Fleming 
643272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
644272cc70bSAndy Fleming 
645272cc70bSAndy Fleming 	if (err)
646272cc70bSAndy Fleming 		return err;
647272cc70bSAndy Fleming 
648*998be3ddSRabin Vincent 	mmc->csd[0] = cmd.response[0];
649*998be3ddSRabin Vincent 	mmc->csd[1] = cmd.response[1];
650*998be3ddSRabin Vincent 	mmc->csd[2] = cmd.response[2];
651*998be3ddSRabin Vincent 	mmc->csd[3] = cmd.response[3];
652272cc70bSAndy Fleming 
653272cc70bSAndy Fleming 	if (mmc->version == MMC_VERSION_UNKNOWN) {
6540b453ffeSRabin Vincent 		int version = (cmd.response[0] >> 26) & 0xf;
655272cc70bSAndy Fleming 
656272cc70bSAndy Fleming 		switch (version) {
657272cc70bSAndy Fleming 			case 0:
658272cc70bSAndy Fleming 				mmc->version = MMC_VERSION_1_2;
659272cc70bSAndy Fleming 				break;
660272cc70bSAndy Fleming 			case 1:
661272cc70bSAndy Fleming 				mmc->version = MMC_VERSION_1_4;
662272cc70bSAndy Fleming 				break;
663272cc70bSAndy Fleming 			case 2:
664272cc70bSAndy Fleming 				mmc->version = MMC_VERSION_2_2;
665272cc70bSAndy Fleming 				break;
666272cc70bSAndy Fleming 			case 3:
667272cc70bSAndy Fleming 				mmc->version = MMC_VERSION_3;
668272cc70bSAndy Fleming 				break;
669272cc70bSAndy Fleming 			case 4:
670272cc70bSAndy Fleming 				mmc->version = MMC_VERSION_4;
671272cc70bSAndy Fleming 				break;
672272cc70bSAndy Fleming 			default:
673272cc70bSAndy Fleming 				mmc->version = MMC_VERSION_1_2;
674272cc70bSAndy Fleming 				break;
675272cc70bSAndy Fleming 		}
676272cc70bSAndy Fleming 	}
677272cc70bSAndy Fleming 
678272cc70bSAndy Fleming 	/* divide frequency by 10, since the mults are 10x bigger */
6790b453ffeSRabin Vincent 	freq = fbase[(cmd.response[0] & 0x7)];
6800b453ffeSRabin Vincent 	mult = multipliers[((cmd.response[0] >> 3) & 0xf)];
681272cc70bSAndy Fleming 
682272cc70bSAndy Fleming 	mmc->tran_speed = freq * mult;
683272cc70bSAndy Fleming 
684*998be3ddSRabin Vincent 	mmc->read_bl_len = 1 << ((cmd.response[1] >> 16) & 0xf);
685272cc70bSAndy Fleming 
686272cc70bSAndy Fleming 	if (IS_SD(mmc))
687272cc70bSAndy Fleming 		mmc->write_bl_len = mmc->read_bl_len;
688272cc70bSAndy Fleming 	else
689*998be3ddSRabin Vincent 		mmc->write_bl_len = 1 << ((cmd.response[3] >> 22) & 0xf);
690272cc70bSAndy Fleming 
691272cc70bSAndy Fleming 	if (mmc->high_capacity) {
692272cc70bSAndy Fleming 		csize = (mmc->csd[1] & 0x3f) << 16
693272cc70bSAndy Fleming 			| (mmc->csd[2] & 0xffff0000) >> 16;
694272cc70bSAndy Fleming 		cmult = 8;
695272cc70bSAndy Fleming 	} else {
696272cc70bSAndy Fleming 		csize = (mmc->csd[1] & 0x3ff) << 2
697272cc70bSAndy Fleming 			| (mmc->csd[2] & 0xc0000000) >> 30;
698272cc70bSAndy Fleming 		cmult = (mmc->csd[2] & 0x00038000) >> 15;
699272cc70bSAndy Fleming 	}
700272cc70bSAndy Fleming 
701272cc70bSAndy Fleming 	mmc->capacity = (csize + 1) << (cmult + 2);
702272cc70bSAndy Fleming 	mmc->capacity *= mmc->read_bl_len;
703272cc70bSAndy Fleming 
704272cc70bSAndy Fleming 	if (mmc->read_bl_len > 512)
705272cc70bSAndy Fleming 		mmc->read_bl_len = 512;
706272cc70bSAndy Fleming 
707272cc70bSAndy Fleming 	if (mmc->write_bl_len > 512)
708272cc70bSAndy Fleming 		mmc->write_bl_len = 512;
709272cc70bSAndy Fleming 
710272cc70bSAndy Fleming 	/* Select the card, and put it into Transfer Mode */
711272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_SELECT_CARD;
712272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1b;
713272cc70bSAndy Fleming 	cmd.cmdarg = mmc->rca << 16;
714272cc70bSAndy Fleming 	cmd.flags = 0;
715272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
716272cc70bSAndy Fleming 
717272cc70bSAndy Fleming 	if (err)
718272cc70bSAndy Fleming 		return err;
719272cc70bSAndy Fleming 
720272cc70bSAndy Fleming 	if (IS_SD(mmc))
721272cc70bSAndy Fleming 		err = sd_change_freq(mmc);
722272cc70bSAndy Fleming 	else
723272cc70bSAndy Fleming 		err = mmc_change_freq(mmc);
724272cc70bSAndy Fleming 
725272cc70bSAndy Fleming 	if (err)
726272cc70bSAndy Fleming 		return err;
727272cc70bSAndy Fleming 
728272cc70bSAndy Fleming 	/* Restrict card's capabilities by what the host can do */
729272cc70bSAndy Fleming 	mmc->card_caps &= mmc->host_caps;
730272cc70bSAndy Fleming 
731272cc70bSAndy Fleming 	if (IS_SD(mmc)) {
732272cc70bSAndy Fleming 		if (mmc->card_caps & MMC_MODE_4BIT) {
733272cc70bSAndy Fleming 			cmd.cmdidx = MMC_CMD_APP_CMD;
734272cc70bSAndy Fleming 			cmd.resp_type = MMC_RSP_R1;
735272cc70bSAndy Fleming 			cmd.cmdarg = mmc->rca << 16;
736272cc70bSAndy Fleming 			cmd.flags = 0;
737272cc70bSAndy Fleming 
738272cc70bSAndy Fleming 			err = mmc_send_cmd(mmc, &cmd, NULL);
739272cc70bSAndy Fleming 			if (err)
740272cc70bSAndy Fleming 				return err;
741272cc70bSAndy Fleming 
742272cc70bSAndy Fleming 			cmd.cmdidx = SD_CMD_APP_SET_BUS_WIDTH;
743272cc70bSAndy Fleming 			cmd.resp_type = MMC_RSP_R1;
744272cc70bSAndy Fleming 			cmd.cmdarg = 2;
745272cc70bSAndy Fleming 			cmd.flags = 0;
746272cc70bSAndy Fleming 			err = mmc_send_cmd(mmc, &cmd, NULL);
747272cc70bSAndy Fleming 			if (err)
748272cc70bSAndy Fleming 				return err;
749272cc70bSAndy Fleming 
750272cc70bSAndy Fleming 			mmc_set_bus_width(mmc, 4);
751272cc70bSAndy Fleming 		}
752272cc70bSAndy Fleming 
753272cc70bSAndy Fleming 		if (mmc->card_caps & MMC_MODE_HS)
754272cc70bSAndy Fleming 			mmc_set_clock(mmc, 50000000);
755272cc70bSAndy Fleming 		else
756272cc70bSAndy Fleming 			mmc_set_clock(mmc, 25000000);
757272cc70bSAndy Fleming 	} else {
758272cc70bSAndy Fleming 		if (mmc->card_caps & MMC_MODE_4BIT) {
759272cc70bSAndy Fleming 			/* Set the card to use 4 bit*/
760272cc70bSAndy Fleming 			err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
761272cc70bSAndy Fleming 					EXT_CSD_BUS_WIDTH,
762272cc70bSAndy Fleming 					EXT_CSD_BUS_WIDTH_4);
763272cc70bSAndy Fleming 
764272cc70bSAndy Fleming 			if (err)
765272cc70bSAndy Fleming 				return err;
766272cc70bSAndy Fleming 
767272cc70bSAndy Fleming 			mmc_set_bus_width(mmc, 4);
768272cc70bSAndy Fleming 		} else if (mmc->card_caps & MMC_MODE_8BIT) {
769272cc70bSAndy Fleming 			/* Set the card to use 8 bit*/
770272cc70bSAndy Fleming 			err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
771272cc70bSAndy Fleming 					EXT_CSD_BUS_WIDTH,
772272cc70bSAndy Fleming 					EXT_CSD_BUS_WIDTH_8);
773272cc70bSAndy Fleming 
774272cc70bSAndy Fleming 			if (err)
775272cc70bSAndy Fleming 				return err;
776272cc70bSAndy Fleming 
777272cc70bSAndy Fleming 			mmc_set_bus_width(mmc, 8);
778272cc70bSAndy Fleming 		}
779272cc70bSAndy Fleming 
780272cc70bSAndy Fleming 		if (mmc->card_caps & MMC_MODE_HS) {
781272cc70bSAndy Fleming 			if (mmc->card_caps & MMC_MODE_HS_52MHz)
782272cc70bSAndy Fleming 				mmc_set_clock(mmc, 52000000);
783272cc70bSAndy Fleming 			else
784272cc70bSAndy Fleming 				mmc_set_clock(mmc, 26000000);
785272cc70bSAndy Fleming 		} else
786272cc70bSAndy Fleming 			mmc_set_clock(mmc, 20000000);
787272cc70bSAndy Fleming 	}
788272cc70bSAndy Fleming 
789272cc70bSAndy Fleming 	/* fill in device description */
790272cc70bSAndy Fleming 	mmc->block_dev.lun = 0;
791272cc70bSAndy Fleming 	mmc->block_dev.type = 0;
792272cc70bSAndy Fleming 	mmc->block_dev.blksz = mmc->read_bl_len;
7939b1f942cSRabin Vincent 	mmc->block_dev.lba = lldiv(mmc->capacity, mmc->read_bl_len);
7940b453ffeSRabin Vincent 	sprintf(mmc->block_dev.vendor, "Man %06x Snr %08x", mmc->cid[0] >> 8,
7950b453ffeSRabin Vincent 			(mmc->cid[2] << 8) | (mmc->cid[3] >> 24));
7960b453ffeSRabin Vincent 	sprintf(mmc->block_dev.product, "%c%c%c%c%c", mmc->cid[0] & 0xff,
7970b453ffeSRabin Vincent 			(mmc->cid[1] >> 24), (mmc->cid[1] >> 16) & 0xff,
7980b453ffeSRabin Vincent 			(mmc->cid[1] >> 8) & 0xff, mmc->cid[1] & 0xff);
7990b453ffeSRabin Vincent 	sprintf(mmc->block_dev.revision, "%d.%d", mmc->cid[2] >> 28,
8000b453ffeSRabin Vincent 			(mmc->cid[2] >> 24) & 0xf);
801272cc70bSAndy Fleming 	init_part(&mmc->block_dev);
802272cc70bSAndy Fleming 
803272cc70bSAndy Fleming 	return 0;
804272cc70bSAndy Fleming }
805272cc70bSAndy Fleming 
806272cc70bSAndy Fleming int mmc_send_if_cond(struct mmc *mmc)
807272cc70bSAndy Fleming {
808272cc70bSAndy Fleming 	struct mmc_cmd cmd;
809272cc70bSAndy Fleming 	int err;
810272cc70bSAndy Fleming 
811272cc70bSAndy Fleming 	cmd.cmdidx = SD_CMD_SEND_IF_COND;
812272cc70bSAndy Fleming 	/* We set the bit if the host supports voltages between 2.7 and 3.6 V */
813272cc70bSAndy Fleming 	cmd.cmdarg = ((mmc->voltages & 0xff8000) != 0) << 8 | 0xaa;
814272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R7;
815272cc70bSAndy Fleming 	cmd.flags = 0;
816272cc70bSAndy Fleming 
817272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
818272cc70bSAndy Fleming 
819272cc70bSAndy Fleming 	if (err)
820272cc70bSAndy Fleming 		return err;
821272cc70bSAndy Fleming 
822*998be3ddSRabin Vincent 	if ((cmd.response[0] & 0xff) != 0xaa)
823272cc70bSAndy Fleming 		return UNUSABLE_ERR;
824272cc70bSAndy Fleming 	else
825272cc70bSAndy Fleming 		mmc->version = SD_VERSION_2;
826272cc70bSAndy Fleming 
827272cc70bSAndy Fleming 	return 0;
828272cc70bSAndy Fleming }
829272cc70bSAndy Fleming 
830272cc70bSAndy Fleming int mmc_register(struct mmc *mmc)
831272cc70bSAndy Fleming {
832272cc70bSAndy Fleming 	/* Setup the universal parts of the block interface just once */
833272cc70bSAndy Fleming 	mmc->block_dev.if_type = IF_TYPE_MMC;
834272cc70bSAndy Fleming 	mmc->block_dev.dev = cur_dev_num++;
835272cc70bSAndy Fleming 	mmc->block_dev.removable = 1;
836272cc70bSAndy Fleming 	mmc->block_dev.block_read = mmc_bread;
837272cc70bSAndy Fleming 	mmc->block_dev.block_write = mmc_bwrite;
838272cc70bSAndy Fleming 
839272cc70bSAndy Fleming 	INIT_LIST_HEAD (&mmc->link);
840272cc70bSAndy Fleming 
841272cc70bSAndy Fleming 	list_add_tail (&mmc->link, &mmc_devices);
842272cc70bSAndy Fleming 
843272cc70bSAndy Fleming 	return 0;
844272cc70bSAndy Fleming }
845272cc70bSAndy Fleming 
846272cc70bSAndy Fleming block_dev_desc_t *mmc_get_dev(int dev)
847272cc70bSAndy Fleming {
848272cc70bSAndy Fleming 	struct mmc *mmc = find_mmc_device(dev);
849272cc70bSAndy Fleming 
850e85649c7SRabin Vincent 	return mmc ? &mmc->block_dev : NULL;
851272cc70bSAndy Fleming }
852272cc70bSAndy Fleming 
853272cc70bSAndy Fleming int mmc_init(struct mmc *mmc)
854272cc70bSAndy Fleming {
855272cc70bSAndy Fleming 	int err;
856272cc70bSAndy Fleming 
857272cc70bSAndy Fleming 	err = mmc->init(mmc);
858272cc70bSAndy Fleming 
859272cc70bSAndy Fleming 	if (err)
860272cc70bSAndy Fleming 		return err;
861272cc70bSAndy Fleming 
862272cc70bSAndy Fleming 	/* Reset the Card */
863272cc70bSAndy Fleming 	err = mmc_go_idle(mmc);
864272cc70bSAndy Fleming 
865272cc70bSAndy Fleming 	if (err)
866272cc70bSAndy Fleming 		return err;
867272cc70bSAndy Fleming 
868272cc70bSAndy Fleming 	/* Test for SD version 2 */
869272cc70bSAndy Fleming 	err = mmc_send_if_cond(mmc);
870272cc70bSAndy Fleming 
871272cc70bSAndy Fleming 	/* If we got an error other than timeout, we bail */
872272cc70bSAndy Fleming 	if (err && err != TIMEOUT)
873272cc70bSAndy Fleming 		return err;
874272cc70bSAndy Fleming 
875272cc70bSAndy Fleming 	/* Now try to get the SD card's operating condition */
876272cc70bSAndy Fleming 	err = sd_send_op_cond(mmc);
877272cc70bSAndy Fleming 
878272cc70bSAndy Fleming 	/* If the command timed out, we check for an MMC card */
879272cc70bSAndy Fleming 	if (err == TIMEOUT) {
880272cc70bSAndy Fleming 		err = mmc_send_op_cond(mmc);
881272cc70bSAndy Fleming 
882272cc70bSAndy Fleming 		if (err) {
883272cc70bSAndy Fleming 			printf("Card did not respond to voltage select!\n");
884272cc70bSAndy Fleming 			return UNUSABLE_ERR;
885272cc70bSAndy Fleming 		}
886272cc70bSAndy Fleming 	}
887272cc70bSAndy Fleming 
888272cc70bSAndy Fleming 	return mmc_startup(mmc);
889272cc70bSAndy Fleming }
890272cc70bSAndy Fleming 
891272cc70bSAndy Fleming /*
892272cc70bSAndy Fleming  * CPU and board-specific MMC initializations.  Aliased function
893272cc70bSAndy Fleming  * signals caller to move on
894272cc70bSAndy Fleming  */
895272cc70bSAndy Fleming static int __def_mmc_init(bd_t *bis)
896272cc70bSAndy Fleming {
897272cc70bSAndy Fleming 	return -1;
898272cc70bSAndy Fleming }
899272cc70bSAndy Fleming 
900f9a109b3SPeter Tyser int cpu_mmc_init(bd_t *bis) __attribute__((weak, alias("__def_mmc_init")));
901f9a109b3SPeter Tyser int board_mmc_init(bd_t *bis) __attribute__((weak, alias("__def_mmc_init")));
902272cc70bSAndy Fleming 
903272cc70bSAndy Fleming void print_mmc_devices(char separator)
904272cc70bSAndy Fleming {
905272cc70bSAndy Fleming 	struct mmc *m;
906272cc70bSAndy Fleming 	struct list_head *entry;
907272cc70bSAndy Fleming 
908272cc70bSAndy Fleming 	list_for_each(entry, &mmc_devices) {
909272cc70bSAndy Fleming 		m = list_entry(entry, struct mmc, link);
910272cc70bSAndy Fleming 
911272cc70bSAndy Fleming 		printf("%s: %d", m->name, m->block_dev.dev);
912272cc70bSAndy Fleming 
913272cc70bSAndy Fleming 		if (entry->next != &mmc_devices)
914272cc70bSAndy Fleming 			printf("%c ", separator);
915272cc70bSAndy Fleming 	}
916272cc70bSAndy Fleming 
917272cc70bSAndy Fleming 	printf("\n");
918272cc70bSAndy Fleming }
919272cc70bSAndy Fleming 
920272cc70bSAndy Fleming int mmc_initialize(bd_t *bis)
921272cc70bSAndy Fleming {
922272cc70bSAndy Fleming 	INIT_LIST_HEAD (&mmc_devices);
923272cc70bSAndy Fleming 	cur_dev_num = 0;
924272cc70bSAndy Fleming 
925272cc70bSAndy Fleming 	if (board_mmc_init(bis) < 0)
926272cc70bSAndy Fleming 		cpu_mmc_init(bis);
927272cc70bSAndy Fleming 
928272cc70bSAndy Fleming 	print_mmc_devices(',');
929272cc70bSAndy Fleming 
930272cc70bSAndy Fleming 	return 0;
931272cc70bSAndy Fleming }
932