xref: /freebsd/sys/dev/mmc/mmc.c (revision fa5f41d31c4658ad48a5abf30d251f13de87e51b)
1114b4164SWarner Losh /*-
2114b4164SWarner Losh  * Copyright (c) 2006 Bernd Walter.  All rights reserved.
3114b4164SWarner Losh  * Copyright (c) 2006 M. Warner Losh.  All rights reserved.
4114b4164SWarner Losh  *
5114b4164SWarner Losh  * Redistribution and use in source and binary forms, with or without
6114b4164SWarner Losh  * modification, are permitted provided that the following conditions
7114b4164SWarner Losh  * are met:
8114b4164SWarner Losh  * 1. Redistributions of source code must retain the above copyright
9114b4164SWarner Losh  *    notice, this list of conditions and the following disclaimer.
10114b4164SWarner Losh  * 2. Redistributions in binary form must reproduce the above copyright
11114b4164SWarner Losh  *    notice, this list of conditions and the following disclaimer in the
12114b4164SWarner Losh  *    documentation and/or other materials provided with the distribution.
13114b4164SWarner Losh  *
14114b4164SWarner Losh  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
15114b4164SWarner Losh  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
16114b4164SWarner Losh  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
17114b4164SWarner Losh  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
18114b4164SWarner Losh  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
19114b4164SWarner Losh  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
20114b4164SWarner Losh  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
21114b4164SWarner Losh  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
22114b4164SWarner Losh  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
23114b4164SWarner Losh  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
2414eced72SWarner Losh  *
2514eced72SWarner Losh  * Portions of this software may have been developed with reference to
2614eced72SWarner Losh  * the SD Simplified Specification.  The following disclaimer may apply:
2714eced72SWarner Losh  *
2814eced72SWarner Losh  * The following conditions apply to the release of the simplified
2914eced72SWarner Losh  * specification ("Simplified Specification") by the SD Card Association and
3014eced72SWarner Losh  * the SD Group. The Simplified Specification is a subset of the complete SD
3114eced72SWarner Losh  * Specification which is owned by the SD Card Association and the SD
3214eced72SWarner Losh  * Group. This Simplified Specification is provided on a non-confidential
3314eced72SWarner Losh  * basis subject to the disclaimers below. Any implementation of the
3414eced72SWarner Losh  * Simplified Specification may require a license from the SD Card
3514eced72SWarner Losh  * Association, SD Group, SD-3C LLC or other third parties.
3614eced72SWarner Losh  *
3714eced72SWarner Losh  * Disclaimers:
3814eced72SWarner Losh  *
3914eced72SWarner Losh  * The information contained in the Simplified Specification is presented only
4014eced72SWarner Losh  * as a standard specification for SD Cards and SD Host/Ancillary products and
4114eced72SWarner Losh  * is provided "AS-IS" without any representations or warranties of any
4214eced72SWarner Losh  * kind. No responsibility is assumed by the SD Group, SD-3C LLC or the SD
4314eced72SWarner Losh  * Card Association for any damages, any infringements of patents or other
4414eced72SWarner Losh  * right of the SD Group, SD-3C LLC, the SD Card Association or any third
4514eced72SWarner Losh  * parties, which may result from its use. No license is granted by
4614eced72SWarner Losh  * implication, estoppel or otherwise under any patent or other rights of the
4714eced72SWarner Losh  * SD Group, SD-3C LLC, the SD Card Association or any third party. Nothing
4814eced72SWarner Losh  * herein shall be construed as an obligation by the SD Group, the SD-3C LLC
4914eced72SWarner Losh  * or the SD Card Association to disclose or distribute any technical
5014eced72SWarner Losh  * information, know-how or other confidential information to any third party.
51114b4164SWarner Losh  */
52114b4164SWarner Losh 
53114b4164SWarner Losh #include <sys/cdefs.h>
54114b4164SWarner Losh __FBSDID("$FreeBSD$");
55114b4164SWarner Losh 
56114b4164SWarner Losh #include <sys/param.h>
57114b4164SWarner Losh #include <sys/systm.h>
58114b4164SWarner Losh #include <sys/kernel.h>
59114b4164SWarner Losh #include <sys/malloc.h>
60114b4164SWarner Losh #include <sys/lock.h>
61114b4164SWarner Losh #include <sys/module.h>
62114b4164SWarner Losh #include <sys/mutex.h>
63114b4164SWarner Losh #include <sys/bus.h>
64c18f1e26SAlexander Motin #include <sys/endian.h>
65114b4164SWarner Losh 
66114b4164SWarner Losh #include <dev/mmc/mmcreg.h>
67114b4164SWarner Losh #include <dev/mmc/mmcbrvar.h>
68114b4164SWarner Losh #include <dev/mmc/mmcvar.h>
69114b4164SWarner Losh #include "mmcbr_if.h"
70114b4164SWarner Losh #include "mmcbus_if.h"
71114b4164SWarner Losh 
72114b4164SWarner Losh struct mmc_softc {
73114b4164SWarner Losh 	device_t dev;
74114b4164SWarner Losh 	struct mtx sc_mtx;
75114b4164SWarner Losh 	struct intr_config_hook config_intrhook;
76114b4164SWarner Losh 	device_t owner;
77114b4164SWarner Losh 	uint32_t last_rca;
78114b4164SWarner Losh };
79114b4164SWarner Losh 
80114b4164SWarner Losh /*
81114b4164SWarner Losh  * Per-card data
82114b4164SWarner Losh  */
83114b4164SWarner Losh struct mmc_ivars {
84114b4164SWarner Losh 	uint32_t raw_cid[4];	/* Raw bits of the CID */
85114b4164SWarner Losh 	uint32_t raw_csd[4];	/* Raw bits of the CSD */
86c18f1e26SAlexander Motin 	uint32_t raw_scr[2];	/* Raw bits of the SCR */
87c18f1e26SAlexander Motin 	uint8_t raw_ext_csd[512];	/* Raw bits of the EXT_CSD */
88114b4164SWarner Losh 	uint16_t rca;
89114b4164SWarner Losh 	enum mmc_card_mode mode;
90114b4164SWarner Losh 	struct mmc_cid cid;	/* cid decoded */
91114b4164SWarner Losh 	struct mmc_csd csd;	/* csd decoded */
92c18f1e26SAlexander Motin 	struct mmc_scr scr;	/* scr decoded */
9340fab6e7SWarner Losh 	u_char read_only;	/* True when the device is read-only */
94c18f1e26SAlexander Motin 	u_char bus_width;	/* Bus width to use */
95c18f1e26SAlexander Motin 	u_char timing;		/* Bus timing support */
96fa5f41d3SAlexander Motin 	u_char high_cap;	/* High Capacity card (block addressed) */
97fa5f41d3SAlexander Motin 	uint32_t sec_count;	/* Card capacity in 512byte blocks */
98c18f1e26SAlexander Motin 	uint32_t tran_speed;	/* Max speed in normal mode */
99c18f1e26SAlexander Motin 	uint32_t hs_tran_speed;	/* Max speed in high speed mode */
100114b4164SWarner Losh };
101114b4164SWarner Losh 
102114b4164SWarner Losh #define CMD_RETRIES	3
103114b4164SWarner Losh 
104114b4164SWarner Losh /* bus entry points */
105114b4164SWarner Losh static int mmc_probe(device_t dev);
106114b4164SWarner Losh static int mmc_attach(device_t dev);
107114b4164SWarner Losh static int mmc_detach(device_t dev);
108114b4164SWarner Losh 
109114b4164SWarner Losh #define MMC_LOCK(_sc)		mtx_lock(&(_sc)->sc_mtx)
110114b4164SWarner Losh #define	MMC_UNLOCK(_sc)		mtx_unlock(&(_sc)->sc_mtx)
111114b4164SWarner Losh #define MMC_LOCK_INIT(_sc)					\
112114b4164SWarner Losh 	mtx_init(&_sc->sc_mtx, device_get_nameunit(_sc->dev),	\
113114b4164SWarner Losh 	    "mmc", MTX_DEF)
114114b4164SWarner Losh #define MMC_LOCK_DESTROY(_sc)	mtx_destroy(&_sc->sc_mtx);
115114b4164SWarner Losh #define MMC_ASSERT_LOCKED(_sc)	mtx_assert(&_sc->sc_mtx, MA_OWNED);
116114b4164SWarner Losh #define MMC_ASSERT_UNLOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_NOTOWNED);
117114b4164SWarner Losh 
118114b4164SWarner Losh static void mmc_delayed_attach(void *);
1195d2f6510SWarner Losh static void mmc_power_down(struct mmc_softc *sc);
120114b4164SWarner Losh static int mmc_wait_for_cmd(struct mmc_softc *sc, struct mmc_command *cmd,
121114b4164SWarner Losh     int retries);
122114b4164SWarner Losh static int mmc_wait_for_command(struct mmc_softc *sc, uint32_t opcode,
123114b4164SWarner Losh     uint32_t arg, uint32_t flags, uint32_t *resp, int retries);
124c18f1e26SAlexander Motin static int mmc_select_card(struct mmc_softc *sc, uint16_t rca);
125c18f1e26SAlexander Motin static int mmc_set_bus_width(struct mmc_softc *sc, uint16_t rca, int width);
126c18f1e26SAlexander Motin static int mmc_app_send_scr(struct mmc_softc *sc, uint16_t rca, uint32_t *rawscr);
127c18f1e26SAlexander Motin static void mmc_app_decode_scr(uint32_t *raw_scr, struct mmc_scr *scr);
128c18f1e26SAlexander Motin static int mmc_send_ext_csd(struct mmc_softc *sc, uint8_t *rawextcsd);
129114b4164SWarner Losh 
130114b4164SWarner Losh static void
131114b4164SWarner Losh mmc_ms_delay(int ms)
132114b4164SWarner Losh {
133114b4164SWarner Losh 	DELAY(1000 * ms);	/* XXX BAD */
134114b4164SWarner Losh }
135114b4164SWarner Losh 
136114b4164SWarner Losh static int
137114b4164SWarner Losh mmc_probe(device_t dev)
138114b4164SWarner Losh {
139114b4164SWarner Losh 
1402703cdbbSWarner Losh 	device_set_desc(dev, "MMC/SD bus");
141114b4164SWarner Losh 	return (0);
142114b4164SWarner Losh }
143114b4164SWarner Losh 
144114b4164SWarner Losh static int
145114b4164SWarner Losh mmc_attach(device_t dev)
146114b4164SWarner Losh {
147114b4164SWarner Losh 	struct mmc_softc *sc;
148114b4164SWarner Losh 
149114b4164SWarner Losh 	sc = device_get_softc(dev);
150114b4164SWarner Losh 	sc->dev = dev;
151114b4164SWarner Losh 	MMC_LOCK_INIT(sc);
152114b4164SWarner Losh 
153114b4164SWarner Losh 	/* We'll probe and attach our children later, but before / mount */
154114b4164SWarner Losh 	sc->config_intrhook.ich_func = mmc_delayed_attach;
155114b4164SWarner Losh 	sc->config_intrhook.ich_arg = sc;
156114b4164SWarner Losh 	if (config_intrhook_establish(&sc->config_intrhook) != 0)
157114b4164SWarner Losh 		device_printf(dev, "config_intrhook_establish failed\n");
158114b4164SWarner Losh 	return (0);
159114b4164SWarner Losh }
160114b4164SWarner Losh 
161114b4164SWarner Losh static int
162114b4164SWarner Losh mmc_detach(device_t dev)
163114b4164SWarner Losh {
1640e1466acSWarner Losh 	struct mmc_softc *sc = device_get_softc(dev);
1650e1466acSWarner Losh 	device_t *kids;
1660e1466acSWarner Losh 	int i, nkid;
1670e1466acSWarner Losh 
1680e1466acSWarner Losh 	/* kill children [ph33r].  -sorbo */
1690e1466acSWarner Losh 	if (device_get_children(sc->dev, &kids, &nkid) != 0)
170128d0ff2SWarner Losh 		return (0);
1710e1466acSWarner Losh 	for (i = 0; i < nkid; i++) {
1720e1466acSWarner Losh 		device_t kid = kids[i];
1730e1466acSWarner Losh 		void *ivar = device_get_ivars(kid);
1740e1466acSWarner Losh 
1750e1466acSWarner Losh 		device_detach(kid);
1760e1466acSWarner Losh 		device_delete_child(sc->dev, kid);
1770e1466acSWarner Losh 		free(ivar, M_DEVBUF);
1780e1466acSWarner Losh 	}
1790e1466acSWarner Losh 	free(kids, M_TEMP);
1805d2f6510SWarner Losh 	mmc_power_down(sc);
1810e1466acSWarner Losh 
1820e1466acSWarner Losh 	MMC_LOCK_DESTROY(sc);
1830e1466acSWarner Losh 
184128d0ff2SWarner Losh 	return (0);
185114b4164SWarner Losh }
186114b4164SWarner Losh 
187114b4164SWarner Losh static int
188114b4164SWarner Losh mmc_acquire_bus(device_t busdev, device_t dev)
189114b4164SWarner Losh {
190114b4164SWarner Losh 	struct mmc_softc *sc;
191c18f1e26SAlexander Motin 	struct mmc_ivars *ivar;
192114b4164SWarner Losh 	int err;
193114b4164SWarner Losh 	int rca;
194114b4164SWarner Losh 
195e9bb9da3SWarner Losh 	err = MMCBR_ACQUIRE_HOST(device_get_parent(busdev), busdev);
196114b4164SWarner Losh 	if (err)
197114b4164SWarner Losh 		return (err);
198114b4164SWarner Losh 	sc = device_get_softc(busdev);
199114b4164SWarner Losh 	MMC_LOCK(sc);
200114b4164SWarner Losh 	if (sc->owner)
201114b4164SWarner Losh 		panic("mmc: host bridge didn't seralize us.");
202114b4164SWarner Losh 	sc->owner = dev;
203114b4164SWarner Losh 	MMC_UNLOCK(sc);
204114b4164SWarner Losh 
205114b4164SWarner Losh 	if (busdev != dev) {
2066fdacf52SWarner Losh 		/*
2076fdacf52SWarner Losh 		 * Keep track of the last rca that we've selected.  If
2086fdacf52SWarner Losh 		 * we're asked to do it again, don't.  We never
2096fdacf52SWarner Losh 		 * unselect unless the bus code itself wants the mmc
2106fdacf52SWarner Losh 		 * bus, and constantly reselecting causes problems.
2116fdacf52SWarner Losh 		 */
212114b4164SWarner Losh 		rca = mmc_get_rca(dev);
213114b4164SWarner Losh 		if (sc->last_rca != rca) {
214c18f1e26SAlexander Motin 			mmc_select_card(sc, rca);
215114b4164SWarner Losh 			sc->last_rca = rca;
216c18f1e26SAlexander Motin 			/* Prepare bus width for the new card. */
217c18f1e26SAlexander Motin 			ivar = device_get_ivars(dev);
218c18f1e26SAlexander Motin 			device_printf(busdev,
219c18f1e26SAlexander Motin 			    "setting bus width to %d bits\n",
220c18f1e26SAlexander Motin 			    (ivar->bus_width == bus_width_4)?4:
221c18f1e26SAlexander Motin 			    (ivar->bus_width == bus_width_8)?8:1);
222c18f1e26SAlexander Motin 			mmc_set_bus_width(sc, rca, ivar->bus_width);
223c18f1e26SAlexander Motin 			mmcbr_set_bus_width(busdev, ivar->bus_width);
224c18f1e26SAlexander Motin 			mmcbr_update_ios(busdev);
225114b4164SWarner Losh 		}
226114b4164SWarner Losh 	} else {
2276fdacf52SWarner Losh 		/*
2286fdacf52SWarner Losh 		 * If there's a card selected, stand down.
2296fdacf52SWarner Losh 		 */
230114b4164SWarner Losh 		if (sc->last_rca != 0) {
231c18f1e26SAlexander Motin 			mmc_select_card(sc, 0);
232114b4164SWarner Losh 			sc->last_rca = 0;
233114b4164SWarner Losh 		}
234114b4164SWarner Losh 	}
235114b4164SWarner Losh 
236114b4164SWarner Losh 	return (0);
237114b4164SWarner Losh }
238114b4164SWarner Losh 
239114b4164SWarner Losh static int
240114b4164SWarner Losh mmc_release_bus(device_t busdev, device_t dev)
241114b4164SWarner Losh {
242114b4164SWarner Losh 	struct mmc_softc *sc;
243114b4164SWarner Losh 	int err;
244114b4164SWarner Losh 
245114b4164SWarner Losh 	sc = device_get_softc(busdev);
246114b4164SWarner Losh 
247114b4164SWarner Losh 	MMC_LOCK(sc);
248114b4164SWarner Losh 	if (!sc->owner)
249114b4164SWarner Losh 		panic("mmc: releasing unowned bus.");
250114b4164SWarner Losh 	if (sc->owner != dev)
251114b4164SWarner Losh 		panic("mmc: you don't own the bus.  game over.");
252114b4164SWarner Losh 	MMC_UNLOCK(sc);
253e9bb9da3SWarner Losh 	err = MMCBR_RELEASE_HOST(device_get_parent(busdev), busdev);
254114b4164SWarner Losh 	if (err)
255114b4164SWarner Losh 		return (err);
256114b4164SWarner Losh 	MMC_LOCK(sc);
257114b4164SWarner Losh 	sc->owner = NULL;
258114b4164SWarner Losh 	MMC_UNLOCK(sc);
259114b4164SWarner Losh 	return (0);
260114b4164SWarner Losh }
261114b4164SWarner Losh 
262114b4164SWarner Losh static void
263114b4164SWarner Losh mmc_rescan_cards(struct mmc_softc *sc)
264114b4164SWarner Losh {
265114b4164SWarner Losh 	/* XXX: Look at the children and see if they respond to status */
266114b4164SWarner Losh }
267114b4164SWarner Losh 
268114b4164SWarner Losh static uint32_t
269114b4164SWarner Losh mmc_select_vdd(struct mmc_softc *sc, uint32_t ocr)
270114b4164SWarner Losh {
2718aaa15e2SWarner Losh 
272128d0ff2SWarner Losh 	return (ocr & MMC_OCR_VOLTAGE);
273114b4164SWarner Losh }
274114b4164SWarner Losh 
275114b4164SWarner Losh static int
276114b4164SWarner Losh mmc_highest_voltage(uint32_t ocr)
277114b4164SWarner Losh {
278114b4164SWarner Losh 	int i;
279114b4164SWarner Losh 
280114b4164SWarner Losh 	for (i = 30; i >= 0; i--)
281114b4164SWarner Losh 		if (ocr & (1 << i))
282128d0ff2SWarner Losh 			return (i);
283114b4164SWarner Losh 	return (-1);
284114b4164SWarner Losh }
285114b4164SWarner Losh 
286114b4164SWarner Losh static void
287114b4164SWarner Losh mmc_wakeup(struct mmc_request *req)
288114b4164SWarner Losh {
289114b4164SWarner Losh 	struct mmc_softc *sc;
290114b4164SWarner Losh 
2916fdacf52SWarner Losh /*	printf("Wakeup for req %p done_data %p\n", req, req->done_data); */
292114b4164SWarner Losh 	sc = (struct mmc_softc *)req->done_data;
293114b4164SWarner Losh 	MMC_LOCK(sc);
294114b4164SWarner Losh 	req->flags |= MMC_REQ_DONE;
295114b4164SWarner Losh 	wakeup(req);
296114b4164SWarner Losh 	MMC_UNLOCK(sc);
297114b4164SWarner Losh }
298114b4164SWarner Losh 
299114b4164SWarner Losh static int
300114b4164SWarner Losh mmc_wait_for_req(struct mmc_softc *sc, struct mmc_request *req)
301114b4164SWarner Losh {
302114b4164SWarner Losh 	int err;
303114b4164SWarner Losh 
304114b4164SWarner Losh 	req->done = mmc_wakeup;
305114b4164SWarner Losh 	req->done_data = sc;
3066fdacf52SWarner Losh /*	printf("Submitting request %p sc %p\n", req, sc); */
307114b4164SWarner Losh 	MMCBR_REQUEST(device_get_parent(sc->dev), sc->dev, req);
308114b4164SWarner Losh 	MMC_LOCK(sc);
309114b4164SWarner Losh 	do {
310114b4164SWarner Losh 		err = msleep(req, &sc->sc_mtx, PZERO | PCATCH, "mmcreq",
311114b4164SWarner Losh 		    hz / 10);
312114b4164SWarner Losh 	} while (!(req->flags & MMC_REQ_DONE) && err == EAGAIN);
3136fdacf52SWarner Losh /*	printf("Request %p done with error %d\n", req, err); */
314114b4164SWarner Losh 	MMC_UNLOCK(sc);
315114b4164SWarner Losh 	return (err);
316114b4164SWarner Losh }
317114b4164SWarner Losh 
318114b4164SWarner Losh static int
319114b4164SWarner Losh mmc_wait_for_request(device_t brdev, device_t reqdev, struct mmc_request *req)
320114b4164SWarner Losh {
321114b4164SWarner Losh 	struct mmc_softc *sc = device_get_softc(brdev);
322114b4164SWarner Losh 
323128d0ff2SWarner Losh 	return (mmc_wait_for_req(sc, req));
324114b4164SWarner Losh }
325114b4164SWarner Losh 
326114b4164SWarner Losh static int
327114b4164SWarner Losh mmc_wait_for_cmd(struct mmc_softc *sc, struct mmc_command *cmd, int retries)
328114b4164SWarner Losh {
329114b4164SWarner Losh 	struct mmc_request mreq;
330114b4164SWarner Losh 
331114b4164SWarner Losh 	memset(&mreq, 0, sizeof(mreq));
332114b4164SWarner Losh 	memset(cmd->resp, 0, sizeof(cmd->resp));
333114b4164SWarner Losh 	cmd->retries = retries;
334114b4164SWarner Losh 	mreq.cmd = cmd;
3356fdacf52SWarner Losh /*	printf("CMD: %x ARG %x\n", cmd->opcode, cmd->arg); */
336114b4164SWarner Losh 	mmc_wait_for_req(sc, &mreq);
337114b4164SWarner Losh 	return (cmd->error);
338114b4164SWarner Losh }
339114b4164SWarner Losh 
340114b4164SWarner Losh static int
341114b4164SWarner Losh mmc_wait_for_app_cmd(struct mmc_softc *sc, uint32_t rca,
342114b4164SWarner Losh     struct mmc_command *cmd, int retries)
343114b4164SWarner Losh {
344114b4164SWarner Losh 	struct mmc_command appcmd;
345114b4164SWarner Losh 	int err = MMC_ERR_NONE, i;
346114b4164SWarner Losh 
347114b4164SWarner Losh 	for (i = 0; i <= retries; i++) {
348114b4164SWarner Losh 		appcmd.opcode = MMC_APP_CMD;
349114b4164SWarner Losh 		appcmd.arg = rca << 16;
350114b4164SWarner Losh 		appcmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
3514e0efe35SWarner Losh 		appcmd.data = NULL;
352114b4164SWarner Losh 		mmc_wait_for_cmd(sc, &appcmd, 0);
353114b4164SWarner Losh 		err = appcmd.error;
354114b4164SWarner Losh 		if (err != MMC_ERR_NONE)
355114b4164SWarner Losh 			continue;
356114b4164SWarner Losh 		if (!(appcmd.resp[0] & R1_APP_CMD))
357114b4164SWarner Losh 			return MMC_ERR_FAILED;
358114b4164SWarner Losh 		mmc_wait_for_cmd(sc, cmd, 0);
359114b4164SWarner Losh 		err = cmd->error;
360114b4164SWarner Losh 		if (err == MMC_ERR_NONE)
361114b4164SWarner Losh 			break;
362114b4164SWarner Losh 	}
363114b4164SWarner Losh 	return (err);
364114b4164SWarner Losh }
365114b4164SWarner Losh 
366114b4164SWarner Losh static int
367114b4164SWarner Losh mmc_wait_for_command(struct mmc_softc *sc, uint32_t opcode,
368114b4164SWarner Losh     uint32_t arg, uint32_t flags, uint32_t *resp, int retries)
369114b4164SWarner Losh {
370114b4164SWarner Losh 	struct mmc_command cmd;
371114b4164SWarner Losh 	int err;
372114b4164SWarner Losh 
373114b4164SWarner Losh 	memset(&cmd, 0, sizeof(cmd));
374114b4164SWarner Losh 	cmd.opcode = opcode;
375114b4164SWarner Losh 	cmd.arg = arg;
376114b4164SWarner Losh 	cmd.flags = flags;
3774e0efe35SWarner Losh 	cmd.data = NULL;
378114b4164SWarner Losh 	err = mmc_wait_for_cmd(sc, &cmd, retries);
379114b4164SWarner Losh 	if (err)
380114b4164SWarner Losh 		return (err);
381114b4164SWarner Losh 	if (cmd.error)
382114b4164SWarner Losh 		return (cmd.error);
383114b4164SWarner Losh 	if (resp) {
384114b4164SWarner Losh 		if (flags & MMC_RSP_136)
385114b4164SWarner Losh 			memcpy(resp, cmd.resp, 4 * sizeof(uint32_t));
386114b4164SWarner Losh 		else
387114b4164SWarner Losh 			*resp = cmd.resp[0];
388114b4164SWarner Losh 	}
389114b4164SWarner Losh 	return (0);
390114b4164SWarner Losh }
391114b4164SWarner Losh 
392114b4164SWarner Losh static void
393114b4164SWarner Losh mmc_idle_cards(struct mmc_softc *sc)
394114b4164SWarner Losh {
395114b4164SWarner Losh 	device_t dev;
396114b4164SWarner Losh 	struct mmc_command cmd;
397114b4164SWarner Losh 
398114b4164SWarner Losh 	dev = sc->dev;
399114b4164SWarner Losh 	mmcbr_set_chip_select(dev, cs_high);
400114b4164SWarner Losh 	mmcbr_update_ios(dev);
401114b4164SWarner Losh 	mmc_ms_delay(1);
402114b4164SWarner Losh 
403114b4164SWarner Losh 	memset(&cmd, 0, sizeof(cmd));
404114b4164SWarner Losh 	cmd.opcode = MMC_GO_IDLE_STATE;
405114b4164SWarner Losh 	cmd.arg = 0;
406114b4164SWarner Losh 	cmd.flags = MMC_RSP_NONE | MMC_CMD_BC;
4074e0efe35SWarner Losh 	cmd.data = NULL;
408114b4164SWarner Losh 	mmc_wait_for_cmd(sc, &cmd, 0);
409114b4164SWarner Losh 	mmc_ms_delay(1);
410114b4164SWarner Losh 
411114b4164SWarner Losh 	mmcbr_set_chip_select(dev, cs_dontcare);
412114b4164SWarner Losh 	mmcbr_update_ios(dev);
413114b4164SWarner Losh 	mmc_ms_delay(1);
414114b4164SWarner Losh }
415114b4164SWarner Losh 
416114b4164SWarner Losh static int
417114b4164SWarner Losh mmc_send_app_op_cond(struct mmc_softc *sc, uint32_t ocr, uint32_t *rocr)
418114b4164SWarner Losh {
419114b4164SWarner Losh 	struct mmc_command cmd;
420114b4164SWarner Losh 	int err = MMC_ERR_NONE, i;
421114b4164SWarner Losh 
422114b4164SWarner Losh 	memset(&cmd, 0, sizeof(cmd));
423114b4164SWarner Losh 	cmd.opcode = ACMD_SD_SEND_OP_COND;
424114b4164SWarner Losh 	cmd.arg = ocr;
425114b4164SWarner Losh 	cmd.flags = MMC_RSP_R3 | MMC_CMD_BCR;
4264e0efe35SWarner Losh 	cmd.data = NULL;
427114b4164SWarner Losh 
4286634080bSWarner Losh 	for (i = 0; i < 100; i++) {
429114b4164SWarner Losh 		err = mmc_wait_for_app_cmd(sc, 0, &cmd, CMD_RETRIES);
430114b4164SWarner Losh 		if (err != MMC_ERR_NONE)
431114b4164SWarner Losh 			break;
43249dd20d1SAlexander Motin 		if ((cmd.resp[0] & MMC_OCR_CARD_BUSY) ||
43349dd20d1SAlexander Motin 		    (ocr & MMC_OCR_VOLTAGE) == 0)
434114b4164SWarner Losh 			break;
435114b4164SWarner Losh 		err = MMC_ERR_TIMEOUT;
436114b4164SWarner Losh 		mmc_ms_delay(10);
437114b4164SWarner Losh 	}
438114b4164SWarner Losh 	if (rocr && err == MMC_ERR_NONE)
439114b4164SWarner Losh 		*rocr = cmd.resp[0];
440128d0ff2SWarner Losh 	return (err);
441114b4164SWarner Losh }
442114b4164SWarner Losh 
443114b4164SWarner Losh static int
444114b4164SWarner Losh mmc_send_op_cond(struct mmc_softc *sc, uint32_t ocr, uint32_t *rocr)
445114b4164SWarner Losh {
446114b4164SWarner Losh 	struct mmc_command cmd;
447114b4164SWarner Losh 	int err = MMC_ERR_NONE, i;
448114b4164SWarner Losh 
449114b4164SWarner Losh 	memset(&cmd, 0, sizeof(cmd));
450114b4164SWarner Losh 	cmd.opcode = MMC_SEND_OP_COND;
451114b4164SWarner Losh 	cmd.arg = ocr;
452114b4164SWarner Losh 	cmd.flags = MMC_RSP_R3 | MMC_CMD_BCR;
4534e0efe35SWarner Losh 	cmd.data = NULL;
454114b4164SWarner Losh 
455114b4164SWarner Losh 	for (i = 0; i < 100; i++) {
456114b4164SWarner Losh 		err = mmc_wait_for_cmd(sc, &cmd, CMD_RETRIES);
457114b4164SWarner Losh 		if (err != MMC_ERR_NONE)
458114b4164SWarner Losh 			break;
45949dd20d1SAlexander Motin 		if ((cmd.resp[0] & MMC_OCR_CARD_BUSY) ||
46049dd20d1SAlexander Motin 		    (ocr & MMC_OCR_VOLTAGE) == 0)
461114b4164SWarner Losh 			break;
462114b4164SWarner Losh 		err = MMC_ERR_TIMEOUT;
463114b4164SWarner Losh 		mmc_ms_delay(10);
464114b4164SWarner Losh 	}
465114b4164SWarner Losh 	if (rocr && err == MMC_ERR_NONE)
466114b4164SWarner Losh 		*rocr = cmd.resp[0];
467128d0ff2SWarner Losh 	return (err);
468114b4164SWarner Losh }
469114b4164SWarner Losh 
470c18f1e26SAlexander Motin static int
471c18f1e26SAlexander Motin mmc_send_if_cond(struct mmc_softc *sc, uint8_t vhs)
472c18f1e26SAlexander Motin {
473c18f1e26SAlexander Motin 	struct mmc_command cmd;
474c18f1e26SAlexander Motin 	int err;
475c18f1e26SAlexander Motin 
476c18f1e26SAlexander Motin 	memset(&cmd, 0, sizeof(cmd));
477c18f1e26SAlexander Motin 	cmd.opcode = SD_SEND_IF_COND;
478c18f1e26SAlexander Motin 	cmd.arg = (vhs << 8) + 0xAA;
479c18f1e26SAlexander Motin 	cmd.flags = MMC_RSP_R7 | MMC_CMD_BCR;
480c18f1e26SAlexander Motin 	cmd.data = NULL;
481c18f1e26SAlexander Motin 
482c18f1e26SAlexander Motin 	err = mmc_wait_for_cmd(sc, &cmd, CMD_RETRIES);
483c18f1e26SAlexander Motin 	return (err);
484c18f1e26SAlexander Motin }
485c18f1e26SAlexander Motin 
486114b4164SWarner Losh static void
487114b4164SWarner Losh mmc_power_up(struct mmc_softc *sc)
488114b4164SWarner Losh {
489114b4164SWarner Losh 	device_t dev;
490114b4164SWarner Losh 
491114b4164SWarner Losh 	dev = sc->dev;
492114b4164SWarner Losh 	mmcbr_set_vdd(dev, mmc_highest_voltage(mmcbr_get_host_ocr(dev)));
493114b4164SWarner Losh 	mmcbr_set_bus_mode(dev, opendrain);
494114b4164SWarner Losh 	mmcbr_set_chip_select(dev, cs_dontcare);
495114b4164SWarner Losh 	mmcbr_set_bus_width(dev, bus_width_1);
496114b4164SWarner Losh 	mmcbr_set_power_mode(dev, power_up);
497114b4164SWarner Losh 	mmcbr_set_clock(dev, 0);
498114b4164SWarner Losh 	mmcbr_update_ios(dev);
499114b4164SWarner Losh 	mmc_ms_delay(1);
500114b4164SWarner Losh 
501114b4164SWarner Losh 	mmcbr_set_clock(dev, mmcbr_get_f_min(sc->dev));
502c18f1e26SAlexander Motin 	mmcbr_set_timing(dev, bus_timing_normal);
503114b4164SWarner Losh 	mmcbr_set_power_mode(dev, power_on);
504114b4164SWarner Losh 	mmcbr_update_ios(dev);
505114b4164SWarner Losh 	mmc_ms_delay(2);
506114b4164SWarner Losh }
507114b4164SWarner Losh 
5085d2f6510SWarner Losh static void
5095d2f6510SWarner Losh mmc_power_down(struct mmc_softc *sc)
5105d2f6510SWarner Losh {
5115d2f6510SWarner Losh 	device_t dev = sc->dev;
5125d2f6510SWarner Losh 
5135d2f6510SWarner Losh 	mmcbr_set_bus_mode(dev, opendrain);
5145d2f6510SWarner Losh 	mmcbr_set_chip_select(dev, cs_dontcare);
5155d2f6510SWarner Losh 	mmcbr_set_bus_width(dev, bus_width_1);
5165d2f6510SWarner Losh 	mmcbr_set_power_mode(dev, power_off);
5175d2f6510SWarner Losh 	mmcbr_set_clock(dev, 0);
518c18f1e26SAlexander Motin 	mmcbr_set_timing(dev, bus_timing_normal);
5195d2f6510SWarner Losh 	mmcbr_update_ios(dev);
5205d2f6510SWarner Losh }
5215d2f6510SWarner Losh 
522c18f1e26SAlexander Motin static int
523c18f1e26SAlexander Motin mmc_select_card(struct mmc_softc *sc, uint16_t rca)
524c18f1e26SAlexander Motin {
525c18f1e26SAlexander Motin 	return (mmc_wait_for_command(sc, MMC_SELECT_CARD, ((uint32_t)rca) << 16,
526c18f1e26SAlexander Motin 	    MMC_RSP_R1B | MMC_CMD_AC, NULL, CMD_RETRIES));
527c18f1e26SAlexander Motin }
528c18f1e26SAlexander Motin 
529c18f1e26SAlexander Motin static int
530c18f1e26SAlexander Motin mmc_switch(struct mmc_softc *sc, uint8_t set, uint8_t index, uint8_t value)
531c18f1e26SAlexander Motin {
532c18f1e26SAlexander Motin 	struct mmc_command cmd;
533c18f1e26SAlexander Motin 	int err;
534c18f1e26SAlexander Motin 
535c18f1e26SAlexander Motin 	cmd.opcode = MMC_SWITCH_FUNC;
536c18f1e26SAlexander Motin 	cmd.arg = (MMC_SWITCH_FUNC_WR << 24) |
537c18f1e26SAlexander Motin 	    (index << 16) |
538c18f1e26SAlexander Motin 	    (value << 8) |
539c18f1e26SAlexander Motin 	    set;
540c18f1e26SAlexander Motin 	cmd.flags = MMC_RSP_R1B | MMC_CMD_AC;
541c18f1e26SAlexander Motin 	cmd.data = NULL;
542c18f1e26SAlexander Motin 	err = mmc_wait_for_cmd(sc, &cmd, 0);
543c18f1e26SAlexander Motin 	return (err);
544c18f1e26SAlexander Motin }
545c18f1e26SAlexander Motin 
546c18f1e26SAlexander Motin static int
547c18f1e26SAlexander Motin mmc_sd_switch(struct mmc_softc *sc, uint8_t mode, uint8_t grp, uint8_t value, uint8_t *res)
548c18f1e26SAlexander Motin {
549c18f1e26SAlexander Motin 	int err;
550c18f1e26SAlexander Motin 	struct mmc_command cmd;
551c18f1e26SAlexander Motin 	struct mmc_data data;
552c18f1e26SAlexander Motin 
553c18f1e26SAlexander Motin 	memset(&cmd, 0, sizeof(struct mmc_command));
554c18f1e26SAlexander Motin 	memset(&data, 0, sizeof(struct mmc_data));
555c18f1e26SAlexander Motin 
556c18f1e26SAlexander Motin 	memset(res, 0, 64);
557c18f1e26SAlexander Motin 	cmd.opcode = SD_SWITCH_FUNC;
558c18f1e26SAlexander Motin 	cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
559c18f1e26SAlexander Motin 	cmd.arg = mode << 31;
560c18f1e26SAlexander Motin 	cmd.arg |= 0x00FFFFFF;
56107492efeSAlexander Motin 	cmd.arg &= ~(0xF << (grp * 4));
56207492efeSAlexander Motin 	cmd.arg |= value << (grp * 4);
563c18f1e26SAlexander Motin 	cmd.data = &data;
564c18f1e26SAlexander Motin 
565c18f1e26SAlexander Motin 	data.data = res;
566c18f1e26SAlexander Motin 	data.len = 64;
567c18f1e26SAlexander Motin 	data.flags = MMC_DATA_READ;
568c18f1e26SAlexander Motin 
569c18f1e26SAlexander Motin 	err = mmc_wait_for_cmd(sc, &cmd, CMD_RETRIES);
570c18f1e26SAlexander Motin 	return (err);
571c18f1e26SAlexander Motin }
572c18f1e26SAlexander Motin 
573c18f1e26SAlexander Motin static int
574c18f1e26SAlexander Motin mmc_set_bus_width(struct mmc_softc *sc, uint16_t rca, int width)
575c18f1e26SAlexander Motin {
576c18f1e26SAlexander Motin 	int err;
577c18f1e26SAlexander Motin 
578c18f1e26SAlexander Motin 	if (mmcbr_get_mode(sc->dev) == mode_sd) {
579c18f1e26SAlexander Motin 		struct mmc_command cmd;
580c18f1e26SAlexander Motin 
581c18f1e26SAlexander Motin 		memset(&cmd, 0, sizeof(struct mmc_command));
582c18f1e26SAlexander Motin 		cmd.opcode = ACMD_SET_BUS_WIDTH;
583c18f1e26SAlexander Motin 		cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
584c18f1e26SAlexander Motin 		switch (width) {
585c18f1e26SAlexander Motin 		case bus_width_1:
586c18f1e26SAlexander Motin 			cmd.arg = SD_BUS_WIDTH_1;
587c18f1e26SAlexander Motin 			break;
588c18f1e26SAlexander Motin 		case bus_width_4:
589c18f1e26SAlexander Motin 			cmd.arg = SD_BUS_WIDTH_4;
590c18f1e26SAlexander Motin 			break;
591c18f1e26SAlexander Motin 		default:
592c18f1e26SAlexander Motin 			return (MMC_ERR_INVALID);
593c18f1e26SAlexander Motin 		}
594c18f1e26SAlexander Motin 		err = mmc_wait_for_app_cmd(sc, rca, &cmd, CMD_RETRIES);
595c18f1e26SAlexander Motin 	} else {
596c18f1e26SAlexander Motin 		uint8_t	value;
597c18f1e26SAlexander Motin 
598c18f1e26SAlexander Motin 		switch (width) {
599c18f1e26SAlexander Motin 		case bus_width_1:
600c18f1e26SAlexander Motin 			value = EXT_CSD_BUS_WIDTH_1;
601c18f1e26SAlexander Motin 			break;
602c18f1e26SAlexander Motin 		case bus_width_4:
603c18f1e26SAlexander Motin 			value = EXT_CSD_BUS_WIDTH_4;
604c18f1e26SAlexander Motin 			break;
605c18f1e26SAlexander Motin 		case bus_width_8:
606c18f1e26SAlexander Motin 			value = EXT_CSD_BUS_WIDTH_8;
607c18f1e26SAlexander Motin 			break;
608c18f1e26SAlexander Motin 		default:
609c18f1e26SAlexander Motin 			return (MMC_ERR_INVALID);
610c18f1e26SAlexander Motin 		}
611c18f1e26SAlexander Motin 		err = mmc_switch(sc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_BUS_WIDTH, value);
612c18f1e26SAlexander Motin 	}
613c18f1e26SAlexander Motin 	return (err);
614c18f1e26SAlexander Motin }
615c18f1e26SAlexander Motin 
616c18f1e26SAlexander Motin static int
617c18f1e26SAlexander Motin mmc_set_timing(struct mmc_softc *sc, int timing)
618c18f1e26SAlexander Motin {
619c18f1e26SAlexander Motin 	int err;
620c18f1e26SAlexander Motin 	uint8_t	value;
621c18f1e26SAlexander Motin 
622c18f1e26SAlexander Motin 	switch (timing) {
623c18f1e26SAlexander Motin 	case bus_timing_normal:
624c18f1e26SAlexander Motin 		value = 0;
625c18f1e26SAlexander Motin 		break;
626c18f1e26SAlexander Motin 	case bus_timing_hs:
627c18f1e26SAlexander Motin 		value = 1;
628c18f1e26SAlexander Motin 		break;
629c18f1e26SAlexander Motin 	default:
630c18f1e26SAlexander Motin 		return (MMC_ERR_INVALID);
631c18f1e26SAlexander Motin 	}
632c18f1e26SAlexander Motin 	if (mmcbr_get_mode(sc->dev) == mode_sd) {
633c18f1e26SAlexander Motin 		u_char switch_res[64];
634c18f1e26SAlexander Motin 
635c18f1e26SAlexander Motin 		err = mmc_sd_switch(sc, 1, 0, value, switch_res);
636c18f1e26SAlexander Motin 	} else {
637c18f1e26SAlexander Motin 		err = mmc_switch(sc, EXT_CSD_CMD_SET_NORMAL,
638c18f1e26SAlexander Motin 		    EXT_CSD_HS_TIMING, value);
639c18f1e26SAlexander Motin 	}
640c18f1e26SAlexander Motin 	return (err);
641c18f1e26SAlexander Motin }
642c18f1e26SAlexander Motin 
643c18f1e26SAlexander Motin static int
644c18f1e26SAlexander Motin mmc_test_bus_width(struct mmc_softc *sc)
645c18f1e26SAlexander Motin {
646c18f1e26SAlexander Motin 	struct mmc_command cmd;
647c18f1e26SAlexander Motin 	struct mmc_data data;
648c18f1e26SAlexander Motin 	int err;
649c18f1e26SAlexander Motin 	uint8_t buf[8];
650c18f1e26SAlexander Motin 	uint8_t	p8[8] =   { 0x55, 0xAA, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
651c18f1e26SAlexander Motin 	uint8_t	p8ok[8] = { 0xAA, 0x55, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
652c18f1e26SAlexander Motin 	uint8_t	p4[4] =   { 0x5A, 0x00, 0x00, 0x00, };
653c18f1e26SAlexander Motin 	uint8_t	p4ok[4] = { 0xA5, 0x00, 0x00, 0x00, };
654c18f1e26SAlexander Motin 
655c18f1e26SAlexander Motin 	if (mmcbr_get_caps(sc->dev) & MMC_CAP_8_BIT_DATA) {
656c18f1e26SAlexander Motin 		mmcbr_set_bus_width(sc->dev, bus_width_8);
657c18f1e26SAlexander Motin 		mmcbr_update_ios(sc->dev);
658c18f1e26SAlexander Motin 
659c18f1e26SAlexander Motin 		cmd.opcode = MMC_BUSTEST_W;
660c18f1e26SAlexander Motin 		cmd.arg = 0;
661c18f1e26SAlexander Motin 		cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
662c18f1e26SAlexander Motin 		cmd.data = &data;
663c18f1e26SAlexander Motin 
664c18f1e26SAlexander Motin 		data.data = p8;
665c18f1e26SAlexander Motin 		data.len = 8;
666c18f1e26SAlexander Motin 		data.flags = MMC_DATA_WRITE;
667c18f1e26SAlexander Motin 		mmc_wait_for_cmd(sc, &cmd, 0);
668c18f1e26SAlexander Motin 
669c18f1e26SAlexander Motin 		cmd.opcode = MMC_BUSTEST_R;
670c18f1e26SAlexander Motin 		cmd.arg = 0;
671c18f1e26SAlexander Motin 		cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
672c18f1e26SAlexander Motin 		cmd.data = &data;
673c18f1e26SAlexander Motin 
674c18f1e26SAlexander Motin 		data.data = buf;
675c18f1e26SAlexander Motin 		data.len = 8;
676c18f1e26SAlexander Motin 		data.flags = MMC_DATA_READ;
677c18f1e26SAlexander Motin 		err = mmc_wait_for_cmd(sc, &cmd, 0);
678c18f1e26SAlexander Motin 
679c18f1e26SAlexander Motin 		mmcbr_set_bus_width(sc->dev, bus_width_1);
680c18f1e26SAlexander Motin 		mmcbr_update_ios(sc->dev);
681c18f1e26SAlexander Motin 
682c18f1e26SAlexander Motin 		if (err == MMC_ERR_NONE && memcmp(buf, p8ok, 8) == 0)
683c18f1e26SAlexander Motin 			return (bus_width_8);
684c18f1e26SAlexander Motin 	}
685c18f1e26SAlexander Motin 
686c18f1e26SAlexander Motin 	if (mmcbr_get_caps(sc->dev) & MMC_CAP_4_BIT_DATA) {
687c18f1e26SAlexander Motin 		mmcbr_set_bus_width(sc->dev, bus_width_4);
688c18f1e26SAlexander Motin 		mmcbr_update_ios(sc->dev);
689c18f1e26SAlexander Motin 
690c18f1e26SAlexander Motin 		cmd.opcode = MMC_BUSTEST_W;
691c18f1e26SAlexander Motin 		cmd.arg = 0;
692c18f1e26SAlexander Motin 		cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
693c18f1e26SAlexander Motin 		cmd.data = &data;
694c18f1e26SAlexander Motin 
695c18f1e26SAlexander Motin 		data.data = p4;
696c18f1e26SAlexander Motin 		data.len = 4;
697c18f1e26SAlexander Motin 		data.flags = MMC_DATA_WRITE;
698c18f1e26SAlexander Motin 		mmc_wait_for_cmd(sc, &cmd, 0);
699c18f1e26SAlexander Motin 
700c18f1e26SAlexander Motin 		cmd.opcode = MMC_BUSTEST_R;
701c18f1e26SAlexander Motin 		cmd.arg = 0;
702c18f1e26SAlexander Motin 		cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
703c18f1e26SAlexander Motin 		cmd.data = &data;
704c18f1e26SAlexander Motin 
705c18f1e26SAlexander Motin 		data.data = buf;
706c18f1e26SAlexander Motin 		data.len = 4;
707c18f1e26SAlexander Motin 		data.flags = MMC_DATA_READ;
708c18f1e26SAlexander Motin 		err = mmc_wait_for_cmd(sc, &cmd, 0);
709c18f1e26SAlexander Motin 
710c18f1e26SAlexander Motin 		mmcbr_set_bus_width(sc->dev, bus_width_1);
711c18f1e26SAlexander Motin 		mmcbr_update_ios(sc->dev);
712c18f1e26SAlexander Motin 
713c18f1e26SAlexander Motin 		if (err == MMC_ERR_NONE && memcmp(buf, p4ok, 4) == 0)
714c18f1e26SAlexander Motin 			return (bus_width_4);
715c18f1e26SAlexander Motin 	}
716c18f1e26SAlexander Motin 	return (bus_width_1);
717c18f1e26SAlexander Motin }
718c18f1e26SAlexander Motin 
719114b4164SWarner Losh static uint32_t
720114b4164SWarner Losh mmc_get_bits(uint32_t *bits, int start, int size)
721114b4164SWarner Losh {
7224871891eSWarner Losh 	const int bit_len = 128;
7234871891eSWarner Losh 	const int i = (bit_len / 32) - (start / 32) - 1;
724114b4164SWarner Losh 	const int shift = start & 31;
725114b4164SWarner Losh 	uint32_t retval = bits[i] >> shift;
726114b4164SWarner Losh 	if (size + shift > 32)
727114b4164SWarner Losh 		retval |= bits[i - 1] << (32 - shift);
728128d0ff2SWarner Losh 	return (retval & ((1 << size) - 1));
729114b4164SWarner Losh }
730114b4164SWarner Losh 
731114b4164SWarner Losh static void
7324871891eSWarner Losh mmc_decode_cid_sd(uint32_t *raw_cid, struct mmc_cid *cid)
733114b4164SWarner Losh {
734114b4164SWarner Losh 	int i;
735114b4164SWarner Losh 
736114b4164SWarner Losh 	/* There's no version info, so we take it on faith */
7374871891eSWarner Losh 	memset(cid, 0, sizeof(*cid));
738114b4164SWarner Losh 	cid->mid = mmc_get_bits(raw_cid, 120, 8);
739114b4164SWarner Losh 	cid->oid = mmc_get_bits(raw_cid, 104, 16);
740114b4164SWarner Losh 	for (i = 0; i < 5; i++)
741114b4164SWarner Losh 		cid->pnm[i] = mmc_get_bits(raw_cid, 96 - i * 8, 8);
742114b4164SWarner Losh 	cid->prv = mmc_get_bits(raw_cid, 56, 8);
743114b4164SWarner Losh 	cid->psn = mmc_get_bits(raw_cid, 24, 32);
744114b4164SWarner Losh 	cid->mdt_year = mmc_get_bits(raw_cid, 12, 8) + 2001;
745114b4164SWarner Losh 	cid->mdt_month = mmc_get_bits(raw_cid, 8, 4);
7464871891eSWarner Losh }
7474871891eSWarner Losh 
7484871891eSWarner Losh static void
7494871891eSWarner Losh mmc_decode_cid_mmc(uint32_t *raw_cid, struct mmc_cid *cid)
7504871891eSWarner Losh {
7514871891eSWarner Losh 	int i;
7524871891eSWarner Losh 
7534871891eSWarner Losh 	/* There's no version info, so we take it on faith */
7544871891eSWarner Losh 	memset(cid, 0, sizeof(*cid));
755c18f1e26SAlexander Motin 	cid->mid = mmc_get_bits(raw_cid, 120, 8);
756c18f1e26SAlexander Motin 	cid->oid = mmc_get_bits(raw_cid, 104, 8);
757c18f1e26SAlexander Motin 	for (i = 0; i < 6; i++)
758c18f1e26SAlexander Motin 		cid->pnm[i] = mmc_get_bits(raw_cid, 96 - i * 8, 8);
759c18f1e26SAlexander Motin 	cid->prv = mmc_get_bits(raw_cid, 48, 8);
760c18f1e26SAlexander Motin 	cid->psn = mmc_get_bits(raw_cid, 16, 32);
761c18f1e26SAlexander Motin 	cid->mdt_month = mmc_get_bits(raw_cid, 12, 4);
762c18f1e26SAlexander Motin 	cid->mdt_year = mmc_get_bits(raw_cid, 8, 4) + 1997;
763114b4164SWarner Losh }
764114b4164SWarner Losh 
765114b4164SWarner Losh static const int exp[8] = {
766114b4164SWarner Losh 	1, 10, 100, 1000, 10000, 100000, 1000000, 10000000
767114b4164SWarner Losh };
768114b4164SWarner Losh static const int mant[16] = {
769114b4164SWarner Losh 	10, 12, 13, 15, 20, 25, 30, 35, 40, 45, 50, 55, 60, 70, 80
770114b4164SWarner Losh };
771114b4164SWarner Losh static const int cur_min[8] = {
772114b4164SWarner Losh 	500, 1000, 5000, 10000, 25000, 35000, 60000, 100000
773114b4164SWarner Losh };
774114b4164SWarner Losh static const int cur_max[8] = {
775114b4164SWarner Losh 	1000, 5000, 10000, 25000, 35000, 45000, 800000, 200000
776114b4164SWarner Losh };
777114b4164SWarner Losh 
778114b4164SWarner Losh static void
7794871891eSWarner Losh mmc_decode_csd_sd(uint32_t *raw_csd, struct mmc_csd *csd)
780114b4164SWarner Losh {
781114b4164SWarner Losh 	int v;
782114b4164SWarner Losh 	int m;
783114b4164SWarner Losh 	int e;
784114b4164SWarner Losh 
785114b4164SWarner Losh 	memset(csd, 0, sizeof(*csd));
786114b4164SWarner Losh 	csd->csd_structure = v = mmc_get_bits(raw_csd, 126, 2);
787114b4164SWarner Losh 	if (v == 0) {
788114b4164SWarner Losh 		m = mmc_get_bits(raw_csd, 115, 4);
789114b4164SWarner Losh 		e = mmc_get_bits(raw_csd, 112, 3);
790114b4164SWarner Losh 		csd->tacc = exp[e] * mant[m] + 9 / 10;
791114b4164SWarner Losh 		csd->nsac = mmc_get_bits(raw_csd, 104, 8) * 100;
792114b4164SWarner Losh 		m = mmc_get_bits(raw_csd, 99, 4);
793114b4164SWarner Losh 		e = mmc_get_bits(raw_csd, 96, 3);
794114b4164SWarner Losh 		csd->tran_speed = exp[e] * 10000 * mant[m];
795114b4164SWarner Losh 		csd->ccc = mmc_get_bits(raw_csd, 84, 12);
796114b4164SWarner Losh 		csd->read_bl_len = 1 << mmc_get_bits(raw_csd, 80, 4);
797114b4164SWarner Losh 		csd->read_bl_partial = mmc_get_bits(raw_csd, 79, 1);
798114b4164SWarner Losh 		csd->write_blk_misalign = mmc_get_bits(raw_csd, 78, 1);
799114b4164SWarner Losh 		csd->read_blk_misalign = mmc_get_bits(raw_csd, 77, 1);
800114b4164SWarner Losh 		csd->dsr_imp = mmc_get_bits(raw_csd, 76, 1);
801114b4164SWarner Losh 		csd->vdd_r_curr_min = cur_min[mmc_get_bits(raw_csd, 59, 3)];
802114b4164SWarner Losh 		csd->vdd_r_curr_max = cur_max[mmc_get_bits(raw_csd, 56, 3)];
803114b4164SWarner Losh 		csd->vdd_w_curr_min = cur_min[mmc_get_bits(raw_csd, 53, 3)];
804114b4164SWarner Losh 		csd->vdd_w_curr_max = cur_max[mmc_get_bits(raw_csd, 50, 3)];
805114b4164SWarner Losh 		m = mmc_get_bits(raw_csd, 62, 12);
806114b4164SWarner Losh 		e = mmc_get_bits(raw_csd, 47, 3);
807114b4164SWarner Losh 		csd->capacity = ((1 + m) << (e + 2)) * csd->read_bl_len;
808114b4164SWarner Losh 		csd->erase_blk_en = mmc_get_bits(raw_csd, 46, 1);
809114b4164SWarner Losh 		csd->sector_size = mmc_get_bits(raw_csd, 39, 7);
810114b4164SWarner Losh 		csd->wp_grp_size = mmc_get_bits(raw_csd, 32, 7);
811114b4164SWarner Losh 		csd->wp_grp_enable = mmc_get_bits(raw_csd, 31, 1);
812114b4164SWarner Losh 		csd->r2w_factor = 1 << mmc_get_bits(raw_csd, 26, 3);
813114b4164SWarner Losh 		csd->write_bl_len = 1 << mmc_get_bits(raw_csd, 22, 4);
814114b4164SWarner Losh 		csd->write_bl_partial = mmc_get_bits(raw_csd, 21, 1);
815114b4164SWarner Losh 	} else if (v == 1) {
816c18f1e26SAlexander Motin 		m = mmc_get_bits(raw_csd, 115, 4);
817c18f1e26SAlexander Motin 		e = mmc_get_bits(raw_csd, 112, 3);
818c18f1e26SAlexander Motin 		csd->tacc = exp[e] * mant[m] + 9 / 10;
819c18f1e26SAlexander Motin 		csd->nsac = mmc_get_bits(raw_csd, 104, 8) * 100;
820c18f1e26SAlexander Motin 		m = mmc_get_bits(raw_csd, 99, 4);
821c18f1e26SAlexander Motin 		e = mmc_get_bits(raw_csd, 96, 3);
822c18f1e26SAlexander Motin 		csd->tran_speed = exp[e] * 10000 * mant[m];
823c18f1e26SAlexander Motin 		csd->ccc = mmc_get_bits(raw_csd, 84, 12);
824c18f1e26SAlexander Motin 		csd->read_bl_len = 1 << mmc_get_bits(raw_csd, 80, 4);
825c18f1e26SAlexander Motin 		csd->read_bl_partial = mmc_get_bits(raw_csd, 79, 1);
826c18f1e26SAlexander Motin 		csd->write_blk_misalign = mmc_get_bits(raw_csd, 78, 1);
827c18f1e26SAlexander Motin 		csd->read_blk_misalign = mmc_get_bits(raw_csd, 77, 1);
828c18f1e26SAlexander Motin 		csd->dsr_imp = mmc_get_bits(raw_csd, 76, 1);
829c18f1e26SAlexander Motin 		csd->capacity = ((uint64_t)mmc_get_bits(raw_csd, 48, 22) + 1) *
830c18f1e26SAlexander Motin 		    512 * 1024;
831c18f1e26SAlexander Motin 		csd->erase_blk_en = mmc_get_bits(raw_csd, 46, 1);
832c18f1e26SAlexander Motin 		csd->sector_size = mmc_get_bits(raw_csd, 39, 7);
833c18f1e26SAlexander Motin 		csd->wp_grp_size = mmc_get_bits(raw_csd, 32, 7);
834c18f1e26SAlexander Motin 		csd->wp_grp_enable = mmc_get_bits(raw_csd, 31, 1);
835c18f1e26SAlexander Motin 		csd->r2w_factor = 1 << mmc_get_bits(raw_csd, 26, 3);
836c18f1e26SAlexander Motin 		csd->write_bl_len = 1 << mmc_get_bits(raw_csd, 22, 4);
837c18f1e26SAlexander Motin 		csd->write_bl_partial = mmc_get_bits(raw_csd, 21, 1);
838114b4164SWarner Losh 	} else
839114b4164SWarner Losh 		panic("unknown SD CSD version");
8404871891eSWarner Losh }
8414871891eSWarner Losh 
8424871891eSWarner Losh static void
8434871891eSWarner Losh mmc_decode_csd_mmc(uint32_t *raw_csd, struct mmc_csd *csd)
8444871891eSWarner Losh {
8454871891eSWarner Losh 	int m;
8464871891eSWarner Losh 	int e;
8474871891eSWarner Losh 
8484871891eSWarner Losh 	memset(csd, 0, sizeof(*csd));
849c18f1e26SAlexander Motin 	csd->csd_structure = mmc_get_bits(raw_csd, 126, 2);
850c18f1e26SAlexander Motin 	csd->spec_vers = mmc_get_bits(raw_csd, 122, 4);
851c18f1e26SAlexander Motin 	m = mmc_get_bits(raw_csd, 115, 4);
852c18f1e26SAlexander Motin 	e = mmc_get_bits(raw_csd, 112, 3);
853c18f1e26SAlexander Motin 	csd->tacc = exp[e] * mant[m] + 9 / 10;
854c18f1e26SAlexander Motin 	csd->nsac = mmc_get_bits(raw_csd, 104, 8) * 100;
855c18f1e26SAlexander Motin 	m = mmc_get_bits(raw_csd, 99, 4);
856c18f1e26SAlexander Motin 	e = mmc_get_bits(raw_csd, 96, 3);
857c18f1e26SAlexander Motin 	csd->tran_speed = exp[e] * 10000 * mant[m];
858c18f1e26SAlexander Motin 	csd->ccc = mmc_get_bits(raw_csd, 84, 12);
859c18f1e26SAlexander Motin 	csd->read_bl_len = 1 << mmc_get_bits(raw_csd, 80, 4);
860c18f1e26SAlexander Motin 	csd->read_bl_partial = mmc_get_bits(raw_csd, 79, 1);
861c18f1e26SAlexander Motin 	csd->write_blk_misalign = mmc_get_bits(raw_csd, 78, 1);
862c18f1e26SAlexander Motin 	csd->read_blk_misalign = mmc_get_bits(raw_csd, 77, 1);
863c18f1e26SAlexander Motin 	csd->dsr_imp = mmc_get_bits(raw_csd, 76, 1);
864c18f1e26SAlexander Motin 	csd->vdd_r_curr_min = cur_min[mmc_get_bits(raw_csd, 59, 3)];
865c18f1e26SAlexander Motin 	csd->vdd_r_curr_max = cur_max[mmc_get_bits(raw_csd, 56, 3)];
866c18f1e26SAlexander Motin 	csd->vdd_w_curr_min = cur_min[mmc_get_bits(raw_csd, 53, 3)];
867c18f1e26SAlexander Motin 	csd->vdd_w_curr_max = cur_max[mmc_get_bits(raw_csd, 50, 3)];
868c18f1e26SAlexander Motin 	m = mmc_get_bits(raw_csd, 62, 12);
869c18f1e26SAlexander Motin 	e = mmc_get_bits(raw_csd, 47, 3);
870c18f1e26SAlexander Motin 	csd->capacity = ((1 + m) << (e + 2)) * csd->read_bl_len;
871c18f1e26SAlexander Motin //	csd->erase_blk_en = mmc_get_bits(raw_csd, 46, 1);
872c18f1e26SAlexander Motin //	csd->sector_size = mmc_get_bits(raw_csd, 39, 7);
873c18f1e26SAlexander Motin 	csd->wp_grp_size = mmc_get_bits(raw_csd, 32, 5);
874c18f1e26SAlexander Motin 	csd->wp_grp_enable = mmc_get_bits(raw_csd, 31, 1);
875c18f1e26SAlexander Motin 	csd->r2w_factor = 1 << mmc_get_bits(raw_csd, 26, 3);
876c18f1e26SAlexander Motin 	csd->write_bl_len = 1 << mmc_get_bits(raw_csd, 22, 4);
877c18f1e26SAlexander Motin 	csd->write_bl_partial = mmc_get_bits(raw_csd, 21, 1);
878114b4164SWarner Losh }
879114b4164SWarner Losh 
880c18f1e26SAlexander Motin static void
881c18f1e26SAlexander Motin mmc_app_decode_scr(uint32_t *raw_scr, struct mmc_scr *scr)
882c18f1e26SAlexander Motin {
883c18f1e26SAlexander Motin 	unsigned int scr_struct;
884c18f1e26SAlexander Motin 	uint32_t tmp[4];
885c18f1e26SAlexander Motin 
886c18f1e26SAlexander Motin 	tmp[3] = raw_scr[1];
887c18f1e26SAlexander Motin 	tmp[2] = raw_scr[0];
888c18f1e26SAlexander Motin 
889c18f1e26SAlexander Motin 	memset(scr, 0, sizeof(*scr));
890c18f1e26SAlexander Motin 
891c18f1e26SAlexander Motin 	scr_struct = mmc_get_bits(tmp, 60, 4);
892c18f1e26SAlexander Motin 	if (scr_struct != 0) {
893c18f1e26SAlexander Motin 		printf("Unrecognised SCR structure version %d\n",
894c18f1e26SAlexander Motin 		    scr_struct);
895c18f1e26SAlexander Motin 		return;
896c18f1e26SAlexander Motin 	}
897c18f1e26SAlexander Motin 	scr->sda_vsn = mmc_get_bits(tmp, 56, 4);
898c18f1e26SAlexander Motin 	scr->bus_widths = mmc_get_bits(tmp, 48, 4);
899c18f1e26SAlexander Motin }
900c18f1e26SAlexander Motin 
901114b4164SWarner Losh static int
902114b4164SWarner Losh mmc_all_send_cid(struct mmc_softc *sc, uint32_t *rawcid)
903114b4164SWarner Losh {
904114b4164SWarner Losh 	struct mmc_command cmd;
905114b4164SWarner Losh 	int err;
906114b4164SWarner Losh 
907114b4164SWarner Losh 	cmd.opcode = MMC_ALL_SEND_CID;
908114b4164SWarner Losh 	cmd.arg = 0;
909114b4164SWarner Losh 	cmd.flags = MMC_RSP_R2 | MMC_CMD_BCR;
9104e0efe35SWarner Losh 	cmd.data = NULL;
911114b4164SWarner Losh 	err = mmc_wait_for_cmd(sc, &cmd, 0);
912114b4164SWarner Losh 	memcpy(rawcid, cmd.resp, 4 * sizeof(uint32_t));
913114b4164SWarner Losh 	return (err);
914114b4164SWarner Losh }
915114b4164SWarner Losh 
916114b4164SWarner Losh static int
917114b4164SWarner Losh mmc_send_csd(struct mmc_softc *sc, uint16_t rca, uint32_t *rawcid)
918114b4164SWarner Losh {
919114b4164SWarner Losh 	struct mmc_command cmd;
920114b4164SWarner Losh 	int err;
921114b4164SWarner Losh 
922114b4164SWarner Losh 	cmd.opcode = MMC_SEND_CSD;
923114b4164SWarner Losh 	cmd.arg = rca << 16;
924114b4164SWarner Losh 	cmd.flags = MMC_RSP_R2 | MMC_CMD_BCR;
9254e0efe35SWarner Losh 	cmd.data = NULL;
926114b4164SWarner Losh 	err = mmc_wait_for_cmd(sc, &cmd, 0);
927114b4164SWarner Losh 	memcpy(rawcid, cmd.resp, 4 * sizeof(uint32_t));
928114b4164SWarner Losh 	return (err);
929114b4164SWarner Losh }
930114b4164SWarner Losh 
931114b4164SWarner Losh static int
932c18f1e26SAlexander Motin mmc_app_send_scr(struct mmc_softc *sc, uint16_t rca, uint32_t *rawscr)
933c18f1e26SAlexander Motin {
934c18f1e26SAlexander Motin 	int err;
935c18f1e26SAlexander Motin 	struct mmc_command cmd;
936c18f1e26SAlexander Motin 	struct mmc_data data;
937c18f1e26SAlexander Motin 
938c18f1e26SAlexander Motin 	memset(&cmd, 0, sizeof(struct mmc_command));
939c18f1e26SAlexander Motin 	memset(&data, 0, sizeof(struct mmc_data));
940c18f1e26SAlexander Motin 
941c18f1e26SAlexander Motin 	memset(rawscr, 0, 8);
942c18f1e26SAlexander Motin 	cmd.opcode = ACMD_SEND_SCR;
943c18f1e26SAlexander Motin 	cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
944c18f1e26SAlexander Motin 	cmd.arg = 0;
945c18f1e26SAlexander Motin 	cmd.data = &data;
946c18f1e26SAlexander Motin 
947c18f1e26SAlexander Motin 	data.data = rawscr;
948c18f1e26SAlexander Motin 	data.len = 8;
949c18f1e26SAlexander Motin 	data.flags = MMC_DATA_READ;
950c18f1e26SAlexander Motin 
951c18f1e26SAlexander Motin 	err = mmc_wait_for_app_cmd(sc, rca, &cmd, CMD_RETRIES);
952c18f1e26SAlexander Motin 	rawscr[0] = be32toh(rawscr[0]);
953c18f1e26SAlexander Motin 	rawscr[1] = be32toh(rawscr[1]);
954c18f1e26SAlexander Motin 	return (err);
955c18f1e26SAlexander Motin }
956c18f1e26SAlexander Motin 
957c18f1e26SAlexander Motin static int
958c18f1e26SAlexander Motin mmc_send_ext_csd(struct mmc_softc *sc, uint8_t *rawextcsd)
959c18f1e26SAlexander Motin {
960c18f1e26SAlexander Motin 	int err;
961c18f1e26SAlexander Motin 	struct mmc_command cmd;
962c18f1e26SAlexander Motin 	struct mmc_data data;
963c18f1e26SAlexander Motin 
964c18f1e26SAlexander Motin 	memset(&cmd, 0, sizeof(struct mmc_command));
965c18f1e26SAlexander Motin 	memset(&data, 0, sizeof(struct mmc_data));
966c18f1e26SAlexander Motin 
967c18f1e26SAlexander Motin 	memset(rawextcsd, 0, 512);
968c18f1e26SAlexander Motin 	cmd.opcode = MMC_SEND_EXT_CSD;
969c18f1e26SAlexander Motin 	cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
970c18f1e26SAlexander Motin 	cmd.arg = 0;
971c18f1e26SAlexander Motin 	cmd.data = &data;
972c18f1e26SAlexander Motin 
973c18f1e26SAlexander Motin 	data.data = rawextcsd;
974c18f1e26SAlexander Motin 	data.len = 512;
975c18f1e26SAlexander Motin 	data.flags = MMC_DATA_READ;
976c18f1e26SAlexander Motin 
977c18f1e26SAlexander Motin 	err = mmc_wait_for_cmd(sc, &cmd, CMD_RETRIES);
978c18f1e26SAlexander Motin 	return (err);
979c18f1e26SAlexander Motin }
980c18f1e26SAlexander Motin 
981c18f1e26SAlexander Motin static int
982c18f1e26SAlexander Motin mmc_set_relative_addr(struct mmc_softc *sc, uint16_t resp)
983c18f1e26SAlexander Motin {
984c18f1e26SAlexander Motin 	struct mmc_command cmd;
985c18f1e26SAlexander Motin 	int err;
986c18f1e26SAlexander Motin 
987c18f1e26SAlexander Motin 	cmd.opcode = MMC_SET_RELATIVE_ADDR;
988c18f1e26SAlexander Motin 	cmd.arg = resp << 16;
989c18f1e26SAlexander Motin 	cmd.flags = MMC_RSP_R6 | MMC_CMD_BCR;
990c18f1e26SAlexander Motin 	cmd.data = NULL;
991c18f1e26SAlexander Motin 	err = mmc_wait_for_cmd(sc, &cmd, 0);
992c18f1e26SAlexander Motin 	return (err);
993c18f1e26SAlexander Motin }
994c18f1e26SAlexander Motin 
995c18f1e26SAlexander Motin static int
996114b4164SWarner Losh mmc_send_relative_addr(struct mmc_softc *sc, uint32_t *resp)
997114b4164SWarner Losh {
998114b4164SWarner Losh 	struct mmc_command cmd;
999114b4164SWarner Losh 	int err;
1000114b4164SWarner Losh 
1001114b4164SWarner Losh 	cmd.opcode = SD_SEND_RELATIVE_ADDR;
1002114b4164SWarner Losh 	cmd.arg = 0;
1003114b4164SWarner Losh 	cmd.flags = MMC_RSP_R6 | MMC_CMD_BCR;
10044e0efe35SWarner Losh 	cmd.data = NULL;
1005114b4164SWarner Losh 	err = mmc_wait_for_cmd(sc, &cmd, 0);
1006114b4164SWarner Losh 	*resp = cmd.resp[0];
1007114b4164SWarner Losh 	return (err);
1008114b4164SWarner Losh }
1009114b4164SWarner Losh 
1010114b4164SWarner Losh static void
1011114b4164SWarner Losh mmc_discover_cards(struct mmc_softc *sc)
1012114b4164SWarner Losh {
1013114b4164SWarner Losh 	struct mmc_ivars *ivar;
1014114b4164SWarner Losh 	int err;
1015fa5f41d3SAlexander Motin 	uint32_t resp, sec_count;
1016114b4164SWarner Losh 	device_t child;
1017c18f1e26SAlexander Motin 	uint16_t rca = 2;
1018c18f1e26SAlexander Motin 	u_char switch_res[64];
1019114b4164SWarner Losh 
1020114b4164SWarner Losh 	while (1) {
1021dece39abSWarner Losh 		ivar = malloc(sizeof(struct mmc_ivars), M_DEVBUF,
1022dece39abSWarner Losh 		    M_WAITOK | M_ZERO);
10230e1466acSWarner Losh 		if (!ivar)
10240e1466acSWarner Losh 			return;
1025114b4164SWarner Losh 		err = mmc_all_send_cid(sc, ivar->raw_cid);
1026114b4164SWarner Losh 		if (err == MMC_ERR_TIMEOUT)
1027114b4164SWarner Losh 			break;
1028114b4164SWarner Losh 		if (err != MMC_ERR_NONE) {
1029dece39abSWarner Losh 			device_printf(sc->dev, "Error reading CID %d\n", err);
1030114b4164SWarner Losh 			break;
1031114b4164SWarner Losh 		}
1032c18f1e26SAlexander Motin 		if (mmcbr_get_ro(sc->dev))
1033c18f1e26SAlexander Motin 			ivar->read_only = 1;
1034c18f1e26SAlexander Motin 		ivar->bus_width = bus_width_1;
1035c18f1e26SAlexander Motin 		ivar->mode = mmcbr_get_mode(sc->dev);
1036c18f1e26SAlexander Motin 		if (ivar->mode == mode_sd) {
10374871891eSWarner Losh 			mmc_decode_cid_sd(ivar->raw_cid, &ivar->cid);
1038114b4164SWarner Losh 			mmc_send_relative_addr(sc, &resp);
1039114b4164SWarner Losh 			ivar->rca = resp >> 16;
1040c18f1e26SAlexander Motin 			/* Get card CSD. */
1041114b4164SWarner Losh 			mmc_send_csd(sc, ivar->rca, ivar->raw_csd);
10424871891eSWarner Losh 			mmc_decode_csd_sd(ivar->raw_csd, &ivar->csd);
1043fa5f41d3SAlexander Motin 			ivar->sec_count = ivar->csd.capacity / MMC_SECTOR_SIZE;
1044c18f1e26SAlexander Motin 			if (ivar->csd.csd_structure > 0)
1045c18f1e26SAlexander Motin 				ivar->high_cap = 1;
1046c18f1e26SAlexander Motin 			ivar->tran_speed = ivar->csd.tran_speed;
1047c18f1e26SAlexander Motin 			/* Get card SCR. Card must be selected to fetch it. */
1048c18f1e26SAlexander Motin 			mmc_select_card(sc, ivar->rca);
1049c18f1e26SAlexander Motin 			mmc_app_send_scr(sc, ivar->rca, ivar->raw_scr);
1050c18f1e26SAlexander Motin 			mmc_app_decode_scr(ivar->raw_scr, &ivar->scr);
1051c18f1e26SAlexander Motin 			/* Get card switch capabilities. */
1052c18f1e26SAlexander Motin 			if ((ivar->scr.sda_vsn >= 1) &&
1053c18f1e26SAlexander Motin 			    (ivar->csd.ccc & (1<<10))) {
1054c18f1e26SAlexander Motin 				mmc_sd_switch(sc, 0, 0, 0xF, switch_res);
1055c18f1e26SAlexander Motin 				if (switch_res[13] & 2) {
1056c18f1e26SAlexander Motin 					ivar->timing = bus_timing_hs;
1057c18f1e26SAlexander Motin 					ivar->hs_tran_speed = 50000000;
1058c18f1e26SAlexander Motin 				}
1059c18f1e26SAlexander Motin 			}
1060c18f1e26SAlexander Motin 			mmc_select_card(sc, 0);
1061c18f1e26SAlexander Motin 			/* Find max supported bus width. */
1062c18f1e26SAlexander Motin 			if ((mmcbr_get_caps(sc->dev) & MMC_CAP_4_BIT_DATA) &&
1063c18f1e26SAlexander Motin 			    (ivar->scr.bus_widths & SD_SCR_BUS_WIDTH_4))
1064c18f1e26SAlexander Motin 				ivar->bus_width = bus_width_4;
1065c18f1e26SAlexander Motin 			/* Add device. */
1066114b4164SWarner Losh 			child = device_add_child(sc->dev, NULL, -1);
1067114b4164SWarner Losh 			device_set_ivars(child, ivar);
10680e1466acSWarner Losh 			return;
1069114b4164SWarner Losh 		}
10704871891eSWarner Losh 		mmc_decode_cid_mmc(ivar->raw_cid, &ivar->cid);
1071c18f1e26SAlexander Motin 		ivar->rca = rca++;
1072c18f1e26SAlexander Motin 		mmc_set_relative_addr(sc, ivar->rca);
1073c18f1e26SAlexander Motin 		/* Get card CSD. */
1074c18f1e26SAlexander Motin 		mmc_send_csd(sc, ivar->rca, ivar->raw_csd);
10754871891eSWarner Losh 		mmc_decode_csd_mmc(ivar->raw_csd, &ivar->csd);
1076fa5f41d3SAlexander Motin 		ivar->sec_count = ivar->csd.capacity / MMC_SECTOR_SIZE;
1077c18f1e26SAlexander Motin 		ivar->tran_speed = ivar->csd.tran_speed;
1078c18f1e26SAlexander Motin 		/* Only MMC >= 4.x cards support EXT_CSD. */
1079c18f1e26SAlexander Motin 		if (ivar->csd.spec_vers >= 4) {
1080c18f1e26SAlexander Motin 			/* Card must be selected to fetch EXT_CSD. */
1081c18f1e26SAlexander Motin 			mmc_select_card(sc, ivar->rca);
1082c18f1e26SAlexander Motin 			mmc_send_ext_csd(sc, ivar->raw_ext_csd);
1083fa5f41d3SAlexander Motin 			/* Handle extended capacity from EXT_CSD */
1084fa5f41d3SAlexander Motin 			sec_count = ivar->raw_ext_csd[EXT_CSD_SEC_CNT] +
1085fa5f41d3SAlexander Motin 			    (ivar->raw_ext_csd[EXT_CSD_SEC_CNT + 1] << 8) +
1086fa5f41d3SAlexander Motin 			    (ivar->raw_ext_csd[EXT_CSD_SEC_CNT + 2] << 16) +
1087fa5f41d3SAlexander Motin 			    (ivar->raw_ext_csd[EXT_CSD_SEC_CNT + 3] << 24);
1088fa5f41d3SAlexander Motin 			if (sec_count != 0) {
1089fa5f41d3SAlexander Motin 				ivar->sec_count = sec_count;
1090fa5f41d3SAlexander Motin 				ivar->high_cap = 1;
1091fa5f41d3SAlexander Motin 			}
1092c18f1e26SAlexander Motin 			/* Get card speed in high speed mode. */
1093c18f1e26SAlexander Motin 			ivar->timing = bus_timing_hs;
1094fa5f41d3SAlexander Motin 			if (ivar->raw_ext_csd[EXT_CSD_CARD_TYPE]
1095c18f1e26SAlexander Motin 			    & EXT_CSD_CARD_TYPE_52)
1096c18f1e26SAlexander Motin 				ivar->hs_tran_speed = 52000000;
1097fa5f41d3SAlexander Motin 			else if (ivar->raw_ext_csd[EXT_CSD_CARD_TYPE]
1098c18f1e26SAlexander Motin 			    & EXT_CSD_CARD_TYPE_26)
1099c18f1e26SAlexander Motin 				ivar->hs_tran_speed = 26000000;
1100c18f1e26SAlexander Motin 			else
1101c18f1e26SAlexander Motin 				ivar->hs_tran_speed = ivar->tran_speed;
1102c18f1e26SAlexander Motin 			/* Find max supported bus width. */
1103c18f1e26SAlexander Motin 			ivar->bus_width = mmc_test_bus_width(sc);
1104c18f1e26SAlexander Motin 			mmc_select_card(sc, 0);
1105c18f1e26SAlexander Motin 		} else {
1106c18f1e26SAlexander Motin 			ivar->bus_width = bus_width_1;
1107c18f1e26SAlexander Motin 			ivar->timing = bus_timing_normal;
1108c18f1e26SAlexander Motin 		}
1109c18f1e26SAlexander Motin 		/* Add device. */
1110c18f1e26SAlexander Motin 		child = device_add_child(sc->dev, NULL, -1);
1111c18f1e26SAlexander Motin 		device_set_ivars(child, ivar);
1112114b4164SWarner Losh 	}
11130e1466acSWarner Losh 	free(ivar, M_DEVBUF);
1114114b4164SWarner Losh }
1115114b4164SWarner Losh 
1116114b4164SWarner Losh static void
1117114b4164SWarner Losh mmc_go_discovery(struct mmc_softc *sc)
1118114b4164SWarner Losh {
1119114b4164SWarner Losh 	uint32_t ocr;
1120114b4164SWarner Losh 	device_t dev;
1121c18f1e26SAlexander Motin 	int err;
1122114b4164SWarner Losh 
1123114b4164SWarner Losh 	dev = sc->dev;
1124114b4164SWarner Losh 	if (mmcbr_get_power_mode(dev) != power_on) {
11256fdacf52SWarner Losh 		/*
11266fdacf52SWarner Losh 		 * First, try SD modes
11276fdacf52SWarner Losh 		 */
1128114b4164SWarner Losh 		mmcbr_set_mode(dev, mode_sd);
1129114b4164SWarner Losh 		mmc_power_up(sc);
1130114b4164SWarner Losh 		mmcbr_set_bus_mode(dev, pushpull);
1131114b4164SWarner Losh 		mmc_idle_cards(sc);
1132c18f1e26SAlexander Motin 		err = mmc_send_if_cond(sc, 1);
1133c18f1e26SAlexander Motin 		if (mmc_send_app_op_cond(sc, err?0:MMC_OCR_CCS, &ocr) !=
1134c18f1e26SAlexander Motin 		    MMC_ERR_NONE) {
11356fdacf52SWarner Losh 			/*
11366fdacf52SWarner Losh 			 * Failed, try MMC
11376fdacf52SWarner Losh 			 */
1138114b4164SWarner Losh 			mmcbr_set_mode(dev, mode_mmc);
1139114b4164SWarner Losh 			if (mmc_send_op_cond(sc, 0, &ocr) != MMC_ERR_NONE)
11406fdacf52SWarner Losh 				return;	/* Failed both, punt! XXX powerdown? */
1141114b4164SWarner Losh 		}
1142114b4164SWarner Losh 		mmcbr_set_ocr(dev, mmc_select_vdd(sc, ocr));
1143114b4164SWarner Losh 		if (mmcbr_get_ocr(dev) != 0)
1144114b4164SWarner Losh 			mmc_idle_cards(sc);
1145114b4164SWarner Losh 	} else {
1146114b4164SWarner Losh 		mmcbr_set_bus_mode(dev, opendrain);
1147114b4164SWarner Losh 		mmcbr_set_clock(dev, mmcbr_get_f_min(dev));
1148114b4164SWarner Losh 		mmcbr_update_ios(dev);
11496fdacf52SWarner Losh 		/* XXX recompute vdd based on new cards? */
1150114b4164SWarner Losh 	}
1151114b4164SWarner Losh 	/*
1152114b4164SWarner Losh 	 * Make sure that we have a mutually agreeable voltage to at least
1153114b4164SWarner Losh 	 * one card on the bus.
1154114b4164SWarner Losh 	 */
1155114b4164SWarner Losh 	if (mmcbr_get_ocr(dev) == 0)
1156114b4164SWarner Losh 		return;
1157114b4164SWarner Losh 	/*
1158114b4164SWarner Losh 	 * Reselect the cards after we've idled them above.
1159114b4164SWarner Losh 	 */
1160c18f1e26SAlexander Motin 	if (mmcbr_get_mode(dev) == mode_sd) {
1161c18f1e26SAlexander Motin 		err = mmc_send_if_cond(sc, 1);
1162c18f1e26SAlexander Motin 		mmc_send_app_op_cond(sc,
1163c18f1e26SAlexander Motin 		    (err?0:MMC_OCR_CCS)|mmcbr_get_ocr(dev), NULL);
1164c18f1e26SAlexander Motin 	} else
1165114b4164SWarner Losh 		mmc_send_op_cond(sc, mmcbr_get_ocr(dev), NULL);
1166114b4164SWarner Losh 	mmc_discover_cards(sc);
1167114b4164SWarner Losh 
1168114b4164SWarner Losh 	mmcbr_set_bus_mode(dev, pushpull);
1169114b4164SWarner Losh 	mmcbr_update_ios(dev);
1170114b4164SWarner Losh 	bus_generic_attach(dev);
11716fdacf52SWarner Losh /*	mmc_update_children_sysctl(dev);*/
1172114b4164SWarner Losh }
1173114b4164SWarner Losh 
1174114b4164SWarner Losh static int
1175114b4164SWarner Losh mmc_calculate_clock(struct mmc_softc *sc)
1176114b4164SWarner Losh {
1177c18f1e26SAlexander Motin 	int max_dtr, max_hs_dtr, max_timing;
1178114b4164SWarner Losh 	int nkid, i, f_min, f_max;
1179114b4164SWarner Losh 	device_t *kids;
1180c18f1e26SAlexander Motin 	struct mmc_ivars *ivar;
1181114b4164SWarner Losh 
1182114b4164SWarner Losh 	f_min = mmcbr_get_f_min(sc->dev);
1183114b4164SWarner Losh 	f_max = mmcbr_get_f_max(sc->dev);
1184c18f1e26SAlexander Motin 	max_dtr = max_hs_dtr = f_max;
1185c18f1e26SAlexander Motin 	if ((mmcbr_get_caps(sc->dev) & MMC_CAP_HSPEED))
1186c18f1e26SAlexander Motin 		max_timing = bus_timing_hs;
1187c18f1e26SAlexander Motin 	else
1188c18f1e26SAlexander Motin 		max_timing = bus_timing_normal;
1189114b4164SWarner Losh 	if (device_get_children(sc->dev, &kids, &nkid) != 0)
1190114b4164SWarner Losh 		panic("can't get children");
1191c18f1e26SAlexander Motin 	for (i = 0; i < nkid; i++) {
1192c18f1e26SAlexander Motin 		ivar = device_get_ivars(kids[i]);
1193c18f1e26SAlexander Motin 		if (ivar->timing < max_timing)
1194c18f1e26SAlexander Motin 			max_timing = ivar->timing;
1195c18f1e26SAlexander Motin 		if (ivar->tran_speed < max_dtr)
1196c18f1e26SAlexander Motin 			max_dtr = ivar->tran_speed;
1197c18f1e26SAlexander Motin 		if (ivar->hs_tran_speed < max_dtr)
1198c18f1e26SAlexander Motin 			max_hs_dtr = ivar->hs_tran_speed;
1199c18f1e26SAlexander Motin 	}
1200c18f1e26SAlexander Motin 	for (i = 0; i < nkid; i++) {
1201c18f1e26SAlexander Motin 		ivar = device_get_ivars(kids[i]);
1202c18f1e26SAlexander Motin 		if (ivar->timing == bus_timing_normal)
1203c18f1e26SAlexander Motin 			continue;
1204c18f1e26SAlexander Motin 		mmc_select_card(sc, ivar->rca);
1205c18f1e26SAlexander Motin 		mmc_set_timing(sc, max_timing);
1206c18f1e26SAlexander Motin 	}
1207c18f1e26SAlexander Motin 	mmc_select_card(sc, 0);
1208114b4164SWarner Losh 	free(kids, M_TEMP);
1209c18f1e26SAlexander Motin 	if (max_timing == bus_timing_hs)
1210c18f1e26SAlexander Motin 		max_dtr = max_hs_dtr;
1211c18f1e26SAlexander Motin 	device_printf(sc->dev, "setting transfer rate to %d.%03dMHz%s\n",
1212c18f1e26SAlexander Motin 	    max_dtr / 1000000, (max_dtr / 1000) % 1000,
1213c18f1e26SAlexander Motin 	    (max_timing == bus_timing_hs)?" with high speed timing":"");
1214c18f1e26SAlexander Motin 	mmcbr_set_timing(sc->dev, max_timing);
1215c18f1e26SAlexander Motin 	mmcbr_set_clock(sc->dev, max_dtr);
1216c18f1e26SAlexander Motin 	mmcbr_update_ios(sc->dev);
1217c18f1e26SAlexander Motin 	return max_dtr;
1218114b4164SWarner Losh }
1219114b4164SWarner Losh 
1220114b4164SWarner Losh static void
1221114b4164SWarner Losh mmc_scan(struct mmc_softc *sc)
1222114b4164SWarner Losh {
1223114b4164SWarner Losh 	device_t dev;
1224114b4164SWarner Losh 
1225114b4164SWarner Losh 	dev = sc->dev;
1226114b4164SWarner Losh 	mmc_acquire_bus(dev, dev);
1227114b4164SWarner Losh 
1228114b4164SWarner Losh 	if (mmcbr_get_power_mode(dev) == power_on)
1229114b4164SWarner Losh 		mmc_rescan_cards(sc);
1230114b4164SWarner Losh 	mmc_go_discovery(sc);
1231c18f1e26SAlexander Motin 	mmc_calculate_clock(sc);
1232114b4164SWarner Losh 
1233114b4164SWarner Losh 	mmc_release_bus(dev, dev);
12346fdacf52SWarner Losh 	/* XXX probe/attach/detach children? */
1235114b4164SWarner Losh }
1236114b4164SWarner Losh 
1237114b4164SWarner Losh static int
1238114b4164SWarner Losh mmc_read_ivar(device_t bus, device_t child, int which, u_char *result)
1239114b4164SWarner Losh {
1240114b4164SWarner Losh 	struct mmc_ivars *ivar = device_get_ivars(child);
1241114b4164SWarner Losh 
1242114b4164SWarner Losh 	switch (which) {
1243114b4164SWarner Losh 	default:
1244114b4164SWarner Losh 		return (EINVAL);
1245114b4164SWarner Losh 	case MMC_IVAR_DSR_IMP:
1246114b4164SWarner Losh 		*(int *)result = ivar->csd.dsr_imp;
1247114b4164SWarner Losh 		break;
1248114b4164SWarner Losh 	case MMC_IVAR_MEDIA_SIZE:
1249fa5f41d3SAlexander Motin 		*(off_t *)result = ivar->sec_count;
1250114b4164SWarner Losh 		break;
1251114b4164SWarner Losh 	case MMC_IVAR_RCA:
1252114b4164SWarner Losh 		*(int *)result = ivar->rca;
1253114b4164SWarner Losh 		break;
1254114b4164SWarner Losh 	case MMC_IVAR_SECTOR_SIZE:
125538c51cbeSWarner Losh 		*(int *)result = MMC_SECTOR_SIZE;
1256114b4164SWarner Losh 		break;
1257114b4164SWarner Losh 	case MMC_IVAR_TRAN_SPEED:
1258114b4164SWarner Losh 		*(int *)result = ivar->csd.tran_speed;
1259114b4164SWarner Losh 		break;
126040fab6e7SWarner Losh 	case MMC_IVAR_READ_ONLY:
126140fab6e7SWarner Losh 		*(int *)result = ivar->read_only;
126240fab6e7SWarner Losh 		break;
1263c18f1e26SAlexander Motin 	case MMC_IVAR_HIGH_CAP:
1264c18f1e26SAlexander Motin 		*(int *)result = ivar->high_cap;
1265c18f1e26SAlexander Motin 		break;
1266114b4164SWarner Losh 	}
1267114b4164SWarner Losh 	return (0);
1268114b4164SWarner Losh }
1269114b4164SWarner Losh 
1270114b4164SWarner Losh static int
1271114b4164SWarner Losh mmc_write_ivar(device_t bus, device_t child, int which, uintptr_t value)
1272114b4164SWarner Losh {
12736fdacf52SWarner Losh 	/*
12746fdacf52SWarner Losh 	 * None are writable ATM
12756fdacf52SWarner Losh 	 */
1276114b4164SWarner Losh 	return (EINVAL);
1277114b4164SWarner Losh }
1278114b4164SWarner Losh 
1279114b4164SWarner Losh 
1280114b4164SWarner Losh static void
1281114b4164SWarner Losh mmc_delayed_attach(void *xsc)
1282114b4164SWarner Losh {
1283114b4164SWarner Losh 	struct mmc_softc *sc = xsc;
1284114b4164SWarner Losh 
1285114b4164SWarner Losh 	mmc_scan(sc);
1286114b4164SWarner Losh 	config_intrhook_disestablish(&sc->config_intrhook);
1287114b4164SWarner Losh }
1288114b4164SWarner Losh 
1289114b4164SWarner Losh static device_method_t mmc_methods[] = {
1290114b4164SWarner Losh 	/* device_if */
1291114b4164SWarner Losh 	DEVMETHOD(device_probe, mmc_probe),
1292114b4164SWarner Losh 	DEVMETHOD(device_attach, mmc_attach),
1293114b4164SWarner Losh 	DEVMETHOD(device_detach, mmc_detach),
1294114b4164SWarner Losh 
1295114b4164SWarner Losh 	/* Bus interface */
1296114b4164SWarner Losh 	DEVMETHOD(bus_read_ivar, mmc_read_ivar),
1297114b4164SWarner Losh 	DEVMETHOD(bus_write_ivar, mmc_write_ivar),
1298114b4164SWarner Losh 
1299114b4164SWarner Losh 	/* MMC Bus interface */
1300114b4164SWarner Losh 	DEVMETHOD(mmcbus_wait_for_request, mmc_wait_for_request),
1301114b4164SWarner Losh 	DEVMETHOD(mmcbus_acquire_bus, mmc_acquire_bus),
1302114b4164SWarner Losh 	DEVMETHOD(mmcbus_release_bus, mmc_release_bus),
1303114b4164SWarner Losh 
1304114b4164SWarner Losh 	{0, 0},
1305114b4164SWarner Losh };
1306114b4164SWarner Losh 
1307114b4164SWarner Losh static driver_t mmc_driver = {
1308114b4164SWarner Losh 	"mmc",
1309114b4164SWarner Losh 	mmc_methods,
1310114b4164SWarner Losh 	sizeof(struct mmc_softc),
1311114b4164SWarner Losh };
1312114b4164SWarner Losh static devclass_t mmc_devclass;
1313114b4164SWarner Losh 
1314114b4164SWarner Losh 
1315114b4164SWarner Losh DRIVER_MODULE(mmc, at91_mci, mmc_driver, mmc_devclass, 0, 0);
13168d66abb0SAlexander Motin DRIVER_MODULE(mmc, sdhci, mmc_driver, mmc_devclass, 0, 0);
1317