xref: /openbmc/u-boot/drivers/mmc/mmc.c (revision 4a1a06bc8b21c6787a22458142e3ca3c06935517)
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 
3911fdade2SStefano Babic int __board_mmc_getcd(u8 *cd, struct mmc *mmc) {
4011fdade2SStefano Babic 	return -1;
4111fdade2SStefano Babic }
4211fdade2SStefano Babic 
4311fdade2SStefano Babic int board_mmc_getcd(u8 *cd, struct mmc *mmc)__attribute__((weak,
4411fdade2SStefano Babic 	alias("__board_mmc_getcd")));
4511fdade2SStefano Babic 
46272cc70bSAndy Fleming int mmc_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd, struct mmc_data *data)
47272cc70bSAndy Fleming {
48272cc70bSAndy Fleming 	return mmc->send_cmd(mmc, cmd, data);
49272cc70bSAndy Fleming }
50272cc70bSAndy Fleming 
51272cc70bSAndy Fleming int mmc_set_blocklen(struct mmc *mmc, int len)
52272cc70bSAndy Fleming {
53272cc70bSAndy Fleming 	struct mmc_cmd cmd;
54272cc70bSAndy Fleming 
55272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_SET_BLOCKLEN;
56272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
57272cc70bSAndy Fleming 	cmd.cmdarg = len;
58272cc70bSAndy Fleming 	cmd.flags = 0;
59272cc70bSAndy Fleming 
60272cc70bSAndy Fleming 	return mmc_send_cmd(mmc, &cmd, NULL);
61272cc70bSAndy Fleming }
62272cc70bSAndy Fleming 
63272cc70bSAndy Fleming struct mmc *find_mmc_device(int dev_num)
64272cc70bSAndy Fleming {
65272cc70bSAndy Fleming 	struct mmc *m;
66272cc70bSAndy Fleming 	struct list_head *entry;
67272cc70bSAndy Fleming 
68272cc70bSAndy Fleming 	list_for_each(entry, &mmc_devices) {
69272cc70bSAndy Fleming 		m = list_entry(entry, struct mmc, link);
70272cc70bSAndy Fleming 
71272cc70bSAndy Fleming 		if (m->block_dev.dev == dev_num)
72272cc70bSAndy Fleming 			return m;
73272cc70bSAndy Fleming 	}
74272cc70bSAndy Fleming 
75272cc70bSAndy Fleming 	printf("MMC Device %d not found\n", dev_num);
76272cc70bSAndy Fleming 
77272cc70bSAndy Fleming 	return NULL;
78272cc70bSAndy Fleming }
79272cc70bSAndy Fleming 
80272cc70bSAndy Fleming static ulong
810158126eSLei Wen mmc_write_blocks(struct mmc *mmc, ulong start, lbaint_t blkcnt, const void*src)
82272cc70bSAndy Fleming {
83272cc70bSAndy Fleming 	struct mmc_cmd cmd;
84272cc70bSAndy Fleming 	struct mmc_data data;
85272cc70bSAndy Fleming 
86d2bf29e3SLei Wen 	if ((start + blkcnt) > mmc->block_dev.lba) {
87def412b6SSteve Sakoman 		printf("MMC: block number 0x%lx exceeds max(0x%lx)\n",
88d2bf29e3SLei Wen 			start + blkcnt, mmc->block_dev.lba);
89d2bf29e3SLei Wen 		return 0;
90d2bf29e3SLei Wen 	}
91272cc70bSAndy Fleming 
92272cc70bSAndy Fleming 	if (blkcnt > 1)
93272cc70bSAndy Fleming 		cmd.cmdidx = MMC_CMD_WRITE_MULTIPLE_BLOCK;
94272cc70bSAndy Fleming 	else
95272cc70bSAndy Fleming 		cmd.cmdidx = MMC_CMD_WRITE_SINGLE_BLOCK;
96272cc70bSAndy Fleming 
97272cc70bSAndy Fleming 	if (mmc->high_capacity)
98272cc70bSAndy Fleming 		cmd.cmdarg = start;
99272cc70bSAndy Fleming 	else
100def412b6SSteve Sakoman 		cmd.cmdarg = start * mmc->write_bl_len;
101272cc70bSAndy Fleming 
102272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
103272cc70bSAndy Fleming 	cmd.flags = 0;
104272cc70bSAndy Fleming 
105272cc70bSAndy Fleming 	data.src = src;
106272cc70bSAndy Fleming 	data.blocks = blkcnt;
107def412b6SSteve Sakoman 	data.blocksize = mmc->write_bl_len;
108272cc70bSAndy Fleming 	data.flags = MMC_DATA_WRITE;
109272cc70bSAndy Fleming 
110def412b6SSteve Sakoman 	if (mmc_send_cmd(mmc, &cmd, &data)) {
111def412b6SSteve Sakoman 		printf("mmc write failed\n");
112def412b6SSteve Sakoman 		return 0;
113272cc70bSAndy Fleming 	}
114272cc70bSAndy Fleming 
115272cc70bSAndy Fleming 	if (blkcnt > 1) {
116272cc70bSAndy Fleming 		cmd.cmdidx = MMC_CMD_STOP_TRANSMISSION;
117272cc70bSAndy Fleming 		cmd.cmdarg = 0;
118272cc70bSAndy Fleming 		cmd.resp_type = MMC_RSP_R1b;
119272cc70bSAndy Fleming 		cmd.flags = 0;
120def412b6SSteve Sakoman 		if (mmc_send_cmd(mmc, &cmd, NULL)) {
121def412b6SSteve Sakoman 			printf("mmc fail to send stop cmd\n");
122def412b6SSteve Sakoman 			return 0;
123272cc70bSAndy Fleming 		}
1240158126eSLei Wen 	}
1250158126eSLei Wen 
1260158126eSLei Wen 	return blkcnt;
1270158126eSLei Wen }
1280158126eSLei Wen 
1290158126eSLei Wen static ulong
1300158126eSLei Wen mmc_bwrite(int dev_num, ulong start, lbaint_t blkcnt, const void*src)
1310158126eSLei Wen {
1320158126eSLei Wen 	lbaint_t cur, blocks_todo = blkcnt;
1330158126eSLei Wen 
134def412b6SSteve Sakoman 	struct mmc *mmc = find_mmc_device(dev_num);
1350158126eSLei Wen 	if (!mmc)
136def412b6SSteve Sakoman 		return 0;
1370158126eSLei Wen 
138def412b6SSteve Sakoman 	if (mmc_set_blocklen(mmc, mmc->write_bl_len))
139def412b6SSteve Sakoman 		return 0;
1400158126eSLei Wen 
1410158126eSLei Wen 	do {
1420158126eSLei Wen 		/*
1430158126eSLei Wen 		 * The 65535 constraint comes from some hardware has
1440158126eSLei Wen 		 * only 16 bit width block number counter
1450158126eSLei Wen 		 */
1460158126eSLei Wen 		cur = (blocks_todo > 65535) ? 65535 : blocks_todo;
1470158126eSLei Wen 		if(mmc_write_blocks(mmc, start, cur, src) != cur)
148def412b6SSteve Sakoman 			return 0;
1490158126eSLei Wen 		blocks_todo -= cur;
1500158126eSLei Wen 		start += cur;
1510158126eSLei Wen 		src += cur * mmc->write_bl_len;
1520158126eSLei Wen 	} while (blocks_todo > 0);
153272cc70bSAndy Fleming 
154272cc70bSAndy Fleming 	return blkcnt;
155272cc70bSAndy Fleming }
156272cc70bSAndy Fleming 
157*4a1a06bcSAlagu Sankar int mmc_read_blocks(struct mmc *mmc, void *dst, ulong start, lbaint_t blkcnt)
158272cc70bSAndy Fleming {
159272cc70bSAndy Fleming 	struct mmc_cmd cmd;
160272cc70bSAndy Fleming 	struct mmc_data data;
161272cc70bSAndy Fleming 
162*4a1a06bcSAlagu Sankar 	if (blkcnt > 1)
163*4a1a06bcSAlagu Sankar 		cmd.cmdidx = MMC_CMD_READ_MULTIPLE_BLOCK;
164*4a1a06bcSAlagu Sankar 	else
165272cc70bSAndy Fleming 		cmd.cmdidx = MMC_CMD_READ_SINGLE_BLOCK;
166272cc70bSAndy Fleming 
167272cc70bSAndy Fleming 	if (mmc->high_capacity)
168*4a1a06bcSAlagu Sankar 		cmd.cmdarg = start;
169272cc70bSAndy Fleming 	else
170*4a1a06bcSAlagu Sankar 		cmd.cmdarg = start * mmc->read_bl_len;
171272cc70bSAndy Fleming 
172272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
173272cc70bSAndy Fleming 	cmd.flags = 0;
174272cc70bSAndy Fleming 
175272cc70bSAndy Fleming 	data.dest = dst;
176*4a1a06bcSAlagu Sankar 	data.blocks = blkcnt;
177272cc70bSAndy Fleming 	data.blocksize = mmc->read_bl_len;
178272cc70bSAndy Fleming 	data.flags = MMC_DATA_READ;
179272cc70bSAndy Fleming 
180*4a1a06bcSAlagu Sankar 	if (mmc_send_cmd(mmc, &cmd, &data))
181*4a1a06bcSAlagu Sankar 		return 0;
182*4a1a06bcSAlagu Sankar 
183*4a1a06bcSAlagu Sankar 	if (blkcnt > 1) {
184*4a1a06bcSAlagu Sankar 		cmd.cmdidx = MMC_CMD_STOP_TRANSMISSION;
185*4a1a06bcSAlagu Sankar 		cmd.cmdarg = 0;
186*4a1a06bcSAlagu Sankar 		cmd.resp_type = MMC_RSP_R1b;
187*4a1a06bcSAlagu Sankar 		cmd.flags = 0;
188*4a1a06bcSAlagu Sankar 		if (mmc_send_cmd(mmc, &cmd, NULL)) {
189*4a1a06bcSAlagu Sankar 			printf("mmc fail to send stop cmd\n");
190*4a1a06bcSAlagu Sankar 			return 0;
191*4a1a06bcSAlagu Sankar 		}
192272cc70bSAndy Fleming 	}
193272cc70bSAndy Fleming 
194*4a1a06bcSAlagu Sankar 	return blkcnt;
195272cc70bSAndy Fleming }
196272cc70bSAndy Fleming 
197272cc70bSAndy Fleming static ulong mmc_bread(int dev_num, ulong start, lbaint_t blkcnt, void *dst)
198272cc70bSAndy Fleming {
199*4a1a06bcSAlagu Sankar 	lbaint_t cur, blocks_todo = blkcnt;
200272cc70bSAndy Fleming 
201*4a1a06bcSAlagu Sankar 	if (blkcnt == 0)
202*4a1a06bcSAlagu Sankar 		return 0;
203*4a1a06bcSAlagu Sankar 
204*4a1a06bcSAlagu Sankar 	struct mmc *mmc = find_mmc_device(dev_num);
205272cc70bSAndy Fleming 	if (!mmc)
206272cc70bSAndy Fleming 		return 0;
207272cc70bSAndy Fleming 
208d2bf29e3SLei Wen 	if ((start + blkcnt) > mmc->block_dev.lba) {
209*4a1a06bcSAlagu Sankar 		printf("MMC: block number 0x%lx exceeds max(0x%lx)\n",
210d2bf29e3SLei Wen 			start + blkcnt, mmc->block_dev.lba);
211d2bf29e3SLei Wen 		return 0;
212d2bf29e3SLei Wen 	}
213272cc70bSAndy Fleming 
214*4a1a06bcSAlagu Sankar 	if (mmc_set_blocklen(mmc, mmc->read_bl_len))
215272cc70bSAndy Fleming 		return 0;
216272cc70bSAndy Fleming 
217*4a1a06bcSAlagu Sankar 	do {
218*4a1a06bcSAlagu Sankar 		/*
219*4a1a06bcSAlagu Sankar 		 * The 65535 constraint comes from some hardware has
220*4a1a06bcSAlagu Sankar 		 * only 16 bit width block number counter
221*4a1a06bcSAlagu Sankar 		 */
222*4a1a06bcSAlagu Sankar 		cur = (blocks_todo > 65535) ? 65535 : blocks_todo;
223*4a1a06bcSAlagu Sankar 		if(mmc_read_blocks(mmc, dst, start, cur) != cur)
224*4a1a06bcSAlagu Sankar 			return 0;
225*4a1a06bcSAlagu Sankar 		blocks_todo -= cur;
226*4a1a06bcSAlagu Sankar 		start += cur;
227*4a1a06bcSAlagu Sankar 		dst += cur * mmc->read_bl_len;
228*4a1a06bcSAlagu Sankar 	} while (blocks_todo > 0);
229272cc70bSAndy Fleming 
230272cc70bSAndy Fleming 	return blkcnt;
231272cc70bSAndy Fleming }
232272cc70bSAndy Fleming 
233272cc70bSAndy Fleming int mmc_go_idle(struct mmc* mmc)
234272cc70bSAndy Fleming {
235272cc70bSAndy Fleming 	struct mmc_cmd cmd;
236272cc70bSAndy Fleming 	int err;
237272cc70bSAndy Fleming 
238272cc70bSAndy Fleming 	udelay(1000);
239272cc70bSAndy Fleming 
240272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_GO_IDLE_STATE;
241272cc70bSAndy Fleming 	cmd.cmdarg = 0;
242272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_NONE;
243272cc70bSAndy Fleming 	cmd.flags = 0;
244272cc70bSAndy Fleming 
245272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
246272cc70bSAndy Fleming 
247272cc70bSAndy Fleming 	if (err)
248272cc70bSAndy Fleming 		return err;
249272cc70bSAndy Fleming 
250272cc70bSAndy Fleming 	udelay(2000);
251272cc70bSAndy Fleming 
252272cc70bSAndy Fleming 	return 0;
253272cc70bSAndy Fleming }
254272cc70bSAndy Fleming 
255272cc70bSAndy Fleming int
256272cc70bSAndy Fleming sd_send_op_cond(struct mmc *mmc)
257272cc70bSAndy Fleming {
258272cc70bSAndy Fleming 	int timeout = 1000;
259272cc70bSAndy Fleming 	int err;
260272cc70bSAndy Fleming 	struct mmc_cmd cmd;
261272cc70bSAndy Fleming 
262272cc70bSAndy Fleming 	do {
263272cc70bSAndy Fleming 		cmd.cmdidx = MMC_CMD_APP_CMD;
264272cc70bSAndy Fleming 		cmd.resp_type = MMC_RSP_R1;
265272cc70bSAndy Fleming 		cmd.cmdarg = 0;
266272cc70bSAndy Fleming 		cmd.flags = 0;
267272cc70bSAndy Fleming 
268272cc70bSAndy Fleming 		err = mmc_send_cmd(mmc, &cmd, NULL);
269272cc70bSAndy Fleming 
270272cc70bSAndy Fleming 		if (err)
271272cc70bSAndy Fleming 			return err;
272272cc70bSAndy Fleming 
273272cc70bSAndy Fleming 		cmd.cmdidx = SD_CMD_APP_SEND_OP_COND;
274272cc70bSAndy Fleming 		cmd.resp_type = MMC_RSP_R3;
275250de12bSStefano Babic 
276250de12bSStefano Babic 		/*
277250de12bSStefano Babic 		 * Most cards do not answer if some reserved bits
278250de12bSStefano Babic 		 * in the ocr are set. However, Some controller
279250de12bSStefano Babic 		 * can set bit 7 (reserved for low voltages), but
280250de12bSStefano Babic 		 * how to manage low voltages SD card is not yet
281250de12bSStefano Babic 		 * specified.
282250de12bSStefano Babic 		 */
283250de12bSStefano Babic 		cmd.cmdarg = mmc->voltages & 0xff8000;
284272cc70bSAndy Fleming 
285272cc70bSAndy Fleming 		if (mmc->version == SD_VERSION_2)
286272cc70bSAndy Fleming 			cmd.cmdarg |= OCR_HCS;
287272cc70bSAndy Fleming 
288272cc70bSAndy Fleming 		err = mmc_send_cmd(mmc, &cmd, NULL);
289272cc70bSAndy Fleming 
290272cc70bSAndy Fleming 		if (err)
291272cc70bSAndy Fleming 			return err;
292272cc70bSAndy Fleming 
293272cc70bSAndy Fleming 		udelay(1000);
294272cc70bSAndy Fleming 	} while ((!(cmd.response[0] & OCR_BUSY)) && timeout--);
295272cc70bSAndy Fleming 
296272cc70bSAndy Fleming 	if (timeout <= 0)
297272cc70bSAndy Fleming 		return UNUSABLE_ERR;
298272cc70bSAndy Fleming 
299272cc70bSAndy Fleming 	if (mmc->version != SD_VERSION_2)
300272cc70bSAndy Fleming 		mmc->version = SD_VERSION_1_0;
301272cc70bSAndy Fleming 
302998be3ddSRabin Vincent 	mmc->ocr = cmd.response[0];
303272cc70bSAndy Fleming 
304272cc70bSAndy Fleming 	mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
305272cc70bSAndy Fleming 	mmc->rca = 0;
306272cc70bSAndy Fleming 
307272cc70bSAndy Fleming 	return 0;
308272cc70bSAndy Fleming }
309272cc70bSAndy Fleming 
310272cc70bSAndy Fleming int mmc_send_op_cond(struct mmc *mmc)
311272cc70bSAndy Fleming {
312272cc70bSAndy Fleming 	int timeout = 1000;
313272cc70bSAndy Fleming 	struct mmc_cmd cmd;
314272cc70bSAndy Fleming 	int err;
315272cc70bSAndy Fleming 
316272cc70bSAndy Fleming 	/* Some cards seem to need this */
317272cc70bSAndy Fleming 	mmc_go_idle(mmc);
318272cc70bSAndy Fleming 
319272cc70bSAndy Fleming 	do {
320272cc70bSAndy Fleming 		cmd.cmdidx = MMC_CMD_SEND_OP_COND;
321272cc70bSAndy Fleming 		cmd.resp_type = MMC_RSP_R3;
322272cc70bSAndy Fleming 		cmd.cmdarg = OCR_HCS | mmc->voltages;
323272cc70bSAndy Fleming 		cmd.flags = 0;
324272cc70bSAndy Fleming 
325272cc70bSAndy Fleming 		err = mmc_send_cmd(mmc, &cmd, NULL);
326272cc70bSAndy Fleming 
327272cc70bSAndy Fleming 		if (err)
328272cc70bSAndy Fleming 			return err;
329272cc70bSAndy Fleming 
330272cc70bSAndy Fleming 		udelay(1000);
331272cc70bSAndy Fleming 	} while (!(cmd.response[0] & OCR_BUSY) && timeout--);
332272cc70bSAndy Fleming 
333272cc70bSAndy Fleming 	if (timeout <= 0)
334272cc70bSAndy Fleming 		return UNUSABLE_ERR;
335272cc70bSAndy Fleming 
336272cc70bSAndy Fleming 	mmc->version = MMC_VERSION_UNKNOWN;
337998be3ddSRabin Vincent 	mmc->ocr = cmd.response[0];
338272cc70bSAndy Fleming 
339272cc70bSAndy Fleming 	mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
340272cc70bSAndy Fleming 	mmc->rca = 0;
341272cc70bSAndy Fleming 
342272cc70bSAndy Fleming 	return 0;
343272cc70bSAndy Fleming }
344272cc70bSAndy Fleming 
345272cc70bSAndy Fleming 
346272cc70bSAndy Fleming int mmc_send_ext_csd(struct mmc *mmc, char *ext_csd)
347272cc70bSAndy Fleming {
348272cc70bSAndy Fleming 	struct mmc_cmd cmd;
349272cc70bSAndy Fleming 	struct mmc_data data;
350272cc70bSAndy Fleming 	int err;
351272cc70bSAndy Fleming 
352272cc70bSAndy Fleming 	/* Get the Card Status Register */
353272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_SEND_EXT_CSD;
354272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
355272cc70bSAndy Fleming 	cmd.cmdarg = 0;
356272cc70bSAndy Fleming 	cmd.flags = 0;
357272cc70bSAndy Fleming 
358272cc70bSAndy Fleming 	data.dest = ext_csd;
359272cc70bSAndy Fleming 	data.blocks = 1;
360272cc70bSAndy Fleming 	data.blocksize = 512;
361272cc70bSAndy Fleming 	data.flags = MMC_DATA_READ;
362272cc70bSAndy Fleming 
363272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, &data);
364272cc70bSAndy Fleming 
365272cc70bSAndy Fleming 	return err;
366272cc70bSAndy Fleming }
367272cc70bSAndy Fleming 
368272cc70bSAndy Fleming 
369272cc70bSAndy Fleming int mmc_switch(struct mmc *mmc, u8 set, u8 index, u8 value)
370272cc70bSAndy Fleming {
371272cc70bSAndy Fleming 	struct mmc_cmd cmd;
372272cc70bSAndy Fleming 
373272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_SWITCH;
374272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1b;
375272cc70bSAndy Fleming 	cmd.cmdarg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
376272cc70bSAndy Fleming 		(index << 16) |
377272cc70bSAndy Fleming 		(value << 8);
378272cc70bSAndy Fleming 	cmd.flags = 0;
379272cc70bSAndy Fleming 
380272cc70bSAndy Fleming 	return mmc_send_cmd(mmc, &cmd, NULL);
381272cc70bSAndy Fleming }
382272cc70bSAndy Fleming 
383272cc70bSAndy Fleming int mmc_change_freq(struct mmc *mmc)
384272cc70bSAndy Fleming {
385272cc70bSAndy Fleming 	char ext_csd[512];
386272cc70bSAndy Fleming 	char cardtype;
387272cc70bSAndy Fleming 	int err;
388272cc70bSAndy Fleming 
389272cc70bSAndy Fleming 	mmc->card_caps = 0;
390272cc70bSAndy Fleming 
391272cc70bSAndy Fleming 	/* Only version 4 supports high-speed */
392272cc70bSAndy Fleming 	if (mmc->version < MMC_VERSION_4)
393272cc70bSAndy Fleming 		return 0;
394272cc70bSAndy Fleming 
395272cc70bSAndy Fleming 	mmc->card_caps |= MMC_MODE_4BIT;
396272cc70bSAndy Fleming 
397272cc70bSAndy Fleming 	err = mmc_send_ext_csd(mmc, ext_csd);
398272cc70bSAndy Fleming 
399272cc70bSAndy Fleming 	if (err)
400272cc70bSAndy Fleming 		return err;
401272cc70bSAndy Fleming 
402272cc70bSAndy Fleming 	if (ext_csd[212] || ext_csd[213] || ext_csd[214] || ext_csd[215])
403272cc70bSAndy Fleming 		mmc->high_capacity = 1;
404272cc70bSAndy Fleming 
405272cc70bSAndy Fleming 	cardtype = ext_csd[196] & 0xf;
406272cc70bSAndy Fleming 
407272cc70bSAndy Fleming 	err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_HS_TIMING, 1);
408272cc70bSAndy Fleming 
409272cc70bSAndy Fleming 	if (err)
410272cc70bSAndy Fleming 		return err;
411272cc70bSAndy Fleming 
412272cc70bSAndy Fleming 	/* Now check to see that it worked */
413272cc70bSAndy Fleming 	err = mmc_send_ext_csd(mmc, ext_csd);
414272cc70bSAndy Fleming 
415272cc70bSAndy Fleming 	if (err)
416272cc70bSAndy Fleming 		return err;
417272cc70bSAndy Fleming 
418272cc70bSAndy Fleming 	/* No high-speed support */
419272cc70bSAndy Fleming 	if (!ext_csd[185])
420272cc70bSAndy Fleming 		return 0;
421272cc70bSAndy Fleming 
422272cc70bSAndy Fleming 	/* High Speed is set, there are two types: 52MHz and 26MHz */
423272cc70bSAndy Fleming 	if (cardtype & MMC_HS_52MHZ)
424272cc70bSAndy Fleming 		mmc->card_caps |= MMC_MODE_HS_52MHz | MMC_MODE_HS;
425272cc70bSAndy Fleming 	else
426272cc70bSAndy Fleming 		mmc->card_caps |= MMC_MODE_HS;
427272cc70bSAndy Fleming 
428272cc70bSAndy Fleming 	return 0;
429272cc70bSAndy Fleming }
430272cc70bSAndy Fleming 
431272cc70bSAndy Fleming int sd_switch(struct mmc *mmc, int mode, int group, u8 value, u8 *resp)
432272cc70bSAndy Fleming {
433272cc70bSAndy Fleming 	struct mmc_cmd cmd;
434272cc70bSAndy Fleming 	struct mmc_data data;
435272cc70bSAndy Fleming 
436272cc70bSAndy Fleming 	/* Switch the frequency */
437272cc70bSAndy Fleming 	cmd.cmdidx = SD_CMD_SWITCH_FUNC;
438272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
439272cc70bSAndy Fleming 	cmd.cmdarg = (mode << 31) | 0xffffff;
440272cc70bSAndy Fleming 	cmd.cmdarg &= ~(0xf << (group * 4));
441272cc70bSAndy Fleming 	cmd.cmdarg |= value << (group * 4);
442272cc70bSAndy Fleming 	cmd.flags = 0;
443272cc70bSAndy Fleming 
444272cc70bSAndy Fleming 	data.dest = (char *)resp;
445272cc70bSAndy Fleming 	data.blocksize = 64;
446272cc70bSAndy Fleming 	data.blocks = 1;
447272cc70bSAndy Fleming 	data.flags = MMC_DATA_READ;
448272cc70bSAndy Fleming 
449272cc70bSAndy Fleming 	return mmc_send_cmd(mmc, &cmd, &data);
450272cc70bSAndy Fleming }
451272cc70bSAndy Fleming 
452272cc70bSAndy Fleming 
453272cc70bSAndy Fleming int sd_change_freq(struct mmc *mmc)
454272cc70bSAndy Fleming {
455272cc70bSAndy Fleming 	int err;
456272cc70bSAndy Fleming 	struct mmc_cmd cmd;
457272cc70bSAndy Fleming 	uint scr[2];
458272cc70bSAndy Fleming 	uint switch_status[16];
459272cc70bSAndy Fleming 	struct mmc_data data;
460272cc70bSAndy Fleming 	int timeout;
461272cc70bSAndy Fleming 
462272cc70bSAndy Fleming 	mmc->card_caps = 0;
463272cc70bSAndy Fleming 
464272cc70bSAndy Fleming 	/* Read the SCR to find out if this card supports higher speeds */
465272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_APP_CMD;
466272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
467272cc70bSAndy Fleming 	cmd.cmdarg = mmc->rca << 16;
468272cc70bSAndy Fleming 	cmd.flags = 0;
469272cc70bSAndy Fleming 
470272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
471272cc70bSAndy Fleming 
472272cc70bSAndy Fleming 	if (err)
473272cc70bSAndy Fleming 		return err;
474272cc70bSAndy Fleming 
475272cc70bSAndy Fleming 	cmd.cmdidx = SD_CMD_APP_SEND_SCR;
476272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1;
477272cc70bSAndy Fleming 	cmd.cmdarg = 0;
478272cc70bSAndy Fleming 	cmd.flags = 0;
479272cc70bSAndy Fleming 
480272cc70bSAndy Fleming 	timeout = 3;
481272cc70bSAndy Fleming 
482272cc70bSAndy Fleming retry_scr:
483272cc70bSAndy Fleming 	data.dest = (char *)&scr;
484272cc70bSAndy Fleming 	data.blocksize = 8;
485272cc70bSAndy Fleming 	data.blocks = 1;
486272cc70bSAndy Fleming 	data.flags = MMC_DATA_READ;
487272cc70bSAndy Fleming 
488272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, &data);
489272cc70bSAndy Fleming 
490272cc70bSAndy Fleming 	if (err) {
491272cc70bSAndy Fleming 		if (timeout--)
492272cc70bSAndy Fleming 			goto retry_scr;
493272cc70bSAndy Fleming 
494272cc70bSAndy Fleming 		return err;
495272cc70bSAndy Fleming 	}
496272cc70bSAndy Fleming 
4974e3d89baSYauhen Kharuzhy 	mmc->scr[0] = __be32_to_cpu(scr[0]);
4984e3d89baSYauhen Kharuzhy 	mmc->scr[1] = __be32_to_cpu(scr[1]);
499272cc70bSAndy Fleming 
500272cc70bSAndy Fleming 	switch ((mmc->scr[0] >> 24) & 0xf) {
501272cc70bSAndy Fleming 		case 0:
502272cc70bSAndy Fleming 			mmc->version = SD_VERSION_1_0;
503272cc70bSAndy Fleming 			break;
504272cc70bSAndy Fleming 		case 1:
505272cc70bSAndy Fleming 			mmc->version = SD_VERSION_1_10;
506272cc70bSAndy Fleming 			break;
507272cc70bSAndy Fleming 		case 2:
508272cc70bSAndy Fleming 			mmc->version = SD_VERSION_2;
509272cc70bSAndy Fleming 			break;
510272cc70bSAndy Fleming 		default:
511272cc70bSAndy Fleming 			mmc->version = SD_VERSION_1_0;
512272cc70bSAndy Fleming 			break;
513272cc70bSAndy Fleming 	}
514272cc70bSAndy Fleming 
515272cc70bSAndy Fleming 	/* Version 1.0 doesn't support switching */
516272cc70bSAndy Fleming 	if (mmc->version == SD_VERSION_1_0)
517272cc70bSAndy Fleming 		return 0;
518272cc70bSAndy Fleming 
519272cc70bSAndy Fleming 	timeout = 4;
520272cc70bSAndy Fleming 	while (timeout--) {
521272cc70bSAndy Fleming 		err = sd_switch(mmc, SD_SWITCH_CHECK, 0, 1,
522272cc70bSAndy Fleming 				(u8 *)&switch_status);
523272cc70bSAndy Fleming 
524272cc70bSAndy Fleming 		if (err)
525272cc70bSAndy Fleming 			return err;
526272cc70bSAndy Fleming 
527272cc70bSAndy Fleming 		/* The high-speed function is busy.  Try again */
5284e3d89baSYauhen Kharuzhy 		if (!(__be32_to_cpu(switch_status[7]) & SD_HIGHSPEED_BUSY))
529272cc70bSAndy Fleming 			break;
530272cc70bSAndy Fleming 	}
531272cc70bSAndy Fleming 
532272cc70bSAndy Fleming 	if (mmc->scr[0] & SD_DATA_4BIT)
533272cc70bSAndy Fleming 		mmc->card_caps |= MMC_MODE_4BIT;
534272cc70bSAndy Fleming 
535272cc70bSAndy Fleming 	/* If high-speed isn't supported, we return */
5364e3d89baSYauhen Kharuzhy 	if (!(__be32_to_cpu(switch_status[3]) & SD_HIGHSPEED_SUPPORTED))
537272cc70bSAndy Fleming 		return 0;
538272cc70bSAndy Fleming 
539272cc70bSAndy Fleming 	err = sd_switch(mmc, SD_SWITCH_SWITCH, 0, 1, (u8 *)&switch_status);
540272cc70bSAndy Fleming 
541272cc70bSAndy Fleming 	if (err)
542272cc70bSAndy Fleming 		return err;
543272cc70bSAndy Fleming 
5444e3d89baSYauhen Kharuzhy 	if ((__be32_to_cpu(switch_status[4]) & 0x0f000000) == 0x01000000)
545272cc70bSAndy Fleming 		mmc->card_caps |= MMC_MODE_HS;
546272cc70bSAndy Fleming 
547272cc70bSAndy Fleming 	return 0;
548272cc70bSAndy Fleming }
549272cc70bSAndy Fleming 
550272cc70bSAndy Fleming /* frequency bases */
551272cc70bSAndy Fleming /* divided by 10 to be nice to platforms without floating point */
552272cc70bSAndy Fleming int fbase[] = {
553272cc70bSAndy Fleming 	10000,
554272cc70bSAndy Fleming 	100000,
555272cc70bSAndy Fleming 	1000000,
556272cc70bSAndy Fleming 	10000000,
557272cc70bSAndy Fleming };
558272cc70bSAndy Fleming 
559272cc70bSAndy Fleming /* Multiplier values for TRAN_SPEED.  Multiplied by 10 to be nice
560272cc70bSAndy Fleming  * to platforms without floating point.
561272cc70bSAndy Fleming  */
562272cc70bSAndy Fleming int multipliers[] = {
563272cc70bSAndy Fleming 	0,	/* reserved */
564272cc70bSAndy Fleming 	10,
565272cc70bSAndy Fleming 	12,
566272cc70bSAndy Fleming 	13,
567272cc70bSAndy Fleming 	15,
568272cc70bSAndy Fleming 	20,
569272cc70bSAndy Fleming 	25,
570272cc70bSAndy Fleming 	30,
571272cc70bSAndy Fleming 	35,
572272cc70bSAndy Fleming 	40,
573272cc70bSAndy Fleming 	45,
574272cc70bSAndy Fleming 	50,
575272cc70bSAndy Fleming 	55,
576272cc70bSAndy Fleming 	60,
577272cc70bSAndy Fleming 	70,
578272cc70bSAndy Fleming 	80,
579272cc70bSAndy Fleming };
580272cc70bSAndy Fleming 
581272cc70bSAndy Fleming void mmc_set_ios(struct mmc *mmc)
582272cc70bSAndy Fleming {
583272cc70bSAndy Fleming 	mmc->set_ios(mmc);
584272cc70bSAndy Fleming }
585272cc70bSAndy Fleming 
586272cc70bSAndy Fleming void mmc_set_clock(struct mmc *mmc, uint clock)
587272cc70bSAndy Fleming {
588272cc70bSAndy Fleming 	if (clock > mmc->f_max)
589272cc70bSAndy Fleming 		clock = mmc->f_max;
590272cc70bSAndy Fleming 
591272cc70bSAndy Fleming 	if (clock < mmc->f_min)
592272cc70bSAndy Fleming 		clock = mmc->f_min;
593272cc70bSAndy Fleming 
594272cc70bSAndy Fleming 	mmc->clock = clock;
595272cc70bSAndy Fleming 
596272cc70bSAndy Fleming 	mmc_set_ios(mmc);
597272cc70bSAndy Fleming }
598272cc70bSAndy Fleming 
599272cc70bSAndy Fleming void mmc_set_bus_width(struct mmc *mmc, uint width)
600272cc70bSAndy Fleming {
601272cc70bSAndy Fleming 	mmc->bus_width = width;
602272cc70bSAndy Fleming 
603272cc70bSAndy Fleming 	mmc_set_ios(mmc);
604272cc70bSAndy Fleming }
605272cc70bSAndy Fleming 
606272cc70bSAndy Fleming int mmc_startup(struct mmc *mmc)
607272cc70bSAndy Fleming {
608272cc70bSAndy Fleming 	int err;
609272cc70bSAndy Fleming 	uint mult, freq;
610272cc70bSAndy Fleming 	u64 cmult, csize;
611272cc70bSAndy Fleming 	struct mmc_cmd cmd;
612d23e2c09SSukumar Ghorai 	char ext_csd[512];
613272cc70bSAndy Fleming 
614272cc70bSAndy Fleming 	/* Put the Card in Identify Mode */
615272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_ALL_SEND_CID;
616272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R2;
617272cc70bSAndy Fleming 	cmd.cmdarg = 0;
618272cc70bSAndy Fleming 	cmd.flags = 0;
619272cc70bSAndy Fleming 
620272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
621272cc70bSAndy Fleming 
622272cc70bSAndy Fleming 	if (err)
623272cc70bSAndy Fleming 		return err;
624272cc70bSAndy Fleming 
625272cc70bSAndy Fleming 	memcpy(mmc->cid, cmd.response, 16);
626272cc70bSAndy Fleming 
627272cc70bSAndy Fleming 	/*
628272cc70bSAndy Fleming 	 * For MMC cards, set the Relative Address.
629272cc70bSAndy Fleming 	 * For SD cards, get the Relatvie Address.
630272cc70bSAndy Fleming 	 * This also puts the cards into Standby State
631272cc70bSAndy Fleming 	 */
632272cc70bSAndy Fleming 	cmd.cmdidx = SD_CMD_SEND_RELATIVE_ADDR;
633272cc70bSAndy Fleming 	cmd.cmdarg = mmc->rca << 16;
634272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R6;
635272cc70bSAndy Fleming 	cmd.flags = 0;
636272cc70bSAndy Fleming 
637272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
638272cc70bSAndy Fleming 
639272cc70bSAndy Fleming 	if (err)
640272cc70bSAndy Fleming 		return err;
641272cc70bSAndy Fleming 
642272cc70bSAndy Fleming 	if (IS_SD(mmc))
643998be3ddSRabin Vincent 		mmc->rca = (cmd.response[0] >> 16) & 0xffff;
644272cc70bSAndy Fleming 
645272cc70bSAndy Fleming 	/* Get the Card-Specific Data */
646272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_SEND_CSD;
647272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R2;
648272cc70bSAndy Fleming 	cmd.cmdarg = mmc->rca << 16;
649272cc70bSAndy Fleming 	cmd.flags = 0;
650272cc70bSAndy Fleming 
651272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
652272cc70bSAndy Fleming 
653272cc70bSAndy Fleming 	if (err)
654272cc70bSAndy Fleming 		return err;
655272cc70bSAndy Fleming 
656998be3ddSRabin Vincent 	mmc->csd[0] = cmd.response[0];
657998be3ddSRabin Vincent 	mmc->csd[1] = cmd.response[1];
658998be3ddSRabin Vincent 	mmc->csd[2] = cmd.response[2];
659998be3ddSRabin Vincent 	mmc->csd[3] = cmd.response[3];
660272cc70bSAndy Fleming 
661272cc70bSAndy Fleming 	if (mmc->version == MMC_VERSION_UNKNOWN) {
6620b453ffeSRabin Vincent 		int version = (cmd.response[0] >> 26) & 0xf;
663272cc70bSAndy Fleming 
664272cc70bSAndy Fleming 		switch (version) {
665272cc70bSAndy Fleming 			case 0:
666272cc70bSAndy Fleming 				mmc->version = MMC_VERSION_1_2;
667272cc70bSAndy Fleming 				break;
668272cc70bSAndy Fleming 			case 1:
669272cc70bSAndy Fleming 				mmc->version = MMC_VERSION_1_4;
670272cc70bSAndy Fleming 				break;
671272cc70bSAndy Fleming 			case 2:
672272cc70bSAndy Fleming 				mmc->version = MMC_VERSION_2_2;
673272cc70bSAndy Fleming 				break;
674272cc70bSAndy Fleming 			case 3:
675272cc70bSAndy Fleming 				mmc->version = MMC_VERSION_3;
676272cc70bSAndy Fleming 				break;
677272cc70bSAndy Fleming 			case 4:
678272cc70bSAndy Fleming 				mmc->version = MMC_VERSION_4;
679272cc70bSAndy Fleming 				break;
680272cc70bSAndy Fleming 			default:
681272cc70bSAndy Fleming 				mmc->version = MMC_VERSION_1_2;
682272cc70bSAndy Fleming 				break;
683272cc70bSAndy Fleming 		}
684272cc70bSAndy Fleming 	}
685272cc70bSAndy Fleming 
686272cc70bSAndy Fleming 	/* divide frequency by 10, since the mults are 10x bigger */
6870b453ffeSRabin Vincent 	freq = fbase[(cmd.response[0] & 0x7)];
6880b453ffeSRabin Vincent 	mult = multipliers[((cmd.response[0] >> 3) & 0xf)];
689272cc70bSAndy Fleming 
690272cc70bSAndy Fleming 	mmc->tran_speed = freq * mult;
691272cc70bSAndy Fleming 
692998be3ddSRabin Vincent 	mmc->read_bl_len = 1 << ((cmd.response[1] >> 16) & 0xf);
693272cc70bSAndy Fleming 
694272cc70bSAndy Fleming 	if (IS_SD(mmc))
695272cc70bSAndy Fleming 		mmc->write_bl_len = mmc->read_bl_len;
696272cc70bSAndy Fleming 	else
697998be3ddSRabin Vincent 		mmc->write_bl_len = 1 << ((cmd.response[3] >> 22) & 0xf);
698272cc70bSAndy Fleming 
699272cc70bSAndy Fleming 	if (mmc->high_capacity) {
700272cc70bSAndy Fleming 		csize = (mmc->csd[1] & 0x3f) << 16
701272cc70bSAndy Fleming 			| (mmc->csd[2] & 0xffff0000) >> 16;
702272cc70bSAndy Fleming 		cmult = 8;
703272cc70bSAndy Fleming 	} else {
704272cc70bSAndy Fleming 		csize = (mmc->csd[1] & 0x3ff) << 2
705272cc70bSAndy Fleming 			| (mmc->csd[2] & 0xc0000000) >> 30;
706272cc70bSAndy Fleming 		cmult = (mmc->csd[2] & 0x00038000) >> 15;
707272cc70bSAndy Fleming 	}
708272cc70bSAndy Fleming 
709272cc70bSAndy Fleming 	mmc->capacity = (csize + 1) << (cmult + 2);
710272cc70bSAndy Fleming 	mmc->capacity *= mmc->read_bl_len;
711272cc70bSAndy Fleming 
712272cc70bSAndy Fleming 	if (mmc->read_bl_len > 512)
713272cc70bSAndy Fleming 		mmc->read_bl_len = 512;
714272cc70bSAndy Fleming 
715272cc70bSAndy Fleming 	if (mmc->write_bl_len > 512)
716272cc70bSAndy Fleming 		mmc->write_bl_len = 512;
717272cc70bSAndy Fleming 
718272cc70bSAndy Fleming 	/* Select the card, and put it into Transfer Mode */
719272cc70bSAndy Fleming 	cmd.cmdidx = MMC_CMD_SELECT_CARD;
720272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R1b;
721272cc70bSAndy Fleming 	cmd.cmdarg = mmc->rca << 16;
722272cc70bSAndy Fleming 	cmd.flags = 0;
723272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
724272cc70bSAndy Fleming 
725272cc70bSAndy Fleming 	if (err)
726272cc70bSAndy Fleming 		return err;
727272cc70bSAndy Fleming 
728d23e2c09SSukumar Ghorai 	if (!IS_SD(mmc) && (mmc->version >= MMC_VERSION_4)) {
729d23e2c09SSukumar Ghorai 		/* check  ext_csd version and capacity */
730d23e2c09SSukumar Ghorai 		err = mmc_send_ext_csd(mmc, ext_csd);
731d23e2c09SSukumar Ghorai 		if (!err & (ext_csd[192] >= 2)) {
732d23e2c09SSukumar Ghorai 			mmc->capacity = ext_csd[212] << 0 | ext_csd[213] << 8 |
733d23e2c09SSukumar Ghorai 					ext_csd[214] << 16 | ext_csd[215] << 24;
734d23e2c09SSukumar Ghorai 			mmc->capacity *= 512;
735d23e2c09SSukumar Ghorai 		}
736d23e2c09SSukumar Ghorai 	}
737d23e2c09SSukumar Ghorai 
738272cc70bSAndy Fleming 	if (IS_SD(mmc))
739272cc70bSAndy Fleming 		err = sd_change_freq(mmc);
740272cc70bSAndy Fleming 	else
741272cc70bSAndy Fleming 		err = mmc_change_freq(mmc);
742272cc70bSAndy Fleming 
743272cc70bSAndy Fleming 	if (err)
744272cc70bSAndy Fleming 		return err;
745272cc70bSAndy Fleming 
746272cc70bSAndy Fleming 	/* Restrict card's capabilities by what the host can do */
747272cc70bSAndy Fleming 	mmc->card_caps &= mmc->host_caps;
748272cc70bSAndy Fleming 
749272cc70bSAndy Fleming 	if (IS_SD(mmc)) {
750272cc70bSAndy Fleming 		if (mmc->card_caps & MMC_MODE_4BIT) {
751272cc70bSAndy Fleming 			cmd.cmdidx = MMC_CMD_APP_CMD;
752272cc70bSAndy Fleming 			cmd.resp_type = MMC_RSP_R1;
753272cc70bSAndy Fleming 			cmd.cmdarg = mmc->rca << 16;
754272cc70bSAndy Fleming 			cmd.flags = 0;
755272cc70bSAndy Fleming 
756272cc70bSAndy Fleming 			err = mmc_send_cmd(mmc, &cmd, NULL);
757272cc70bSAndy Fleming 			if (err)
758272cc70bSAndy Fleming 				return err;
759272cc70bSAndy Fleming 
760272cc70bSAndy Fleming 			cmd.cmdidx = SD_CMD_APP_SET_BUS_WIDTH;
761272cc70bSAndy Fleming 			cmd.resp_type = MMC_RSP_R1;
762272cc70bSAndy Fleming 			cmd.cmdarg = 2;
763272cc70bSAndy Fleming 			cmd.flags = 0;
764272cc70bSAndy Fleming 			err = mmc_send_cmd(mmc, &cmd, NULL);
765272cc70bSAndy Fleming 			if (err)
766272cc70bSAndy Fleming 				return err;
767272cc70bSAndy Fleming 
768272cc70bSAndy Fleming 			mmc_set_bus_width(mmc, 4);
769272cc70bSAndy Fleming 		}
770272cc70bSAndy Fleming 
771272cc70bSAndy Fleming 		if (mmc->card_caps & MMC_MODE_HS)
772272cc70bSAndy Fleming 			mmc_set_clock(mmc, 50000000);
773272cc70bSAndy Fleming 		else
774272cc70bSAndy Fleming 			mmc_set_clock(mmc, 25000000);
775272cc70bSAndy Fleming 	} else {
776272cc70bSAndy Fleming 		if (mmc->card_caps & MMC_MODE_4BIT) {
777272cc70bSAndy Fleming 			/* Set the card to use 4 bit*/
778272cc70bSAndy Fleming 			err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
779272cc70bSAndy Fleming 					EXT_CSD_BUS_WIDTH,
780272cc70bSAndy Fleming 					EXT_CSD_BUS_WIDTH_4);
781272cc70bSAndy Fleming 
782272cc70bSAndy Fleming 			if (err)
783272cc70bSAndy Fleming 				return err;
784272cc70bSAndy Fleming 
785272cc70bSAndy Fleming 			mmc_set_bus_width(mmc, 4);
786272cc70bSAndy Fleming 		} else if (mmc->card_caps & MMC_MODE_8BIT) {
787272cc70bSAndy Fleming 			/* Set the card to use 8 bit*/
788272cc70bSAndy Fleming 			err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
789272cc70bSAndy Fleming 					EXT_CSD_BUS_WIDTH,
790272cc70bSAndy Fleming 					EXT_CSD_BUS_WIDTH_8);
791272cc70bSAndy Fleming 
792272cc70bSAndy Fleming 			if (err)
793272cc70bSAndy Fleming 				return err;
794272cc70bSAndy Fleming 
795272cc70bSAndy Fleming 			mmc_set_bus_width(mmc, 8);
796272cc70bSAndy Fleming 		}
797272cc70bSAndy Fleming 
798272cc70bSAndy Fleming 		if (mmc->card_caps & MMC_MODE_HS) {
799272cc70bSAndy Fleming 			if (mmc->card_caps & MMC_MODE_HS_52MHz)
800272cc70bSAndy Fleming 				mmc_set_clock(mmc, 52000000);
801272cc70bSAndy Fleming 			else
802272cc70bSAndy Fleming 				mmc_set_clock(mmc, 26000000);
803272cc70bSAndy Fleming 		} else
804272cc70bSAndy Fleming 			mmc_set_clock(mmc, 20000000);
805272cc70bSAndy Fleming 	}
806272cc70bSAndy Fleming 
807272cc70bSAndy Fleming 	/* fill in device description */
808272cc70bSAndy Fleming 	mmc->block_dev.lun = 0;
809272cc70bSAndy Fleming 	mmc->block_dev.type = 0;
810272cc70bSAndy Fleming 	mmc->block_dev.blksz = mmc->read_bl_len;
8119b1f942cSRabin Vincent 	mmc->block_dev.lba = lldiv(mmc->capacity, mmc->read_bl_len);
8120b453ffeSRabin Vincent 	sprintf(mmc->block_dev.vendor, "Man %06x Snr %08x", mmc->cid[0] >> 8,
8130b453ffeSRabin Vincent 			(mmc->cid[2] << 8) | (mmc->cid[3] >> 24));
8140b453ffeSRabin Vincent 	sprintf(mmc->block_dev.product, "%c%c%c%c%c", mmc->cid[0] & 0xff,
8150b453ffeSRabin Vincent 			(mmc->cid[1] >> 24), (mmc->cid[1] >> 16) & 0xff,
8160b453ffeSRabin Vincent 			(mmc->cid[1] >> 8) & 0xff, mmc->cid[1] & 0xff);
8170b453ffeSRabin Vincent 	sprintf(mmc->block_dev.revision, "%d.%d", mmc->cid[2] >> 28,
8180b453ffeSRabin Vincent 			(mmc->cid[2] >> 24) & 0xf);
819272cc70bSAndy Fleming 	init_part(&mmc->block_dev);
820272cc70bSAndy Fleming 
821272cc70bSAndy Fleming 	return 0;
822272cc70bSAndy Fleming }
823272cc70bSAndy Fleming 
824272cc70bSAndy Fleming int mmc_send_if_cond(struct mmc *mmc)
825272cc70bSAndy Fleming {
826272cc70bSAndy Fleming 	struct mmc_cmd cmd;
827272cc70bSAndy Fleming 	int err;
828272cc70bSAndy Fleming 
829272cc70bSAndy Fleming 	cmd.cmdidx = SD_CMD_SEND_IF_COND;
830272cc70bSAndy Fleming 	/* We set the bit if the host supports voltages between 2.7 and 3.6 V */
831272cc70bSAndy Fleming 	cmd.cmdarg = ((mmc->voltages & 0xff8000) != 0) << 8 | 0xaa;
832272cc70bSAndy Fleming 	cmd.resp_type = MMC_RSP_R7;
833272cc70bSAndy Fleming 	cmd.flags = 0;
834272cc70bSAndy Fleming 
835272cc70bSAndy Fleming 	err = mmc_send_cmd(mmc, &cmd, NULL);
836272cc70bSAndy Fleming 
837272cc70bSAndy Fleming 	if (err)
838272cc70bSAndy Fleming 		return err;
839272cc70bSAndy Fleming 
840998be3ddSRabin Vincent 	if ((cmd.response[0] & 0xff) != 0xaa)
841272cc70bSAndy Fleming 		return UNUSABLE_ERR;
842272cc70bSAndy Fleming 	else
843272cc70bSAndy Fleming 		mmc->version = SD_VERSION_2;
844272cc70bSAndy Fleming 
845272cc70bSAndy Fleming 	return 0;
846272cc70bSAndy Fleming }
847272cc70bSAndy Fleming 
848272cc70bSAndy Fleming int mmc_register(struct mmc *mmc)
849272cc70bSAndy Fleming {
850272cc70bSAndy Fleming 	/* Setup the universal parts of the block interface just once */
851272cc70bSAndy Fleming 	mmc->block_dev.if_type = IF_TYPE_MMC;
852272cc70bSAndy Fleming 	mmc->block_dev.dev = cur_dev_num++;
853272cc70bSAndy Fleming 	mmc->block_dev.removable = 1;
854272cc70bSAndy Fleming 	mmc->block_dev.block_read = mmc_bread;
855272cc70bSAndy Fleming 	mmc->block_dev.block_write = mmc_bwrite;
856272cc70bSAndy Fleming 
857272cc70bSAndy Fleming 	INIT_LIST_HEAD (&mmc->link);
858272cc70bSAndy Fleming 
859272cc70bSAndy Fleming 	list_add_tail (&mmc->link, &mmc_devices);
860272cc70bSAndy Fleming 
861272cc70bSAndy Fleming 	return 0;
862272cc70bSAndy Fleming }
863272cc70bSAndy Fleming 
864272cc70bSAndy Fleming block_dev_desc_t *mmc_get_dev(int dev)
865272cc70bSAndy Fleming {
866272cc70bSAndy Fleming 	struct mmc *mmc = find_mmc_device(dev);
867272cc70bSAndy Fleming 
868e85649c7SRabin Vincent 	return mmc ? &mmc->block_dev : NULL;
869272cc70bSAndy Fleming }
870272cc70bSAndy Fleming 
871272cc70bSAndy Fleming int mmc_init(struct mmc *mmc)
872272cc70bSAndy Fleming {
873272cc70bSAndy Fleming 	int err;
874272cc70bSAndy Fleming 
875272cc70bSAndy Fleming 	err = mmc->init(mmc);
876272cc70bSAndy Fleming 
877272cc70bSAndy Fleming 	if (err)
878272cc70bSAndy Fleming 		return err;
879272cc70bSAndy Fleming 
880b86b85e2SIlya Yanok 	mmc_set_bus_width(mmc, 1);
881b86b85e2SIlya Yanok 	mmc_set_clock(mmc, 1);
882b86b85e2SIlya Yanok 
883272cc70bSAndy Fleming 	/* Reset the Card */
884272cc70bSAndy Fleming 	err = mmc_go_idle(mmc);
885272cc70bSAndy Fleming 
886272cc70bSAndy Fleming 	if (err)
887272cc70bSAndy Fleming 		return err;
888272cc70bSAndy Fleming 
889272cc70bSAndy Fleming 	/* Test for SD version 2 */
890272cc70bSAndy Fleming 	err = mmc_send_if_cond(mmc);
891272cc70bSAndy Fleming 
892272cc70bSAndy Fleming 	/* Now try to get the SD card's operating condition */
893272cc70bSAndy Fleming 	err = sd_send_op_cond(mmc);
894272cc70bSAndy Fleming 
895272cc70bSAndy Fleming 	/* If the command timed out, we check for an MMC card */
896272cc70bSAndy Fleming 	if (err == TIMEOUT) {
897272cc70bSAndy Fleming 		err = mmc_send_op_cond(mmc);
898272cc70bSAndy Fleming 
899272cc70bSAndy Fleming 		if (err) {
900272cc70bSAndy Fleming 			printf("Card did not respond to voltage select!\n");
901272cc70bSAndy Fleming 			return UNUSABLE_ERR;
902272cc70bSAndy Fleming 		}
903272cc70bSAndy Fleming 	}
904272cc70bSAndy Fleming 
905272cc70bSAndy Fleming 	return mmc_startup(mmc);
906272cc70bSAndy Fleming }
907272cc70bSAndy Fleming 
908272cc70bSAndy Fleming /*
909272cc70bSAndy Fleming  * CPU and board-specific MMC initializations.  Aliased function
910272cc70bSAndy Fleming  * signals caller to move on
911272cc70bSAndy Fleming  */
912272cc70bSAndy Fleming static int __def_mmc_init(bd_t *bis)
913272cc70bSAndy Fleming {
914272cc70bSAndy Fleming 	return -1;
915272cc70bSAndy Fleming }
916272cc70bSAndy Fleming 
917f9a109b3SPeter Tyser int cpu_mmc_init(bd_t *bis) __attribute__((weak, alias("__def_mmc_init")));
918f9a109b3SPeter Tyser int board_mmc_init(bd_t *bis) __attribute__((weak, alias("__def_mmc_init")));
919272cc70bSAndy Fleming 
920272cc70bSAndy Fleming void print_mmc_devices(char separator)
921272cc70bSAndy Fleming {
922272cc70bSAndy Fleming 	struct mmc *m;
923272cc70bSAndy Fleming 	struct list_head *entry;
924272cc70bSAndy Fleming 
925272cc70bSAndy Fleming 	list_for_each(entry, &mmc_devices) {
926272cc70bSAndy Fleming 		m = list_entry(entry, struct mmc, link);
927272cc70bSAndy Fleming 
928272cc70bSAndy Fleming 		printf("%s: %d", m->name, m->block_dev.dev);
929272cc70bSAndy Fleming 
930272cc70bSAndy Fleming 		if (entry->next != &mmc_devices)
931272cc70bSAndy Fleming 			printf("%c ", separator);
932272cc70bSAndy Fleming 	}
933272cc70bSAndy Fleming 
934272cc70bSAndy Fleming 	printf("\n");
935272cc70bSAndy Fleming }
936272cc70bSAndy Fleming 
937272cc70bSAndy Fleming int mmc_initialize(bd_t *bis)
938272cc70bSAndy Fleming {
939272cc70bSAndy Fleming 	INIT_LIST_HEAD (&mmc_devices);
940272cc70bSAndy Fleming 	cur_dev_num = 0;
941272cc70bSAndy Fleming 
942272cc70bSAndy Fleming 	if (board_mmc_init(bis) < 0)
943272cc70bSAndy Fleming 		cpu_mmc_init(bis);
944272cc70bSAndy Fleming 
945272cc70bSAndy Fleming 	print_mmc_devices(',');
946272cc70bSAndy Fleming 
947272cc70bSAndy Fleming 	return 0;
948272cc70bSAndy Fleming }
949