xref: /freebsd/sys/dev/rtsx/rtsx.c (revision 349cc55c9796c4596a5b9904cd3281af295f878f)
1 /*-
2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3  *
4  * Copyright (c) 2006 Uwe Stuehler <uwe@openbsd.org>
5  * Copyright (c) 2012 Stefan Sperling <stsp@openbsd.org>
6  * Copyright (c) 2020 Henri Hennebert <hlh@restart.be>
7  * Copyright (c) 2020 Gary Jennejohn <gj@freebsd.org>
8  * Copyright (c) 2020 Jesper Schmitz Mouridsen <jsm@FreeBSD.org>
9  * All rights reserved.
10  *
11  * Patch from:
12  * - Lutz Bichler <Lutz.Bichler@gmail.com>
13  *
14  * Base on OpenBSD /sys/dev/pci/rtsx_pci.c & /dev/ic/rtsx.c
15  *      on Linux   /drivers/mmc/host/rtsx_pci_sdmmc.c,
16  *                 /include/linux/rtsx_pci.h &
17  *                 /drivers/misc/cardreader/rtsx_pcr.c
18  *      on NetBSD  /sys/dev/ic/rtsx.c
19  *
20  * Permission to use, copy, modify, and distribute this software for any
21  * purpose with or without fee is hereby granted, provided that the above
22  * copyright notice and this permission notice appear in all copies.
23  *
24  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
25  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
28  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
29  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
30  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
31  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
32  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
33  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
34  * SUCH DAMAGE.
35  */
36 
37 #include <sys/cdefs.h>
38 __FBSDID("$FreeBSD$");
39 
40 #include <sys/param.h>
41 #include <sys/module.h>
42 #include <sys/systm.h> /* For FreeBSD 11 */
43 #include <sys/types.h> /* For FreeBSD 11 */
44 #include <sys/errno.h>
45 #include <sys/kernel.h>
46 #include <sys/bus.h>
47 #include <sys/endian.h>
48 #include <machine/bus.h>
49 #include <sys/mutex.h>
50 #include <sys/malloc.h>
51 #include <sys/rman.h>
52 #include <sys/queue.h>
53 #include <sys/taskqueue.h>
54 #include <sys/sysctl.h>
55 #include <dev/pci/pcivar.h>
56 #include <dev/pci/pcireg.h>
57 #include <dev/mmc/bridge.h>
58 #include <dev/mmc/mmcreg.h>
59 #include <dev/mmc/mmcbrvar.h>
60 #include <machine/_inttypes.h>
61 
62 #include "opt_mmccam.h"
63 
64 #ifdef MMCCAM
65 #include <cam/cam.h>
66 #include <cam/cam_ccb.h>
67 #include <cam/cam_debug.h>
68 #include <cam/cam_sim.h>
69 #include <cam/cam_xpt_sim.h>
70 #include <cam/mmc/mmc_sim.h>
71 #include "mmc_sim_if.h"
72 #endif /* MMCCAM */
73 
74 #include "rtsxreg.h"
75 
76 /* The softc holds our per-instance data. */
77 struct rtsx_softc {
78 	struct mtx	rtsx_mtx;		/* device mutex */
79 	device_t	rtsx_dev;		/* device */
80 	uint16_t	rtsx_flags;		/* device flags */
81 	uint16_t	rtsx_device_id;		/* device ID */
82 	device_t	rtsx_mmc_dev;		/* device of mmc bus */
83 	uint32_t	rtsx_intr_enabled;	/* enabled interrupts */
84 	uint32_t 	rtsx_intr_status;	/* soft interrupt status */
85 	int		rtsx_irq_res_id;	/* bus IRQ resource id */
86 	struct resource *rtsx_irq_res;		/* bus IRQ resource */
87 	void		*rtsx_irq_cookie;	/* bus IRQ resource cookie */
88 	struct callout	rtsx_timeout_callout;	/* callout for timeout */
89 	int		rtsx_timeout_cmd;	/* interrupt timeout for setup commands */
90 	int		rtsx_timeout_io;	/* interrupt timeout for I/O commands */
91 	void		(*rtsx_intr_trans_ok)(struct rtsx_softc *sc);
92 						/* function to call if transfer succeed */
93 	void		(*rtsx_intr_trans_ko)(struct rtsx_softc *sc);
94 						/* function to call if transfer fail */
95 
96 	struct timeout_task
97 			rtsx_card_insert_task;	/* card insert delayed task */
98 	struct task	rtsx_card_remove_task;	/* card remove task */
99 
100 	int		rtsx_mem_res_id;	/* bus memory resource id */
101 	struct resource *rtsx_mem_res;		/* bus memory resource */
102 	bus_space_tag_t	   rtsx_mem_btag;	/* host register set tag */
103 	bus_space_handle_t rtsx_mem_bhandle;	/* host register set handle */
104 
105 	bus_dma_tag_t	rtsx_cmd_dma_tag;	/* DMA tag for command transfer */
106 	bus_dmamap_t	rtsx_cmd_dmamap;	/* DMA map for command transfer */
107 	void		*rtsx_cmd_dmamem;	/* DMA mem for command transfer */
108 	bus_addr_t	rtsx_cmd_buffer;	/* device visible address of the DMA segment */
109 	int		rtsx_cmd_index;		/* index in rtsx_cmd_buffer */
110 
111 	bus_dma_tag_t	rtsx_data_dma_tag;	/* DMA tag for data transfer */
112 	bus_dmamap_t	rtsx_data_dmamap;	/* DMA map for data transfer */
113 	void		*rtsx_data_dmamem;	/* DMA mem for data transfer */
114 	bus_addr_t	rtsx_data_buffer;	/* device visible address of the DMA segment */
115 
116 #ifdef MMCCAM
117 	union ccb		*rtsx_ccb;	/* CAM control block */
118 	struct mmc_sim		rtsx_mmc_sim;	/* CAM generic sim */
119 	struct mmc_request	rtsx_cam_req;	/* CAM MMC request */
120 #endif /* MMCCAM */
121 
122 	struct mmc_request *rtsx_req;		/* MMC request */
123 	struct mmc_host rtsx_host;		/* host parameters */
124 	int		rtsx_pcie_cap;		/* PCIe capability offset */
125 	int8_t		rtsx_bus_busy;		/* bus busy status */
126 	int8_t		rtsx_ios_bus_width;	/* current host.ios.bus_width */
127 	int32_t		rtsx_ios_clock;		/* current host.ios.clock */
128 	int8_t		rtsx_ios_power_mode;	/* current host.ios.power mode */
129 	int8_t		rtsx_ios_timing;	/* current host.ios.timing */
130 	int8_t		rtsx_ios_vccq;		/* current host.ios.vccq */
131 	uint8_t		rtsx_read_only;		/* card read only status */
132 	uint8_t		rtsx_inversion;		/* inversion of card detection and read only status */
133 	uint8_t		rtsx_force_timing;	/* force bus_timing_uhs_sdr50 */
134 	uint8_t		rtsx_debug_mask;	/* debugging mask */
135 #define 	RTSX_DEBUG_BASIC	0x01	/* debug basic flow */
136 #define 	RTSX_TRACE_SD_CMD	0x02	/* trace SD commands */
137 #define 	RTSX_DEBUG_TUNING	0x04	/* debug tuning */
138 #ifdef MMCCAM
139 	uint8_t		rtsx_cam_status;	/* CAM status - 1 if card in use */
140 #endif /* MMCCAM */
141 	uint64_t	rtsx_read_count;	/* count of read operations */
142 	uint64_t	rtsx_write_count;	/* count of write operations */
143 	bool		rtsx_discovery_mode;	/* are we in discovery mode? */
144 	bool		rtsx_tuning_mode;	/* are we tuning */
145 	bool		rtsx_double_clk;	/* double clock freqency */
146 	bool		rtsx_vpclk;		/* voltage at Pulse-width Modulation(PWM) clock? */
147 	uint8_t		rtsx_ssc_depth;		/* Spread spectrum clocking depth */
148 	uint8_t		rtsx_card_drive_sel;	/* value for RTSX_CARD_DRIVE_SEL */
149 	uint8_t		rtsx_sd30_drive_sel_3v3;/* value for RTSX_SD30_DRIVE_SEL */
150 };
151 
152 /* rtsx_flags values */
153 #define	RTSX_F_DEFAULT		0x0000
154 #define	RTSX_F_CARD_PRESENT	0x0001
155 #define	RTSX_F_SDIO_SUPPORT	0x0002
156 #define	RTSX_F_VERSION_A	0x0004
157 #define	RTSX_F_VERSION_B	0x0008
158 #define	RTSX_F_VERSION_C	0x0010
159 #define	RTSX_F_VERSION_D	0x0020
160 #define	RTSX_F_8411B_QFN48	0x0040
161 #define	RTSX_F_REVERSE_SOCKET	0x0080
162 
163 #define	RTSX_REALTEK		0x10ec
164 #define	RTSX_RTS5209		0x5209
165 #define	RTSX_RTS5227		0x5227
166 #define	RTSX_RTS5229		0x5229
167 #define	RTSX_RTS522A		0x522a
168 #define	RTSX_RTS525A		0x525a
169 #define	RTSX_RTS5249		0x5249
170 #define	RTSX_RTS5260		0x5260
171 #define	RTSX_RTL8402		0x5286
172 #define	RTSX_RTL8411		0x5289
173 #define	RTSX_RTL8411B		0x5287
174 
175 #define	RTSX_VERSION		"2.1g"
176 
177 static const struct rtsx_device {
178 	uint16_t	vendor_id;
179 	uint16_t	device_id;
180 	const char	*desc;
181 } rtsx_devices[] = {
182 	{ RTSX_REALTEK,	RTSX_RTS5209,	RTSX_VERSION " Realtek RTS5209 PCIe SD Card Reader"},
183 	{ RTSX_REALTEK,	RTSX_RTS5227,	RTSX_VERSION " Realtek RTS5227 PCIe SD Card Reader"},
184 	{ RTSX_REALTEK,	RTSX_RTS5229,	RTSX_VERSION " Realtek RTS5229 PCIe SD Card Reader"},
185 	{ RTSX_REALTEK,	RTSX_RTS522A,	RTSX_VERSION " Realtek RTS522A PCIe SD Card Reader"},
186 	{ RTSX_REALTEK,	RTSX_RTS525A,	RTSX_VERSION " Realtek RTS525A PCIe SD Card Reader"},
187 	{ RTSX_REALTEK,	RTSX_RTS5249,	RTSX_VERSION " Realtek RTS5249 PCIe SD Card Reader"},
188 	{ RTSX_REALTEK,	RTSX_RTS5260,	RTSX_VERSION " Realtek RTS5260 PCIe SD Card Reader"},
189 	{ RTSX_REALTEK,	RTSX_RTL8402,	RTSX_VERSION " Realtek RTL8402 PCIe SD Card Reader"},
190 	{ RTSX_REALTEK,	RTSX_RTL8411,	RTSX_VERSION " Realtek RTL8411 PCIe SD Card Reader"},
191 	{ RTSX_REALTEK,	RTSX_RTL8411B,	RTSX_VERSION " Realtek RTL8411B PCIe SD Card Reader"},
192 	{ 0, 		0,		NULL}
193 };
194 
195 /* See `kenv | grep smbios.system` */
196 static const struct rtsx_inversion_model {
197 	char	*maker;
198 	char	*family;
199 	char	*product;
200 } rtsx_inversion_models[] = {
201 	{ "LENOVO",		"ThinkPad T470p",	"20J7S0PM00"},
202 	{ NULL,			NULL,			NULL}
203 };
204 
205 static int	rtsx_dma_alloc(struct rtsx_softc *sc);
206 static void	rtsx_dmamap_cb(void *arg, bus_dma_segment_t *segs, int nsegs, int error);
207 static void	rtsx_dma_free(struct rtsx_softc *sc);
208 static void	rtsx_intr(void *arg);
209 static void	rtsx_handle_card_present(struct rtsx_softc *sc);
210 static void	rtsx_card_task(void *arg, int pending __unused);
211 static bool	rtsx_is_card_present(struct rtsx_softc *sc);
212 static int	rtsx_init(struct rtsx_softc *sc);
213 static int	rtsx_map_sd_drive(int index);
214 static int	rtsx_rts5227_fill_driving(struct rtsx_softc *sc);
215 static int	rtsx_rts5249_fill_driving(struct rtsx_softc *sc);
216 static int	rtsx_rts5260_fill_driving(struct rtsx_softc *sc);
217 static int	rtsx_read(struct rtsx_softc *, uint16_t, uint8_t *);
218 static int	rtsx_read_cfg(struct rtsx_softc *sc, uint8_t func, uint16_t addr, uint32_t *val);
219 static int	rtsx_write(struct rtsx_softc *sc, uint16_t addr, uint8_t mask, uint8_t val);
220 static int	rtsx_read_phy(struct rtsx_softc *sc, uint8_t addr, uint16_t *val);
221 static int	rtsx_write_phy(struct rtsx_softc *sc, uint8_t addr, uint16_t val);
222 static int	rtsx_bus_power_off(struct rtsx_softc *sc);
223 static int	rtsx_bus_power_on(struct rtsx_softc *sc);
224 static int	rtsx_set_bus_width(struct rtsx_softc *sc, enum mmc_bus_width width);
225 static int	rtsx_set_sd_timing(struct rtsx_softc *sc, enum mmc_bus_timing timing);
226 static int	rtsx_set_sd_clock(struct rtsx_softc *sc, uint32_t freq);
227 static int	rtsx_stop_sd_clock(struct rtsx_softc *sc);
228 static int	rtsx_switch_sd_clock(struct rtsx_softc *sc, uint8_t clk, uint8_t n, uint8_t div, uint8_t mcu);
229 #ifndef MMCCAM
230 static void	rtsx_sd_change_tx_phase(struct rtsx_softc *sc, uint8_t sample_point);
231 static void	rtsx_sd_change_rx_phase(struct rtsx_softc *sc, uint8_t sample_point);
232 static void	rtsx_sd_tuning_rx_phase(struct rtsx_softc *sc, uint32_t *phase_map);
233 static int	rtsx_sd_tuning_rx_cmd(struct rtsx_softc *sc, uint8_t sample_point);
234 static int	rtsx_sd_tuning_rx_cmd_wait(struct rtsx_softc *sc, struct mmc_command *cmd);
235 static void	rtsx_sd_tuning_rx_cmd_wakeup(struct rtsx_softc *sc);
236 static void	rtsx_sd_wait_data_idle(struct rtsx_softc *sc);
237 static uint8_t	rtsx_sd_search_final_rx_phase(struct rtsx_softc *sc, uint32_t phase_map);
238 static int	rtsx_sd_get_rx_phase_len(uint32_t phase_map, int start_bit);
239 #endif /* !MMCCAM */
240 #if 0	/* For led */
241 static int	rtsx_led_enable(struct rtsx_softc *sc);
242 static int	rtsx_led_disable(struct rtsx_softc *sc);
243 #endif	/* For led */
244 static uint8_t	rtsx_response_type(uint16_t mmc_rsp);
245 static void	rtsx_init_cmd(struct rtsx_softc *sc, struct mmc_command *cmd);
246 static void	rtsx_push_cmd(struct rtsx_softc *sc, uint8_t cmd, uint16_t reg,
247 			      uint8_t mask, uint8_t data);
248 static void	rtsx_set_cmd_data_len(struct rtsx_softc *sc, uint16_t block_cnt, uint16_t byte_cnt);
249 static void	rtsx_send_cmd(struct rtsx_softc *sc);
250 static void	rtsx_ret_resp(struct rtsx_softc *sc);
251 static void	rtsx_set_resp(struct rtsx_softc *sc, struct mmc_command *cmd);
252 static void	rtsx_stop_cmd(struct rtsx_softc *sc);
253 static void	rtsx_clear_error(struct rtsx_softc *sc);
254 static void	rtsx_req_done(struct rtsx_softc *sc);
255 static int	rtsx_send_req(struct rtsx_softc *sc, struct mmc_command *cmd);
256 static int	rtsx_xfer_short(struct rtsx_softc *sc, struct mmc_command *cmd);
257 static void	rtsx_ask_ppbuf_part1(struct rtsx_softc *sc);
258 static void	rtsx_get_ppbuf_part1(struct rtsx_softc *sc);
259 static void	rtsx_get_ppbuf_part2(struct rtsx_softc *sc);
260 static void	rtsx_put_ppbuf_part1(struct rtsx_softc *sc);
261 static void	rtsx_put_ppbuf_part2(struct rtsx_softc *sc);
262 static void	rtsx_write_ppbuf(struct rtsx_softc *sc);
263 static int	rtsx_xfer(struct rtsx_softc *sc, struct mmc_command *cmd);
264 static void	rtsx_xfer_begin(struct rtsx_softc *sc);
265 static void	rtsx_xfer_start(struct rtsx_softc *sc);
266 static void	rtsx_xfer_finish(struct rtsx_softc *sc);
267 static void	rtsx_timeout(void *arg);
268 
269 #ifdef MMCCAM
270 static int	rtsx_get_tran_settings(device_t dev, struct ccb_trans_settings_mmc *cts);
271 static int	rtsx_set_tran_settings(device_t dev, struct ccb_trans_settings_mmc *cts);
272 static int	rtsx_cam_request(device_t dev, union ccb *ccb);
273 #endif /* MMCCAM */
274 
275 static int	rtsx_read_ivar(device_t bus, device_t child, int which, uintptr_t *result);
276 static int	rtsx_write_ivar(device_t bus, device_t child, int which, uintptr_t value);
277 
278 static int	rtsx_mmcbr_update_ios(device_t bus, device_t child __unused);
279 static int	rtsx_mmcbr_switch_vccq(device_t bus, device_t child __unused);
280 static int	rtsx_mmcbr_request(device_t bus, device_t child __unused, struct mmc_request *req);
281 #ifndef MMCCAM
282 static int	rtsx_mmcbr_tune(device_t bus, device_t child __unused, bool hs400 __unused);
283 static int	rtsx_mmcbr_retune(device_t bus, device_t child __unused, bool reset __unused);
284 static int	rtsx_mmcbr_get_ro(device_t bus, device_t child __unused);
285 static int	rtsx_mmcbr_acquire_host(device_t bus, device_t child __unused);
286 static int	rtsx_mmcbr_release_host(device_t bus, device_t child __unused);
287 #endif /* !MMCCAM */
288 
289 static int	rtsx_probe(device_t dev);
290 static int	rtsx_attach(device_t dev);
291 static int	rtsx_detach(device_t dev);
292 static int	rtsx_shutdown(device_t dev);
293 static int	rtsx_suspend(device_t dev);
294 static int	rtsx_resume(device_t dev);
295 
296 #define	RTSX_LOCK_INIT(_sc)	mtx_init(&(_sc)->rtsx_mtx,	\
297 					 device_get_nameunit(sc->rtsx_dev), "rtsx", MTX_DEF)
298 #define	RTSX_LOCK(_sc)		mtx_lock(&(_sc)->rtsx_mtx)
299 #define	RTSX_UNLOCK(_sc)	mtx_unlock(&(_sc)->rtsx_mtx)
300 #define	RTSX_LOCK_DESTROY(_sc)	mtx_destroy(&(_sc)->rtsx_mtx)
301 
302 #define	RTSX_SDCLK_OFF			0
303 #define	RTSX_SDCLK_250KHZ	   250000
304 #define	RTSX_SDCLK_400KHZ	   400000
305 #define	RTSX_SDCLK_25MHZ	 25000000
306 #define	RTSX_SDCLK_50MHZ	 50000000
307 #define	RTSX_SDCLK_100MHZ	100000000
308 #define	RTSX_SDCLK_208MHZ	208000000
309 
310 #define	RTSX_MIN_DIV_N		80
311 #define	RTSX_MAX_DIV_N		208
312 
313 #define	RTSX_MAX_DATA_BLKLEN	512
314 
315 #define	RTSX_DMA_ALIGN		4
316 #define	RTSX_HOSTCMD_MAX	256
317 #define	RTSX_DMA_CMD_BIFSIZE	(sizeof(uint32_t) * RTSX_HOSTCMD_MAX)
318 #define	RTSX_DMA_DATA_BUFSIZE	MAXPHYS
319 
320 #define	ISSET(t, f) ((t) & (f))
321 
322 #define	READ4(sc, reg)						\
323 	(bus_space_read_4((sc)->rtsx_mem_btag, (sc)->rtsx_mem_bhandle, (reg)))
324 #define	WRITE4(sc, reg, val)					\
325 	(bus_space_write_4((sc)->rtsx_mem_btag, (sc)->rtsx_mem_bhandle, (reg), (val)))
326 
327 #define	RTSX_READ(sc, reg, val) 				\
328 	do { 							\
329 		int err = rtsx_read((sc), (reg), (val)); 	\
330 		if (err) 					\
331 			return (err);				\
332 	} while (0)
333 
334 #define	RTSX_WRITE(sc, reg, val) 				\
335 	do { 							\
336 		int err = rtsx_write((sc), (reg), 0xff, (val));	\
337 		if (err) 					\
338 			return (err);				\
339 	} while (0)
340 #define	RTSX_CLR(sc, reg, bits)					\
341 	do { 							\
342 		int err = rtsx_write((sc), (reg), (bits), 0); 	\
343 		if (err) 					\
344 			return (err);				\
345 	} while (0)
346 
347 #define	RTSX_SET(sc, reg, bits)					\
348 	do { 							\
349 		int err = rtsx_write((sc), (reg), (bits), 0xff);\
350 		if (err) 					\
351 			return (err);				\
352 	} while (0)
353 
354 #define	RTSX_BITOP(sc, reg, mask, bits)				\
355 	do {							\
356 		int err = rtsx_write((sc), (reg), (mask), (bits));	\
357 		if (err)					\
358 			return (err);				\
359 	} while (0)
360 
361 /*
362  * We use two DMA buffers: a command buffer and a data buffer.
363  *
364  * The command buffer contains a command queue for the host controller,
365  * which describes SD/MMC commands to run, and other parameters. The chip
366  * runs the command queue when a special bit in the RTSX_HCBAR register is
367  * set and signals completion with the RTSX_TRANS_OK_INT interrupt.
368  * Each command is encoded as a 4 byte sequence containing command number
369  * (read, write, or check a host controller register), a register address,
370  * and a data bit-mask and value.
371  * SD/MMC commands which do not transfer any data from/to the card only use
372  * the command buffer.
373  *
374  * The data buffer is used for transfer longer than 512. Data transfer is
375  * controlled via the RTSX_HDBAR register and completion is signalled by
376  * the RTSX_TRANS_OK_INT interrupt.
377  *
378  * The chip is unable to perform DMA above 4GB.
379  */
380 
381 /*
382  * Main commands in the usual seqence used:
383  *
384  * CMD0		Go idle state
385  * CMD8		Send interface condition
386  * CMD55	Application Command for next ACMD
387  * ACMD41	Send Operation Conditions Register (OCR: voltage profile of the card)
388  * CMD2		Send Card Identification (CID) Register
389  * CMD3		Send relative address
390  * CMD9		Send Card Specific Data (CSD)
391  * CMD13	Send status (32 bits -  bit 25: card password protected)
392  * CMD7		Select card (before Get card SCR)
393  * ACMD51	Send SCR (SD CARD Configuration Register - [51:48]: Bus widths supported)
394  * CMD6		SD switch function
395  * ACMD13	Send SD status (512 bits)
396  * ACMD42	Set/Clear card detect
397  * ACMD6	Set bus width
398  * CMD19	Send tuning block
399  * CMD12	Stop transmission
400  *
401  * CMD17	Read single block (<=512)
402  * CMD18	Read multiple blocks (>512)
403  * CMD24	Write single block (<=512)
404  * CMD25	Write multiple blocks (>512)
405  *
406  * CMD52	IO R/W direct
407  * CMD5		Send Operation Conditions
408  */
409 
410 static int
411 rtsx_dma_alloc(struct rtsx_softc *sc)
412 {
413 	int	error = 0;
414 
415 	error = bus_dma_tag_create(bus_get_dma_tag(sc->rtsx_dev), /* inherit from parent */
416 	    RTSX_DMA_ALIGN, 0,		/* alignment, boundary */
417 	    BUS_SPACE_MAXADDR_32BIT,	/* lowaddr */
418 	    BUS_SPACE_MAXADDR,		/* highaddr */
419 	    NULL, NULL,			/* filter, filterarg */
420 	    RTSX_DMA_CMD_BIFSIZE, 1,	/* maxsize, nsegments */
421 	    RTSX_DMA_CMD_BIFSIZE,	/* maxsegsize */
422 	    0,				/* flags */
423 	    NULL, NULL,			/* lockfunc, lockarg */
424 	    &sc->rtsx_cmd_dma_tag);
425 	if (error) {
426 		device_printf(sc->rtsx_dev,
427 			      "Can't create cmd parent DMA tag\n");
428 		return (error);
429 	}
430 	error = bus_dmamem_alloc(sc->rtsx_cmd_dma_tag,		/* DMA tag */
431 	    &sc->rtsx_cmd_dmamem,				/* will hold the KVA pointer */
432 	    BUS_DMA_COHERENT | BUS_DMA_WAITOK | BUS_DMA_ZERO,	/* flags */
433 	    &sc->rtsx_cmd_dmamap); 				/* DMA map */
434 	if (error) {
435 		device_printf(sc->rtsx_dev,
436 			      "Can't create DMA map for command transfer\n");
437 		goto destroy_cmd_dma_tag;
438 
439 	}
440 	error = bus_dmamap_load(sc->rtsx_cmd_dma_tag,	/* DMA tag */
441 	    sc->rtsx_cmd_dmamap,	/* DMA map */
442 	    sc->rtsx_cmd_dmamem,	/* KVA pointer to be mapped */
443 	    RTSX_DMA_CMD_BIFSIZE,	/* size of buffer */
444 	    rtsx_dmamap_cb,		/* callback */
445 	    &sc->rtsx_cmd_buffer,	/* first arg of callback */
446 	    0);				/* flags */
447 	if (error || sc->rtsx_cmd_buffer == 0) {
448 		device_printf(sc->rtsx_dev,
449 			      "Can't load DMA memory for command transfer\n");
450 		error = (error) ? error : EFAULT;
451 		goto destroy_cmd_dmamem_alloc;
452 	}
453 
454 	error = bus_dma_tag_create(bus_get_dma_tag(sc->rtsx_dev),	/* inherit from parent */
455 	    RTSX_DMA_DATA_BUFSIZE, 0,	/* alignment, boundary */
456 	    BUS_SPACE_MAXADDR_32BIT,	/* lowaddr */
457 	    BUS_SPACE_MAXADDR,		/* highaddr */
458 	    NULL, NULL,			/* filter, filterarg */
459 	    RTSX_DMA_DATA_BUFSIZE, 1,	/* maxsize, nsegments */
460 	    RTSX_DMA_DATA_BUFSIZE,	/* maxsegsize */
461 	    0,				/* flags */
462 	    NULL, NULL,			/* lockfunc, lockarg */
463 	    &sc->rtsx_data_dma_tag);
464 	if (error) {
465 		device_printf(sc->rtsx_dev,
466 			      "Can't create data parent DMA tag\n");
467 		goto destroy_cmd_dmamap_load;
468 	}
469 	error = bus_dmamem_alloc(sc->rtsx_data_dma_tag,		/* DMA tag */
470 	    &sc->rtsx_data_dmamem,				/* will hold the KVA pointer */
471 	    BUS_DMA_WAITOK | BUS_DMA_ZERO,			/* flags */
472 	    &sc->rtsx_data_dmamap); 				/* DMA map */
473 	if (error) {
474 		device_printf(sc->rtsx_dev,
475 			      "Can't create DMA map for data transfer\n");
476 		goto destroy_data_dma_tag;
477 	}
478 	error = bus_dmamap_load(sc->rtsx_data_dma_tag,	/* DMA tag */
479 	    sc->rtsx_data_dmamap,	/* DMA map */
480 	    sc->rtsx_data_dmamem,	/* KVA pointer to be mapped */
481 	    RTSX_DMA_DATA_BUFSIZE,	/* size of buffer */
482 	    rtsx_dmamap_cb,		/* callback */
483 	    &sc->rtsx_data_buffer,	/* first arg of callback */
484 	    0);				/* flags */
485 	if (error || sc->rtsx_data_buffer == 0) {
486 		device_printf(sc->rtsx_dev,
487 			      "Can't load DMA memory for data transfer\n");
488 		error = (error) ? error : EFAULT;
489 		goto destroy_data_dmamem_alloc;
490 	}
491 	return (error);
492 
493  destroy_data_dmamem_alloc:
494 	bus_dmamem_free(sc->rtsx_data_dma_tag, sc->rtsx_data_dmamem, sc->rtsx_data_dmamap);
495  destroy_data_dma_tag:
496 	bus_dma_tag_destroy(sc->rtsx_data_dma_tag);
497  destroy_cmd_dmamap_load:
498 	bus_dmamap_unload(sc->rtsx_cmd_dma_tag, sc->rtsx_cmd_dmamap);
499  destroy_cmd_dmamem_alloc:
500 	bus_dmamem_free(sc->rtsx_cmd_dma_tag, sc->rtsx_cmd_dmamem, sc->rtsx_cmd_dmamap);
501  destroy_cmd_dma_tag:
502 	bus_dma_tag_destroy(sc->rtsx_cmd_dma_tag);
503 
504 	return (error);
505 }
506 
507 static void
508 rtsx_dmamap_cb(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
509 {
510 	if (error) {
511 		printf("rtsx_dmamap_cb: error %d\n", error);
512 		return;
513 	}
514 	*(bus_addr_t *)arg = segs[0].ds_addr;
515 }
516 
517 static void
518 rtsx_dma_free(struct rtsx_softc *sc)
519 {
520 	if (sc->rtsx_cmd_dma_tag != NULL) {
521 		if (sc->rtsx_cmd_dmamap != NULL)
522 			bus_dmamap_unload(sc->rtsx_cmd_dma_tag,
523 					  sc->rtsx_cmd_dmamap);
524 		if (sc->rtsx_cmd_dmamem != NULL)
525 			bus_dmamem_free(sc->rtsx_cmd_dma_tag,
526 					sc->rtsx_cmd_dmamem,
527 					sc->rtsx_cmd_dmamap);
528 		sc->rtsx_cmd_dmamap = NULL;
529 		sc->rtsx_cmd_dmamem = NULL;
530 		sc->rtsx_cmd_buffer = 0;
531 		bus_dma_tag_destroy(sc->rtsx_cmd_dma_tag);
532 		sc->rtsx_cmd_dma_tag = NULL;
533 	}
534 	if (sc->rtsx_data_dma_tag != NULL) {
535 		if (sc->rtsx_data_dmamap != NULL)
536 			bus_dmamap_unload(sc->rtsx_data_dma_tag,
537 					  sc->rtsx_data_dmamap);
538 		if (sc->rtsx_data_dmamem != NULL)
539 			bus_dmamem_free(sc->rtsx_data_dma_tag,
540 					sc->rtsx_data_dmamem,
541 					sc->rtsx_data_dmamap);
542 		sc->rtsx_data_dmamap = NULL;
543 		sc->rtsx_data_dmamem = NULL;
544 		sc->rtsx_data_buffer = 0;
545 		bus_dma_tag_destroy(sc->rtsx_data_dma_tag);
546 		sc->rtsx_data_dma_tag = NULL;
547 	}
548 }
549 
550 static void
551 rtsx_intr(void *arg)
552 {
553 	struct rtsx_softc *sc = arg;
554 	uint32_t	enabled;
555 	uint32_t	status;
556 
557 	RTSX_LOCK(sc);
558 
559 	enabled = sc->rtsx_intr_enabled;
560 	status = READ4(sc, RTSX_BIPR);	/* read Bus Interrupt Pending Register */
561 	sc->rtsx_intr_status = status;
562 
563 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
564 		device_printf(sc->rtsx_dev, "Interrupt handler - enabled: 0x%08x, status: 0x%08x\n", enabled, status);
565 
566 	/* Ack interrupts. */
567 	WRITE4(sc, RTSX_BIPR, status);
568 
569 	if (((enabled & status) == 0) || status == 0xffffffff) {
570 		device_printf(sc->rtsx_dev, "Spurious interrupt - enabled: 0x%08x, status: 0x%08x\n", enabled, status);
571 		RTSX_UNLOCK(sc);
572 		return;
573 	}
574 
575 	/* Detect write protect. */
576 	if (status & RTSX_SD_WRITE_PROTECT)
577 		sc->rtsx_read_only = 1;
578 	else
579 		sc->rtsx_read_only = 0;
580 
581 	/* Start task to handle SD card status change (from dwmmc.c). */
582 	if (status & RTSX_SD_INT) {
583 		device_printf(sc->rtsx_dev, "Interrupt card inserted/removed\n");
584 		rtsx_handle_card_present(sc);
585 	}
586 
587 	if (sc->rtsx_req == NULL) {
588 		RTSX_UNLOCK(sc);
589 		return;
590 	}
591 
592 	if (status & RTSX_TRANS_OK_INT) {
593 		sc->rtsx_req->cmd->error = MMC_ERR_NONE;
594 		if (sc->rtsx_intr_trans_ok != NULL)
595 			sc->rtsx_intr_trans_ok(sc);
596 	} else if (status & RTSX_TRANS_FAIL_INT) {
597 		uint8_t stat1;
598 		sc->rtsx_req->cmd->error = MMC_ERR_FAILED;
599 		if (rtsx_read(sc, RTSX_SD_STAT1, &stat1) == 0 &&
600 		    (stat1 & RTSX_SD_CRC_ERR)) {
601 			device_printf(sc->rtsx_dev, "CRC error\n");
602 			sc->rtsx_req->cmd->error = MMC_ERR_BADCRC;
603 		}
604 		if (!sc->rtsx_tuning_mode)
605 			device_printf(sc->rtsx_dev, "Transfer fail - status: 0x%08x\n", status);
606 		rtsx_stop_cmd(sc);
607 		if (sc->rtsx_intr_trans_ko != NULL)
608 			sc->rtsx_intr_trans_ko(sc);
609 	}
610 
611 	RTSX_UNLOCK(sc);
612 }
613 
614 /*
615  * Function called from the IRQ handler (from dwmmc.c).
616  */
617 static void
618 rtsx_handle_card_present(struct rtsx_softc *sc)
619 {
620 	bool	was_present;
621 	bool	is_present;
622 
623 #ifdef MMCCAM
624 	was_present = sc->rtsx_cam_status;
625 #else  /* !MMCCAM */
626 	was_present = sc->rtsx_mmc_dev != NULL;
627 #endif /* MMCCAM */
628 	is_present = rtsx_is_card_present(sc);
629 	if (is_present)
630 		device_printf(sc->rtsx_dev, "Card present\n");
631 	else
632 		device_printf(sc->rtsx_dev, "Card absent\n");
633 
634 	if (!was_present && is_present) {
635 		/*
636 		 * The delay is to debounce the card insert
637 		 * (sometimes the card detect pin stabilizes
638 		 * before the other pins have made good contact).
639 		 */
640 		taskqueue_enqueue_timeout(taskqueue_swi_giant,
641 					  &sc->rtsx_card_insert_task, -hz);
642 	} else if (was_present && !is_present) {
643 		taskqueue_enqueue(taskqueue_swi_giant, &sc->rtsx_card_remove_task);
644 	}
645 }
646 
647 /*
648  * This function is called at startup.
649  */
650 static void
651 rtsx_card_task(void *arg, int pending __unused)
652 {
653 	struct rtsx_softc *sc = arg;
654 
655 	if (rtsx_is_card_present(sc)) {
656 		sc->rtsx_flags |= RTSX_F_CARD_PRESENT;
657 		/* Card is present, attach if necessary. */
658 #ifdef MMCCAM
659 		if (sc->rtsx_cam_status == 0) {
660 #else  /* !MMCCAM */
661 		if (sc->rtsx_mmc_dev == NULL) {
662 #endif /* MMCCAM */
663 			if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
664 				device_printf(sc->rtsx_dev, "Card inserted\n");
665 
666 			sc->rtsx_read_count = sc->rtsx_write_count = 0;
667 #ifdef MMCCAM
668 			sc->rtsx_cam_status = 1;
669 			mmc_cam_sim_discover(&sc->rtsx_mmc_sim);
670 #else  /* !MMCCAM */
671 			RTSX_LOCK(sc);
672 			sc->rtsx_mmc_dev = device_add_child(sc->rtsx_dev, "mmc", -1);
673 			RTSX_UNLOCK(sc);
674 			if (sc->rtsx_mmc_dev == NULL) {
675 				device_printf(sc->rtsx_dev, "Adding MMC bus failed\n");
676 			} else {
677 				device_set_ivars(sc->rtsx_mmc_dev, sc);
678 				device_probe_and_attach(sc->rtsx_mmc_dev);
679 			}
680 #endif /* MMCCAM */
681 		}
682 	} else {
683 		sc->rtsx_flags &= ~RTSX_F_CARD_PRESENT;
684 		/* Card isn't present, detach if necessary. */
685 #ifdef MMCCAM
686 		if (sc->rtsx_cam_status != 0) {
687 #else  /* !MMCCAM */
688 		if (sc->rtsx_mmc_dev != NULL) {
689 #endif /* MMCCAM */
690 			if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
691 				device_printf(sc->rtsx_dev, "Card removed\n");
692 
693 			if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
694 				device_printf(sc->rtsx_dev, "Read count: %" PRIu64 ", write count: %" PRIu64 "\n",
695 					      sc->rtsx_read_count, sc->rtsx_write_count);
696 #ifdef MMCCAM
697 			sc->rtsx_cam_status = 0;
698 			mmc_cam_sim_discover(&sc->rtsx_mmc_sim);
699 #else  /* !MMCCAM */
700 			if (device_delete_child(sc->rtsx_dev, sc->rtsx_mmc_dev))
701 				device_printf(sc->rtsx_dev, "Detaching MMC bus failed\n");
702 			sc->rtsx_mmc_dev = NULL;
703 #endif /* MMCCAM */
704 		}
705 	}
706 }
707 
708 static bool
709 rtsx_is_card_present(struct rtsx_softc *sc)
710 {
711 	uint32_t status;
712 
713 	status = READ4(sc, RTSX_BIPR);
714 	if (sc->rtsx_inversion == 0)
715 		return (status & RTSX_SD_EXIST);
716 	else
717 		return !(status & RTSX_SD_EXIST);
718 }
719 
720 static int
721 rtsx_init(struct rtsx_softc *sc)
722 {
723 	uint8_t	version;
724 	uint8_t	val;
725 	int	error;
726 
727 	sc->rtsx_host.host_ocr = RTSX_SUPPORTED_VOLTAGE;
728 	sc->rtsx_host.f_min = RTSX_SDCLK_250KHZ;
729 	sc->rtsx_host.f_max = RTSX_SDCLK_208MHZ;
730 	sc->rtsx_host.caps = MMC_CAP_4_BIT_DATA | MMC_CAP_HSPEED |
731 		MMC_CAP_UHS_SDR12 | MMC_CAP_UHS_SDR25;
732 
733 	sc->rtsx_host.caps |= MMC_CAP_UHS_SDR50 | MMC_CAP_UHS_SDR104;
734 	if (sc->rtsx_device_id == RTSX_RTS5209)
735 		sc->rtsx_host.caps |= MMC_CAP_8_BIT_DATA;
736 	pci_find_cap(sc->rtsx_dev, PCIY_EXPRESS, &(sc->rtsx_pcie_cap));
737 
738 	/*
739 	 * Check IC version.
740 	 */
741 	switch (sc->rtsx_device_id) {
742 	case RTSX_RTS5229:
743 		/* Read IC version from dummy register. */
744 		RTSX_READ(sc, RTSX_DUMMY_REG, &version);
745 		if ((version & 0x0F) == RTSX_IC_VERSION_C)
746 			sc->rtsx_flags |= RTSX_F_VERSION_C;
747 		break;
748 	case RTSX_RTS522A:
749 		/* Read IC version from dummy register. */
750 		RTSX_READ(sc, RTSX_DUMMY_REG, &version);
751 		if ((version & 0x0F) == RTSX_IC_VERSION_A)
752 			sc->rtsx_flags |= RTSX_F_VERSION_A;
753 		break;
754 	case RTSX_RTS525A:
755 		/* Read IC version from dummy register. */
756 		RTSX_READ(sc, RTSX_DUMMY_REG, &version);
757 		if ((version & 0x0F) == RTSX_IC_VERSION_A)
758 			sc->rtsx_flags |= RTSX_F_VERSION_A;
759 		break;
760 	case RTSX_RTL8411B:
761 		RTSX_READ(sc, RTSX_RTL8411B_PACKAGE, &version);
762 		if (version & RTSX_RTL8411B_QFN48)
763 			sc->rtsx_flags |= RTSX_F_8411B_QFN48;
764 		break;
765 	}
766 
767 	/*
768 	 * Fetch vendor settings.
769 	 */
770 	/*
771 	 * Normally OEMs will set vendor setting to the config space
772 	 * of Realtek card reader in BIOS stage. This statement reads
773 	 * the setting and configure the internal registers according
774 	 * to it, to improve card reader's compatibility condition.
775 	 */
776 	sc->rtsx_card_drive_sel = RTSX_CARD_DRIVE_DEFAULT;
777 	switch (sc->rtsx_device_id) {
778 		uint32_t reg;
779 		uint32_t reg1;
780 		uint8_t  reg3;
781 	case RTSX_RTS5209:
782 		sc->rtsx_card_drive_sel = RTSX_RTS5209_CARD_DRIVE_DEFAULT;
783 		sc->rtsx_sd30_drive_sel_3v3 = RTSX_DRIVER_TYPE_D;
784 		reg = pci_read_config(sc->rtsx_dev, RTSX_PCR_SETTING_REG2, 4);
785 		if (!(reg & 0x80)) {
786 			sc->rtsx_card_drive_sel = (reg >> 8) & 0x3F;
787 			sc->rtsx_sd30_drive_sel_3v3 = reg & 0x07;
788 		} else if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC) {
789 			device_printf(sc->rtsx_dev, "pci_read_config() error - reg: 0x%08x\n", reg);
790 		}
791 		if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
792 			device_printf(sc->rtsx_dev, "card_drive_sel: 0x%02x, sd30_drive_sel_3v3: 0x%02x\n",
793 				      sc->rtsx_card_drive_sel, sc->rtsx_sd30_drive_sel_3v3);
794 		break;
795 	case RTSX_RTS5227:
796 	case RTSX_RTS522A:
797 		sc->rtsx_sd30_drive_sel_3v3 = RTSX_CFG_DRIVER_TYPE_B;
798 		reg = pci_read_config(sc->rtsx_dev, RTSX_PCR_SETTING_REG1, 4);
799 		if (!(reg & 0x1000000)) {
800 			sc->rtsx_card_drive_sel &= 0x3F;
801 			sc->rtsx_card_drive_sel |= ((reg >> 25) & 0x01) << 6;
802 			reg = pci_read_config(sc->rtsx_dev, RTSX_PCR_SETTING_REG2, 4);
803 			sc->rtsx_sd30_drive_sel_3v3 = (reg >> 5) & 0x03;
804 			if (reg & 0x4000)
805 				sc->rtsx_flags |= RTSX_F_REVERSE_SOCKET;
806 		} else if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC) {
807 			device_printf(sc->rtsx_dev, "pci_read_config() error - reg: 0x%08x\n", reg);
808 		}
809 		if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
810 			device_printf(sc->rtsx_dev,
811 				      "card_drive_sel: 0x%02x, sd30_drive_sel_3v3: 0x%02x, reverse_socket is %s\n",
812 				      sc->rtsx_card_drive_sel, sc->rtsx_sd30_drive_sel_3v3,
813 				      (sc->rtsx_flags & RTSX_F_REVERSE_SOCKET) ? "true" : "false");
814 		break;
815 	case RTSX_RTS5229:
816 		sc->rtsx_sd30_drive_sel_3v3 = RTSX_DRIVER_TYPE_D;
817 		reg = pci_read_config(sc->rtsx_dev, RTSX_PCR_SETTING_REG1, 4);
818 		if (!(reg & 0x1000000)) {
819 			sc->rtsx_card_drive_sel &= 0x3F;
820 			sc->rtsx_card_drive_sel |= ((reg >> 25) & 0x01) << 6;
821 			reg = pci_read_config(sc->rtsx_dev, RTSX_PCR_SETTING_REG2, 4);
822 			sc->rtsx_sd30_drive_sel_3v3 = rtsx_map_sd_drive((reg >> 5) & 0x03);
823 		} else if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC) {
824 			device_printf(sc->rtsx_dev, "pci_read_config() error - reg: 0x%08x\n", reg);
825 		}
826 		if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
827 			device_printf(sc->rtsx_dev, "card_drive_sel: 0x%02x, sd30_drive_sel_3v3: 0x%02x\n",
828 				      sc->rtsx_card_drive_sel, sc->rtsx_sd30_drive_sel_3v3);
829 		break;
830 	case RTSX_RTS525A:
831 	case RTSX_RTS5249:
832 	case RTSX_RTS5260:
833 		sc->rtsx_sd30_drive_sel_3v3 = RTSX_CFG_DRIVER_TYPE_B;
834 		reg = pci_read_config(sc->rtsx_dev, RTSX_PCR_SETTING_REG1, 4);
835 		if ((reg & 0x1000000)) {
836 			sc->rtsx_card_drive_sel &= 0x3F;
837 			sc->rtsx_card_drive_sel |= ((reg >> 25) & 0x01) << 6;
838 			reg = pci_read_config(sc->rtsx_dev, RTSX_PCR_SETTING_REG2, 4);
839 			sc->rtsx_sd30_drive_sel_3v3 = (reg >> 5) & 0x03;
840 			if (reg & 0x4000)
841 				sc->rtsx_flags |= RTSX_F_REVERSE_SOCKET;
842 		} else if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC) {
843 			device_printf(sc->rtsx_dev, "pci_read_config() error - reg: 0x%08x\n", reg);
844 		}
845 		if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
846 			device_printf(sc->rtsx_dev,
847 				      "card_drive_sel = 0x%02x, sd30_drive_sel_3v3: 0x%02x, reverse_socket is %s\n",
848 				      sc->rtsx_card_drive_sel, sc->rtsx_sd30_drive_sel_3v3,
849 				      (sc->rtsx_flags & RTSX_F_REVERSE_SOCKET) ? "true" : "false");
850 		break;
851 	case RTSX_RTL8402:
852 	case RTSX_RTL8411:
853 		sc->rtsx_card_drive_sel = RTSX_RTL8411_CARD_DRIVE_DEFAULT;
854 		sc->rtsx_sd30_drive_sel_3v3 = RTSX_DRIVER_TYPE_D;
855 		reg1 = pci_read_config(sc->rtsx_dev, RTSX_PCR_SETTING_REG1, 4);
856 		if (reg1 & 0x1000000) {
857 			sc->rtsx_card_drive_sel &= 0x3F;
858 			sc->rtsx_card_drive_sel |= ((reg1 >> 25) & 0x01) << 6;
859 			reg3 = pci_read_config(sc->rtsx_dev, RTSX_PCR_SETTING_REG3, 1);
860 			sc->rtsx_sd30_drive_sel_3v3 = (reg3 >> 5) & 0x07;
861 		} else if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC) {
862 			device_printf(sc->rtsx_dev, "pci_read_config() error - reg1: 0x%08x\n", reg1);
863 		}
864 		if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
865 			device_printf(sc->rtsx_dev,
866 				      "card_drive_sel: 0x%02x, sd30_drive_sel_3v3: 0x%02x\n",
867 				      sc->rtsx_card_drive_sel, sc->rtsx_sd30_drive_sel_3v3);
868 		break;
869 	case RTSX_RTL8411B:
870 		sc->rtsx_card_drive_sel = RTSX_RTL8411_CARD_DRIVE_DEFAULT;
871 		sc->rtsx_sd30_drive_sel_3v3 = RTSX_DRIVER_TYPE_D;
872 		reg = pci_read_config(sc->rtsx_dev, RTSX_PCR_SETTING_REG1, 4);
873 		if (!(reg & 0x1000000)) {
874 			sc->rtsx_sd30_drive_sel_3v3 = rtsx_map_sd_drive(reg & 0x03);
875 		} else if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC) {
876 			device_printf(sc->rtsx_dev, "pci_read_config() error - reg: 0x%08x\n", reg);
877 		}
878 		if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
879 			device_printf(sc->rtsx_dev,
880 				      "card_drive_sel: 0x%02x, sd30_drive_sel_3v3: 0x%02x\n",
881 				      sc->rtsx_card_drive_sel, sc->rtsx_sd30_drive_sel_3v3);
882 		break;
883 	}
884 
885 	if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
886 		device_printf(sc->rtsx_dev, "rtsx_init() rtsx_flags: 0x%04x\n", sc->rtsx_flags);
887 
888 	/* Enable interrupts. */
889 	sc->rtsx_intr_enabled = RTSX_TRANS_OK_INT_EN | RTSX_TRANS_FAIL_INT_EN | RTSX_SD_INT_EN;
890 	WRITE4(sc, RTSX_BIER, sc->rtsx_intr_enabled);
891 
892 	/* Power on SSC clock. */
893 	RTSX_CLR(sc, RTSX_FPDCTL, RTSX_SSC_POWER_DOWN);
894 	/* Wait SSC power stable. */
895 	DELAY(200);
896 
897 	/* Disable ASPM */
898 	val = pci_read_config(sc->rtsx_dev, sc->rtsx_pcie_cap + PCIER_LINK_CTL, 1);
899 	pci_write_config(sc->rtsx_dev, sc->rtsx_pcie_cap + PCIER_LINK_CTL, val & 0xfc, 1);
900 
901 	/*
902 	 * Optimize phy.
903 	 */
904 	switch (sc->rtsx_device_id) {
905 	case RTSX_RTS5209:
906 		/* Some magic numbers from Linux driver. */
907 		if ((error = rtsx_write_phy(sc, 0x00, 0xB966)))
908 			return (error);
909 		break;
910 	case RTSX_RTS5227:
911 		RTSX_CLR(sc, RTSX_PM_CTRL3, RTSX_D3_DELINK_MODE_EN);
912 
913 		/* Optimize RX sensitivity. */
914 		if ((error = rtsx_write_phy(sc, 0x00, 0xBA42)))
915 			return (error);
916 		break;
917 	case RTSX_RTS5229:
918 		/* Optimize RX sensitivity. */
919 		if ((error = rtsx_write_phy(sc, 0x00, 0xBA42)))
920 			return (error);
921 		break;
922 	case RTSX_RTS522A:
923 		RTSX_CLR(sc, RTSX_RTS522A_PM_CTRL3, RTSX_D3_DELINK_MODE_EN);
924 		if (sc->rtsx_flags & RTSX_F_VERSION_A) {
925 			if ((error = rtsx_write_phy(sc, RTSX_PHY_RCR2, RTSX_PHY_RCR2_INIT_27S)))
926 				return (error);
927 		}
928 		if ((error = rtsx_write_phy(sc, RTSX_PHY_RCR1, RTSX_PHY_RCR1_INIT_27S)))
929 			return (error);
930 		if ((error = rtsx_write_phy(sc, RTSX_PHY_FLD0, RTSX_PHY_FLD0_INIT_27S)))
931 			return (error);
932 		if ((error = rtsx_write_phy(sc, RTSX_PHY_FLD3, RTSX_PHY_FLD3_INIT_27S)))
933 			return (error);
934 		if ((error = rtsx_write_phy(sc, RTSX_PHY_FLD4, RTSX_PHY_FLD4_INIT_27S)))
935 			return (error);
936 		break;
937 	case RTSX_RTS525A:
938 		if ((error = rtsx_write_phy(sc, RTSX__PHY_FLD0,
939 					    RTSX__PHY_FLD0_CLK_REQ_20C | RTSX__PHY_FLD0_RX_IDLE_EN |
940 					    RTSX__PHY_FLD0_BIT_ERR_RSTN | RTSX__PHY_FLD0_BER_COUNT |
941 					    RTSX__PHY_FLD0_BER_TIMER | RTSX__PHY_FLD0_CHECK_EN)))
942 			return (error);
943 		if ((error = rtsx_write_phy(sc, RTSX__PHY_ANA03,
944 					    RTSX__PHY_ANA03_TIMER_MAX | RTSX__PHY_ANA03_OOBS_DEB_EN |
945 					    RTSX__PHY_CMU_DEBUG_EN)))
946 			return (error);
947 		if (sc->rtsx_flags & RTSX_F_VERSION_A)
948 			if ((error = rtsx_write_phy(sc, RTSX__PHY_REV0,
949 						    RTSX__PHY_REV0_FILTER_OUT | RTSX__PHY_REV0_CDR_BYPASS_PFD |
950 						    RTSX__PHY_REV0_CDR_RX_IDLE_BYPASS)))
951 				return (error);
952 		break;
953 	case RTSX_RTS5249:
954 		RTSX_CLR(sc, RTSX_PM_CTRL3, RTSX_D3_DELINK_MODE_EN);
955 		if ((error = rtsx_write_phy(sc, RTSX_PHY_REV,
956 					    RTSX_PHY_REV_RESV | RTSX_PHY_REV_RXIDLE_LATCHED |
957 					    RTSX_PHY_REV_P1_EN | RTSX_PHY_REV_RXIDLE_EN |
958 					    RTSX_PHY_REV_CLKREQ_TX_EN | RTSX_PHY_REV_RX_PWST |
959 					    RTSX_PHY_REV_CLKREQ_DT_1_0 | RTSX_PHY_REV_STOP_CLKRD |
960 					    RTSX_PHY_REV_STOP_CLKWR)))
961 			return (error);
962 		DELAY(1000);
963 		if ((error = rtsx_write_phy(sc, RTSX_PHY_BPCR,
964 					    RTSX_PHY_BPCR_IBRXSEL | RTSX_PHY_BPCR_IBTXSEL |
965 					    RTSX_PHY_BPCR_IB_FILTER | RTSX_PHY_BPCR_CMIRROR_EN)))
966 			return (error);
967 		if ((error = rtsx_write_phy(sc, RTSX_PHY_PCR,
968 					    RTSX_PHY_PCR_FORCE_CODE | RTSX_PHY_PCR_OOBS_CALI_50 |
969 					    RTSX_PHY_PCR_OOBS_VCM_08 | RTSX_PHY_PCR_OOBS_SEN_90 |
970 					    RTSX_PHY_PCR_RSSI_EN | RTSX_PHY_PCR_RX10K)))
971 			return (error);
972 		if ((error = rtsx_write_phy(sc, RTSX_PHY_RCR2,
973 					    RTSX_PHY_RCR2_EMPHASE_EN | RTSX_PHY_RCR2_NADJR |
974 					    RTSX_PHY_RCR2_CDR_SR_2 | RTSX_PHY_RCR2_FREQSEL_12 |
975 					    RTSX_PHY_RCR2_CDR_SC_12P | RTSX_PHY_RCR2_CALIB_LATE)))
976 			return (error);
977 		if ((error = rtsx_write_phy(sc, RTSX_PHY_FLD4,
978 					    RTSX_PHY_FLD4_FLDEN_SEL | RTSX_PHY_FLD4_REQ_REF |
979 					    RTSX_PHY_FLD4_RXAMP_OFF | RTSX_PHY_FLD4_REQ_ADDA |
980 					    RTSX_PHY_FLD4_BER_COUNT | RTSX_PHY_FLD4_BER_TIMER |
981 					    RTSX_PHY_FLD4_BER_CHK_EN)))
982 			return (error);
983 		if ((error = rtsx_write_phy(sc, RTSX_PHY_RDR,
984 					    RTSX_PHY_RDR_RXDSEL_1_9 | RTSX_PHY_SSC_AUTO_PWD)))
985 			return (error);
986 		if ((error = rtsx_write_phy(sc, RTSX_PHY_RCR1,
987 					    RTSX_PHY_RCR1_ADP_TIME_4 | RTSX_PHY_RCR1_VCO_COARSE)))
988 			return (error);
989 		if ((error = rtsx_write_phy(sc, RTSX_PHY_FLD3,
990 					    RTSX_PHY_FLD3_TIMER_4 | RTSX_PHY_FLD3_TIMER_6 |
991 					    RTSX_PHY_FLD3_RXDELINK)))
992 			return (error);
993 		if ((error = rtsx_write_phy(sc, RTSX_PHY_TUNE,
994 					    RTSX_PHY_TUNE_TUNEREF_1_0 | RTSX_PHY_TUNE_VBGSEL_1252 |
995 					    RTSX_PHY_TUNE_SDBUS_33 | RTSX_PHY_TUNE_TUNED18 |
996 					    RTSX_PHY_TUNE_TUNED12 | RTSX_PHY_TUNE_TUNEA12)))
997 			return (error);
998 		break;
999 	}
1000 
1001 	/* Set mcu_cnt to 7 to ensure data can be sampled properly. */
1002 	RTSX_BITOP(sc, RTSX_CLK_DIV, 0x07, 0x07);
1003 
1004 	/* Disable sleep mode. */
1005 	RTSX_CLR(sc, RTSX_HOST_SLEEP_STATE,
1006 		 RTSX_HOST_ENTER_S1 | RTSX_HOST_ENTER_S3);
1007 
1008 	/* Disable card clock. */
1009 	RTSX_CLR(sc, RTSX_CARD_CLK_EN, RTSX_CARD_CLK_EN_ALL);
1010 
1011 	/* Reset delink mode. */
1012 	RTSX_CLR(sc, RTSX_CHANGE_LINK_STATE,
1013 		 RTSX_FORCE_RST_CORE_EN | RTSX_NON_STICKY_RST_N_DBG);
1014 
1015 	/* Card driving select. */
1016 	RTSX_WRITE(sc, RTSX_CARD_DRIVE_SEL, sc->rtsx_card_drive_sel);
1017 
1018 	/* Enable SSC clock. */
1019 	RTSX_WRITE(sc, RTSX_SSC_CTL1, RTSX_SSC_8X_EN | RTSX_SSC_SEL_4M);
1020 	RTSX_WRITE(sc, RTSX_SSC_CTL2, 0x12);
1021 
1022 	/* Disable cd_pwr_save. */
1023 	RTSX_BITOP(sc, RTSX_CHANGE_LINK_STATE, 0x16, RTSX_MAC_PHY_RST_N_DBG);
1024 
1025 	/* Clear Link Ready Interrupt. */
1026 	RTSX_BITOP(sc, RTSX_IRQSTAT0, RTSX_LINK_READY_INT, RTSX_LINK_READY_INT);
1027 
1028 	/* Enlarge the estimation window of PERST# glitch
1029 	 * to reduce the chance of invalid card interrupt. */
1030 	RTSX_WRITE(sc, RTSX_PERST_GLITCH_WIDTH, 0x80);
1031 
1032 	/* Set RC oscillator to 400K. */
1033 	RTSX_CLR(sc, RTSX_RCCTL, RTSX_RCCTL_F_2M);
1034 
1035 	/* Enable interrupt write-clear (default is read-clear). */
1036 	RTSX_CLR(sc, RTSX_NFTS_TX_CTRL, RTSX_INT_READ_CLR);
1037 
1038 	switch (sc->rtsx_device_id) {
1039 	case RTSX_RTS525A:
1040 	case RTSX_RTS5260:
1041 		RTSX_BITOP(sc, RTSX_PM_CLK_FORCE_CTL, 1, 1);
1042 		break;
1043 	}
1044 
1045 	/* OC power down. */
1046 	RTSX_BITOP(sc, RTSX_FPDCTL, RTSX_SD_OC_POWER_DOWN, RTSX_SD_OC_POWER_DOWN);
1047 
1048 	/* Enable clk_request_n to enable clock power management */
1049 	pci_write_config(sc->rtsx_dev, sc->rtsx_pcie_cap + PCIER_LINK_CTL + 1, 1, 1);
1050 
1051 	/* Enter L1 when host tx idle */
1052 	pci_write_config(sc->rtsx_dev, 0x70F, 0x5B, 1);
1053 
1054 	/*
1055 	 * Specific extra init.
1056 	 */
1057 	switch (sc->rtsx_device_id) {
1058 		uint16_t cap;
1059 	case RTSX_RTS5209:
1060 		/* Turn off LED. */
1061 		RTSX_WRITE(sc, RTSX_CARD_GPIO, 0x03);
1062 		/* Reset ASPM state to default value. */
1063 		RTSX_CLR(sc, RTSX_ASPM_FORCE_CTL, RTSX_ASPM_FORCE_MASK);
1064 		/* Force CLKREQ# PIN to drive 0 to request clock. */
1065 		RTSX_BITOP(sc, RTSX_PETXCFG, 0x08, 0x08);
1066 		/* Configure GPIO as output. */
1067 		RTSX_WRITE(sc, RTSX_CARD_GPIO_DIR, 0x03);
1068 		/* Configure driving. */
1069 		RTSX_WRITE(sc, RTSX_SD30_CMD_DRIVE_SEL, sc->rtsx_sd30_drive_sel_3v3);
1070 		break;
1071 	case RTSX_RTS5227:
1072 		/* Configure GPIO as output. */
1073 		RTSX_BITOP(sc, RTSX_GPIO_CTL, RTSX_GPIO_LED_ON, RTSX_GPIO_LED_ON);
1074 		/* Reset ASPM state to default value. */
1075 		RTSX_BITOP(sc, RTSX_ASPM_FORCE_CTL, RTSX_ASPM_FORCE_MASK, RTSX_FORCE_ASPM_NO_ASPM);
1076 		/* Switch LDO3318 source from DV33 to 3V3. */
1077 		RTSX_CLR(sc, RTSX_LDO_PWR_SEL, RTSX_LDO_PWR_SEL_DV33);
1078 		RTSX_BITOP(sc, RTSX_LDO_PWR_SEL, RTSX_LDO_PWR_SEL_DV33, RTSX_LDO_PWR_SEL_3V3);
1079 		/* Set default OLT blink period. */
1080 		RTSX_BITOP(sc, RTSX_OLT_LED_CTL, 0x0F, RTSX_OLT_LED_PERIOD);
1081 		/* Configure LTR. */
1082 		cap = pci_read_config(sc->rtsx_dev, sc->rtsx_pcie_cap + PCIER_DEVICE_CTL2, 2);
1083 		if (cap & PCIEM_CTL2_LTR_ENABLE)
1084 			RTSX_WRITE(sc, RTSX_LTR_CTL, 0xa3);
1085 		/* Configure OBFF. */
1086 		RTSX_BITOP(sc, RTSX_OBFF_CFG, RTSX_OBFF_EN_MASK, RTSX_OBFF_ENABLE);
1087 		/* Configure driving. */
1088 		if ((error = rtsx_rts5227_fill_driving(sc)))
1089 			return (error);
1090 		/* Configure force_clock_req. */
1091 		if (sc->rtsx_flags & RTSX_F_REVERSE_SOCKET)
1092 			RTSX_BITOP(sc, RTSX_PETXCFG, 0xB8, 0xB8);
1093 		else
1094 			RTSX_BITOP(sc, RTSX_PETXCFG, 0xB8, 0x88);
1095 		RTSX_CLR(sc, RTSX_PM_CTRL3, RTSX_D3_DELINK_MODE_EN);
1096 		/*!!! Added for reboot after Windows. */
1097 		RTSX_BITOP(sc, RTSX_PM_CTRL3, RTSX_PM_WAKE_EN, RTSX_PM_WAKE_EN);
1098 		break;
1099 	case RTSX_RTS5229:
1100 		/* Configure GPIO as output. */
1101 		RTSX_BITOP(sc, RTSX_GPIO_CTL, RTSX_GPIO_LED_ON, RTSX_GPIO_LED_ON);
1102 		/* Reset ASPM state to default value. */
1103 		/*  With this reset: dd if=/dev/random of=/dev/mmcsd0 encounter a timeout. */
1104 //!!!		RTSX_BITOP(sc, RTSX_ASPM_FORCE_CTL, RTSX_ASPM_FORCE_MASK, RTSX_FORCE_ASPM_NO_ASPM);
1105 		/* Force CLKREQ# PIN to drive 0 to request clock. */
1106 		RTSX_BITOP(sc, RTSX_PETXCFG, 0x08, 0x08);
1107 		/* Switch LDO3318 source from DV33 to card_3v3. */
1108 		RTSX_CLR(sc, RTSX_LDO_PWR_SEL, RTSX_LDO_PWR_SEL_DV33);
1109 		RTSX_BITOP(sc, RTSX_LDO_PWR_SEL, RTSX_LDO_PWR_SEL_DV33, RTSX_LDO_PWR_SEL_3V3);
1110 		/* Set default OLT blink period. */
1111 		RTSX_BITOP(sc, RTSX_OLT_LED_CTL, 0x0F, RTSX_OLT_LED_PERIOD);
1112 		/* Configure driving. */
1113 		RTSX_WRITE(sc, RTSX_SD30_CMD_DRIVE_SEL, sc->rtsx_sd30_drive_sel_3v3);
1114 		break;
1115 	case RTSX_RTS522A:
1116 		/* Add specific init from RTS5227. */
1117 		/* Configure GPIO as output. */
1118 		RTSX_BITOP(sc, RTSX_GPIO_CTL, RTSX_GPIO_LED_ON, RTSX_GPIO_LED_ON);
1119 		/* Reset ASPM state to default value. */
1120 		RTSX_BITOP(sc, RTSX_ASPM_FORCE_CTL, RTSX_ASPM_FORCE_MASK, RTSX_FORCE_ASPM_NO_ASPM);
1121 		/* Switch LDO3318 source from DV33 to 3V3. */
1122 		RTSX_CLR(sc, RTSX_LDO_PWR_SEL, RTSX_LDO_PWR_SEL_DV33);
1123 		RTSX_BITOP(sc, RTSX_LDO_PWR_SEL, RTSX_LDO_PWR_SEL_DV33, RTSX_LDO_PWR_SEL_3V3);
1124 		/* Set default OLT blink period. */
1125 		RTSX_BITOP(sc, RTSX_OLT_LED_CTL, 0x0F, RTSX_OLT_LED_PERIOD);
1126 		/* Configure LTR. */
1127 		cap = pci_read_config(sc->rtsx_dev, sc->rtsx_pcie_cap + PCIER_DEVICE_CTL2, 2);
1128 		if (cap & PCIEM_CTL2_LTR_ENABLE)
1129 			RTSX_WRITE(sc, RTSX_LTR_CTL, 0xa3);
1130 		/* Configure OBFF. */
1131 		RTSX_BITOP(sc, RTSX_OBFF_CFG, RTSX_OBFF_EN_MASK, RTSX_OBFF_ENABLE);
1132 		/* Configure driving. */
1133 		if ((error = rtsx_rts5227_fill_driving(sc)))
1134 			return (error);
1135 		/* Configure force_clock_req. */
1136 		if (sc->rtsx_flags & RTSX_F_REVERSE_SOCKET)
1137 			RTSX_BITOP(sc, RTSX_PETXCFG, 0xB8, 0xB8);
1138 		else
1139 			RTSX_BITOP(sc, RTSX_PETXCFG, 0xB8, 0x88);
1140 		RTSX_CLR(sc, RTSX_RTS522A_PM_CTRL3,  0x10);
1141 
1142 		/* specific for RTS522A. */
1143 		RTSX_BITOP(sc, RTSX_FUNC_FORCE_CTL,
1144 			   RTSX_FUNC_FORCE_UPME_XMT_DBG, RTSX_FUNC_FORCE_UPME_XMT_DBG);
1145 		RTSX_BITOP(sc, RTSX_PCLK_CTL, 0x04, 0x04);
1146 		RTSX_BITOP(sc, RTSX_PM_EVENT_DEBUG,
1147 			   RTSX_PME_DEBUG_0, RTSX_PME_DEBUG_0);
1148 		RTSX_WRITE(sc, RTSX_PM_CLK_FORCE_CTL, 0x11);
1149 		break;
1150 	case RTSX_RTS525A:
1151 		/* Add specific init from RTS5249. */
1152 		/* Rest L1SUB Config. */
1153 		RTSX_CLR(sc, RTSX_L1SUB_CONFIG3, 0xff);
1154 		/* Configure GPIO as output. */
1155 		RTSX_BITOP(sc, RTSX_GPIO_CTL, RTSX_GPIO_LED_ON, RTSX_GPIO_LED_ON);
1156 		/* Reset ASPM state to default value. */
1157 		RTSX_BITOP(sc, RTSX_ASPM_FORCE_CTL, RTSX_ASPM_FORCE_MASK, RTSX_FORCE_ASPM_NO_ASPM);
1158 		/* Switch LDO3318 source from DV33 to 3V3. */
1159 		RTSX_CLR(sc, RTSX_LDO_PWR_SEL, RTSX_LDO_PWR_SEL_DV33);
1160 		RTSX_BITOP(sc, RTSX_LDO_PWR_SEL, RTSX_LDO_PWR_SEL_DV33, RTSX_LDO_PWR_SEL_3V3);
1161 		/* Set default OLT blink period. */
1162 		RTSX_BITOP(sc, RTSX_OLT_LED_CTL, 0x0F, RTSX_OLT_LED_PERIOD);
1163 		/* Configure driving. */
1164 		if ((error = rtsx_rts5249_fill_driving(sc)))
1165 			return (error);
1166 		/* Configure force_clock_req. */
1167 		if (sc->rtsx_flags & RTSX_F_REVERSE_SOCKET)
1168 			RTSX_BITOP(sc, RTSX_PETXCFG, 0xB0, 0xB0);
1169 		else
1170 			RTSX_BITOP(sc, RTSX_PETXCFG, 0xB0, 0x80);
1171 
1172 		/* Specifc for RTS525A. */
1173 		RTSX_BITOP(sc, RTSX_PCLK_CTL, RTSX_PCLK_MODE_SEL, RTSX_PCLK_MODE_SEL);
1174 		if (sc->rtsx_flags & RTSX_F_VERSION_A) {
1175 			RTSX_WRITE(sc, RTSX_L1SUB_CONFIG2, RTSX_L1SUB_AUTO_CFG);
1176 			RTSX_BITOP(sc, RTSX_RREF_CFG,
1177 				   RTSX_RREF_VBGSEL_MASK, RTSX_RREF_VBGSEL_1V25);
1178 			RTSX_BITOP(sc, RTSX_LDO_VIO_CFG,
1179 				   RTSX_LDO_VIO_TUNE_MASK, RTSX_LDO_VIO_1V7);
1180 			RTSX_BITOP(sc, RTSX_LDO_DV12S_CFG,
1181 				   RTSX_LDO_D12_TUNE_MASK, RTSX_LDO_D12_TUNE_DF);
1182 			RTSX_BITOP(sc, RTSX_LDO_AV12S_CFG,
1183 				   RTSX_LDO_AV12S_TUNE_MASK, RTSX_LDO_AV12S_TUNE_DF);
1184 			RTSX_BITOP(sc, RTSX_LDO_VCC_CFG0,
1185 				   RTSX_LDO_VCC_LMTVTH_MASK, RTSX_LDO_VCC_LMTVTH_2A);
1186 			RTSX_BITOP(sc, RTSX_OOBS_CONFIG,
1187 				   RTSX_OOBS_AUTOK_DIS | RTSX_OOBS_VAL_MASK, 0x89);
1188 		}
1189 		break;
1190 	case RTSX_RTS5249:
1191 		/* Rest L1SUB Config. */
1192 		RTSX_CLR(sc, RTSX_L1SUB_CONFIG3, 0xff);
1193 		/* Configure GPIO as output. */
1194 		RTSX_BITOP(sc, RTSX_GPIO_CTL, RTSX_GPIO_LED_ON, RTSX_GPIO_LED_ON);
1195 		/* Reset ASPM state to default value. */
1196 		RTSX_BITOP(sc, RTSX_ASPM_FORCE_CTL, RTSX_ASPM_FORCE_MASK, RTSX_FORCE_ASPM_NO_ASPM);
1197 		/* Switch LDO3318 source from DV33 to 3V3. */
1198 		RTSX_CLR(sc, RTSX_LDO_PWR_SEL, RTSX_LDO_PWR_SEL_DV33);
1199 		RTSX_BITOP(sc, RTSX_LDO_PWR_SEL, RTSX_LDO_PWR_SEL_DV33, RTSX_LDO_PWR_SEL_3V3);
1200 		/* Set default OLT blink period. */
1201 		RTSX_BITOP(sc, RTSX_OLT_LED_CTL, 0x0F, RTSX_OLT_LED_PERIOD);
1202 		/* Configure driving. */
1203 		if ((error = rtsx_rts5249_fill_driving(sc)))
1204 			return (error);
1205 		/* Configure force_clock_req. */
1206 		if (sc->rtsx_flags & RTSX_F_REVERSE_SOCKET)
1207 			RTSX_BITOP(sc, RTSX_PETXCFG, 0xB0, 0xB0);
1208 		else
1209 			RTSX_BITOP(sc, RTSX_PETXCFG, 0xB0, 0x80);
1210 		break;
1211 	case RTSX_RTS5260:
1212 		/* Set mcu_cnt to 7 to ensure data can be sampled properly. */
1213 		RTSX_BITOP(sc, RTSX_CLK_DIV, 0x07, 0x07);
1214 		RTSX_WRITE(sc, RTSX_SSC_DIV_N_0, 0x5D);
1215 		/* Force no MDIO */
1216 		RTSX_WRITE(sc, RTSX_RTS5260_AUTOLOAD_CFG4, RTSX_RTS5260_MIMO_DISABLE);
1217 		/* Modify SDVCC Tune Default Parameters! */
1218 		RTSX_BITOP(sc, RTSX_LDO_VCC_CFG0, RTSX_RTS5260_DVCC_TUNE_MASK, RTSX_RTS5260_DVCC_33);
1219 
1220 		RTSX_BITOP(sc, RTSX_PCLK_CTL, RTSX_PCLK_MODE_SEL, RTSX_PCLK_MODE_SEL);
1221 
1222 		RTSX_BITOP(sc, RTSX_L1SUB_CONFIG1, RTSX_AUX_CLK_ACTIVE_SEL_MASK, RTSX_MAC_CKSW_DONE);
1223 		/* Rest L1SUB Config */
1224 		RTSX_CLR(sc, RTSX_L1SUB_CONFIG3, 0xFF);
1225 		RTSX_BITOP(sc, RTSX_PM_CLK_FORCE_CTL, RTSX_CLK_PM_EN, RTSX_CLK_PM_EN);
1226 		RTSX_WRITE(sc, RTSX_PWD_SUSPEND_EN, 0xFF);
1227 		RTSX_BITOP(sc, RTSX_PWR_GATE_CTRL, RTSX_PWR_GATE_EN, RTSX_PWR_GATE_EN);
1228 		RTSX_BITOP(sc, RTSX_REG_VREF, RTSX_PWD_SUSPND_EN, RTSX_PWD_SUSPND_EN);
1229 		RTSX_BITOP(sc, RTSX_RBCTL, RTSX_U_AUTO_DMA_EN_MASK, RTSX_U_AUTO_DMA_DISABLE);
1230 		if (sc->rtsx_flags & RTSX_F_REVERSE_SOCKET)
1231 			RTSX_BITOP(sc, RTSX_PETXCFG, 0xB0, 0xB0);
1232 		else
1233 			RTSX_BITOP(sc, RTSX_PETXCFG, 0xB0, 0x80);
1234 		RTSX_BITOP(sc, RTSX_OBFF_CFG, RTSX_OBFF_EN_MASK, RTSX_OBFF_DISABLE);
1235 
1236 		RTSX_CLR(sc, RTSX_RTS5260_DVCC_CTRL, RTSX_RTS5260_DVCC_OCP_EN | RTSX_RTS5260_DVCC_OCP_CL_EN);
1237 
1238 		/* CLKREQ# PIN will be forced to drive low. */
1239 		RTSX_BITOP(sc, RTSX_PETXCFG, RTSX_FORCE_CLKREQ_DELINK_MASK, RTSX_FORCE_CLKREQ_LOW);
1240 
1241 		RTSX_CLR(sc, RTSX_RTS522A_PM_CTRL3,  0x10);
1242 		break;
1243 	case RTSX_RTL8402:
1244 	case RTSX_RTL8411:
1245 		RTSX_WRITE(sc, RTSX_SD30_CMD_DRIVE_SEL, sc->rtsx_sd30_drive_sel_3v3);
1246 		RTSX_BITOP(sc, RTSX_CARD_PAD_CTL, RTSX_CD_DISABLE_MASK | RTSX_CD_AUTO_DISABLE,
1247 			   RTSX_CD_ENABLE);
1248 		break;
1249 	case RTSX_RTL8411B:
1250 		if (sc->rtsx_flags & RTSX_F_8411B_QFN48)
1251 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, 0xf5);
1252 		RTSX_WRITE(sc, RTSX_SD30_CMD_DRIVE_SEL, sc->rtsx_sd30_drive_sel_3v3);
1253 		/* Enable SD interrupt. */
1254 		RTSX_BITOP(sc, RTSX_CARD_PAD_CTL, RTSX_CD_DISABLE_MASK | RTSX_CD_AUTO_DISABLE,
1255 			   RTSX_CD_ENABLE);
1256 		/* Clear hw_pfm_en to disable hardware PFM mode. */
1257 		RTSX_BITOP(sc, RTSX_FUNC_FORCE_CTL, 0x06, 0x00);
1258 		break;
1259 	}
1260 
1261 	/*!!! Added for reboot after Windows. */
1262 	rtsx_bus_power_off(sc);
1263 	rtsx_set_sd_timing(sc, bus_timing_normal);
1264 	rtsx_set_sd_clock(sc, 0);
1265 	/*!!! Added for reboot after Windows. */
1266 
1267 	return (0);
1268 }
1269 
1270 static int
1271 rtsx_map_sd_drive(int index)
1272 {
1273 	uint8_t	sd_drive[4] =
1274 		{
1275 		 0x01,	/* Type D */
1276 		 0x02,	/* Type C */
1277 		 0x05,	/* Type A */
1278 		 0x03	/* Type B */
1279 		};
1280 	return (sd_drive[index]);
1281 }
1282 
1283 /* For voltage 3v3. */
1284 static int
1285 rtsx_rts5227_fill_driving(struct rtsx_softc *sc)
1286 {
1287 	u_char	driving_3v3[4][3] = {
1288 				     {0x13, 0x13, 0x13},
1289 				     {0x96, 0x96, 0x96},
1290 				     {0x7F, 0x7F, 0x7F},
1291 				     {0x96, 0x96, 0x96},
1292 	};
1293 	RTSX_WRITE(sc, RTSX_SD30_CLK_DRIVE_SEL, driving_3v3[sc->rtsx_sd30_drive_sel_3v3][0]);
1294 	RTSX_WRITE(sc, RTSX_SD30_CMD_DRIVE_SEL, driving_3v3[sc->rtsx_sd30_drive_sel_3v3][1]);
1295 	RTSX_WRITE(sc, RTSX_SD30_DAT_DRIVE_SEL, driving_3v3[sc->rtsx_sd30_drive_sel_3v3][2]);
1296 
1297 	return (0);
1298 }
1299 
1300 /* For voltage 3v3. */
1301 static int
1302 rtsx_rts5249_fill_driving(struct rtsx_softc *sc)
1303 {
1304 	u_char	driving_3v3[4][3] = {
1305 				     {0x11, 0x11, 0x18},
1306 				     {0x55, 0x55, 0x5C},
1307 				     {0xFF, 0xFF, 0xFF},
1308 				     {0x96, 0x96, 0x96},
1309 	};
1310 	RTSX_WRITE(sc, RTSX_SD30_CLK_DRIVE_SEL, driving_3v3[sc->rtsx_sd30_drive_sel_3v3][0]);
1311 	RTSX_WRITE(sc, RTSX_SD30_CMD_DRIVE_SEL, driving_3v3[sc->rtsx_sd30_drive_sel_3v3][1]);
1312 	RTSX_WRITE(sc, RTSX_SD30_DAT_DRIVE_SEL, driving_3v3[sc->rtsx_sd30_drive_sel_3v3][2]);
1313 
1314 	return (0);
1315 }
1316 
1317 static int
1318 rtsx_rts5260_fill_driving(struct rtsx_softc *sc)
1319 {
1320 	u_char	driving_3v3[4][3] = {
1321 				     {0x11, 0x11, 0x11},
1322 				     {0x22, 0x22, 0x22},
1323 				     {0x55, 0x55, 0x55},
1324 				     {0x33, 0x33, 0x33},
1325 	};
1326 	RTSX_WRITE(sc, RTSX_SD30_CLK_DRIVE_SEL, driving_3v3[sc->rtsx_sd30_drive_sel_3v3][0]);
1327 	RTSX_WRITE(sc, RTSX_SD30_CMD_DRIVE_SEL, driving_3v3[sc->rtsx_sd30_drive_sel_3v3][1]);
1328 	RTSX_WRITE(sc, RTSX_SD30_DAT_DRIVE_SEL, driving_3v3[sc->rtsx_sd30_drive_sel_3v3][2]);
1329 
1330 	return (0);
1331 }
1332 
1333 static int
1334 rtsx_read(struct rtsx_softc *sc, uint16_t addr, uint8_t *val)
1335 {
1336 	int	 tries = 1024;
1337 	uint32_t arg;
1338 	uint32_t reg;
1339 
1340 	arg = RTSX_HAIMR_BUSY | (uint32_t)((addr & 0x3FFF) << 16);
1341 	WRITE4(sc, RTSX_HAIMR, arg);
1342 
1343 	while (tries--) {
1344 		reg = READ4(sc, RTSX_HAIMR);
1345 		if (!(reg & RTSX_HAIMR_BUSY))
1346 			break;
1347 	}
1348 	*val = (reg & 0xff);
1349 
1350 	if (tries > 0) {
1351 		return (0);
1352 	} else {
1353 		device_printf(sc->rtsx_dev, "rtsx_read(0x%x) timeout\n", arg);
1354 		return (ETIMEDOUT);
1355 	}
1356 }
1357 
1358 static int
1359 rtsx_read_cfg(struct rtsx_softc *sc, uint8_t func, uint16_t addr, uint32_t *val)
1360 {
1361 	int	tries = 1024;
1362 	uint8_t	data0, data1, data2, data3, rwctl;
1363 
1364 	RTSX_WRITE(sc, RTSX_CFGADDR0, addr);
1365 	RTSX_WRITE(sc, RTSX_CFGADDR1, addr >> 8);
1366 	RTSX_WRITE(sc, RTSX_CFGRWCTL, RTSX_CFG_BUSY | (func & 0x03 << 4));
1367 
1368 	while (tries--) {
1369 		RTSX_READ(sc, RTSX_CFGRWCTL, &rwctl);
1370 		if (!(rwctl & RTSX_CFG_BUSY))
1371 			break;
1372 	}
1373 
1374 	if (tries == 0)
1375 		return (ETIMEDOUT);
1376 
1377 	RTSX_READ(sc, RTSX_CFGDATA0, &data0);
1378 	RTSX_READ(sc, RTSX_CFGDATA1, &data1);
1379 	RTSX_READ(sc, RTSX_CFGDATA2, &data2);
1380 	RTSX_READ(sc, RTSX_CFGDATA3, &data3);
1381 
1382 	*val = (data3 << 24) | (data2 << 16) | (data1 << 8) | data0;
1383 
1384 	return (0);
1385 }
1386 
1387 static int
1388 rtsx_write(struct rtsx_softc *sc, uint16_t addr, uint8_t mask, uint8_t val)
1389 {
1390 	int 	 tries = 1024;
1391 	uint32_t arg;
1392 	uint32_t reg;
1393 
1394 	arg = RTSX_HAIMR_BUSY | RTSX_HAIMR_WRITE |
1395 		(uint32_t)(((addr & 0x3FFF) << 16) |
1396 			   (mask << 8) | val);
1397 	WRITE4(sc, RTSX_HAIMR, arg);
1398 
1399 	while (tries--) {
1400 		reg = READ4(sc, RTSX_HAIMR);
1401 		if (!(reg & RTSX_HAIMR_BUSY)) {
1402 			if (val != (reg & 0xff)) {
1403 				device_printf(sc->rtsx_dev, "rtsx_write(0x%x) error reg=0x%x\n", arg, reg);
1404 				return (EIO);
1405 			}
1406 			return (0);
1407 		}
1408 	}
1409 	device_printf(sc->rtsx_dev, "rtsx_write(0x%x) timeout\n", arg);
1410 
1411 	return (ETIMEDOUT);
1412 }
1413 
1414 static int
1415 rtsx_read_phy(struct rtsx_softc *sc, uint8_t addr, uint16_t *val)
1416 {
1417 	int	tries = 100000;
1418 	uint8_t	data0, data1, rwctl;
1419 
1420 	RTSX_WRITE(sc, RTSX_PHY_ADDR, addr);
1421 	RTSX_WRITE(sc, RTSX_PHY_RWCTL, RTSX_PHY_BUSY | RTSX_PHY_READ);
1422 
1423 	while (tries--) {
1424 		RTSX_READ(sc, RTSX_PHY_RWCTL, &rwctl);
1425 		if (!(rwctl & RTSX_PHY_BUSY))
1426 			break;
1427 	}
1428 	if (tries == 0)
1429 		return (ETIMEDOUT);
1430 
1431 	RTSX_READ(sc, RTSX_PHY_DATA0, &data0);
1432 	RTSX_READ(sc, RTSX_PHY_DATA1, &data1);
1433 	*val = data1 << 8 | data0;
1434 
1435 	return (0);
1436 }
1437 
1438 static int
1439 rtsx_write_phy(struct rtsx_softc *sc, uint8_t addr, uint16_t val)
1440 {
1441 	int	tries = 100000;
1442 	uint8_t	rwctl;
1443 
1444 	RTSX_WRITE(sc, RTSX_PHY_DATA0, val);
1445 	RTSX_WRITE(sc, RTSX_PHY_DATA1, val >> 8);
1446 	RTSX_WRITE(sc, RTSX_PHY_ADDR, addr);
1447 	RTSX_WRITE(sc, RTSX_PHY_RWCTL, RTSX_PHY_BUSY | RTSX_PHY_WRITE);
1448 
1449 	while (tries--) {
1450 		RTSX_READ(sc, RTSX_PHY_RWCTL, &rwctl);
1451 		if (!(rwctl & RTSX_PHY_BUSY))
1452 			break;
1453 	}
1454 
1455 	return ((tries == 0) ? ETIMEDOUT : 0);
1456 }
1457 
1458 /*
1459  * Notice that the meaning of RTSX_PWR_GATE_CTRL changes between RTS5209 and
1460  * RTS5229. In RTS5209 it is a mask of disabled power gates, while in RTS5229
1461  * it is a mask of *enabled* gates.
1462  */
1463 static int
1464 rtsx_bus_power_off(struct rtsx_softc *sc)
1465 {
1466 	if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
1467 		device_printf(sc->rtsx_dev, "rtsx_bus_power_off()\n");
1468 
1469 	/* Disable SD clock. */
1470 	RTSX_CLR(sc, RTSX_CARD_CLK_EN, RTSX_SD_CLK_EN);
1471 
1472 	/* Disable SD output. */
1473 	RTSX_CLR(sc, RTSX_CARD_OE, RTSX_SD_OUTPUT_EN);
1474 
1475 	/* Turn off power. */
1476 	switch (sc->rtsx_device_id) {
1477 	case RTSX_RTS5209:
1478 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_SD_PWR_MASK | RTSX_PMOS_STRG_MASK,
1479 			   RTSX_SD_PWR_OFF | RTSX_PMOS_STRG_400mA);
1480 		RTSX_SET(sc, RTSX_PWR_GATE_CTRL, RTSX_LDO3318_OFF);
1481 		break;
1482 	case RTSX_RTS5227:
1483 	case RTSX_RTS5229:
1484 	case RTSX_RTS522A:
1485 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_SD_PWR_MASK | RTSX_PMOS_STRG_MASK,
1486 			   RTSX_SD_PWR_OFF | RTSX_PMOS_STRG_400mA);
1487 		RTSX_CLR(sc, RTSX_PWR_GATE_CTRL, RTSX_LDO3318_PWR_MASK);
1488 		break;
1489 	case RTSX_RTS5260:
1490 		rtsx_stop_cmd(sc);
1491 		/* Switch vccq to 330 */
1492 		RTSX_BITOP(sc, RTSX_LDO_CONFIG2, RTSX_DV331812_VDD1, RTSX_DV331812_VDD1);
1493 		RTSX_BITOP(sc, RTSX_LDO_DV18_CFG, RTSX_DV331812_MASK, RTSX_DV331812_33);
1494 		RTSX_CLR(sc, RTSX_SD_PAD_CTL, RTSX_SD_IO_USING_1V8);
1495 		rtsx_rts5260_fill_driving(sc);
1496 
1497 		RTSX_BITOP(sc, RTSX_LDO_VCC_CFG1, RTSX_LDO_POW_SDVDD1_MASK, RTSX_LDO_POW_SDVDD1_OFF);
1498 		RTSX_BITOP(sc, RTSX_LDO_CONFIG2, RTSX_DV331812_POWERON, RTSX_DV331812_POWEROFF);
1499 		break;
1500 	case RTSX_RTL8402:
1501 	case RTSX_RTL8411:
1502 	case RTSX_RTL8411B:
1503 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_BPP_POWER_MASK,
1504 			   RTSX_BPP_POWER_OFF);
1505 		RTSX_BITOP(sc, RTSX_LDO_CTL, RTSX_BPP_LDO_POWB,
1506 			   RTSX_BPP_LDO_SUSPEND);
1507 		break;
1508 	default:
1509 		RTSX_CLR(sc, RTSX_PWR_GATE_CTRL, RTSX_LDO3318_PWR_MASK);
1510 		RTSX_SET(sc, RTSX_CARD_PWR_CTL, RTSX_SD_PWR_OFF);
1511 		RTSX_CLR(sc, RTSX_CARD_PWR_CTL, RTSX_PMOS_STRG_800mA);
1512 		break;
1513 	}
1514 
1515 	/* Disable pull control. */
1516 	switch (sc->rtsx_device_id) {
1517 	case RTSX_RTS5209:
1518 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL1, RTSX_PULL_CTL_DISABLE12);
1519 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, RTSX_PULL_CTL_DISABLE12);
1520 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, RTSX_PULL_CTL_DISABLE3);
1521 		break;
1522 	case RTSX_RTS5227:
1523 	case RTSX_RTS522A:
1524 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, RTSX_PULL_CTL_DISABLE12);
1525 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, RTSX_PULL_CTL_DISABLE3);
1526 		break;
1527 	case RTSX_RTS5229:
1528 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, RTSX_PULL_CTL_DISABLE12);
1529 		if (sc->rtsx_flags & RTSX_F_VERSION_C)
1530 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, RTSX_PULL_CTL_DISABLE3_TYPE_C);
1531 		else
1532 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, RTSX_PULL_CTL_DISABLE3);
1533 		break;
1534 	case RTSX_RTS525A:
1535 	case RTSX_RTS5249:
1536 	case RTSX_RTS5260:
1537 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL1, 0x66);
1538 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, RTSX_PULL_CTL_DISABLE12);
1539 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, RTSX_PULL_CTL_DISABLE3);
1540 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL4, 0x55);
1541 		break;
1542 	case RTSX_RTL8402:
1543 	case RTSX_RTL8411:
1544 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL1, 0x65);
1545 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, 0x55);
1546 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, 0x95);
1547 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL4, 0x09);
1548 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL5, 0x05);
1549 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL6, 0x04);
1550 		break;
1551 	case RTSX_RTL8411B:
1552 		if (sc->rtsx_flags & RTSX_F_8411B_QFN48) {
1553 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, 0x55);
1554 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, 0xf5);
1555 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL6, 0x15);
1556 		} else {
1557 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL1, 0x65);
1558 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, 0x55);
1559 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, 0xd5);
1560 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL4, 0x59);
1561 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL5, 0x55);
1562 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL6, 0x15);
1563 		}
1564 		break;
1565 	}
1566 
1567 	return (0);
1568 }
1569 
1570 static int
1571 rtsx_bus_power_on(struct rtsx_softc *sc)
1572 {
1573 	if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
1574 		device_printf(sc->rtsx_dev, "rtsx_bus_power_on()\n");
1575 
1576 	/* Select SD card. */
1577 	RTSX_BITOP(sc, RTSX_CARD_SELECT, 0x07, RTSX_SD_MOD_SEL);
1578 	RTSX_BITOP(sc, RTSX_CARD_SHARE_MODE, RTSX_CARD_SHARE_MASK, RTSX_CARD_SHARE_48_SD);
1579 
1580 	/* Enable SD clock. */
1581 	RTSX_BITOP(sc, RTSX_CARD_CLK_EN, RTSX_SD_CLK_EN,  RTSX_SD_CLK_EN);
1582 
1583 	/* Enable pull control. */
1584 	switch (sc->rtsx_device_id) {
1585 	case RTSX_RTS5209:
1586 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL1, RTSX_PULL_CTL_ENABLE12);
1587 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, RTSX_PULL_CTL_ENABLE12);
1588 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, RTSX_PULL_CTL_ENABLE3);
1589 		break;
1590 	case RTSX_RTS5227:
1591 	case RTSX_RTS522A:
1592 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, RTSX_PULL_CTL_ENABLE12);
1593 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, RTSX_PULL_CTL_ENABLE3);
1594 		break;
1595 	case RTSX_RTS5229:
1596 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, RTSX_PULL_CTL_ENABLE12);
1597 		if (sc->rtsx_flags & RTSX_F_VERSION_C)
1598 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, RTSX_PULL_CTL_ENABLE3_TYPE_C);
1599 		else
1600 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, RTSX_PULL_CTL_ENABLE3);
1601 		break;
1602 	case RTSX_RTS525A:
1603 	case RTSX_RTS5249:
1604 	case RTSX_RTS5260:
1605 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL1, 0x66);
1606 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, RTSX_PULL_CTL_ENABLE12);
1607 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, RTSX_PULL_CTL_ENABLE3);
1608 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL4, 0xaa);
1609 		break;
1610 	case RTSX_RTL8402:
1611 	case RTSX_RTL8411:
1612 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL1, 0xaa);
1613 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, 0xaa);
1614 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, 0xa9);
1615 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL4, 0x09);
1616 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL5, 0x09);
1617 		RTSX_WRITE(sc, RTSX_CARD_PULL_CTL6, 0x04);
1618 		break;
1619 	case RTSX_RTL8411B:
1620 		if (sc->rtsx_flags & RTSX_F_8411B_QFN48) {
1621 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, 0xaa);
1622 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, 0xf9);
1623 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL6, 0x19);
1624 		} else {
1625 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL1, 0xaa);
1626 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL2, 0xaa);
1627 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL3, 0xd9);
1628 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL4, 0x59);
1629 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL5, 0x55);
1630 			RTSX_WRITE(sc, RTSX_CARD_PULL_CTL6, 0x15);
1631 		}
1632 		break;
1633 	}
1634 
1635 	/*
1636 	 * To avoid a current peak, enable card power in two phases
1637 	 * with a delay in between.
1638 	 */
1639 	switch (sc->rtsx_device_id) {
1640 	case RTSX_RTS5209:
1641 		/* Partial power. */
1642 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_SD_PWR_MASK, RTSX_SD_PARTIAL_PWR_ON);
1643 		RTSX_BITOP(sc, RTSX_PWR_GATE_CTRL, RTSX_LDO3318_PWR_MASK, RTSX_LDO3318_VCC2);
1644 
1645 		DELAY(200);
1646 
1647 		/* Full power. */
1648 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_SD_PWR_MASK, RTSX_SD_PWR_ON);
1649 		RTSX_BITOP(sc, RTSX_PWR_GATE_CTRL, RTSX_LDO3318_PWR_MASK, RTSX_LDO3318_ON);
1650 		break;
1651 	case RTSX_RTS5227:
1652 	case RTSX_RTS522A:
1653 		/* Partial power. */
1654 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_SD_PWR_MASK, RTSX_SD_PARTIAL_PWR_ON);
1655 		RTSX_BITOP(sc, RTSX_PWR_GATE_CTRL, RTSX_LDO3318_PWR_MASK, RTSX_LDO3318_VCC1);
1656 
1657 		DELAY(20000);
1658 
1659 		/* Full power. */
1660 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_SD_PWR_MASK, RTSX_SD_PWR_ON);
1661 		RTSX_BITOP(sc, RTSX_PWR_GATE_CTRL, RTSX_LDO3318_PWR_MASK,
1662 			   RTSX_LDO3318_VCC1 | RTSX_LDO3318_VCC2);
1663 		RTSX_BITOP(sc, RTSX_CARD_OE, RTSX_SD_OUTPUT_EN, RTSX_SD_OUTPUT_EN);
1664 		RTSX_BITOP(sc, RTSX_CARD_OE, RTSX_MS_OUTPUT_EN, RTSX_MS_OUTPUT_EN);
1665 		break;
1666 	case RTSX_RTS5229:
1667 		/* Partial power. */
1668 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_SD_PWR_MASK, RTSX_SD_PARTIAL_PWR_ON);
1669 		RTSX_BITOP(sc, RTSX_PWR_GATE_CTRL, RTSX_LDO3318_PWR_MASK, RTSX_LDO3318_VCC1);
1670 
1671 		DELAY(200);
1672 
1673 		/* Full power. */
1674 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_SD_PWR_MASK, RTSX_SD_PWR_ON);
1675 		RTSX_BITOP(sc, RTSX_PWR_GATE_CTRL, RTSX_LDO3318_PWR_MASK,
1676 			   RTSX_LDO3318_VCC1 | RTSX_LDO3318_VCC2);
1677 		break;
1678 	case RTSX_RTS525A:
1679 		RTSX_BITOP(sc, RTSX_LDO_VCC_CFG1, RTSX_LDO_VCC_TUNE_MASK, RTSX_LDO_VCC_3V3);
1680 	case RTSX_RTS5249:
1681 		/* Partial power. */
1682 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_SD_PWR_MASK, RTSX_SD_PARTIAL_PWR_ON);
1683 		RTSX_BITOP(sc, RTSX_PWR_GATE_CTRL, RTSX_LDO3318_PWR_MASK, RTSX_LDO3318_VCC1);
1684 
1685 		DELAY(5000);
1686 
1687 		/* Full power. */
1688 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_SD_PWR_MASK, RTSX_SD_PWR_ON);
1689 		RTSX_BITOP(sc, RTSX_PWR_GATE_CTRL, RTSX_LDO3318_PWR_MASK,
1690 			   RTSX_LDO3318_VCC1 | RTSX_LDO3318_VCC2);
1691 		break;
1692 	case RTSX_RTS5260:
1693 		RTSX_BITOP(sc, RTSX_LDO_CONFIG2, RTSX_DV331812_VDD1, RTSX_DV331812_VDD1);
1694 		RTSX_BITOP(sc, RTSX_LDO_VCC_CFG0, RTSX_RTS5260_DVCC_TUNE_MASK, RTSX_RTS5260_DVCC_33);
1695 		RTSX_BITOP(sc, RTSX_LDO_VCC_CFG1, RTSX_LDO_POW_SDVDD1_MASK, RTSX_LDO_POW_SDVDD1_ON);
1696 		RTSX_BITOP(sc, RTSX_LDO_CONFIG2, RTSX_DV331812_POWERON, RTSX_DV331812_POWERON);
1697 
1698 		DELAY(20000);
1699 
1700 		RTSX_BITOP(sc, RTSX_SD_CFG1, RTSX_SD_MODE_MASK | RTSX_SD_ASYNC_FIFO_NOT_RST,
1701 			   RTSX_SD30_MODE | RTSX_SD_ASYNC_FIFO_NOT_RST);
1702 		RTSX_BITOP(sc, RTSX_CLK_CTL, RTSX_CHANGE_CLK, RTSX_CLK_LOW_FREQ);
1703 		RTSX_WRITE(sc, RTSX_CARD_CLK_SOURCE,
1704 			   RTSX_CRC_VAR_CLK0 | RTSX_SD30_FIX_CLK | RTSX_SAMPLE_VAR_CLK1);
1705 		RTSX_CLR(sc, RTSX_CLK_CTL, RTSX_CLK_LOW_FREQ);
1706 
1707 		/* Initialize SD_CFG1 register */
1708 		RTSX_WRITE(sc, RTSX_SD_CFG1, RTSX_CLK_DIVIDE_128 | RTSX_SD20_MODE);
1709 		RTSX_WRITE(sc, RTSX_SD_SAMPLE_POINT_CTL, RTSX_SD20_RX_POS_EDGE);
1710 		RTSX_CLR(sc, RTSX_SD_PUSH_POINT_CTL, 0xff);
1711 		RTSX_BITOP(sc, RTSX_CARD_STOP, RTSX_SD_STOP | RTSX_SD_CLR_ERR,
1712 			   RTSX_SD_STOP | RTSX_SD_CLR_ERR);
1713 		/* Reset SD_CFG3 register */
1714 		RTSX_CLR(sc, RTSX_SD_CFG3, RTSX_SD30_CLK_END_EN);
1715 		RTSX_CLR(sc, RTSX_REG_SD_STOP_SDCLK_CFG,
1716 			 RTSX_SD30_CLK_STOP_CFG_EN | RTSX_SD30_CLK_STOP_CFG0 | RTSX_SD30_CLK_STOP_CFG1);
1717 		RTSX_CLR(sc, RTSX_REG_PRE_RW_MODE, RTSX_EN_INFINITE_MODE);
1718 		break;
1719 	case RTSX_RTL8402:
1720 	case RTSX_RTL8411:
1721 	case RTSX_RTL8411B:
1722 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_BPP_POWER_MASK,
1723 			   RTSX_BPP_POWER_5_PERCENT_ON);
1724 		RTSX_BITOP(sc, RTSX_LDO_CTL, RTSX_BPP_LDO_POWB,
1725 			   RTSX_BPP_LDO_SUSPEND);
1726 		DELAY(150);
1727 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_BPP_POWER_MASK,
1728 			   RTSX_BPP_POWER_10_PERCENT_ON);
1729 		DELAY(150);
1730 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_BPP_POWER_MASK,
1731 			   RTSX_BPP_POWER_15_PERCENT_ON);
1732 		DELAY(150);
1733 		RTSX_BITOP(sc, RTSX_CARD_PWR_CTL, RTSX_BPP_POWER_MASK,
1734 			   RTSX_BPP_POWER_ON);
1735 		RTSX_BITOP(sc, RTSX_LDO_CTL, RTSX_BPP_LDO_POWB,
1736 			   RTSX_BPP_LDO_ON);
1737 		break;
1738 	}
1739 
1740 	/* Enable SD card output. */
1741 	RTSX_WRITE(sc, RTSX_CARD_OE, RTSX_SD_OUTPUT_EN);
1742 
1743 	DELAY(200);
1744 
1745 	return (0);
1746 }
1747 
1748 /*
1749  * Set but width.
1750  */
1751 static int
1752 rtsx_set_bus_width(struct rtsx_softc *sc, enum mmc_bus_width width)
1753 {
1754 	uint32_t bus_width;
1755 
1756 	switch (width) {
1757 	case bus_width_1:
1758 		bus_width = RTSX_BUS_WIDTH_1;
1759 		break;
1760 	case bus_width_4:
1761 		bus_width = RTSX_BUS_WIDTH_4;
1762 		break;
1763 	case bus_width_8:
1764 		bus_width = RTSX_BUS_WIDTH_8;
1765 		break;
1766 	default:
1767 		return (MMC_ERR_INVALID);
1768 	}
1769 	RTSX_BITOP(sc, RTSX_SD_CFG1, RTSX_BUS_WIDTH_MASK, bus_width);
1770 
1771 	if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC) {
1772 		char *busw[] = {
1773 				"1 bit",
1774 				"4 bits",
1775 				"8 bits"
1776 		};
1777 		device_printf(sc->rtsx_dev, "Setting bus width to %s\n", busw[bus_width]);
1778 	}
1779 	return (0);
1780 }
1781 
1782 static int
1783 rtsx_set_sd_timing(struct rtsx_softc *sc, enum mmc_bus_timing timing)
1784 {
1785 	if (timing == bus_timing_hs && sc->rtsx_force_timing) {
1786 		timing = bus_timing_uhs_sdr50;
1787 		sc->rtsx_ios_timing = timing;
1788 	}
1789 
1790 	if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
1791 		device_printf(sc->rtsx_dev, "rtsx_set_sd_timing(%u)\n", timing);
1792 
1793 	switch (timing) {
1794 	case bus_timing_uhs_sdr50:
1795 	case bus_timing_uhs_sdr104:
1796 		sc->rtsx_double_clk = false;
1797 		sc->rtsx_vpclk = true;
1798 		RTSX_BITOP(sc, RTSX_SD_CFG1, 0x0c | RTSX_SD_ASYNC_FIFO_NOT_RST,
1799 			   RTSX_SD30_MODE | RTSX_SD_ASYNC_FIFO_NOT_RST);
1800 		RTSX_BITOP(sc, RTSX_CLK_CTL, RTSX_CLK_LOW_FREQ, RTSX_CLK_LOW_FREQ);
1801 		RTSX_WRITE(sc, RTSX_CARD_CLK_SOURCE,
1802 			   RTSX_CRC_VAR_CLK0 | RTSX_SD30_FIX_CLK | RTSX_SAMPLE_VAR_CLK1);
1803 		RTSX_CLR(sc, RTSX_CLK_CTL, RTSX_CLK_LOW_FREQ);
1804 		break;
1805 	case bus_timing_hs:
1806 		RTSX_BITOP(sc, RTSX_SD_CFG1, RTSX_SD_MODE_MASK, RTSX_SD20_MODE);
1807 		RTSX_BITOP(sc, RTSX_CLK_CTL, RTSX_CLK_LOW_FREQ, RTSX_CLK_LOW_FREQ);
1808 		RTSX_WRITE(sc, RTSX_CARD_CLK_SOURCE,
1809 			   RTSX_CRC_FIX_CLK | RTSX_SD30_VAR_CLK0 | RTSX_SAMPLE_VAR_CLK1);
1810 		RTSX_CLR(sc, RTSX_CLK_CTL, RTSX_CLK_LOW_FREQ);
1811 
1812 		RTSX_BITOP(sc, RTSX_SD_PUSH_POINT_CTL,
1813 			   RTSX_SD20_TX_SEL_MASK, RTSX_SD20_TX_14_AHEAD);
1814 		RTSX_BITOP(sc, RTSX_SD_SAMPLE_POINT_CTL,
1815 			   RTSX_SD20_RX_SEL_MASK, RTSX_SD20_RX_14_DELAY);
1816 		break;
1817 	default:
1818 		RTSX_BITOP(sc, RTSX_SD_CFG1, RTSX_SD_MODE_MASK, RTSX_SD20_MODE);
1819 		RTSX_BITOP(sc, RTSX_CLK_CTL, RTSX_CLK_LOW_FREQ, RTSX_CLK_LOW_FREQ);
1820 		RTSX_WRITE(sc, RTSX_CARD_CLK_SOURCE,
1821 			   RTSX_CRC_FIX_CLK | RTSX_SD30_VAR_CLK0 | RTSX_SAMPLE_VAR_CLK1);
1822 		RTSX_CLR(sc, RTSX_CLK_CTL, RTSX_CLK_LOW_FREQ);
1823 
1824 		RTSX_WRITE(sc, RTSX_SD_PUSH_POINT_CTL, RTSX_SD20_TX_NEG_EDGE);
1825 		RTSX_BITOP(sc, RTSX_SD_SAMPLE_POINT_CTL,
1826 			   RTSX_SD20_RX_SEL_MASK, RTSX_SD20_RX_POS_EDGE);
1827 		break;
1828 	}
1829 
1830 	return (0);
1831 }
1832 
1833 /*
1834  * Set or change SDCLK frequency or disable the SD clock.
1835  * Return zero on success.
1836  */
1837 static int
1838 rtsx_set_sd_clock(struct rtsx_softc *sc, uint32_t freq)
1839 {
1840 	uint8_t	clk;
1841 	uint8_t	clk_divider, n, div, mcu;
1842 	int	error = 0;
1843 
1844 	if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
1845 		device_printf(sc->rtsx_dev, "rtsx_set_sd_clock(%u)\n", freq);
1846 
1847 	if (freq == RTSX_SDCLK_OFF) {
1848 		error = rtsx_stop_sd_clock(sc);
1849 		return error;
1850 	}
1851 
1852 	sc->rtsx_ssc_depth = RTSX_SSC_DEPTH_500K;
1853 	sc->rtsx_discovery_mode = (freq <= 1000000) ? true : false;
1854 
1855 	if (sc->rtsx_discovery_mode) {
1856 		/* We use 250k(around) here, in discovery stage. */
1857 		clk_divider = RTSX_CLK_DIVIDE_128;
1858 		freq = 30000000;
1859 	} else {
1860 		clk_divider = RTSX_CLK_DIVIDE_0;
1861 	}
1862 	RTSX_BITOP(sc, RTSX_SD_CFG1, RTSX_CLK_DIVIDE_MASK, clk_divider);
1863 
1864 	freq /= 1000000;
1865 	if (sc->rtsx_discovery_mode || !sc->rtsx_double_clk)
1866 		clk = freq;
1867 	else
1868 		clk = freq * 2;
1869 
1870 	switch (sc->rtsx_device_id) {
1871 	case RTSX_RTL8402:
1872 	case RTSX_RTL8411:
1873 	case RTSX_RTL8411B:
1874 		n = clk * 4 / 5 - 2;
1875 		break;
1876 	default:
1877 		n = clk - 2;
1878 		break;
1879 	}
1880 	if ((clk <= 2) || (n > RTSX_MAX_DIV_N))
1881 		return (MMC_ERR_INVALID);
1882 
1883 	mcu = 125 / clk + 3;
1884 	if (mcu > 15)
1885 		mcu = 15;
1886 
1887 	/* Make sure that the SSC clock div_n is not less than RTSX_MIN_DIV_N. */
1888 	div = RTSX_CLK_DIV_1;
1889 	while ((n < RTSX_MIN_DIV_N) && (div < RTSX_CLK_DIV_8)) {
1890 		switch (sc->rtsx_device_id) {
1891 		case RTSX_RTL8402:
1892 		case RTSX_RTL8411:
1893 		case RTSX_RTL8411B:
1894 			n = (((n + 2) * 5 / 4) * 2) * 4 / 5 - 2;
1895 			break;
1896 		default:
1897 			n = (n + 2) * 2 - 2;
1898 			break;
1899 		}
1900 		div++;
1901 	}
1902 
1903 	if (sc->rtsx_double_clk && sc->rtsx_ssc_depth > 1)
1904 		sc->rtsx_ssc_depth -= 1;
1905 
1906 	if (div > RTSX_CLK_DIV_1) {
1907 		if (sc->rtsx_ssc_depth > (div - 1))
1908 			sc->rtsx_ssc_depth -= (div - 1);
1909 		else
1910 			sc->rtsx_ssc_depth = RTSX_SSC_DEPTH_4M;
1911 	}
1912 
1913 	/* Enable SD clock. */
1914 	error = rtsx_switch_sd_clock(sc, clk, n, div, mcu);
1915 
1916 	return (error);
1917 }
1918 
1919 static int
1920 rtsx_stop_sd_clock(struct rtsx_softc *sc)
1921 {
1922 	RTSX_CLR(sc, RTSX_CARD_CLK_EN, RTSX_CARD_CLK_EN_ALL);
1923 	RTSX_SET(sc, RTSX_SD_BUS_STAT, RTSX_SD_CLK_FORCE_STOP);
1924 
1925 	return (0);
1926 }
1927 
1928 static int
1929 rtsx_switch_sd_clock(struct rtsx_softc *sc, uint8_t clk, uint8_t n, uint8_t div, uint8_t mcu)
1930 {
1931 	if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC) {
1932 		device_printf(sc->rtsx_dev, "rtsx_switch_sd_clock() - discovery-mode is %s, ssc_depth: %d\n",
1933 			      (sc->rtsx_discovery_mode) ? "true" : "false", sc->rtsx_ssc_depth);
1934 		device_printf(sc->rtsx_dev, "rtsx_switch_sd_clock() - clk: %d, n: %d, div: %d, mcu: %d\n",
1935 			      clk, n, div, mcu);
1936 	}
1937 
1938 	RTSX_BITOP(sc, RTSX_CLK_CTL, RTSX_CLK_LOW_FREQ, RTSX_CLK_LOW_FREQ);
1939 	RTSX_WRITE(sc, RTSX_CLK_DIV, (div << 4) | mcu);
1940 	RTSX_CLR(sc, RTSX_SSC_CTL1, RTSX_RSTB);
1941 	RTSX_BITOP(sc, RTSX_SSC_CTL2, RTSX_SSC_DEPTH_MASK, sc->rtsx_ssc_depth);
1942 	RTSX_WRITE(sc, RTSX_SSC_DIV_N_0, n);
1943 	RTSX_BITOP(sc, RTSX_SSC_CTL1, RTSX_RSTB, RTSX_RSTB);
1944 	if (sc->rtsx_vpclk) {
1945 		RTSX_CLR(sc, RTSX_SD_VPCLK0_CTL, RTSX_PHASE_NOT_RESET);
1946 		RTSX_BITOP(sc, RTSX_SD_VPCLK0_CTL, RTSX_PHASE_NOT_RESET, RTSX_PHASE_NOT_RESET);
1947 	}
1948 
1949 	/* Wait SSC clock stable. */
1950 	DELAY(200);
1951 
1952 	RTSX_CLR(sc, RTSX_CLK_CTL, RTSX_CLK_LOW_FREQ);
1953 
1954 	return (0);
1955 }
1956 
1957 #ifndef MMCCAM
1958 static void
1959 rtsx_sd_change_tx_phase(struct rtsx_softc *sc, uint8_t sample_point)
1960 {
1961 	if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
1962 		device_printf(sc->rtsx_dev, "rtsx_sd_change_tx_phase() - sample_point: %d\n", sample_point);
1963 
1964 	rtsx_write(sc, RTSX_CLK_CTL, RTSX_CHANGE_CLK, RTSX_CHANGE_CLK);
1965 	rtsx_write(sc, RTSX_SD_VPCLK0_CTL, RTSX_PHASE_SELECT_MASK, sample_point);
1966 	rtsx_write(sc, RTSX_SD_VPCLK0_CTL, RTSX_PHASE_NOT_RESET, 0);
1967 	rtsx_write(sc, RTSX_SD_VPCLK0_CTL, RTSX_PHASE_NOT_RESET, RTSX_PHASE_NOT_RESET);
1968 	rtsx_write(sc, RTSX_CLK_CTL, RTSX_CHANGE_CLK, 0);
1969 	rtsx_write(sc, RTSX_SD_CFG1, RTSX_SD_ASYNC_FIFO_NOT_RST, 0);
1970 }
1971 
1972 static void
1973 rtsx_sd_change_rx_phase(struct rtsx_softc *sc, uint8_t sample_point)
1974 {
1975 	if (sc->rtsx_debug_mask & RTSX_DEBUG_TUNING)
1976 		device_printf(sc->rtsx_dev, "rtsx_sd_change_rx_phase() - sample_point: %d\n", sample_point);
1977 
1978 	rtsx_write(sc, RTSX_CLK_CTL, RTSX_CHANGE_CLK, RTSX_CHANGE_CLK);
1979 	rtsx_write(sc, RTSX_SD_VPCLK1_CTL, RTSX_PHASE_SELECT_MASK, sample_point);
1980 	rtsx_write(sc, RTSX_SD_VPCLK1_CTL, RTSX_PHASE_NOT_RESET, 0);
1981 	rtsx_write(sc, RTSX_SD_VPCLK1_CTL, RTSX_PHASE_NOT_RESET, RTSX_PHASE_NOT_RESET);
1982 	rtsx_write(sc, RTSX_CLK_CTL, RTSX_CHANGE_CLK, 0);
1983 	rtsx_write(sc, RTSX_SD_CFG1, RTSX_SD_ASYNC_FIFO_NOT_RST, 0);
1984 }
1985 
1986 static void
1987 rtsx_sd_tuning_rx_phase(struct rtsx_softc *sc, uint32_t *phase_map)
1988 {
1989 	uint32_t raw_phase_map = 0;
1990 	int	 i;
1991 	int	 error;
1992 
1993 	for (i = 0; i < RTSX_RX_PHASE_MAX; i++) {
1994 		error = rtsx_sd_tuning_rx_cmd(sc, (uint8_t)i);
1995 		if (error == 0)
1996 			raw_phase_map |= 1 << i;
1997 	}
1998 	if (phase_map != NULL)
1999 		*phase_map = raw_phase_map;
2000 }
2001 
2002 static int
2003 rtsx_sd_tuning_rx_cmd(struct rtsx_softc *sc, uint8_t sample_point)
2004 {
2005 	struct mmc_request req = {};
2006 	struct mmc_command cmd = {};
2007 	int	error = 0;
2008 
2009 	cmd.opcode = MMC_SEND_TUNING_BLOCK;
2010 	cmd.arg = 0;
2011 	req.cmd = &cmd;
2012 
2013 	RTSX_LOCK(sc);
2014 
2015 	sc->rtsx_req = &req;
2016 
2017 	rtsx_sd_change_rx_phase(sc, sample_point);
2018 
2019 	rtsx_write(sc, RTSX_SD_CFG3, RTSX_SD_RSP_80CLK_TIMEOUT_EN,
2020 		   RTSX_SD_RSP_80CLK_TIMEOUT_EN);
2021 
2022 	rtsx_init_cmd(sc, &cmd);
2023 	rtsx_set_cmd_data_len(sc, 1, 0x40);
2024 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_CFG2, 0xff,
2025 		      RTSX_SD_CALCULATE_CRC7 | RTSX_SD_CHECK_CRC16 |
2026 		      RTSX_SD_NO_WAIT_BUSY_END | RTSX_SD_CHECK_CRC7 | RTSX_SD_RSP_LEN_6);
2027 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_TRANSFER,
2028 		      0xff, RTSX_TM_AUTO_TUNING | RTSX_SD_TRANSFER_START);
2029 	rtsx_push_cmd(sc, RTSX_CHECK_REG_CMD, RTSX_SD_TRANSFER,
2030 		      RTSX_SD_TRANSFER_END, RTSX_SD_TRANSFER_END);
2031 
2032 	/* Set interrupt post processing */
2033 	sc->rtsx_intr_trans_ok = rtsx_sd_tuning_rx_cmd_wakeup;
2034 	sc->rtsx_intr_trans_ko = rtsx_sd_tuning_rx_cmd_wakeup;
2035 
2036 	/* Run the command queue. */
2037 	rtsx_send_cmd(sc);
2038 
2039 	error = rtsx_sd_tuning_rx_cmd_wait(sc, &cmd);
2040 
2041 	if (error) {
2042 		if (sc->rtsx_debug_mask & RTSX_DEBUG_TUNING)
2043 			device_printf(sc->rtsx_dev, "rtsx_sd_tuning_rx_cmd() - error: %d\n", error);
2044 		rtsx_sd_wait_data_idle(sc);
2045 		rtsx_clear_error(sc);
2046 	}
2047 	rtsx_write(sc, RTSX_SD_CFG3, RTSX_SD_RSP_80CLK_TIMEOUT_EN, 0);
2048 
2049 	sc->rtsx_req = NULL;
2050 
2051 	RTSX_UNLOCK(sc);
2052 
2053 	return (error);
2054 }
2055 
2056 static int
2057 rtsx_sd_tuning_rx_cmd_wait(struct rtsx_softc *sc, struct mmc_command *cmd)
2058 {
2059 	int	status;
2060 	int	mask = RTSX_TRANS_OK_INT | RTSX_TRANS_FAIL_INT;
2061 
2062 	status = sc->rtsx_intr_status & mask;
2063 	while (status == 0) {
2064 		if (msleep(&sc->rtsx_intr_status, &sc->rtsx_mtx, 0, "rtsxintr", sc->rtsx_timeout_cmd) == EWOULDBLOCK) {
2065 			cmd->error = MMC_ERR_TIMEOUT;
2066 			return (MMC_ERR_TIMEOUT);
2067 		}
2068 		status = sc->rtsx_intr_status & mask;
2069 	}
2070 	return (cmd->error);
2071 }
2072 
2073 static void
2074 rtsx_sd_tuning_rx_cmd_wakeup(struct rtsx_softc *sc)
2075 {
2076 	wakeup(&sc->rtsx_intr_status);
2077 }
2078 
2079 static void
2080 rtsx_sd_wait_data_idle(struct rtsx_softc *sc)
2081 {
2082 	int	i;
2083 	uint8_t	val;
2084 
2085 	for (i = 0; i < 100; i++) {
2086 		rtsx_read(sc, RTSX_SD_DATA_STATE, &val);
2087 		if (val & RTSX_SD_DATA_IDLE)
2088 			return;
2089 		DELAY(100);
2090 	}
2091 }
2092 
2093 static uint8_t
2094 rtsx_sd_search_final_rx_phase(struct rtsx_softc *sc, uint32_t phase_map)
2095 {
2096 	int	start = 0, len = 0;
2097 	int	start_final = 0, len_final = 0;
2098 	uint8_t	final_phase = 0xff;
2099 
2100 	while (start < RTSX_RX_PHASE_MAX) {
2101 		len = rtsx_sd_get_rx_phase_len(phase_map, start);
2102 		if (len_final < len) {
2103 			start_final = start;
2104 			len_final = len;
2105 		}
2106 		start += len ? len : 1;
2107 	}
2108 
2109 	final_phase = (start_final + len_final / 2) % RTSX_RX_PHASE_MAX;
2110 
2111 	if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
2112 		device_printf(sc->rtsx_dev,
2113 			      "rtsx_sd_search_final_rx_phase() - phase_map: %x, start_final: %d, len_final: %d, final_phase: %d\n",
2114 			      phase_map, start_final, len_final, final_phase);
2115 
2116 	return final_phase;
2117 }
2118 
2119 static int
2120 rtsx_sd_get_rx_phase_len(uint32_t phase_map, int start_bit)
2121 {
2122 	int	i;
2123 
2124 	for (i = 0; i < RTSX_RX_PHASE_MAX; i++) {
2125 		if ((phase_map & (1 << (start_bit + i) % RTSX_RX_PHASE_MAX)) == 0)
2126 			return i;
2127 	}
2128 	return RTSX_RX_PHASE_MAX;
2129 }
2130 #endif /* !MMCCAM */
2131 
2132 #if 0	/* For led */
2133 static int
2134 rtsx_led_enable(struct rtsx_softc *sc)
2135 {
2136 	switch (sc->rtsx_device_id) {
2137 	case RTSX_RTS5209:
2138 		RTSX_CLR(sc, RTSX_CARD_GPIO, RTSX_CARD_GPIO_LED_OFF);
2139 		RTSX_WRITE(sc, RTSX_CARD_AUTO_BLINK,
2140 			   RTSX_LED_BLINK_EN | RTSX_LED_BLINK_SPEED);
2141 		break;
2142 	case RTSX_RTL8411B:
2143 		RTSX_CLR(sc, RTSX_GPIO_CTL, 0x01);
2144 		RTSX_WRITE(sc, RTSX_CARD_AUTO_BLINK,
2145 			   RTSX_LED_BLINK_EN | RTSX_LED_BLINK_SPEED);
2146 		break;
2147 	default:
2148 		RTSX_SET(sc, RTSX_GPIO_CTL, RTSX_GPIO_LED_ON);
2149 		RTSX_SET(sc, RTSX_OLT_LED_CTL, RTSX_OLT_LED_AUTOBLINK);
2150 		break;
2151 	}
2152 
2153 	return (0);
2154 }
2155 
2156 static int
2157 rtsx_led_disable(struct rtsx_softc *sc)
2158 {
2159 	switch (sc->rtsx_device_id) {
2160 	case RTSX_RTS5209:
2161 		RTSX_CLR(sc, RTSX_CARD_AUTO_BLINK, RTSX_LED_BLINK_EN);
2162 		RTSX_WRITE(sc, RTSX_CARD_GPIO, RTSX_CARD_GPIO_LED_OFF);
2163 		break;
2164 	case RTSX_RTL8411B:
2165 		RTSX_CLR(sc, RTSX_CARD_AUTO_BLINK, RTSX_LED_BLINK_EN);
2166 		RTSX_SET(sc, RTSX_GPIO_CTL, 0x01);
2167 		break;
2168 	default:
2169 		RTSX_CLR(sc, RTSX_OLT_LED_CTL, RTSX_OLT_LED_AUTOBLINK);
2170 		RTSX_CLR(sc, RTSX_GPIO_CTL, RTSX_GPIO_LED_ON);
2171 		break;
2172 	}
2173 
2174 	return (0);
2175 }
2176 #endif	/* For led */
2177 
2178 static uint8_t
2179 rtsx_response_type(uint16_t mmc_rsp)
2180 {
2181 	int	i;
2182 	struct rsp_type {
2183 		uint16_t mmc_rsp;
2184 		uint8_t  rtsx_rsp;
2185 	} rsp_types[] = {
2186 		{ MMC_RSP_NONE,	RTSX_SD_RSP_TYPE_R0 },
2187 		{ MMC_RSP_R1,	RTSX_SD_RSP_TYPE_R1 },
2188 		{ MMC_RSP_R1B,	RTSX_SD_RSP_TYPE_R1B },
2189 		{ MMC_RSP_R2,	RTSX_SD_RSP_TYPE_R2 },
2190 		{ MMC_RSP_R3,	RTSX_SD_RSP_TYPE_R3 },
2191 		{ MMC_RSP_R4,	RTSX_SD_RSP_TYPE_R4 },
2192 		{ MMC_RSP_R5,	RTSX_SD_RSP_TYPE_R5 },
2193 		{ MMC_RSP_R6,	RTSX_SD_RSP_TYPE_R6 },
2194 		{ MMC_RSP_R7,	RTSX_SD_RSP_TYPE_R7 }
2195 	};
2196 
2197 	for (i = 0; i < nitems(rsp_types); i++) {
2198 		if (mmc_rsp == rsp_types[i].mmc_rsp)
2199 			return (rsp_types[i].rtsx_rsp);
2200 	}
2201 
2202 	return (0);
2203 }
2204 
2205 /*
2206  * Init command buffer with SD command index and argument.
2207  */
2208 static void
2209 rtsx_init_cmd(struct rtsx_softc *sc, struct mmc_command *cmd)
2210 {
2211 	sc->rtsx_cmd_index = 0;
2212 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_CMD0,
2213 		      0xff, RTSX_SD_CMD_START  | cmd->opcode);
2214 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_CMD1,
2215 		     0xff, cmd->arg >> 24);
2216 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_CMD2,
2217 		      0xff, cmd->arg >> 16);
2218 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_CMD3,
2219 		     0xff, cmd->arg >> 8);
2220 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_CMD4,
2221 		     0xff, cmd->arg);
2222 }
2223 
2224 /*
2225  * Append a properly encoded host command to the host command buffer.
2226  */
2227 static void
2228 rtsx_push_cmd(struct rtsx_softc *sc, uint8_t cmd, uint16_t reg,
2229 	      uint8_t mask, uint8_t data)
2230 {
2231 	KASSERT(sc->rtsx_cmd_index < RTSX_HOSTCMD_MAX,
2232 		("rtsx: Too many host commands (%d)\n", sc->rtsx_cmd_index));
2233 
2234 	uint32_t *cmd_buffer = (uint32_t *)(sc->rtsx_cmd_dmamem);
2235 	cmd_buffer[sc->rtsx_cmd_index++] =
2236 		htole32((uint32_t)(cmd & 0x3) << 30) |
2237 		((uint32_t)(reg & 0x3fff) << 16) |
2238 		((uint32_t)(mask) << 8) |
2239 		((uint32_t)data);
2240 }
2241 
2242 /*
2243  * Queue commands to configure data transfer size.
2244  */
2245 static void
2246 rtsx_set_cmd_data_len(struct rtsx_softc *sc, uint16_t block_cnt, uint16_t byte_cnt)
2247 {
2248 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_BLOCK_CNT_L,
2249 		      0xff, block_cnt & 0xff);
2250 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_BLOCK_CNT_H,
2251 		      0xff, block_cnt >> 8);
2252 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_BYTE_CNT_L,
2253 		      0xff, byte_cnt & 0xff);
2254 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_BYTE_CNT_H,
2255 		      0xff, byte_cnt >> 8);
2256 }
2257 
2258 /*
2259  * Run the command queue.
2260  */
2261 static void
2262 rtsx_send_cmd(struct rtsx_softc *sc)
2263 {
2264 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
2265 		device_printf(sc->rtsx_dev, "rtsx_send_cmd()\n");
2266 
2267 	sc->rtsx_intr_status = 0;
2268 
2269 	/* Sync command DMA buffer. */
2270 	bus_dmamap_sync(sc->rtsx_cmd_dma_tag, sc->rtsx_cmd_dmamap, BUS_DMASYNC_PREREAD);
2271 	bus_dmamap_sync(sc->rtsx_cmd_dma_tag, sc->rtsx_cmd_dmamap, BUS_DMASYNC_PREWRITE);
2272 
2273 	/* Tell the chip where the command buffer is and run the commands. */
2274 	WRITE4(sc, RTSX_HCBAR, (uint32_t)sc->rtsx_cmd_buffer);
2275 	WRITE4(sc, RTSX_HCBCTLR,
2276 	       ((sc->rtsx_cmd_index * 4) & 0x00ffffff) | RTSX_START_CMD | RTSX_HW_AUTO_RSP);
2277 }
2278 
2279 /*
2280  * Stop previous command.
2281  */
2282 static void
2283 rtsx_stop_cmd(struct rtsx_softc *sc)
2284 {
2285 	/* Stop command transfer. */
2286 	WRITE4(sc, RTSX_HCBCTLR, RTSX_STOP_CMD);
2287 
2288 	/* Stop DMA transfer. */
2289 	WRITE4(sc, RTSX_HDBCTLR, RTSX_STOP_DMA);
2290 
2291 	switch (sc->rtsx_device_id) {
2292 	case RTSX_RTS5260:
2293 		rtsx_write(sc, RTSX_RTS5260_DMA_RST_CTL_0,
2294 			   RTSX_RTS5260_DMA_RST | RTSX_RTS5260_ADMA3_RST,
2295 			   RTSX_RTS5260_DMA_RST | RTSX_RTS5260_ADMA3_RST);
2296 		rtsx_write(sc, RTSX_RBCTL, RTSX_RB_FLUSH, RTSX_RB_FLUSH);
2297 		break;
2298 	default:
2299 		rtsx_write(sc, RTSX_DMACTL, RTSX_DMA_RST, RTSX_DMA_RST);
2300 
2301 		rtsx_write(sc, RTSX_RBCTL, RTSX_RB_FLUSH, RTSX_RB_FLUSH);
2302 		break;
2303 	}
2304 }
2305 
2306 /*
2307  * Clear error.
2308  */
2309 static void
2310 rtsx_clear_error(struct rtsx_softc *sc)
2311 {
2312 	/* Clear error. */
2313 	rtsx_write(sc, RTSX_CARD_STOP, RTSX_SD_STOP | RTSX_SD_CLR_ERR,
2314 		   RTSX_SD_STOP | RTSX_SD_CLR_ERR);
2315 }
2316 
2317 /*
2318  * Signal end of request to mmc/mmcsd.
2319  */
2320 static void
2321 rtsx_req_done(struct rtsx_softc *sc)
2322 {
2323 #ifdef MMCCAM
2324 	union ccb *ccb;
2325 #endif /* MMCCAM */
2326 	struct mmc_request *req;
2327 
2328 	req = sc->rtsx_req;
2329 	if (req->cmd->error == MMC_ERR_NONE) {
2330 		if (req->cmd->opcode == MMC_READ_SINGLE_BLOCK ||
2331 		    req->cmd->opcode == MMC_READ_MULTIPLE_BLOCK)
2332 			sc->rtsx_read_count++;
2333 		else if (req->cmd->opcode == MMC_WRITE_BLOCK ||
2334 			 req->cmd->opcode == MMC_WRITE_MULTIPLE_BLOCK)
2335 			sc->rtsx_write_count++;
2336 	} else {
2337 		rtsx_clear_error(sc);
2338 	}
2339 	callout_stop(&sc->rtsx_timeout_callout);
2340 	sc->rtsx_req = NULL;
2341 #ifdef MMCCAM
2342 	ccb = sc->rtsx_ccb;
2343 	sc->rtsx_ccb = NULL;
2344 	ccb->ccb_h.status = (req->cmd->error == 0 ? CAM_REQ_CMP : CAM_REQ_CMP_ERR);
2345 	xpt_done(ccb);
2346 #else  /* !MMCCAM */
2347 	req->done(req);
2348 #endif /* MMCCAM */
2349 }
2350 
2351 /*
2352  * Send request.
2353  */
2354 static int
2355 rtsx_send_req(struct rtsx_softc *sc, struct mmc_command *cmd)
2356 {
2357 	uint8_t	 rsp_type;
2358 	uint16_t reg;
2359 
2360 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
2361 		device_printf(sc->rtsx_dev, "rtsx_send_req() - CMD%d\n", cmd->opcode);
2362 
2363 	/* Convert response type. */
2364 	rsp_type = rtsx_response_type(cmd->flags & MMC_RSP_MASK);
2365 	if (rsp_type == 0) {
2366 		device_printf(sc->rtsx_dev, "Unknown rsp_type: 0x%lx\n", (cmd->flags & MMC_RSP_MASK));
2367 		cmd->error = MMC_ERR_INVALID;
2368 		return (MMC_ERR_INVALID);
2369 	}
2370 
2371 	rtsx_init_cmd(sc, cmd);
2372 
2373 	/* Queue command to set response type. */
2374 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_CFG2, 0xff, rsp_type);
2375 
2376 	/* Use the ping-pong buffer (cmd buffer) for commands which do not transfer data. */
2377 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_CARD_DATA_SOURCE,
2378 		      0x01, RTSX_PINGPONG_BUFFER);
2379 
2380 	/* Queue commands to perform SD transfer. */
2381 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_TRANSFER,
2382 		      0xff, RTSX_TM_CMD_RSP | RTSX_SD_TRANSFER_START);
2383 	rtsx_push_cmd(sc, RTSX_CHECK_REG_CMD, RTSX_SD_TRANSFER,
2384 		      RTSX_SD_TRANSFER_END|RTSX_SD_STAT_IDLE,
2385 		      RTSX_SD_TRANSFER_END|RTSX_SD_STAT_IDLE);
2386 
2387 	/* If needed queue commands to read back card status response. */
2388 	if (rsp_type == RTSX_SD_RSP_TYPE_R2) {
2389 		/* Read data from ping-pong buffer. */
2390 		for (reg = RTSX_PPBUF_BASE2; reg < RTSX_PPBUF_BASE2 + 16; reg++)
2391 			rtsx_push_cmd(sc, RTSX_READ_REG_CMD, reg, 0, 0);
2392 	} else if (rsp_type != RTSX_SD_RSP_TYPE_R0) {
2393 		/* Read data from SD_CMDx registers. */
2394 		for (reg = RTSX_SD_CMD0; reg <= RTSX_SD_CMD4; reg++)
2395 			rtsx_push_cmd(sc, RTSX_READ_REG_CMD, reg, 0, 0);
2396 	}
2397 	rtsx_push_cmd(sc, RTSX_READ_REG_CMD, RTSX_SD_STAT1, 0, 0);
2398 
2399 	/* Set transfer OK function. */
2400 	if (sc->rtsx_intr_trans_ok == NULL)
2401 		sc->rtsx_intr_trans_ok = rtsx_ret_resp;
2402 
2403 	/* Run the command queue. */
2404 	rtsx_send_cmd(sc);
2405 
2406 	return (0);
2407 }
2408 
2409 /*
2410  * Return response of previous command (case cmd->data == NULL) and complete resquest.
2411  * This Function is called by the interrupt handler via sc->rtsx_intr_trans_ok.
2412  */
2413 static void
2414 rtsx_ret_resp(struct rtsx_softc *sc)
2415 {
2416 	struct mmc_command *cmd;
2417 
2418 	cmd = sc->rtsx_req->cmd;
2419 	rtsx_set_resp(sc, cmd);
2420 	rtsx_req_done(sc);
2421 }
2422 
2423 /*
2424  * Set response of previous command.
2425  */
2426 static void
2427 rtsx_set_resp(struct rtsx_softc *sc, struct mmc_command *cmd)
2428 {
2429 	uint8_t	 rsp_type;
2430 
2431 	rsp_type = rtsx_response_type(cmd->flags & MMC_RSP_MASK);
2432 
2433 	/* Sync command DMA buffer. */
2434 	bus_dmamap_sync(sc->rtsx_cmd_dma_tag, sc->rtsx_cmd_dmamap, BUS_DMASYNC_POSTREAD);
2435 	bus_dmamap_sync(sc->rtsx_cmd_dma_tag, sc->rtsx_cmd_dmamap, BUS_DMASYNC_POSTWRITE);
2436 
2437 	/* Copy card response into mmc response buffer. */
2438 	if (ISSET(cmd->flags, MMC_RSP_PRESENT)) {
2439 		uint32_t *cmd_buffer = (uint32_t *)(sc->rtsx_cmd_dmamem);
2440 
2441 		if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD) {
2442 			device_printf(sc->rtsx_dev, "cmd_buffer: 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n",
2443 				      cmd_buffer[0], cmd_buffer[1], cmd_buffer[2], cmd_buffer[3], cmd_buffer[4]);
2444 		}
2445 
2446 		if (rsp_type == RTSX_SD_RSP_TYPE_R2) {
2447 			/* First byte is CHECK_REG_CMD return value, skip it. */
2448 			unsigned char *ptr = (unsigned char *)cmd_buffer + 1;
2449 			int i;
2450 
2451 			/*
2452 			 * The controller offloads the last byte {CRC-7, end bit 1}
2453 			 * of response type R2. Assign dummy CRC, 0, and end bit to this
2454 			 * byte (ptr[16], goes into the LSB of resp[3] later).
2455 			 */
2456 			ptr[16] = 0x01;
2457 			/* The second byte is the status of response, skip it. */
2458 			for (i = 0; i < 4; i++)
2459 				cmd->resp[i] = be32dec(ptr + 1 + i * 4);
2460 		} else {
2461 			/*
2462 			 * First byte is CHECK_REG_CMD return value, second
2463 			 * one is the command op code -- we skip those.
2464 			 */
2465 			cmd->resp[0] =
2466 				((be32toh(cmd_buffer[0]) & 0x0000ffff) << 16) |
2467 				((be32toh(cmd_buffer[1]) & 0xffff0000) >> 16);
2468 		}
2469 
2470 		if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
2471 			device_printf(sc->rtsx_dev, "cmd->resp: 0x%08x 0x%08x 0x%08x 0x%08x\n",
2472 				      cmd->resp[0], cmd->resp[1], cmd->resp[2], cmd->resp[3]);
2473 	}
2474 }
2475 
2476 /*
2477  * Use the ping-pong buffer (cmd buffer) for transfer <= 512 bytes.
2478  */
2479 static int
2480 rtsx_xfer_short(struct rtsx_softc *sc, struct mmc_command *cmd)
2481 {
2482 	int	read;
2483 
2484 	if (cmd->data == NULL || cmd->data->len == 0) {
2485 		cmd->error = MMC_ERR_INVALID;
2486 		return (MMC_ERR_INVALID);
2487 	}
2488 	cmd->data->xfer_len = (cmd->data->len > RTSX_MAX_DATA_BLKLEN) ?
2489 		RTSX_MAX_DATA_BLKLEN : cmd->data->len;
2490 
2491 	read = ISSET(cmd->data->flags, MMC_DATA_READ);
2492 
2493 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
2494 		device_printf(sc->rtsx_dev, "rtsx_xfer_short() - %s xfer: %ld bytes with block size %ld\n",
2495 			      read ? "Read" : "Write",
2496 			      (unsigned long)cmd->data->len, (unsigned long)cmd->data->xfer_len);
2497 
2498 	if (cmd->data->len > 512) {
2499 		device_printf(sc->rtsx_dev, "rtsx_xfer_short() - length too large: %ld > 512\n",
2500 			      (unsigned long)cmd->data->len);
2501 		cmd->error = MMC_ERR_INVALID;
2502 		return (MMC_ERR_INVALID);
2503 	}
2504 
2505 	if (read) {
2506 		if (sc->rtsx_discovery_mode)
2507 			rtsx_write(sc, RTSX_SD_CFG1, RTSX_CLK_DIVIDE_MASK, RTSX_CLK_DIVIDE_0);
2508 
2509 		rtsx_init_cmd(sc, cmd);
2510 
2511 		/* Queue commands to configure data transfer size. */
2512 		rtsx_set_cmd_data_len(sc, cmd->data->len / cmd->data->xfer_len, cmd->data->xfer_len);
2513 
2514 		/* From Linux: rtsx_pci_sdmmc.c sd_read_data(). */
2515 		rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_CFG2, 0xff,
2516 			      RTSX_SD_CALCULATE_CRC7 | RTSX_SD_CHECK_CRC16 |
2517 			      RTSX_SD_NO_WAIT_BUSY_END | RTSX_SD_CHECK_CRC7 | RTSX_SD_RSP_LEN_6);
2518 
2519 		/* Use the ping-pong buffer (cmd buffer). */
2520 		rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_CARD_DATA_SOURCE,
2521 			      0x01, RTSX_PINGPONG_BUFFER);
2522 
2523 		/* Queue commands to perform SD transfer. */
2524 		rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_TRANSFER,
2525 			      0xff, RTSX_TM_NORMAL_READ | RTSX_SD_TRANSFER_START);
2526 		rtsx_push_cmd(sc, RTSX_CHECK_REG_CMD, RTSX_SD_TRANSFER,
2527 			      RTSX_SD_TRANSFER_END, RTSX_SD_TRANSFER_END);
2528 
2529 		/* Set transfer OK function. */
2530 		sc->rtsx_intr_trans_ok = rtsx_ask_ppbuf_part1;
2531 
2532 		/* Run the command queue. */
2533 		rtsx_send_cmd(sc);
2534 	} else {
2535 		/* Set transfer OK function. */
2536 		sc->rtsx_intr_trans_ok = rtsx_put_ppbuf_part1;
2537 
2538 		/* Run the command queue. */
2539 		rtsx_send_req(sc, cmd);
2540 	}
2541 
2542 	return (0);
2543 }
2544 
2545 /*
2546  * Use the ping-pong buffer (cmd buffer) for the transfer - first part <= 256 bytes.
2547  * This Function is called by the interrupt handler via sc->rtsx_intr_trans_ok.
2548  */
2549 static void
2550 rtsx_ask_ppbuf_part1(struct rtsx_softc *sc)
2551 {
2552 	struct mmc_command *cmd;
2553 	uint16_t reg = RTSX_PPBUF_BASE2;
2554 	int	 len;
2555 	int	 i;
2556 
2557 	cmd = sc->rtsx_req->cmd;
2558 	len = (cmd->data->len > RTSX_HOSTCMD_MAX) ? RTSX_HOSTCMD_MAX : cmd->data->len;
2559 
2560 	sc->rtsx_cmd_index = 0;
2561 	for (i = 0; i < len; i++) {
2562 		rtsx_push_cmd(sc, RTSX_READ_REG_CMD, reg++, 0, 0);
2563 	}
2564 
2565 	/* Set transfer OK function. */
2566 	sc->rtsx_intr_trans_ok = rtsx_get_ppbuf_part1;
2567 
2568 	/* Run the command queue. */
2569 	rtsx_send_cmd(sc);
2570 }
2571 
2572 /*
2573  * Get the data from the ping-pong buffer (cmd buffer) - first part <= 256 bytes.
2574  * This Function is called by the interrupt handler via sc->rtsx_intr_trans_ok.
2575  */
2576 static void
2577 rtsx_get_ppbuf_part1(struct rtsx_softc *sc)
2578 {
2579 	struct mmc_command *cmd;
2580 	uint8_t	 *ptr;
2581 	int	 len;
2582 
2583 	cmd = sc->rtsx_req->cmd;
2584 	ptr = cmd->data->data;
2585 	len = (cmd->data->len > RTSX_HOSTCMD_MAX) ? RTSX_HOSTCMD_MAX : cmd->data->len;
2586 
2587 	/* Sync command DMA buffer. */
2588 	bus_dmamap_sync(sc->rtsx_cmd_dma_tag, sc->rtsx_cmd_dmamap, BUS_DMASYNC_POSTREAD);
2589 	bus_dmamap_sync(sc->rtsx_cmd_dma_tag, sc->rtsx_cmd_dmamap, BUS_DMASYNC_POSTWRITE);
2590 
2591 	memcpy(ptr, sc->rtsx_cmd_dmamem, len);
2592 
2593 	len = (cmd->data->len > RTSX_HOSTCMD_MAX) ? cmd->data->len - RTSX_HOSTCMD_MAX : 0;
2594 
2595 	/* Use the ping-pong buffer (cmd buffer) for the transfer - second part > 256 bytes. */
2596 	if (len > 0) {
2597 		uint16_t reg = RTSX_PPBUF_BASE2 + RTSX_HOSTCMD_MAX;
2598 		int	 i;
2599 
2600 		sc->rtsx_cmd_index = 0;
2601 		for (i = 0; i < len; i++) {
2602 			rtsx_push_cmd(sc, RTSX_READ_REG_CMD, reg++, 0, 0);
2603 		}
2604 
2605 		/* Set transfer OK function. */
2606 		sc->rtsx_intr_trans_ok = rtsx_get_ppbuf_part2;
2607 
2608 		/* Run the command queue. */
2609 		rtsx_send_cmd(sc);
2610 	} else {
2611 		if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD && cmd->opcode == ACMD_SEND_SCR) {
2612 			uint8_t *ptr = cmd->data->data;
2613 			device_printf(sc->rtsx_dev, "SCR: 0x%02x%02x%02x%02x%02x%02x%02x%02x\n",
2614 				      ptr[0], ptr[1], ptr[2], ptr[3],
2615 				      ptr[4], ptr[5], ptr[6], ptr[7]);
2616 		}
2617 
2618 		if (sc->rtsx_discovery_mode)
2619 			rtsx_write(sc, RTSX_SD_CFG1, RTSX_CLK_DIVIDE_MASK, RTSX_CLK_DIVIDE_128);
2620 
2621 		rtsx_req_done(sc);
2622 	}
2623 }
2624 
2625 /*
2626  * Get the data from the ping-pong buffer (cmd buffer) - second part > 256 bytes.
2627  * This Function is called by the interrupt handler via sc->rtsx_intr_trans_ok.
2628  */
2629 static void
2630 rtsx_get_ppbuf_part2(struct rtsx_softc *sc)
2631 {
2632 	struct mmc_command *cmd;
2633 	uint8_t	*ptr;
2634 	int	len;
2635 
2636 	cmd = sc->rtsx_req->cmd;
2637 	ptr = cmd->data->data;
2638 	ptr += RTSX_HOSTCMD_MAX;
2639 	len = cmd->data->len - RTSX_HOSTCMD_MAX;
2640 
2641 	/* Sync command DMA buffer. */
2642 	bus_dmamap_sync(sc->rtsx_cmd_dma_tag, sc->rtsx_cmd_dmamap, BUS_DMASYNC_POSTREAD);
2643 	bus_dmamap_sync(sc->rtsx_cmd_dma_tag, sc->rtsx_cmd_dmamap, BUS_DMASYNC_POSTWRITE);
2644 
2645 	memcpy(ptr, sc->rtsx_cmd_dmamem, len);
2646 
2647 	if (sc->rtsx_discovery_mode)
2648 		rtsx_write(sc, RTSX_SD_CFG1, RTSX_CLK_DIVIDE_MASK, RTSX_CLK_DIVIDE_128);
2649 
2650 	rtsx_req_done(sc);
2651 }
2652 
2653 /*
2654  * Use the ping-pong buffer (cmd buffer) for transfer - first part <= 256 bytes.
2655  * This Function is called by the interrupt handler via sc->rtsx_intr_trans_ok.
2656  */
2657 static void
2658 rtsx_put_ppbuf_part1(struct rtsx_softc *sc)
2659 {
2660 	struct mmc_command *cmd;
2661 	uint16_t reg = RTSX_PPBUF_BASE2;
2662 	uint8_t	 *ptr;
2663 	int	 len;
2664 	int	 i;
2665 
2666 	cmd = sc->rtsx_req->cmd;
2667 	ptr = cmd->data->data;
2668 	len = (cmd->data->len > RTSX_HOSTCMD_MAX) ? RTSX_HOSTCMD_MAX : cmd->data->len;
2669 
2670 	rtsx_set_resp(sc, cmd);
2671 
2672 	sc->rtsx_cmd_index = 0;
2673 	for (i = 0; i < len; i++) {
2674 		rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, reg++, 0xff, *ptr);
2675 		ptr++;
2676 	}
2677 
2678 	/* Set transfer OK function. */
2679 	if (cmd->data->len > RTSX_HOSTCMD_MAX)
2680 		sc->rtsx_intr_trans_ok = rtsx_put_ppbuf_part2;
2681 	else
2682 		sc->rtsx_intr_trans_ok = rtsx_write_ppbuf;
2683 
2684 	/* Run the command queue. */
2685 	rtsx_send_cmd(sc);
2686 }
2687 
2688 /*
2689  * Use the ping-pong buffer (cmd buffer) for transfer - second part > 256 bytes.
2690  * This Function is called by the interrupt handler via sc->rtsx_intr_trans_ok.
2691  */
2692 static void
2693 rtsx_put_ppbuf_part2(struct rtsx_softc *sc)
2694 {
2695 	struct mmc_command *cmd;
2696 	uint16_t reg = RTSX_PPBUF_BASE2 + RTSX_HOSTCMD_MAX;
2697 	uint8_t	 *ptr;
2698 	int	 len;
2699 	int	 i;
2700 
2701 	cmd = sc->rtsx_req->cmd;
2702 	ptr = cmd->data->data;
2703 	ptr += RTSX_HOSTCMD_MAX;
2704 	len = cmd->data->len - RTSX_HOSTCMD_MAX;
2705 
2706 	sc->rtsx_cmd_index = 0;
2707 	for (i = 0; i < len; i++) {
2708 		rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, reg++, 0xff, *ptr);
2709 		ptr++;
2710 	}
2711 
2712 	/* Set transfer OK function. */
2713 	sc->rtsx_intr_trans_ok = rtsx_write_ppbuf;
2714 
2715 	/* Run the command queue. */
2716 	rtsx_send_cmd(sc);
2717 }
2718 
2719 /*
2720  * Write the data previously given via the ping-pong buffer on the card.
2721  * This Function is called by the interrupt handler via sc->rtsx_intr_trans_ok.
2722  */
2723 static void
2724 rtsx_write_ppbuf(struct rtsx_softc *sc)
2725 {
2726 	struct mmc_command *cmd;
2727 
2728 	cmd = sc->rtsx_req->cmd;
2729 
2730 	sc->rtsx_cmd_index = 0;
2731 
2732 	/* Queue commands to configure data transfer size. */
2733 	rtsx_set_cmd_data_len(sc, cmd->data->len / cmd->data->xfer_len, cmd->data->xfer_len);
2734 
2735 	/* From Linux: rtsx_pci_sdmmc.c sd_write_data(). */
2736 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_CFG2, 0xff,
2737 		      RTSX_SD_CALCULATE_CRC7 | RTSX_SD_CHECK_CRC16 |
2738 		      RTSX_SD_NO_WAIT_BUSY_END | RTSX_SD_CHECK_CRC7 | RTSX_SD_RSP_LEN_0);
2739 
2740 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_TRANSFER, 0xff,
2741 		      RTSX_TM_AUTO_WRITE3 | RTSX_SD_TRANSFER_START);
2742 	rtsx_push_cmd(sc, RTSX_CHECK_REG_CMD, RTSX_SD_TRANSFER,
2743 		      RTSX_SD_TRANSFER_END, RTSX_SD_TRANSFER_END);
2744 
2745 	/* Set transfer OK function. */
2746 	sc->rtsx_intr_trans_ok = rtsx_req_done;
2747 
2748 	/* Run the command queue. */
2749 	rtsx_send_cmd(sc);
2750 }
2751 
2752 /*
2753  * Use the data buffer for transfer > 512 bytes.
2754  */
2755 static int
2756 rtsx_xfer(struct rtsx_softc *sc, struct mmc_command *cmd)
2757 {
2758 	int	read = ISSET(cmd->data->flags, MMC_DATA_READ);
2759 
2760 	cmd->data->xfer_len = (cmd->data->len > RTSX_MAX_DATA_BLKLEN) ?
2761 		RTSX_MAX_DATA_BLKLEN : cmd->data->len;
2762 
2763 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
2764 		device_printf(sc->rtsx_dev, "rtsx_xfer() - %s xfer: %ld bytes with block size %ld\n",
2765 			      read ? "Read" : "Write",
2766 			      (unsigned long)cmd->data->len, (unsigned long)cmd->data->xfer_len);
2767 
2768 	if (cmd->data->len > RTSX_DMA_DATA_BUFSIZE) {
2769 		device_printf(sc->rtsx_dev, "rtsx_xfer() length too large: %ld > %d\n",
2770 			      (unsigned long)cmd->data->len, RTSX_DMA_DATA_BUFSIZE);
2771 		cmd->error = MMC_ERR_INVALID;
2772 		return (MMC_ERR_INVALID);
2773 	}
2774 
2775 	if (!read) {
2776 		/* Set transfer OK function. */
2777 		sc->rtsx_intr_trans_ok = rtsx_xfer_begin;
2778 
2779 		/* Run the command queue. */
2780 		rtsx_send_req(sc, cmd);
2781 	} else {
2782 		rtsx_xfer_start(sc);
2783 	}
2784 
2785 	return (0);
2786 }
2787 
2788 /*
2789  * Get request response and start dma data transfer (write command).
2790  * This Function is called by the interrupt handler via sc->rtsx_intr_trans_ok.
2791  */
2792 static void
2793 rtsx_xfer_begin(struct rtsx_softc *sc)
2794 {
2795 	struct mmc_command *cmd;
2796 
2797 	cmd = sc->rtsx_req->cmd;
2798 
2799 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
2800 		device_printf(sc->rtsx_dev, "rtsx_xfer_begin() - CMD%d\n", cmd->opcode);
2801 
2802 	rtsx_set_resp(sc, cmd);
2803 	rtsx_xfer_start(sc);
2804 }
2805 
2806 /*
2807  * Start dma data transfer.
2808  */
2809 static void
2810 rtsx_xfer_start(struct rtsx_softc *sc)
2811 {
2812 	struct mmc_command *cmd;
2813 	int	read;
2814 	uint8_t	cfg2;
2815 	int	dma_dir;
2816 	int	tmode;
2817 
2818 	cmd = sc->rtsx_req->cmd;
2819 	read = ISSET(cmd->data->flags, MMC_DATA_READ);
2820 
2821 	/* Configure DMA transfer mode parameters. */
2822 	if (cmd->opcode == MMC_READ_MULTIPLE_BLOCK)
2823 		cfg2 = RTSX_SD_CHECK_CRC16 | RTSX_SD_NO_WAIT_BUSY_END | RTSX_SD_RSP_LEN_6;
2824 	else
2825 		cfg2 = RTSX_SD_CHECK_CRC16 | RTSX_SD_NO_WAIT_BUSY_END | RTSX_SD_RSP_LEN_0;
2826 	if (read) {
2827 		dma_dir = RTSX_DMA_DIR_FROM_CARD;
2828 		/*
2829 		 * Use transfer mode AUTO_READ1, which assume we not
2830 		 * already send the read command and don't need to send
2831 		 * CMD 12 manually after read.
2832 		 */
2833 		tmode = RTSX_TM_AUTO_READ1;
2834 		cfg2 |= RTSX_SD_CALCULATE_CRC7 | RTSX_SD_CHECK_CRC7;
2835 
2836 		rtsx_init_cmd(sc, cmd);
2837 	} else {
2838 		dma_dir = RTSX_DMA_DIR_TO_CARD;
2839 		/*
2840 		 * Use transfer mode AUTO_WRITE3, wich assumes we've already
2841 		 * sent the write command and gotten the response, and will
2842 		 * send CMD 12 manually after writing.
2843 		 */
2844 		tmode = RTSX_TM_AUTO_WRITE3;
2845 		cfg2 |= RTSX_SD_NO_CALCULATE_CRC7 | RTSX_SD_NO_CHECK_CRC7;
2846 
2847 		sc->rtsx_cmd_index = 0;
2848 	}
2849 
2850 	/* Queue commands to configure data transfer size. */
2851 	rtsx_set_cmd_data_len(sc, cmd->data->len / cmd->data->xfer_len, cmd->data->xfer_len);
2852 
2853 	/* Configure DMA controller. */
2854 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_IRQSTAT0,
2855 		     RTSX_DMA_DONE_INT, RTSX_DMA_DONE_INT);
2856 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_DMATC3,
2857 		     0xff, cmd->data->len >> 24);
2858 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_DMATC2,
2859 		     0xff, cmd->data->len >> 16);
2860 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_DMATC1,
2861 		     0xff, cmd->data->len >> 8);
2862 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_DMATC0,
2863 		     0xff, cmd->data->len);
2864 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_DMACTL,
2865 		     RTSX_DMA_EN | RTSX_DMA_DIR | RTSX_DMA_PACK_SIZE_MASK,
2866 		     RTSX_DMA_EN | dma_dir | RTSX_DMA_512);
2867 
2868 	/* Use the DMA ring buffer for commands which transfer data. */
2869 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_CARD_DATA_SOURCE,
2870 		      0x01, RTSX_RING_BUFFER);
2871 
2872 	/* Queue command to set response type. */
2873 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_CFG2, 0xff, cfg2);
2874 
2875 	/* Queue commands to perform SD transfer. */
2876 	rtsx_push_cmd(sc, RTSX_WRITE_REG_CMD, RTSX_SD_TRANSFER,
2877 		      0xff, tmode | RTSX_SD_TRANSFER_START);
2878 	rtsx_push_cmd(sc, RTSX_CHECK_REG_CMD, RTSX_SD_TRANSFER,
2879 		      RTSX_SD_TRANSFER_END, RTSX_SD_TRANSFER_END);
2880 
2881 	/* Run the command queue. */
2882 	rtsx_send_cmd(sc);
2883 
2884 	if (!read)
2885 		memcpy(sc->rtsx_data_dmamem, cmd->data->data, cmd->data->len);
2886 
2887 	/* Sync data DMA buffer. */
2888 	bus_dmamap_sync(sc->rtsx_data_dma_tag, sc->rtsx_data_dmamap, BUS_DMASYNC_PREREAD);
2889 	bus_dmamap_sync(sc->rtsx_data_dma_tag, sc->rtsx_data_dmamap, BUS_DMASYNC_PREWRITE);
2890 
2891 	/* Set transfer OK function. */
2892 	sc->rtsx_intr_trans_ok = rtsx_xfer_finish;
2893 
2894 	/* Tell the chip where the data buffer is and run the transfer. */
2895 	WRITE4(sc, RTSX_HDBAR, sc->rtsx_data_buffer);
2896 	WRITE4(sc, RTSX_HDBCTLR, RTSX_TRIG_DMA | (read ? RTSX_DMA_READ : 0) |
2897 	       (cmd->data->len & 0x00ffffff));
2898 }
2899 
2900 /*
2901  * Finish dma data transfer.
2902  * This Function is called by the interrupt handler via sc->rtsx_intr_trans_ok.
2903  */
2904 static void
2905 rtsx_xfer_finish(struct rtsx_softc *sc)
2906 {
2907 	struct mmc_command *cmd;
2908 	int	read;
2909 
2910 	cmd = sc->rtsx_req->cmd;
2911 
2912 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
2913 		device_printf(sc->rtsx_dev, "rtsx_xfer_finish() - CMD%d\n", cmd->opcode);
2914 
2915 	read = ISSET(cmd->data->flags, MMC_DATA_READ);
2916 
2917 	/* Sync data DMA buffer. */
2918 	bus_dmamap_sync(sc->rtsx_data_dma_tag, sc->rtsx_data_dmamap, BUS_DMASYNC_POSTREAD);
2919 	bus_dmamap_sync(sc->rtsx_data_dma_tag, sc->rtsx_data_dmamap, BUS_DMASYNC_POSTWRITE);
2920 
2921 	if (read) {
2922 		memcpy(cmd->data->data, sc->rtsx_data_dmamem, cmd->data->len);
2923 		rtsx_req_done(sc);
2924 	} else {
2925 		/* Send CMD12 after AUTO_WRITE3 (see mmcsd_rw() in mmcsd.c) */
2926 		/* and complete request. */
2927 		sc->rtsx_intr_trans_ok = NULL;
2928 		rtsx_send_req(sc, sc->rtsx_req->stop);
2929 	}
2930 }
2931 
2932 /*
2933  * Manage request timeout.
2934  */
2935 static void
2936 rtsx_timeout(void *arg)
2937 {
2938 	struct rtsx_softc *sc;
2939 
2940 	sc = (struct rtsx_softc *)arg;
2941 	if (sc->rtsx_req != NULL) {
2942 		device_printf(sc->rtsx_dev, "Controller timeout for CMD%u\n",
2943 			      sc->rtsx_req->cmd->opcode);
2944 		sc->rtsx_req->cmd->error = MMC_ERR_TIMEOUT;
2945 		rtsx_stop_cmd(sc);
2946 		rtsx_req_done(sc);
2947 	} else {
2948 		device_printf(sc->rtsx_dev, "Controller timeout!\n");
2949 	}
2950 }
2951 
2952 #ifdef MMCCAM
2953 static int
2954 rtsx_get_tran_settings(device_t dev, struct ccb_trans_settings_mmc *cts)
2955 {
2956 	struct rtsx_softc *sc;
2957 
2958 	sc = device_get_softc(dev);
2959 
2960 	cts->host_ocr = sc->rtsx_host.host_ocr;
2961 	cts->host_f_min = sc->rtsx_host.f_min;
2962 	cts->host_f_max = sc->rtsx_host.f_max;
2963 	cts->host_caps = sc->rtsx_host.caps;
2964 	cts->host_max_data = RTSX_DMA_DATA_BUFSIZE / MMC_SECTOR_SIZE;
2965 	memcpy(&cts->ios, &sc->rtsx_host.ios, sizeof(struct mmc_ios));
2966 
2967 	return (0);
2968 }
2969 
2970 /*
2971  *  Apply settings and return status accordingly.
2972 */
2973 static int
2974 rtsx_set_tran_settings(device_t dev, struct ccb_trans_settings_mmc *cts)
2975 {
2976 	struct rtsx_softc *sc;
2977 	struct mmc_ios *ios;
2978 	struct mmc_ios *new_ios;
2979 
2980 	sc = device_get_softc(dev);
2981 
2982 	ios = &sc->rtsx_host.ios;
2983 	new_ios = &cts->ios;
2984 
2985 	/* Update only requested fields */
2986 	if (cts->ios_valid & MMC_CLK) {
2987 		ios->clock = new_ios->clock;
2988 		sc->rtsx_ios_clock = -1;	/* To be updated by rtsx_mmcbr_update_ios(). */
2989 		if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
2990 			device_printf(sc->rtsx_dev, "rtsx_set_tran_settings() - clock: %u\n", ios->clock);
2991 	}
2992 	if (cts->ios_valid & MMC_VDD) {
2993 		ios->vdd = new_ios->vdd;
2994 		if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
2995 			device_printf(sc->rtsx_dev, "rtsx_set_tran_settings() - vdd: %d\n", ios->vdd);
2996 	}
2997 	if (cts->ios_valid & MMC_CS) {
2998 		ios->chip_select = new_ios->chip_select;
2999 		if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
3000 			device_printf(sc->rtsx_dev, "rtsx_set_tran_settings() - chip_select: %d\n", ios->chip_select);
3001 	}
3002 	if (cts->ios_valid & MMC_BW) {
3003 		ios->bus_width = new_ios->bus_width;
3004 		sc->rtsx_ios_bus_width = -1;	/* To be updated by rtsx_mmcbr_update_ios(). */
3005 		if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
3006 			device_printf(sc->rtsx_dev, "rtsx_set_tran_settings() - bus width: %d\n", ios->bus_width);
3007 	}
3008 	if (cts->ios_valid & MMC_PM) {
3009 		ios->power_mode = new_ios->power_mode;
3010 		sc->rtsx_ios_power_mode = -1;	/* To be updated by rtsx_mmcbr_update_ios(). */
3011 		if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
3012 			device_printf(sc->rtsx_dev, "rtsx_set_tran_settings() - power mode: %d\n", ios->power_mode);
3013 	}
3014 	if (cts->ios_valid & MMC_BT) {
3015 		ios->timing = new_ios->timing;
3016 		sc->rtsx_ios_timing = -1;	/* To be updated by rtsx_mmcbr_update_ios(). */
3017 		if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
3018 			device_printf(sc->rtsx_dev, "rtsx_set_tran_settings() - timing: %d\n", ios->timing);
3019 	}
3020 	if (cts->ios_valid & MMC_BM) {
3021 		ios->bus_mode = new_ios->bus_mode;
3022 		if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
3023 			device_printf(sc->rtsx_dev, "rtsx_set_tran_settings() - bus mode: %d\n", ios->bus_mode);
3024 	}
3025 #if  __FreeBSD_version >= 1300000
3026 	if (cts->ios_valid & MMC_VCCQ) {
3027 		ios->vccq = new_ios->vccq;
3028 		sc->rtsx_ios_vccq = -1;		/* To be updated by rtsx_mmcbr_update_ios(). */
3029 		if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
3030 			device_printf(sc->rtsx_dev, "rtsx_set_tran_settings() - vccq: %d\n", ios->vccq);
3031 	}
3032 #endif /* __FreeBSD_version >= 1300000 */
3033 	if (rtsx_mmcbr_update_ios(sc->rtsx_dev, NULL) == 0)
3034 		return (CAM_REQ_CMP);
3035 	else
3036 		return (CAM_REQ_CMP_ERR);
3037 }
3038 
3039 /*
3040  * Build a request and run it.
3041  */
3042 static int
3043 rtsx_cam_request(device_t dev, union ccb *ccb)
3044 {
3045 	struct rtsx_softc *sc;
3046 
3047 	sc = device_get_softc(dev);
3048 
3049 	RTSX_LOCK(sc);
3050 	if (sc->rtsx_ccb != NULL) {
3051 		RTSX_UNLOCK(sc);
3052 		return (CAM_BUSY);
3053 	}
3054 	sc->rtsx_ccb = ccb;
3055 	sc->rtsx_cam_req.cmd = &ccb->mmcio.cmd;
3056 	sc->rtsx_cam_req.stop = &ccb->mmcio.stop;
3057 	RTSX_UNLOCK(sc);
3058 
3059 	rtsx_mmcbr_request(sc->rtsx_dev, NULL, &sc->rtsx_cam_req);
3060 	return (0);
3061 }
3062 #endif /* MMCCAM */
3063 
3064 static int
3065 rtsx_read_ivar(device_t bus, device_t child, int which, uintptr_t *result)
3066 {
3067 	struct rtsx_softc *sc;
3068 
3069 	sc = device_get_softc(bus);
3070 	switch (which) {
3071 	case MMCBR_IVAR_BUS_MODE:		/* ivar  0 - 1 = opendrain, 2 = pushpull */
3072 		*result = sc->rtsx_host.ios.bus_mode;
3073 		break;
3074 	case MMCBR_IVAR_BUS_WIDTH:		/* ivar  1 - 0 = 1b   2 = 4b, 3 = 8b */
3075 		*result = sc->rtsx_host.ios.bus_width;
3076 		break;
3077 	case MMCBR_IVAR_CHIP_SELECT:		/* ivar  2 - O = dontcare, 1 = cs_high, 2 = cs_low */
3078 		*result = sc->rtsx_host.ios.chip_select;
3079 		break;
3080 	case MMCBR_IVAR_CLOCK:			/* ivar  3 - clock in Hz */
3081 		*result = sc->rtsx_host.ios.clock;
3082 		break;
3083 	case MMCBR_IVAR_F_MIN:			/* ivar  4 */
3084 		*result = sc->rtsx_host.f_min;
3085 		break;
3086 	case MMCBR_IVAR_F_MAX:			/* ivar  5 */
3087 		*result = sc->rtsx_host.f_max;
3088 		break;
3089 	case MMCBR_IVAR_HOST_OCR: 		/* ivar  6 - host operation conditions register */
3090 		*result = sc->rtsx_host.host_ocr;
3091 		break;
3092 	case MMCBR_IVAR_MODE:			/* ivar  7 - 0 = mode_mmc, 1 = mode_sd */
3093 		*result = sc->rtsx_host.mode;
3094 		break;
3095 	case MMCBR_IVAR_OCR:			/* ivar  8 - operation conditions register */
3096 		*result = sc->rtsx_host.ocr;
3097 		break;
3098 	case MMCBR_IVAR_POWER_MODE:		/* ivar  9 - 0 = off, 1 = up, 2 = on */
3099 		*result = sc->rtsx_host.ios.power_mode;
3100 		break;
3101 	case MMCBR_IVAR_VDD:			/* ivar 11 - voltage power pin */
3102 		*result = sc->rtsx_host.ios.vdd;
3103 		break;
3104 	case MMCBR_IVAR_VCCQ:			/* ivar 12 - signaling: 0 = 1.20V, 1 = 1.80V, 2 = 3.30V */
3105 		*result = sc->rtsx_host.ios.vccq;
3106 		break;
3107 	case MMCBR_IVAR_CAPS:			/* ivar 13 */
3108 		*result = sc->rtsx_host.caps;
3109 		break;
3110 	case MMCBR_IVAR_TIMING:			/* ivar 14 - 0 = normal, 1 = timing_hs, ... */
3111 		*result = sc->rtsx_host.ios.timing;
3112 		break;
3113 	case MMCBR_IVAR_MAX_DATA:		/* ivar 15 */
3114 		*result = RTSX_DMA_DATA_BUFSIZE / MMC_SECTOR_SIZE;
3115 		break;
3116 	case MMCBR_IVAR_RETUNE_REQ:		/* ivar 10 */
3117 	case MMCBR_IVAR_MAX_BUSY_TIMEOUT:	/* ivar 16 */
3118 	default:
3119 		return (EINVAL);
3120 	}
3121 
3122 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
3123 		device_printf(bus, "Read ivar #%d, value %#x / #%d\n",
3124 			      which, *(int *)result, *(int *)result);
3125 
3126 	return (0);
3127 }
3128 
3129 static int
3130 rtsx_write_ivar(device_t bus, device_t child, int which, uintptr_t value)
3131 {
3132 	struct rtsx_softc *sc;
3133 
3134 	sc = device_get_softc(bus);
3135 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
3136 		device_printf(bus, "Write ivar #%d, value %#x / #%d\n",
3137 			      which, (int)value, (int)value);
3138 
3139 	switch (which) {
3140 	case MMCBR_IVAR_BUS_MODE:		/* ivar  0 - 1 = opendrain, 2 = pushpull */
3141 		sc->rtsx_host.ios.bus_mode = value;
3142 		break;
3143 	case MMCBR_IVAR_BUS_WIDTH:		/* ivar  1 - 0 = 1b   2 = 4b, 3 = 8b */
3144 		sc->rtsx_host.ios.bus_width = value;
3145 		sc->rtsx_ios_bus_width = -1;	/* To be updated on next rtsx_mmcbr_update_ios(). */
3146 		break;
3147 	case MMCBR_IVAR_CHIP_SELECT:		/* ivar  2 - O = dontcare, 1 = cs_high, 2 = cs_low */
3148 		sc->rtsx_host.ios.chip_select = value;
3149 		break;
3150 	case MMCBR_IVAR_CLOCK:			/* ivar  3 - clock in Hz */
3151 		sc->rtsx_host.ios.clock = value;
3152 		sc->rtsx_ios_clock = -1;	/* To be updated on next rtsx_mmcbr_update_ios(). */
3153 		break;
3154 	case MMCBR_IVAR_MODE:			/* ivar  7 - 0 = mode_mmc, 1 = mode_sd */
3155 		sc->rtsx_host.mode = value;
3156 		break;
3157 	case MMCBR_IVAR_OCR:			/* ivar  8 - operation conditions register */
3158 		sc->rtsx_host.ocr = value;
3159 		break;
3160 	case MMCBR_IVAR_POWER_MODE:		/* ivar  9 - 0 = off, 1 = up, 2 = on */
3161 		sc->rtsx_host.ios.power_mode = value;
3162 		sc->rtsx_ios_power_mode = -1;	/* To be updated on next rtsx_mmcbr_update_ios(). */
3163 		break;
3164 	case MMCBR_IVAR_VDD:			/* ivar 11 - voltage power pin */
3165 		sc->rtsx_host.ios.vdd = value;
3166 		break;
3167 	case MMCBR_IVAR_VCCQ:			/* ivar 12 - signaling: 0 = 1.20V, 1 = 1.80V, 2 = 3.30V */
3168 		sc->rtsx_host.ios.vccq = value;
3169 		sc->rtsx_ios_vccq = value;	/* rtsx_mmcbr_switch_vccq() will be called by mmc.c (MMCCAM undef). */
3170 		break;
3171 	case MMCBR_IVAR_TIMING:			/* ivar 14 - 0 = normal, 1 = timing_hs, ... */
3172 		sc->rtsx_host.ios.timing = value;
3173 		sc->rtsx_ios_timing = -1;	/* To be updated on next rtsx_mmcbr_update_ios(). */
3174 		break;
3175 	/* These are read-only. */
3176 	case MMCBR_IVAR_F_MIN:			/* ivar  4 */
3177 	case MMCBR_IVAR_F_MAX:			/* ivar  5 */
3178 	case MMCBR_IVAR_HOST_OCR: 		/* ivar  6 - host operation conditions register */
3179 	case MMCBR_IVAR_RETUNE_REQ:		/* ivar 10 */
3180 	case MMCBR_IVAR_CAPS:			/* ivar 13 */
3181 	case MMCBR_IVAR_MAX_DATA:		/* ivar 15 */
3182 	case MMCBR_IVAR_MAX_BUSY_TIMEOUT:	/* ivar 16 */
3183 	default:
3184 		return (EINVAL);
3185 	}
3186 
3187 	return (0);
3188 }
3189 
3190 static int
3191 rtsx_mmcbr_update_ios(device_t bus, device_t child__unused)
3192 {
3193 	struct rtsx_softc *sc;
3194 	struct mmc_ios	  *ios;
3195 	int	error;
3196 
3197 	sc = device_get_softc(bus);
3198 	ios = &sc->rtsx_host.ios;
3199 
3200 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
3201 		device_printf(bus, "rtsx_mmcbr_update_ios()\n");
3202 
3203 	/* if MMCBR_IVAR_BUS_WIDTH updated. */
3204 	if (sc->rtsx_ios_bus_width < 0) {
3205 		sc->rtsx_ios_bus_width = ios->bus_width;
3206 		if ((error = rtsx_set_bus_width(sc, ios->bus_width)))
3207 			return (error);
3208 	}
3209 
3210 	/* if MMCBR_IVAR_POWER_MODE updated. */
3211 	if (sc->rtsx_ios_power_mode < 0) {
3212 		sc->rtsx_ios_power_mode = ios->power_mode;
3213 		switch (ios->power_mode) {
3214 		case power_off:
3215 			if ((error = rtsx_bus_power_off(sc)))
3216 				return (error);
3217 			break;
3218 		case power_up:
3219 			if ((error = rtsx_bus_power_on(sc)))
3220 				return (error);
3221 			break;
3222 		case power_on:
3223 			if ((error = rtsx_bus_power_on(sc)))
3224 				return (error);
3225 			break;
3226 		}
3227 	}
3228 
3229 	sc->rtsx_double_clk = true;
3230 	sc->rtsx_vpclk = false;
3231 
3232 	/* if MMCBR_IVAR_TIMING updated. */
3233 	if (sc->rtsx_ios_timing < 0) {
3234 		sc->rtsx_ios_timing = ios->timing;
3235 		if ((error = rtsx_set_sd_timing(sc, ios->timing)))
3236 			return (error);
3237 	}
3238 
3239 	/* if MMCBR_IVAR_CLOCK updated, must be after rtsx_set_sd_timing() */
3240 	if (sc->rtsx_ios_clock < 0) {
3241 		sc->rtsx_ios_clock = ios->clock;
3242 		if ((error = rtsx_set_sd_clock(sc, ios->clock)))
3243 			return (error);
3244 	}
3245 
3246 	/* if MMCCAM and vccq updated */
3247 	if (sc->rtsx_ios_vccq < 0) {
3248 		sc->rtsx_ios_vccq = ios->vccq;
3249 		if ((error = rtsx_mmcbr_switch_vccq(sc->rtsx_dev, NULL)))
3250 			return (error);
3251 	}
3252 
3253 	return (0);
3254 }
3255 
3256 /*
3257  * Set output stage logic power voltage.
3258  */
3259 static int
3260 rtsx_mmcbr_switch_vccq(device_t bus, device_t child __unused)
3261 {
3262 	struct rtsx_softc *sc;
3263 	int	vccq = 0;
3264 	int	error;
3265 
3266 	sc = device_get_softc(bus);
3267 
3268 	switch (sc->rtsx_host.ios.vccq) {
3269 	case vccq_120:
3270 		vccq = 120;
3271 		break;
3272 	case vccq_180:
3273 		vccq = 180;
3274 		break;
3275 	case vccq_330:
3276 		vccq = 330;
3277 		break;
3278 	};
3279 	/* It seems it is always vccq_330. */
3280 	if (vccq == 330) {
3281 		switch (sc->rtsx_device_id) {
3282 			uint16_t val;
3283 		case RTSX_RTS5227:
3284 			if ((error = rtsx_write_phy(sc, 0x08, 0x4FE4)))
3285 				return (error);
3286 			if ((error = rtsx_rts5227_fill_driving(sc)))
3287 				return (error);
3288 			break;
3289 		case RTSX_RTS5209:
3290 		case RTSX_RTS5229:
3291 			RTSX_BITOP(sc, RTSX_SD30_CMD_DRIVE_SEL, RTSX_SD30_DRIVE_SEL_MASK, sc->rtsx_sd30_drive_sel_3v3);
3292 			if ((error = rtsx_write_phy(sc, 0x08, 0x4FE4)))
3293 				return (error);
3294 			break;
3295 		case RTSX_RTS522A:
3296 			if ((error = rtsx_write_phy(sc, 0x08, 0x57E4)))
3297 				return (error);
3298 			if ((error = rtsx_rts5227_fill_driving(sc)))
3299 				return (error);
3300 			break;
3301 		case RTSX_RTS525A:
3302 			RTSX_BITOP(sc, RTSX_LDO_CONFIG2, RTSX_LDO_D3318_MASK, RTSX_LDO_D3318_33V);
3303 			RTSX_BITOP(sc, RTSX_SD_PAD_CTL, RTSX_SD_IO_USING_1V8, 0);
3304 			if ((error = rtsx_rts5249_fill_driving(sc)))
3305 				return (error);
3306 			break;
3307 		case RTSX_RTS5249:
3308 			if ((error = rtsx_read_phy(sc, RTSX_PHY_TUNE, &val)))
3309 				return (error);
3310 			if ((error = rtsx_write_phy(sc, RTSX_PHY_TUNE,
3311 						    (val & RTSX_PHY_TUNE_VOLTAGE_MASK) | RTSX_PHY_TUNE_VOLTAGE_3V3)))
3312 				return (error);
3313 			if ((error = rtsx_rts5249_fill_driving(sc)))
3314 				return (error);
3315 			break;
3316 		case RTSX_RTS5260:
3317 			RTSX_BITOP(sc, RTSX_LDO_CONFIG2, RTSX_DV331812_VDD1, RTSX_DV331812_VDD1);
3318 			RTSX_BITOP(sc, RTSX_LDO_DV18_CFG, RTSX_DV331812_MASK, RTSX_DV331812_33);
3319 			RTSX_CLR(sc, RTSX_SD_PAD_CTL, RTSX_SD_IO_USING_1V8);
3320 			if ((error = rtsx_rts5260_fill_driving(sc)))
3321 				return (error);
3322 			break;
3323 		case RTSX_RTL8402:
3324 			RTSX_BITOP(sc, RTSX_SD30_CMD_DRIVE_SEL, RTSX_SD30_DRIVE_SEL_MASK, sc->rtsx_sd30_drive_sel_3v3);
3325 			RTSX_BITOP(sc, RTSX_LDO_CTL,
3326 				   (RTSX_BPP_ASIC_MASK << RTSX_BPP_SHIFT_8402) | RTSX_BPP_PAD_MASK,
3327 				   (RTSX_BPP_ASIC_3V3 << RTSX_BPP_SHIFT_8402) | RTSX_BPP_PAD_3V3);
3328 			break;
3329 		case RTSX_RTL8411:
3330 		case RTSX_RTL8411B:
3331 			RTSX_BITOP(sc, RTSX_SD30_CMD_DRIVE_SEL, RTSX_SD30_DRIVE_SEL_MASK, sc->rtsx_sd30_drive_sel_3v3);
3332 			RTSX_BITOP(sc, RTSX_LDO_CTL,
3333 				   (RTSX_BPP_ASIC_MASK << RTSX_BPP_SHIFT_8411) | RTSX_BPP_PAD_MASK,
3334 				   (RTSX_BPP_ASIC_3V3 << RTSX_BPP_SHIFT_8411) | RTSX_BPP_PAD_3V3);
3335 			break;
3336 		}
3337 		DELAY(300);
3338 	}
3339 
3340 	if (sc->rtsx_debug_mask & (RTSX_DEBUG_BASIC | RTSX_TRACE_SD_CMD))
3341 		device_printf(sc->rtsx_dev, "rtsx_mmcbr_switch_vccq(%d)\n", vccq);
3342 
3343 	return (0);
3344 }
3345 
3346 #ifndef MMCCAM
3347 /*
3348  * Tune card if bus_timing_uhs_sdr50.
3349  */
3350 static int
3351 rtsx_mmcbr_tune(device_t bus, device_t child __unused, bool hs400)
3352 {
3353 	struct rtsx_softc *sc;
3354 	uint32_t raw_phase_map[RTSX_RX_TUNING_CNT] = {0};
3355 	uint32_t phase_map;
3356 	uint8_t	 final_phase;
3357 	int	 i;
3358 
3359 	sc = device_get_softc(bus);
3360 
3361 	if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
3362 		device_printf(sc->rtsx_dev, "rtsx_mmcbr_tune() - hs400 is %s\n",
3363 			      (hs400) ? "true" : "false");
3364 
3365 	if (sc->rtsx_ios_timing != bus_timing_uhs_sdr50)
3366 		return (0);
3367 
3368 	sc->rtsx_tuning_mode = true;
3369 
3370 	switch (sc->rtsx_device_id) {
3371 	case RTSX_RTS5209:
3372 	case RTSX_RTS5227:
3373 		rtsx_sd_change_tx_phase(sc, 27);
3374 		break;
3375 	case RTSX_RTS522A:
3376 		rtsx_sd_change_tx_phase(sc, 20);
3377 		break;
3378 	case RTSX_RTS5229:
3379 		rtsx_sd_change_tx_phase(sc, 27);
3380 		break;
3381 	case RTSX_RTS525A:
3382 	case RTSX_RTS5249:
3383 		rtsx_sd_change_tx_phase(sc, 29);
3384 		break;
3385 	case RTSX_RTL8402:
3386 	case RTSX_RTL8411:
3387 	case RTSX_RTL8411B:
3388 		rtsx_sd_change_tx_phase(sc, 7);
3389 		break;
3390 	}
3391 
3392 	/* trying rx tuning for bus_timing_uhs_sdr50. */
3393 	for (i = 0; i < RTSX_RX_TUNING_CNT; i++) {
3394 		rtsx_sd_tuning_rx_phase(sc, &(raw_phase_map[i]));
3395 		if (raw_phase_map[i] == 0)
3396 			break;
3397 	}
3398 
3399 	phase_map = 0xffffffff;
3400 	for (i = 0; i < RTSX_RX_TUNING_CNT; i++) {
3401 		if (sc->rtsx_debug_mask & (RTSX_DEBUG_BASIC | RTSX_DEBUG_TUNING))
3402 			device_printf(sc->rtsx_dev, "rtsx_mmcbr_tune() - RX raw_phase_map[%d]: 0x%08x\n",
3403 				      i, raw_phase_map[i]);
3404 		phase_map &= raw_phase_map[i];
3405 	}
3406 	if (sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
3407 		device_printf(sc->rtsx_dev, "rtsx_mmcbr_tune() - RX phase_map: 0x%08x\n", phase_map);
3408 
3409 	if (phase_map) {
3410 		final_phase = rtsx_sd_search_final_rx_phase(sc, phase_map);
3411 		if (final_phase != 0xff) {
3412 			rtsx_sd_change_rx_phase(sc, final_phase);
3413 		}
3414 	}
3415 
3416 	sc->rtsx_tuning_mode = false;
3417 
3418 	return (0);
3419 }
3420 
3421 static int
3422 rtsx_mmcbr_retune(device_t bus, device_t child __unused, bool reset __unused)
3423 {
3424 	struct rtsx_softc *sc;
3425 
3426 	sc = device_get_softc(bus);
3427 
3428 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
3429 		device_printf(sc->rtsx_dev, "rtsx_mmcbr_retune()\n");
3430 
3431 	return (0);
3432 }
3433 #endif /* !MMCCAM */
3434 
3435 static int
3436 rtsx_mmcbr_request(device_t bus, device_t child __unused, struct mmc_request *req)
3437 {
3438 	struct rtsx_softc  *sc;
3439 	struct mmc_command *cmd;
3440 	int	timeout;
3441 	int	error;
3442 
3443 	sc = device_get_softc(bus);
3444 
3445 	RTSX_LOCK(sc);
3446 	if (sc->rtsx_req != NULL) {
3447 		RTSX_UNLOCK(sc);
3448 		return (EBUSY);
3449 	}
3450 	sc->rtsx_req = req;
3451 	cmd = req->cmd;
3452 	cmd->error = error = MMC_ERR_NONE;
3453 	sc->rtsx_intr_status = 0;
3454 	sc->rtsx_intr_trans_ok = NULL;
3455 	sc->rtsx_intr_trans_ko = rtsx_req_done;
3456 
3457 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
3458 		device_printf(sc->rtsx_dev, "rtsx_mmcbr_request(CMD%u arg %#x, flags %#x, dlen %u, dflags %#x)\n",
3459 			      cmd->opcode, cmd->arg, cmd->flags,
3460 			      cmd->data != NULL ? (unsigned int)cmd->data->len : 0,
3461 			      cmd->data != NULL ? cmd->data->flags : 0);
3462 
3463 	/* Check if card present. */
3464 	if (!ISSET(sc->rtsx_flags, RTSX_F_CARD_PRESENT)) {
3465 		cmd->error = error = MMC_ERR_FAILED;
3466 		goto end;
3467 	}
3468 
3469 	/* Refuse SDIO probe if the chip doesn't support SDIO. */
3470 	if (cmd->opcode == IO_SEND_OP_COND &&
3471 	    !ISSET(sc->rtsx_flags, RTSX_F_SDIO_SUPPORT)) {
3472 		cmd->error = error = MMC_ERR_INVALID;
3473 		goto end;
3474 	}
3475 
3476 	/* Return MMC_ERR_TIMEOUT for SD_IO_RW_DIRECT and IO_SEND_OP_COND. */
3477 	if (cmd->opcode == SD_IO_RW_DIRECT || cmd->opcode == IO_SEND_OP_COND) {
3478 		cmd->error = error = MMC_ERR_TIMEOUT;
3479 		goto end;
3480 	}
3481 
3482 	/* Select SD card. */
3483 	RTSX_BITOP(sc, RTSX_CARD_SELECT, 0x07, RTSX_SD_MOD_SEL);
3484 	RTSX_BITOP(sc, RTSX_CARD_SHARE_MODE, RTSX_CARD_SHARE_MASK, RTSX_CARD_SHARE_48_SD);
3485 
3486 	if (cmd->data == NULL) {
3487 		DELAY(200);
3488 		timeout = sc->rtsx_timeout_cmd;
3489 		error = rtsx_send_req(sc, cmd);
3490 	} else if (cmd->data->len <= 512) {
3491 		timeout = sc->rtsx_timeout_io;
3492 		error = rtsx_xfer_short(sc, cmd);
3493 	} else {
3494 		timeout = sc->rtsx_timeout_io;
3495 		error = rtsx_xfer(sc, cmd);
3496 	}
3497  end:
3498 	if (error == MMC_ERR_NONE) {
3499 		callout_reset(&sc->rtsx_timeout_callout, timeout * hz, rtsx_timeout, sc);
3500 	} else {
3501 		rtsx_req_done(sc);
3502 	}
3503 	RTSX_UNLOCK(sc);
3504 
3505 	return (error);
3506 }
3507 
3508 #ifndef MMCCAM
3509 static int
3510 rtsx_mmcbr_get_ro(device_t bus, device_t child __unused)
3511 {
3512 	struct rtsx_softc *sc;
3513 
3514 	sc = device_get_softc(bus);
3515 
3516 	if (sc->rtsx_inversion == 0)
3517 		return (sc->rtsx_read_only);
3518 	else
3519 		return !(sc->rtsx_read_only);
3520 }
3521 
3522 static int
3523 rtsx_mmcbr_acquire_host(device_t bus, device_t child __unused)
3524 {
3525 	struct rtsx_softc *sc;
3526 
3527 	sc = device_get_softc(bus);
3528 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
3529 		device_printf(bus, "rtsx_mmcbr_acquire_host()\n");
3530 
3531 	RTSX_LOCK(sc);
3532 	while (sc->rtsx_bus_busy)
3533 		msleep(&sc->rtsx_bus_busy, &sc->rtsx_mtx, 0, "rtsxah", 0);
3534 	sc->rtsx_bus_busy++;
3535 	RTSX_UNLOCK(sc);
3536 
3537 	return (0);
3538 }
3539 
3540 static int
3541 rtsx_mmcbr_release_host(device_t bus, device_t child __unused)
3542 {
3543 	struct rtsx_softc *sc;
3544 
3545 	sc = device_get_softc(bus);
3546 	if (sc->rtsx_debug_mask & RTSX_TRACE_SD_CMD)
3547 		device_printf(bus, "rtsx_mmcbr_release_host()\n");
3548 
3549 	RTSX_LOCK(sc);
3550 	sc->rtsx_bus_busy--;
3551 	wakeup(&sc->rtsx_bus_busy);
3552 	RTSX_UNLOCK(sc);
3553 
3554 	return (0);
3555 }
3556 #endif /* !MMCCAM */
3557 
3558 /*
3559  *
3560  * PCI Support Functions
3561  *
3562  */
3563 
3564 /*
3565  * Compare the device ID (chip) of this device against the IDs that this driver
3566  * supports. If there is a match, set the description and return success.
3567  */
3568 static int
3569 rtsx_probe(device_t dev)
3570 {
3571 	uint16_t vendor_id;
3572 	uint16_t device_id;
3573 	int	 i;
3574 	int	 result;
3575 
3576 	vendor_id = pci_get_vendor(dev);
3577 	device_id = pci_get_device(dev);
3578 
3579 	result = ENXIO;
3580 	for (i = 0; rtsx_devices[i].vendor_id != 0; i++) {
3581 		if (rtsx_devices[i].vendor_id == vendor_id &&
3582 		    rtsx_devices[i].device_id == device_id) {
3583 			device_set_desc(dev, rtsx_devices[i].desc);
3584 			result = BUS_PROBE_DEFAULT;
3585 			break;
3586 		}
3587 	}
3588 
3589 	return (result);
3590 }
3591 
3592 /*
3593  * Attach function is only called if the probe is successful.
3594  */
3595 static int
3596 rtsx_attach(device_t dev)
3597 {
3598 	struct rtsx_softc 	*sc = device_get_softc(dev);
3599 	uint16_t 		vendor_id;
3600 	uint16_t 		device_id;
3601 	struct sysctl_ctx_list	*ctx;
3602 	struct sysctl_oid_list	*tree;
3603 	int			msi_count = 1;
3604 	uint32_t		sdio_cfg;
3605 	int			error;
3606 	char			*maker;
3607 	char			*family;
3608 	char			*product;
3609 	int			i;
3610 
3611 	vendor_id = pci_get_vendor(dev);
3612 	device_id = pci_get_device(dev);
3613 	if (bootverbose)
3614 		device_printf(dev, "Attach - Vendor ID: 0x%x - Device ID: 0x%x\n",
3615 			      vendor_id, device_id);
3616 
3617 	sc->rtsx_dev = dev;
3618 	sc->rtsx_device_id = device_id;
3619 	sc->rtsx_req = NULL;
3620 	sc->rtsx_timeout_cmd = 1;
3621 	sc->rtsx_timeout_io = 10;
3622 	sc->rtsx_read_only = 0;
3623 	sc->rtsx_inversion = 0;
3624 	sc->rtsx_force_timing = 0;
3625 	sc->rtsx_debug_mask = 0;
3626 	sc->rtsx_read_count = 0;
3627 	sc->rtsx_write_count = 0;
3628 
3629 	maker = kern_getenv("smbios.system.maker");
3630 	family = kern_getenv("smbios.system.family");
3631 	product = kern_getenv("smbios.system.product");
3632 	for (i = 0; rtsx_inversion_models[i].maker != NULL; i++) {
3633 		if (strcmp(rtsx_inversion_models[i].maker, maker) == 0 &&
3634 		    strcmp(rtsx_inversion_models[i].family, family) == 0 &&
3635 		    strcmp(rtsx_inversion_models[i].product, product) == 0) {
3636 			device_printf(dev, "Inversion activated for %s/%s/%s, see BUG in rtsx(4)\n", maker, family, product);
3637 			device_printf(dev, "If a card is detected without an SD card present,"
3638 				      " add dev.rtsx.0.inversion=0 in loader.conf(5)\n");
3639 			sc->rtsx_inversion = 1;
3640 		}
3641 	}
3642 
3643 	RTSX_LOCK_INIT(sc);
3644 
3645 	ctx = device_get_sysctl_ctx(dev);
3646 	tree = SYSCTL_CHILDREN(device_get_sysctl_tree(dev));
3647 	SYSCTL_ADD_INT(ctx, tree, OID_AUTO, "timeout_io", CTLFLAG_RW,
3648 		       &sc->rtsx_timeout_io, 0, "Request timeout for I/O commands in seconds");
3649 	SYSCTL_ADD_INT(ctx, tree, OID_AUTO, "timeout_cmd", CTLFLAG_RW,
3650 		       &sc->rtsx_timeout_cmd, 0, "Request timeout for setup commands in seconds");
3651 	SYSCTL_ADD_U8(ctx, tree, OID_AUTO, "read_only", CTLFLAG_RD,
3652 		      &sc->rtsx_read_only, 0, "Card is write protected");
3653 	SYSCTL_ADD_U8(ctx, tree, OID_AUTO, "inversion", CTLFLAG_RWTUN,
3654 		      &sc->rtsx_inversion, 0, "Inversion of card detection and read only status");
3655 	SYSCTL_ADD_U8(ctx, tree, OID_AUTO, "force_timing", CTLFLAG_RW,
3656 		      &sc->rtsx_force_timing, 0, "Force bus_timing_uhs_sdr50");
3657 	SYSCTL_ADD_U8(ctx, tree, OID_AUTO, "debug_mask", CTLFLAG_RWTUN,
3658 		      &sc->rtsx_debug_mask, 0, "debugging mask, see rtsx(4)");
3659 	SYSCTL_ADD_U64(ctx, tree, OID_AUTO, "read_count", CTLFLAG_RD | CTLFLAG_STATS,
3660 		       &sc->rtsx_read_count, 0, "Count of read operations");
3661 	SYSCTL_ADD_U64(ctx, tree, OID_AUTO, "write_count", CTLFLAG_RD | CTLFLAG_STATS,
3662 		       &sc->rtsx_write_count, 0, "Count of write operations");
3663 
3664 	if (bootverbose || sc->rtsx_debug_mask & RTSX_DEBUG_BASIC)
3665 		device_printf(dev, "We are running with inversion: %d\n", sc->rtsx_inversion);
3666 
3667 	/* Allocate IRQ. */
3668 	sc->rtsx_irq_res_id = 0;
3669 	if (pci_alloc_msi(dev, &msi_count) == 0)
3670 		sc->rtsx_irq_res_id = 1;
3671 	sc->rtsx_irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->rtsx_irq_res_id,
3672 						  RF_ACTIVE | (sc->rtsx_irq_res_id != 0 ? 0 : RF_SHAREABLE));
3673 	if (sc->rtsx_irq_res == NULL) {
3674 		device_printf(dev, "Can't allocate IRQ resources for %d\n", sc->rtsx_irq_res_id);
3675 		pci_release_msi(dev);
3676 		return (ENXIO);
3677 	}
3678 
3679 	callout_init_mtx(&sc->rtsx_timeout_callout, &sc->rtsx_mtx, 0);
3680 
3681 	/* Allocate memory resource. */
3682 	if (sc->rtsx_device_id == RTSX_RTS525A)
3683 		sc->rtsx_mem_res_id = PCIR_BAR(1);
3684 	else
3685 		sc->rtsx_mem_res_id = PCIR_BAR(0);
3686 	sc->rtsx_mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->rtsx_mem_res_id, RF_ACTIVE);
3687 	if (sc->rtsx_mem_res == NULL) {
3688 		device_printf(dev, "Can't allocate memory resource for %d\n", sc->rtsx_mem_res_id);
3689 		goto destroy_rtsx_irq_res;
3690 	}
3691 
3692 	if (bootverbose)
3693 		device_printf(dev, "rtsx_irq_res_id: %d, rtsx_mem_res_id: %d\n",
3694 			      sc->rtsx_irq_res_id, sc->rtsx_mem_res_id);
3695 
3696 	sc->rtsx_mem_btag = rman_get_bustag(sc->rtsx_mem_res);
3697 	sc->rtsx_mem_bhandle = rman_get_bushandle(sc->rtsx_mem_res);
3698 
3699 	TIMEOUT_TASK_INIT(taskqueue_swi_giant, &sc->rtsx_card_insert_task, 0,
3700 			  rtsx_card_task, sc);
3701 	TASK_INIT(&sc->rtsx_card_remove_task, 0, rtsx_card_task, sc);
3702 
3703 	/* Allocate two DMA buffers: a command buffer and a data buffer. */
3704 	error = rtsx_dma_alloc(sc);
3705 	if (error)
3706 		goto destroy_rtsx_irq_res;
3707 
3708 	/* Activate the interrupt. */
3709 	error = bus_setup_intr(dev, sc->rtsx_irq_res, INTR_TYPE_MISC | INTR_MPSAFE,
3710 			       NULL, rtsx_intr, sc, &sc->rtsx_irq_cookie);
3711 	if (error) {
3712 		device_printf(dev, "Can't set up irq [0x%x]!\n", error);
3713 		goto destroy_rtsx_mem_res;
3714 	}
3715 	pci_enable_busmaster(dev);
3716 
3717 	if (rtsx_read_cfg(sc, 0, RTSX_SDIOCFG_REG, &sdio_cfg) == 0) {
3718 		if ((sdio_cfg & RTSX_SDIOCFG_SDIO_ONLY) ||
3719 		    (sdio_cfg & RTSX_SDIOCFG_HAVE_SDIO))
3720 			sc->rtsx_flags |= RTSX_F_SDIO_SUPPORT;
3721 	}
3722 
3723 #ifdef MMCCAM
3724 	sc->rtsx_ccb = NULL;
3725 	sc->rtsx_cam_status = 0;
3726 
3727 	SYSCTL_ADD_U8(ctx, tree, OID_AUTO, "cam_status", CTLFLAG_RD,
3728 		      &sc->rtsx_cam_status, 0, "driver cam card present");
3729 
3730 	if (mmc_cam_sim_alloc(dev, "rtsx_mmc", &sc->rtsx_mmc_sim) != 0) {
3731 		device_printf(dev, "Can't allocate CAM SIM\n");
3732 		goto destroy_rtsx_irq;
3733 	}
3734 #endif /* MMCCAM */
3735 
3736 	/* Initialize device. */
3737 	error = rtsx_init(sc);
3738 	if (error) {
3739 		device_printf(dev, "Error %d during rtsx_init()\n", error);
3740 		goto destroy_rtsx_irq;
3741 	}
3742 
3743 	/*
3744 	 * Schedule a card detection as we won't get an interrupt
3745 	 * if the card is inserted when we attach. We wait a quarter
3746 	 * of a second to allow for a "spontaneous" interrupt which may
3747 	 * change the card presence state. This delay avoid a panic
3748 	 * on some configuration (e.g. Lenovo T540p).
3749 	 */
3750 	DELAY(250000);
3751 	if (rtsx_is_card_present(sc))
3752 		device_printf(sc->rtsx_dev, "A card is detected\n");
3753 	else
3754 		device_printf(sc->rtsx_dev, "No card is detected\n");
3755 	rtsx_card_task(sc, 0);
3756 
3757 	if (bootverbose)
3758 		device_printf(dev, "Device attached\n");
3759 
3760 	return (0);
3761 
3762  destroy_rtsx_irq:
3763 	bus_teardown_intr(dev, sc->rtsx_irq_res, sc->rtsx_irq_cookie);
3764  destroy_rtsx_mem_res:
3765 	bus_release_resource(dev, SYS_RES_MEMORY, sc->rtsx_mem_res_id,
3766 			     sc->rtsx_mem_res);
3767 	rtsx_dma_free(sc);
3768  destroy_rtsx_irq_res:
3769 	callout_drain(&sc->rtsx_timeout_callout);
3770 	bus_release_resource(dev, SYS_RES_IRQ, sc->rtsx_irq_res_id,
3771 			     sc->rtsx_irq_res);
3772 	pci_release_msi(dev);
3773 	RTSX_LOCK_DESTROY(sc);
3774 
3775 	return (ENXIO);
3776 }
3777 
3778 static int
3779 rtsx_detach(device_t dev)
3780 {
3781 	struct rtsx_softc *sc = device_get_softc(dev);
3782 	int	error;
3783 
3784 	if (bootverbose)
3785 		device_printf(dev, "Detach - Vendor ID: 0x%x - Device ID: 0x%x\n",
3786 			      pci_get_vendor(dev), sc->rtsx_device_id);
3787 
3788 	/* Disable interrupts. */
3789 	sc->rtsx_intr_enabled = 0;
3790 	WRITE4(sc, RTSX_BIER, sc->rtsx_intr_enabled);
3791 
3792 	/* Stop device. */
3793 	error = device_delete_children(sc->rtsx_dev);
3794 	sc->rtsx_mmc_dev = NULL;
3795 	if (error)
3796 		return (error);
3797 
3798 	taskqueue_drain_timeout(taskqueue_swi_giant, &sc->rtsx_card_insert_task);
3799 	taskqueue_drain(taskqueue_swi_giant, &sc->rtsx_card_remove_task);
3800 
3801 	/* Teardown the state in our softc created in our attach routine. */
3802 	rtsx_dma_free(sc);
3803 	if (sc->rtsx_mem_res != NULL)
3804 		bus_release_resource(dev, SYS_RES_MEMORY, sc->rtsx_mem_res_id,
3805 				     sc->rtsx_mem_res);
3806 	if (sc->rtsx_irq_cookie != NULL)
3807 		bus_teardown_intr(dev, sc->rtsx_irq_res, sc->rtsx_irq_cookie);
3808 	if (sc->rtsx_irq_res != NULL) {
3809 		callout_drain(&sc->rtsx_timeout_callout);
3810 		bus_release_resource(dev, SYS_RES_IRQ, sc->rtsx_irq_res_id,
3811 				     sc->rtsx_irq_res);
3812 		pci_release_msi(dev);
3813 	}
3814 	RTSX_LOCK_DESTROY(sc);
3815 #ifdef MMCCAM
3816 	mmc_cam_sim_free(&sc->rtsx_mmc_sim);
3817 #endif /* MMCCAM */
3818 
3819 	return (0);
3820 }
3821 
3822 static int
3823 rtsx_shutdown(device_t dev)
3824 {
3825 	if (bootverbose)
3826 		device_printf(dev, "Shutdown\n");
3827 
3828 	return (0);
3829 }
3830 
3831 /*
3832  * Device suspend routine.
3833  */
3834 static int
3835 rtsx_suspend(device_t dev)
3836 {
3837 	struct rtsx_softc *sc = device_get_softc(dev);
3838 
3839 	device_printf(dev, "Suspend\n");
3840 
3841 #ifdef MMCCAM
3842 	if (sc->rtsx_ccb != NULL) {
3843 		device_printf(dev, "Request in progress: CMD%u, rtsr_intr_status: 0x%08x\n",
3844 			      sc->rtsx_ccb->mmcio.cmd.opcode, sc->rtsx_intr_status);
3845 	}
3846 #else  /* !MMCCAM */
3847 	if (sc->rtsx_req != NULL) {
3848 		device_printf(dev, "Request in progress: CMD%u, rtsr_intr_status: 0x%08x\n",
3849 			      sc->rtsx_req->cmd->opcode, sc->rtsx_intr_status);
3850 	}
3851 #endif /* MMCCAM */
3852 
3853 	bus_generic_suspend(dev);
3854 
3855 	return (0);
3856 }
3857 
3858 /*
3859  * Device resume routine.
3860  */
3861 static int
3862 rtsx_resume(device_t dev)
3863 {
3864 	device_printf(dev, "Resume\n");
3865 
3866 	rtsx_init(device_get_softc(dev));
3867 
3868 	bus_generic_resume(dev);
3869 
3870 	return (0);
3871 }
3872 
3873 static device_method_t rtsx_methods[] = {
3874 	/* Device interface */
3875 	DEVMETHOD(device_probe,		rtsx_probe),
3876 	DEVMETHOD(device_attach,	rtsx_attach),
3877 	DEVMETHOD(device_detach,	rtsx_detach),
3878 	DEVMETHOD(device_shutdown,	rtsx_shutdown),
3879 	DEVMETHOD(device_suspend,	rtsx_suspend),
3880 	DEVMETHOD(device_resume,	rtsx_resume),
3881 
3882 	/* Bus interface */
3883 	DEVMETHOD(bus_read_ivar,	rtsx_read_ivar),
3884 	DEVMETHOD(bus_write_ivar,	rtsx_write_ivar),
3885 
3886 #ifndef MMCCAM
3887 	/* MMC bridge interface */
3888 	DEVMETHOD(mmcbr_update_ios,	rtsx_mmcbr_update_ios),
3889 	DEVMETHOD(mmcbr_switch_vccq,	rtsx_mmcbr_switch_vccq),
3890 	DEVMETHOD(mmcbr_tune,		rtsx_mmcbr_tune),
3891 	DEVMETHOD(mmcbr_retune,		rtsx_mmcbr_retune),
3892 	DEVMETHOD(mmcbr_request,	rtsx_mmcbr_request),
3893 	DEVMETHOD(mmcbr_get_ro,		rtsx_mmcbr_get_ro),
3894 	DEVMETHOD(mmcbr_acquire_host,	rtsx_mmcbr_acquire_host),
3895 	DEVMETHOD(mmcbr_release_host,	rtsx_mmcbr_release_host),
3896 #endif /* !MMCCAM */
3897 
3898 #ifdef MMCCAM
3899 	/* MMCCAM interface */
3900 	DEVMETHOD(mmc_sim_get_tran_settings,	rtsx_get_tran_settings),
3901 	DEVMETHOD(mmc_sim_set_tran_settings,	rtsx_set_tran_settings),
3902 	DEVMETHOD(mmc_sim_cam_request,		rtsx_cam_request),
3903 #endif /* MMCCAM */
3904 
3905 	DEVMETHOD_END
3906 };
3907 
3908 DEFINE_CLASS_0(rtsx, rtsx_driver, rtsx_methods, sizeof(struct rtsx_softc));
3909 DRIVER_MODULE(rtsx, pci, rtsx_driver, NULL, NULL);
3910 #ifndef MMCCAM
3911 MMC_DECLARE_BRIDGE(rtsx);
3912 #endif /* !MMCCAM */
3913