1 // SPDX-License-Identifier: GPL-2.0
3 * NVIDIA Tegra xHCI host controller driver
5 * Copyright (C) 2014 NVIDIA Corporation
6 * Copyright (C) 2014 Google, Inc.
10 #include <linux/delay.h>
11 #include <linux/dma-mapping.h>
12 #include <linux/firmware.h>
13 #include <linux/interrupt.h>
14 #include <linux/iopoll.h>
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/of_device.h>
18 #include <linux/phy/phy.h>
19 #include <linux/phy/tegra/xusb.h>
20 #include <linux/platform_device.h>
22 #include <linux/pm_domain.h>
23 #include <linux/pm_runtime.h>
24 #include <linux/regulator/consumer.h>
25 #include <linux/reset.h>
26 #include <linux/slab.h>
27 #include <linux/usb/otg.h>
28 #include <linux/usb/phy.h>
29 #include <linux/usb/role.h>
30 #include <soc/tegra/pmc.h>
34 #define TEGRA_XHCI_SS_HIGH_SPEED 120000000
35 #define TEGRA_XHCI_SS_LOW_SPEED 12000000
37 /* FPCI CFG registers */
38 #define XUSB_CFG_1 0x004
39 #define XUSB_IO_SPACE_EN BIT(0)
40 #define XUSB_MEM_SPACE_EN BIT(1)
41 #define XUSB_BUS_MASTER_EN BIT(2)
42 #define XUSB_CFG_4 0x010
43 #define XUSB_BASE_ADDR_SHIFT 15
44 #define XUSB_BASE_ADDR_MASK 0x1ffff
45 #define XUSB_CFG_16 0x040
46 #define XUSB_CFG_24 0x060
47 #define XUSB_CFG_AXI_CFG 0x0f8
48 #define XUSB_CFG_ARU_C11_CSBRANGE 0x41c
49 #define XUSB_CFG_ARU_CONTEXT 0x43c
50 #define XUSB_CFG_ARU_CONTEXT_HS_PLS 0x478
51 #define XUSB_CFG_ARU_CONTEXT_FS_PLS 0x47c
52 #define XUSB_CFG_ARU_CONTEXT_HSFS_SPEED 0x480
53 #define XUSB_CFG_ARU_CONTEXT_HSFS_PP 0x484
54 #define XUSB_CFG_CSB_BASE_ADDR 0x800
56 /* FPCI mailbox registers */
57 /* XUSB_CFG_ARU_MBOX_CMD */
58 #define MBOX_DEST_FALC BIT(27)
59 #define MBOX_DEST_PME BIT(28)
60 #define MBOX_DEST_SMI BIT(29)
61 #define MBOX_DEST_XHCI BIT(30)
62 #define MBOX_INT_EN BIT(31)
63 /* XUSB_CFG_ARU_MBOX_DATA_IN and XUSB_CFG_ARU_MBOX_DATA_OUT */
64 #define CMD_DATA_SHIFT 0
65 #define CMD_DATA_MASK 0xffffff
66 #define CMD_TYPE_SHIFT 24
67 #define CMD_TYPE_MASK 0xff
68 /* XUSB_CFG_ARU_MBOX_OWNER */
69 #define MBOX_OWNER_NONE 0
70 #define MBOX_OWNER_FW 1
71 #define MBOX_OWNER_SW 2
72 #define XUSB_CFG_ARU_SMI_INTR 0x428
73 #define MBOX_SMI_INTR_FW_HANG BIT(1)
74 #define MBOX_SMI_INTR_EN BIT(3)
77 #define IPFS_XUSB_HOST_MSI_BAR_SZ_0 0x0c0
78 #define IPFS_XUSB_HOST_MSI_AXI_BAR_ST_0 0x0c4
79 #define IPFS_XUSB_HOST_MSI_FPCI_BAR_ST_0 0x0c8
80 #define IPFS_XUSB_HOST_MSI_VEC0_0 0x100
81 #define IPFS_XUSB_HOST_MSI_EN_VEC0_0 0x140
82 #define IPFS_XUSB_HOST_CONFIGURATION_0 0x180
83 #define IPFS_EN_FPCI BIT(0)
84 #define IPFS_XUSB_HOST_FPCI_ERROR_MASKS_0 0x184
85 #define IPFS_XUSB_HOST_INTR_MASK_0 0x188
86 #define IPFS_IP_INT_MASK BIT(16)
87 #define IPFS_XUSB_HOST_INTR_ENABLE_0 0x198
88 #define IPFS_XUSB_HOST_UFPCI_CONFIG_0 0x19c
89 #define IPFS_XUSB_HOST_CLKGATE_HYSTERESIS_0 0x1bc
90 #define IPFS_XUSB_HOST_MCCIF_FIFOCTRL_0 0x1dc
92 #define CSB_PAGE_SELECT_MASK 0x7fffff
93 #define CSB_PAGE_SELECT_SHIFT 9
94 #define CSB_PAGE_OFFSET_MASK 0x1ff
95 #define CSB_PAGE_SELECT(addr) ((addr) >> (CSB_PAGE_SELECT_SHIFT) & \
97 #define CSB_PAGE_OFFSET(addr) ((addr) & CSB_PAGE_OFFSET_MASK)
99 /* Falcon CSB registers */
100 #define XUSB_FALC_CPUCTL 0x100
101 #define CPUCTL_STARTCPU BIT(1)
102 #define CPUCTL_STATE_HALTED BIT(4)
103 #define CPUCTL_STATE_STOPPED BIT(5)
104 #define XUSB_FALC_BOOTVEC 0x104
105 #define XUSB_FALC_DMACTL 0x10c
106 #define XUSB_FALC_IMFILLRNG1 0x154
107 #define IMFILLRNG1_TAG_MASK 0xffff
108 #define IMFILLRNG1_TAG_LO_SHIFT 0
109 #define IMFILLRNG1_TAG_HI_SHIFT 16
110 #define XUSB_FALC_IMFILLCTL 0x158
112 /* MP CSB registers */
113 #define XUSB_CSB_MP_ILOAD_ATTR 0x101a00
114 #define XUSB_CSB_MP_ILOAD_BASE_LO 0x101a04
115 #define XUSB_CSB_MP_ILOAD_BASE_HI 0x101a08
116 #define XUSB_CSB_MP_L2IMEMOP_SIZE 0x101a10
117 #define L2IMEMOP_SIZE_SRC_OFFSET_SHIFT 8
118 #define L2IMEMOP_SIZE_SRC_OFFSET_MASK 0x3ff
119 #define L2IMEMOP_SIZE_SRC_COUNT_SHIFT 24
120 #define L2IMEMOP_SIZE_SRC_COUNT_MASK 0xff
121 #define XUSB_CSB_MP_L2IMEMOP_TRIG 0x101a14
122 #define L2IMEMOP_ACTION_SHIFT 24
123 #define L2IMEMOP_INVALIDATE_ALL (0x40 << L2IMEMOP_ACTION_SHIFT)
124 #define L2IMEMOP_LOAD_LOCKED_RESULT (0x11 << L2IMEMOP_ACTION_SHIFT)
125 #define XUSB_CSB_MEMPOOL_L2IMEMOP_RESULT 0x101a18
126 #define L2IMEMOP_RESULT_VLD BIT(31)
127 #define XUSB_CSB_MP_APMAP 0x10181c
128 #define APMAP_BOOTPATH BIT(31)
130 #define IMEM_BLOCK_SIZE 256
132 struct tegra_xusb_fw_header
{
133 __le32 boot_loadaddr_in_imem
;
134 __le32 boot_codedfi_offset
;
136 __le32 boot_codesize
;
138 __le16 reqphys_memsize
;
139 __le16 alloc_phys_memsize
;
140 __le32 rodata_img_offset
;
141 __le32 rodata_section_start
;
142 __le32 rodata_section_end
;
145 __le32 fwimg_created_time
;
146 __le32 imem_resident_start
;
147 __le32 imem_resident_end
;
148 __le32 idirect_start
;
150 __le32 l2_imem_start
;
155 __le32 phys_addr_log_buffer
;
156 __le32 total_log_entries
;
161 __le32 ss_low_power_entry_timeout
;
163 u8 padding
[139]; /* Pad to 256 bytes */
166 struct tegra_xusb_phy_type
{
171 struct tegra_xusb_mbox_regs
{
178 struct tegra_xusb_context_soc
{
180 const unsigned int *offsets
;
181 unsigned int num_offsets
;
185 const unsigned int *offsets
;
186 unsigned int num_offsets
;
190 struct tegra_xusb_soc
{
191 const char *firmware
;
192 const char * const *supply_names
;
193 unsigned int num_supplies
;
194 const struct tegra_xusb_phy_type
*phy_types
;
195 unsigned int num_types
;
196 const struct tegra_xusb_context_soc
*context
;
202 } usb2
, ulpi
, hsic
, usb3
;
205 struct tegra_xusb_mbox_regs mbox
;
213 struct tegra_xusb_context
{
228 void __iomem
*ipfs_base
;
229 void __iomem
*fpci_base
;
231 const struct tegra_xusb_soc
*soc
;
233 struct regulator_bulk_data
*supplies
;
235 struct tegra_xusb_padctl
*padctl
;
237 struct clk
*host_clk
;
238 struct clk
*falcon_clk
;
240 struct clk
*ss_src_clk
;
241 struct clk
*hs_src_clk
;
242 struct clk
*fs_src_clk
;
243 struct clk
*pll_u_480m
;
247 struct reset_control
*host_rst
;
248 struct reset_control
*ss_rst
;
250 struct device
*genpd_dev_host
;
251 struct device
*genpd_dev_ss
;
252 struct device_link
*genpd_dl_host
;
253 struct device_link
*genpd_dl_ss
;
256 unsigned int num_phys
;
258 struct usb_phy
**usbphy
;
259 unsigned int num_usb_phys
;
263 struct notifier_block id_nb
;
264 struct work_struct id_work
;
266 /* Firmware loading related */
273 struct tegra_xusb_context context
;
276 static struct hc_driver __read_mostly tegra_xhci_hc_driver
;
278 static inline u32
fpci_readl(struct tegra_xusb
*tegra
, unsigned int offset
)
280 return readl(tegra
->fpci_base
+ offset
);
283 static inline void fpci_writel(struct tegra_xusb
*tegra
, u32 value
,
286 writel(value
, tegra
->fpci_base
+ offset
);
289 static inline u32
ipfs_readl(struct tegra_xusb
*tegra
, unsigned int offset
)
291 return readl(tegra
->ipfs_base
+ offset
);
294 static inline void ipfs_writel(struct tegra_xusb
*tegra
, u32 value
,
297 writel(value
, tegra
->ipfs_base
+ offset
);
300 static u32
csb_readl(struct tegra_xusb
*tegra
, unsigned int offset
)
302 u32 page
= CSB_PAGE_SELECT(offset
);
303 u32 ofs
= CSB_PAGE_OFFSET(offset
);
305 fpci_writel(tegra
, page
, XUSB_CFG_ARU_C11_CSBRANGE
);
307 return fpci_readl(tegra
, XUSB_CFG_CSB_BASE_ADDR
+ ofs
);
310 static void csb_writel(struct tegra_xusb
*tegra
, u32 value
,
313 u32 page
= CSB_PAGE_SELECT(offset
);
314 u32 ofs
= CSB_PAGE_OFFSET(offset
);
316 fpci_writel(tegra
, page
, XUSB_CFG_ARU_C11_CSBRANGE
);
317 fpci_writel(tegra
, value
, XUSB_CFG_CSB_BASE_ADDR
+ ofs
);
320 static int tegra_xusb_set_ss_clk(struct tegra_xusb
*tegra
,
323 unsigned long new_parent_rate
, old_parent_rate
;
324 struct clk
*clk
= tegra
->ss_src_clk
;
328 if (clk_get_rate(clk
) == rate
)
332 case TEGRA_XHCI_SS_HIGH_SPEED
:
334 * Reparent to PLLU_480M. Set divider first to avoid
337 old_parent_rate
= clk_get_rate(clk_get_parent(clk
));
338 new_parent_rate
= clk_get_rate(tegra
->pll_u_480m
);
339 div
= new_parent_rate
/ rate
;
341 err
= clk_set_rate(clk
, old_parent_rate
/ div
);
345 err
= clk_set_parent(clk
, tegra
->pll_u_480m
);
350 * The rate should already be correct, but set it again just
353 err
= clk_set_rate(clk
, rate
);
359 case TEGRA_XHCI_SS_LOW_SPEED
:
360 /* Reparent to CLK_M */
361 err
= clk_set_parent(clk
, tegra
->clk_m
);
365 err
= clk_set_rate(clk
, rate
);
372 dev_err(tegra
->dev
, "Invalid SS rate: %lu Hz\n", rate
);
376 if (clk_get_rate(clk
) != rate
) {
377 dev_err(tegra
->dev
, "SS clock doesn't match requested rate\n");
384 static unsigned long extract_field(u32 value
, unsigned int start
,
387 return (value
>> start
) & ((1 << count
) - 1);
390 /* Command requests from the firmware */
391 enum tegra_xusb_mbox_cmd
{
392 MBOX_CMD_MSG_ENABLED
= 1,
393 MBOX_CMD_INC_FALC_CLOCK
,
394 MBOX_CMD_DEC_FALC_CLOCK
,
395 MBOX_CMD_INC_SSPI_CLOCK
,
396 MBOX_CMD_DEC_SSPI_CLOCK
,
397 MBOX_CMD_SET_BW
, /* no ACK/NAK required */
398 MBOX_CMD_SET_SS_PWR_GATING
,
399 MBOX_CMD_SET_SS_PWR_UNGATING
,
400 MBOX_CMD_SAVE_DFE_CTLE_CTX
,
401 MBOX_CMD_AIRPLANE_MODE_ENABLED
, /* unused */
402 MBOX_CMD_AIRPLANE_MODE_DISABLED
, /* unused */
403 MBOX_CMD_START_HSIC_IDLE
,
404 MBOX_CMD_STOP_HSIC_IDLE
,
405 MBOX_CMD_DBC_WAKE_STACK
, /* unused */
406 MBOX_CMD_HSIC_PRETEND_CONNECT
,
408 MBOX_CMD_DISABLE_SS_LFPS_DETECTION
,
409 MBOX_CMD_ENABLE_SS_LFPS_DETECTION
,
413 /* Response message to above commands */
418 struct tegra_xusb_mbox_msg
{
423 static inline u32
tegra_xusb_mbox_pack(const struct tegra_xusb_mbox_msg
*msg
)
425 return (msg
->cmd
& CMD_TYPE_MASK
) << CMD_TYPE_SHIFT
|
426 (msg
->data
& CMD_DATA_MASK
) << CMD_DATA_SHIFT
;
428 static inline void tegra_xusb_mbox_unpack(struct tegra_xusb_mbox_msg
*msg
,
431 msg
->cmd
= (value
>> CMD_TYPE_SHIFT
) & CMD_TYPE_MASK
;
432 msg
->data
= (value
>> CMD_DATA_SHIFT
) & CMD_DATA_MASK
;
435 static bool tegra_xusb_mbox_cmd_requires_ack(enum tegra_xusb_mbox_cmd cmd
)
438 case MBOX_CMD_SET_BW
:
448 static int tegra_xusb_mbox_send(struct tegra_xusb
*tegra
,
449 const struct tegra_xusb_mbox_msg
*msg
)
451 bool wait_for_idle
= false;
455 * Acquire the mailbox. The firmware still owns the mailbox for
458 if (!(msg
->cmd
== MBOX_CMD_ACK
|| msg
->cmd
== MBOX_CMD_NAK
)) {
459 value
= fpci_readl(tegra
, tegra
->soc
->mbox
.owner
);
460 if (value
!= MBOX_OWNER_NONE
) {
461 dev_err(tegra
->dev
, "mailbox is busy\n");
465 fpci_writel(tegra
, MBOX_OWNER_SW
, tegra
->soc
->mbox
.owner
);
467 value
= fpci_readl(tegra
, tegra
->soc
->mbox
.owner
);
468 if (value
!= MBOX_OWNER_SW
) {
469 dev_err(tegra
->dev
, "failed to acquire mailbox\n");
473 wait_for_idle
= true;
476 value
= tegra_xusb_mbox_pack(msg
);
477 fpci_writel(tegra
, value
, tegra
->soc
->mbox
.data_in
);
479 value
= fpci_readl(tegra
, tegra
->soc
->mbox
.cmd
);
480 value
|= MBOX_INT_EN
| MBOX_DEST_FALC
;
481 fpci_writel(tegra
, value
, tegra
->soc
->mbox
.cmd
);
484 unsigned long timeout
= jiffies
+ msecs_to_jiffies(250);
486 while (time_before(jiffies
, timeout
)) {
487 value
= fpci_readl(tegra
, tegra
->soc
->mbox
.owner
);
488 if (value
== MBOX_OWNER_NONE
)
491 usleep_range(10, 20);
494 if (time_after(jiffies
, timeout
))
495 value
= fpci_readl(tegra
, tegra
->soc
->mbox
.owner
);
497 if (value
!= MBOX_OWNER_NONE
)
504 static irqreturn_t
tegra_xusb_mbox_irq(int irq
, void *data
)
506 struct tegra_xusb
*tegra
= data
;
509 /* clear mailbox interrupts */
510 value
= fpci_readl(tegra
, XUSB_CFG_ARU_SMI_INTR
);
511 fpci_writel(tegra
, value
, XUSB_CFG_ARU_SMI_INTR
);
513 if (value
& MBOX_SMI_INTR_FW_HANG
)
514 dev_err(tegra
->dev
, "controller firmware hang\n");
516 return IRQ_WAKE_THREAD
;
519 static void tegra_xusb_mbox_handle(struct tegra_xusb
*tegra
,
520 const struct tegra_xusb_mbox_msg
*msg
)
522 struct tegra_xusb_padctl
*padctl
= tegra
->padctl
;
523 const struct tegra_xusb_soc
*soc
= tegra
->soc
;
524 struct device
*dev
= tegra
->dev
;
525 struct tegra_xusb_mbox_msg rsp
;
531 memset(&rsp
, 0, sizeof(rsp
));
534 case MBOX_CMD_INC_FALC_CLOCK
:
535 case MBOX_CMD_DEC_FALC_CLOCK
:
536 rsp
.data
= clk_get_rate(tegra
->falcon_clk
) / 1000;
537 if (rsp
.data
!= msg
->data
)
538 rsp
.cmd
= MBOX_CMD_NAK
;
540 rsp
.cmd
= MBOX_CMD_ACK
;
544 case MBOX_CMD_INC_SSPI_CLOCK
:
545 case MBOX_CMD_DEC_SSPI_CLOCK
:
546 if (tegra
->soc
->scale_ss_clock
) {
547 err
= tegra_xusb_set_ss_clk(tegra
, msg
->data
* 1000);
549 rsp
.cmd
= MBOX_CMD_NAK
;
551 rsp
.cmd
= MBOX_CMD_ACK
;
553 rsp
.data
= clk_get_rate(tegra
->ss_src_clk
) / 1000;
555 rsp
.cmd
= MBOX_CMD_ACK
;
556 rsp
.data
= msg
->data
;
561 case MBOX_CMD_SET_BW
:
563 * TODO: Request bandwidth once EMC scaling is supported.
564 * Ignore for now since ACK/NAK is not required for SET_BW
569 case MBOX_CMD_SAVE_DFE_CTLE_CTX
:
570 err
= tegra_xusb_padctl_usb3_save_context(padctl
, msg
->data
);
572 dev_err(dev
, "failed to save context for USB3#%u: %d\n",
574 rsp
.cmd
= MBOX_CMD_NAK
;
576 rsp
.cmd
= MBOX_CMD_ACK
;
579 rsp
.data
= msg
->data
;
582 case MBOX_CMD_START_HSIC_IDLE
:
583 case MBOX_CMD_STOP_HSIC_IDLE
:
584 if (msg
->cmd
== MBOX_CMD_STOP_HSIC_IDLE
)
589 mask
= extract_field(msg
->data
, 1 + soc
->ports
.hsic
.offset
,
590 soc
->ports
.hsic
.count
);
592 for_each_set_bit(port
, &mask
, 32) {
593 err
= tegra_xusb_padctl_hsic_set_idle(padctl
, port
,
600 dev_err(dev
, "failed to set HSIC#%u %s: %d\n", port
,
601 idle
? "idle" : "busy", err
);
602 rsp
.cmd
= MBOX_CMD_NAK
;
604 rsp
.cmd
= MBOX_CMD_ACK
;
607 rsp
.data
= msg
->data
;
610 case MBOX_CMD_DISABLE_SS_LFPS_DETECTION
:
611 case MBOX_CMD_ENABLE_SS_LFPS_DETECTION
:
612 if (msg
->cmd
== MBOX_CMD_DISABLE_SS_LFPS_DETECTION
)
617 mask
= extract_field(msg
->data
, 1 + soc
->ports
.usb3
.offset
,
618 soc
->ports
.usb3
.count
);
620 for_each_set_bit(port
, &mask
, soc
->ports
.usb3
.count
) {
621 err
= tegra_xusb_padctl_usb3_set_lfps_detect(padctl
,
630 "failed to %s LFPS detection on USB3#%u: %d\n",
631 enable
? "enable" : "disable", port
, err
);
632 rsp
.cmd
= MBOX_CMD_NAK
;
634 rsp
.cmd
= MBOX_CMD_ACK
;
637 rsp
.data
= msg
->data
;
641 dev_warn(dev
, "unknown message: %#x\n", msg
->cmd
);
646 const char *cmd
= (rsp
.cmd
== MBOX_CMD_ACK
) ? "ACK" : "NAK";
648 err
= tegra_xusb_mbox_send(tegra
, &rsp
);
650 dev_err(dev
, "failed to send %s: %d\n", cmd
, err
);
654 static irqreturn_t
tegra_xusb_mbox_thread(int irq
, void *data
)
656 struct tegra_xusb
*tegra
= data
;
657 struct tegra_xusb_mbox_msg msg
;
660 mutex_lock(&tegra
->lock
);
662 value
= fpci_readl(tegra
, tegra
->soc
->mbox
.data_out
);
663 tegra_xusb_mbox_unpack(&msg
, value
);
665 value
= fpci_readl(tegra
, tegra
->soc
->mbox
.cmd
);
666 value
&= ~MBOX_DEST_SMI
;
667 fpci_writel(tegra
, value
, tegra
->soc
->mbox
.cmd
);
669 /* clear mailbox owner if no ACK/NAK is required */
670 if (!tegra_xusb_mbox_cmd_requires_ack(msg
.cmd
))
671 fpci_writel(tegra
, MBOX_OWNER_NONE
, tegra
->soc
->mbox
.owner
);
673 tegra_xusb_mbox_handle(tegra
, &msg
);
675 mutex_unlock(&tegra
->lock
);
679 static void tegra_xusb_config(struct tegra_xusb
*tegra
)
681 u32 regs
= tegra
->hcd
->rsrc_start
;
684 if (tegra
->soc
->has_ipfs
) {
685 value
= ipfs_readl(tegra
, IPFS_XUSB_HOST_CONFIGURATION_0
);
686 value
|= IPFS_EN_FPCI
;
687 ipfs_writel(tegra
, value
, IPFS_XUSB_HOST_CONFIGURATION_0
);
689 usleep_range(10, 20);
692 /* Program BAR0 space */
693 value
= fpci_readl(tegra
, XUSB_CFG_4
);
694 value
&= ~(XUSB_BASE_ADDR_MASK
<< XUSB_BASE_ADDR_SHIFT
);
695 value
|= regs
& (XUSB_BASE_ADDR_MASK
<< XUSB_BASE_ADDR_SHIFT
);
696 fpci_writel(tegra
, value
, XUSB_CFG_4
);
698 usleep_range(100, 200);
700 /* Enable bus master */
701 value
= fpci_readl(tegra
, XUSB_CFG_1
);
702 value
|= XUSB_IO_SPACE_EN
| XUSB_MEM_SPACE_EN
| XUSB_BUS_MASTER_EN
;
703 fpci_writel(tegra
, value
, XUSB_CFG_1
);
705 if (tegra
->soc
->has_ipfs
) {
706 /* Enable interrupt assertion */
707 value
= ipfs_readl(tegra
, IPFS_XUSB_HOST_INTR_MASK_0
);
708 value
|= IPFS_IP_INT_MASK
;
709 ipfs_writel(tegra
, value
, IPFS_XUSB_HOST_INTR_MASK_0
);
712 ipfs_writel(tegra
, 0x80, IPFS_XUSB_HOST_CLKGATE_HYSTERESIS_0
);
716 static int tegra_xusb_clk_enable(struct tegra_xusb
*tegra
)
720 err
= clk_prepare_enable(tegra
->pll_e
);
724 err
= clk_prepare_enable(tegra
->host_clk
);
728 err
= clk_prepare_enable(tegra
->ss_clk
);
732 err
= clk_prepare_enable(tegra
->falcon_clk
);
736 err
= clk_prepare_enable(tegra
->fs_src_clk
);
740 err
= clk_prepare_enable(tegra
->hs_src_clk
);
744 if (tegra
->soc
->scale_ss_clock
) {
745 err
= tegra_xusb_set_ss_clk(tegra
, TEGRA_XHCI_SS_HIGH_SPEED
);
753 clk_disable_unprepare(tegra
->hs_src_clk
);
755 clk_disable_unprepare(tegra
->fs_src_clk
);
757 clk_disable_unprepare(tegra
->falcon_clk
);
759 clk_disable_unprepare(tegra
->ss_clk
);
761 clk_disable_unprepare(tegra
->host_clk
);
763 clk_disable_unprepare(tegra
->pll_e
);
767 static void tegra_xusb_clk_disable(struct tegra_xusb
*tegra
)
769 clk_disable_unprepare(tegra
->pll_e
);
770 clk_disable_unprepare(tegra
->host_clk
);
771 clk_disable_unprepare(tegra
->ss_clk
);
772 clk_disable_unprepare(tegra
->falcon_clk
);
773 clk_disable_unprepare(tegra
->fs_src_clk
);
774 clk_disable_unprepare(tegra
->hs_src_clk
);
777 static int tegra_xusb_phy_enable(struct tegra_xusb
*tegra
)
782 for (i
= 0; i
< tegra
->num_phys
; i
++) {
783 err
= phy_init(tegra
->phys
[i
]);
787 err
= phy_power_on(tegra
->phys
[i
]);
789 phy_exit(tegra
->phys
[i
]);
798 phy_power_off(tegra
->phys
[i
]);
799 phy_exit(tegra
->phys
[i
]);
805 static void tegra_xusb_phy_disable(struct tegra_xusb
*tegra
)
809 for (i
= 0; i
< tegra
->num_phys
; i
++) {
810 phy_power_off(tegra
->phys
[i
]);
811 phy_exit(tegra
->phys
[i
]);
815 static int tegra_xusb_runtime_suspend(struct device
*dev
)
817 struct tegra_xusb
*tegra
= dev_get_drvdata(dev
);
819 regulator_bulk_disable(tegra
->soc
->num_supplies
, tegra
->supplies
);
820 tegra_xusb_clk_disable(tegra
);
825 static int tegra_xusb_runtime_resume(struct device
*dev
)
827 struct tegra_xusb
*tegra
= dev_get_drvdata(dev
);
830 err
= tegra_xusb_clk_enable(tegra
);
832 dev_err(dev
, "failed to enable clocks: %d\n", err
);
836 err
= regulator_bulk_enable(tegra
->soc
->num_supplies
, tegra
->supplies
);
838 dev_err(dev
, "failed to enable regulators: %d\n", err
);
845 tegra_xusb_clk_disable(tegra
);
849 #ifdef CONFIG_PM_SLEEP
850 static int tegra_xusb_init_context(struct tegra_xusb
*tegra
)
852 const struct tegra_xusb_context_soc
*soc
= tegra
->soc
->context
;
854 tegra
->context
.ipfs
= devm_kcalloc(tegra
->dev
, soc
->ipfs
.num_offsets
,
855 sizeof(u32
), GFP_KERNEL
);
856 if (!tegra
->context
.ipfs
)
859 tegra
->context
.fpci
= devm_kcalloc(tegra
->dev
, soc
->fpci
.num_offsets
,
860 sizeof(u32
), GFP_KERNEL
);
861 if (!tegra
->context
.fpci
)
867 static inline int tegra_xusb_init_context(struct tegra_xusb
*tegra
)
873 static int tegra_xusb_request_firmware(struct tegra_xusb
*tegra
)
875 struct tegra_xusb_fw_header
*header
;
876 const struct firmware
*fw
;
879 err
= request_firmware(&fw
, tegra
->soc
->firmware
, tegra
->dev
);
881 dev_err(tegra
->dev
, "failed to request firmware: %d\n", err
);
885 /* Load Falcon controller with its firmware. */
886 header
= (struct tegra_xusb_fw_header
*)fw
->data
;
887 tegra
->fw
.size
= le32_to_cpu(header
->fwimg_len
);
889 tegra
->fw
.virt
= dma_alloc_coherent(tegra
->dev
, tegra
->fw
.size
,
890 &tegra
->fw
.phys
, GFP_KERNEL
);
891 if (!tegra
->fw
.virt
) {
892 dev_err(tegra
->dev
, "failed to allocate memory for firmware\n");
893 release_firmware(fw
);
897 header
= (struct tegra_xusb_fw_header
*)tegra
->fw
.virt
;
898 memcpy(tegra
->fw
.virt
, fw
->data
, tegra
->fw
.size
);
899 release_firmware(fw
);
904 static int tegra_xusb_load_firmware(struct tegra_xusb
*tegra
)
906 unsigned int code_tag_blocks
, code_size_blocks
, code_blocks
;
907 struct xhci_cap_regs __iomem
*cap
= tegra
->regs
;
908 struct tegra_xusb_fw_header
*header
;
909 struct device
*dev
= tegra
->dev
;
910 struct xhci_op_regs __iomem
*op
;
911 unsigned long timeout
;
918 header
= (struct tegra_xusb_fw_header
*)tegra
->fw
.virt
;
919 op
= tegra
->regs
+ HC_LENGTH(readl(&cap
->hc_capbase
));
921 if (csb_readl(tegra
, XUSB_CSB_MP_ILOAD_BASE_LO
) != 0) {
922 dev_info(dev
, "Firmware already loaded, Falcon state %#x\n",
923 csb_readl(tegra
, XUSB_FALC_CPUCTL
));
927 /* Program the size of DFI into ILOAD_ATTR. */
928 csb_writel(tegra
, tegra
->fw
.size
, XUSB_CSB_MP_ILOAD_ATTR
);
931 * Boot code of the firmware reads the ILOAD_BASE registers
932 * to get to the start of the DFI in system memory.
934 address
= tegra
->fw
.phys
+ sizeof(*header
);
935 csb_writel(tegra
, address
>> 32, XUSB_CSB_MP_ILOAD_BASE_HI
);
936 csb_writel(tegra
, address
, XUSB_CSB_MP_ILOAD_BASE_LO
);
938 /* Set BOOTPATH to 1 in APMAP. */
939 csb_writel(tegra
, APMAP_BOOTPATH
, XUSB_CSB_MP_APMAP
);
941 /* Invalidate L2IMEM. */
942 csb_writel(tegra
, L2IMEMOP_INVALIDATE_ALL
, XUSB_CSB_MP_L2IMEMOP_TRIG
);
945 * Initiate fetch of bootcode from system memory into L2IMEM.
946 * Program bootcode location and size in system memory.
948 code_tag_blocks
= DIV_ROUND_UP(le32_to_cpu(header
->boot_codetag
),
950 code_size_blocks
= DIV_ROUND_UP(le32_to_cpu(header
->boot_codesize
),
952 code_blocks
= code_tag_blocks
+ code_size_blocks
;
954 value
= ((code_tag_blocks
& L2IMEMOP_SIZE_SRC_OFFSET_MASK
) <<
955 L2IMEMOP_SIZE_SRC_OFFSET_SHIFT
) |
956 ((code_size_blocks
& L2IMEMOP_SIZE_SRC_COUNT_MASK
) <<
957 L2IMEMOP_SIZE_SRC_COUNT_SHIFT
);
958 csb_writel(tegra
, value
, XUSB_CSB_MP_L2IMEMOP_SIZE
);
960 /* Trigger L2IMEM load operation. */
961 csb_writel(tegra
, L2IMEMOP_LOAD_LOCKED_RESULT
,
962 XUSB_CSB_MP_L2IMEMOP_TRIG
);
964 /* Setup Falcon auto-fill. */
965 csb_writel(tegra
, code_size_blocks
, XUSB_FALC_IMFILLCTL
);
967 value
= ((code_tag_blocks
& IMFILLRNG1_TAG_MASK
) <<
968 IMFILLRNG1_TAG_LO_SHIFT
) |
969 ((code_blocks
& IMFILLRNG1_TAG_MASK
) <<
970 IMFILLRNG1_TAG_HI_SHIFT
);
971 csb_writel(tegra
, value
, XUSB_FALC_IMFILLRNG1
);
973 csb_writel(tegra
, 0, XUSB_FALC_DMACTL
);
975 /* wait for RESULT_VLD to get set */
976 #define tegra_csb_readl(offset) csb_readl(tegra, offset)
977 err
= readx_poll_timeout(tegra_csb_readl
,
978 XUSB_CSB_MEMPOOL_L2IMEMOP_RESULT
, value
,
979 value
& L2IMEMOP_RESULT_VLD
, 100, 10000);
981 dev_err(dev
, "DMA controller not ready %#010x\n", value
);
984 #undef tegra_csb_readl
986 csb_writel(tegra
, le32_to_cpu(header
->boot_codetag
),
989 /* Boot Falcon CPU and wait for USBSTS_CNR to get cleared. */
990 csb_writel(tegra
, CPUCTL_STARTCPU
, XUSB_FALC_CPUCTL
);
992 timeout
= jiffies
+ msecs_to_jiffies(200);
995 value
= readl(&op
->status
);
996 if ((value
& STS_CNR
) == 0)
999 usleep_range(1000, 2000);
1000 } while (time_is_after_jiffies(timeout
));
1002 value
= readl(&op
->status
);
1003 if (value
& STS_CNR
) {
1004 value
= csb_readl(tegra
, XUSB_FALC_CPUCTL
);
1005 dev_err(dev
, "XHCI controller not read: %#010x\n", value
);
1009 timestamp
= le32_to_cpu(header
->fwimg_created_time
);
1010 time64_to_tm(timestamp
, 0, &time
);
1012 dev_info(dev
, "Firmware timestamp: %ld-%02d-%02d %02d:%02d:%02d UTC\n",
1013 time
.tm_year
+ 1900, time
.tm_mon
+ 1, time
.tm_mday
,
1014 time
.tm_hour
, time
.tm_min
, time
.tm_sec
);
1019 static void tegra_xusb_powerdomain_remove(struct device
*dev
,
1020 struct tegra_xusb
*tegra
)
1022 if (tegra
->genpd_dl_ss
)
1023 device_link_del(tegra
->genpd_dl_ss
);
1024 if (tegra
->genpd_dl_host
)
1025 device_link_del(tegra
->genpd_dl_host
);
1026 if (!IS_ERR_OR_NULL(tegra
->genpd_dev_ss
))
1027 dev_pm_domain_detach(tegra
->genpd_dev_ss
, true);
1028 if (!IS_ERR_OR_NULL(tegra
->genpd_dev_host
))
1029 dev_pm_domain_detach(tegra
->genpd_dev_host
, true);
1032 static int tegra_xusb_powerdomain_init(struct device
*dev
,
1033 struct tegra_xusb
*tegra
)
1037 tegra
->genpd_dev_host
= dev_pm_domain_attach_by_name(dev
, "xusb_host");
1038 if (IS_ERR(tegra
->genpd_dev_host
)) {
1039 err
= PTR_ERR(tegra
->genpd_dev_host
);
1040 dev_err(dev
, "failed to get host pm-domain: %d\n", err
);
1044 tegra
->genpd_dev_ss
= dev_pm_domain_attach_by_name(dev
, "xusb_ss");
1045 if (IS_ERR(tegra
->genpd_dev_ss
)) {
1046 err
= PTR_ERR(tegra
->genpd_dev_ss
);
1047 dev_err(dev
, "failed to get superspeed pm-domain: %d\n", err
);
1051 tegra
->genpd_dl_host
= device_link_add(dev
, tegra
->genpd_dev_host
,
1052 DL_FLAG_PM_RUNTIME
|
1054 if (!tegra
->genpd_dl_host
) {
1055 dev_err(dev
, "adding host device link failed!\n");
1059 tegra
->genpd_dl_ss
= device_link_add(dev
, tegra
->genpd_dev_ss
,
1060 DL_FLAG_PM_RUNTIME
|
1062 if (!tegra
->genpd_dl_ss
) {
1063 dev_err(dev
, "adding superspeed device link failed!\n");
1070 static int __tegra_xusb_enable_firmware_messages(struct tegra_xusb
*tegra
)
1072 struct tegra_xusb_mbox_msg msg
;
1075 /* Enable firmware messages from controller. */
1076 msg
.cmd
= MBOX_CMD_MSG_ENABLED
;
1079 err
= tegra_xusb_mbox_send(tegra
, &msg
);
1081 dev_err(tegra
->dev
, "failed to enable messages: %d\n", err
);
1086 static int tegra_xusb_enable_firmware_messages(struct tegra_xusb
*tegra
)
1090 mutex_lock(&tegra
->lock
);
1091 err
= __tegra_xusb_enable_firmware_messages(tegra
);
1092 mutex_unlock(&tegra
->lock
);
1097 static void tegra_xhci_set_port_power(struct tegra_xusb
*tegra
, bool main
,
1100 struct xhci_hcd
*xhci
= hcd_to_xhci(tegra
->hcd
);
1101 struct usb_hcd
*hcd
= main
? xhci
->main_hcd
: xhci
->shared_hcd
;
1102 unsigned int wait
= (!main
&& !set
) ? 1000 : 10;
1103 u16 typeReq
= set
? SetPortFeature
: ClearPortFeature
;
1104 u16 wIndex
= main
? tegra
->otg_usb2_port
+ 1 : tegra
->otg_usb3_port
+ 1;
1106 u32 stat_power
= main
? USB_PORT_STAT_POWER
: USB_SS_PORT_STAT_POWER
;
1107 u32 status_val
= set
? stat_power
: 0;
1109 dev_dbg(tegra
->dev
, "%s():%s %s port power\n", __func__
,
1110 set
? "set" : "clear", main
? "HS" : "SS");
1112 hcd
->driver
->hub_control(hcd
, typeReq
, USB_PORT_FEAT_POWER
, wIndex
,
1116 tegra_xhci_hc_driver
.hub_control(hcd
, GetPortStatus
, 0, wIndex
,
1117 (char *) &status
, sizeof(status
));
1118 if (status_val
== (status
& stat_power
))
1122 usleep_range(600, 700);
1124 usleep_range(10, 20);
1125 } while (--wait
> 0);
1127 if (status_val
!= (status
& stat_power
))
1128 dev_info(tegra
->dev
, "failed to %s %s PP %d\n",
1129 set
? "set" : "clear",
1130 main
? "HS" : "SS", status
);
1133 static struct phy
*tegra_xusb_get_phy(struct tegra_xusb
*tegra
, char *name
,
1136 unsigned int i
, phy_count
= 0;
1138 for (i
= 0; i
< tegra
->soc
->num_types
; i
++) {
1139 if (!strncmp(tegra
->soc
->phy_types
[i
].name
, name
,
1141 return tegra
->phys
[phy_count
+port
];
1143 phy_count
+= tegra
->soc
->phy_types
[i
].num
;
1149 static void tegra_xhci_id_work(struct work_struct
*work
)
1151 struct tegra_xusb
*tegra
= container_of(work
, struct tegra_xusb
,
1153 struct xhci_hcd
*xhci
= hcd_to_xhci(tegra
->hcd
);
1154 struct tegra_xusb_mbox_msg msg
;
1155 struct phy
*phy
= tegra_xusb_get_phy(tegra
, "usb2",
1156 tegra
->otg_usb2_port
);
1160 dev_dbg(tegra
->dev
, "host mode %s\n", tegra
->host_mode
? "on" : "off");
1162 mutex_lock(&tegra
->lock
);
1164 if (tegra
->host_mode
)
1165 phy_set_mode_ext(phy
, PHY_MODE_USB_OTG
, USB_ROLE_HOST
);
1167 phy_set_mode_ext(phy
, PHY_MODE_USB_OTG
, USB_ROLE_NONE
);
1169 mutex_unlock(&tegra
->lock
);
1171 if (tegra
->host_mode
) {
1172 /* switch to host mode */
1173 if (tegra
->otg_usb3_port
>= 0) {
1174 if (tegra
->soc
->otg_reset_sspi
) {
1176 tegra_xhci_hc_driver
.hub_control(
1177 xhci
->shared_hcd
, GetPortStatus
,
1178 0, tegra
->otg_usb3_port
+1,
1179 (char *) &status
, sizeof(status
));
1180 if (status
& USB_SS_PORT_STAT_POWER
)
1181 tegra_xhci_set_port_power(tegra
, false,
1184 /* reset OTG port SSPI */
1185 msg
.cmd
= MBOX_CMD_RESET_SSPI
;
1186 msg
.data
= tegra
->otg_usb3_port
+1;
1188 ret
= tegra_xusb_mbox_send(tegra
, &msg
);
1190 dev_info(tegra
->dev
,
1191 "failed to RESET_SSPI %d\n",
1196 tegra_xhci_set_port_power(tegra
, false, true);
1199 tegra_xhci_set_port_power(tegra
, true, true);
1202 if (tegra
->otg_usb3_port
>= 0)
1203 tegra_xhci_set_port_power(tegra
, false, false);
1205 tegra_xhci_set_port_power(tegra
, true, false);
1209 static int tegra_xusb_get_usb2_port(struct tegra_xusb
*tegra
,
1210 struct usb_phy
*usbphy
)
1214 for (i
= 0; i
< tegra
->num_usb_phys
; i
++) {
1215 if (tegra
->usbphy
[i
] && usbphy
== tegra
->usbphy
[i
])
1222 static int tegra_xhci_id_notify(struct notifier_block
*nb
,
1223 unsigned long action
, void *data
)
1225 struct tegra_xusb
*tegra
= container_of(nb
, struct tegra_xusb
,
1227 struct usb_phy
*usbphy
= (struct usb_phy
*)data
;
1229 dev_dbg(tegra
->dev
, "%s(): action is %d", __func__
, usbphy
->last_event
);
1231 if ((tegra
->host_mode
&& usbphy
->last_event
== USB_EVENT_ID
) ||
1232 (!tegra
->host_mode
&& usbphy
->last_event
!= USB_EVENT_ID
)) {
1233 dev_dbg(tegra
->dev
, "Same role(%d) received. Ignore",
1238 tegra
->otg_usb2_port
= tegra_xusb_get_usb2_port(tegra
, usbphy
);
1239 tegra
->otg_usb3_port
= tegra_xusb_padctl_get_usb3_companion(
1241 tegra
->otg_usb2_port
);
1243 tegra
->host_mode
= (usbphy
->last_event
== USB_EVENT_ID
) ? true : false;
1245 schedule_work(&tegra
->id_work
);
1250 static int tegra_xusb_init_usb_phy(struct tegra_xusb
*tegra
)
1254 tegra
->usbphy
= devm_kcalloc(tegra
->dev
, tegra
->num_usb_phys
,
1255 sizeof(*tegra
->usbphy
), GFP_KERNEL
);
1259 INIT_WORK(&tegra
->id_work
, tegra_xhci_id_work
);
1260 tegra
->id_nb
.notifier_call
= tegra_xhci_id_notify
;
1261 tegra
->otg_usb2_port
= -EINVAL
;
1262 tegra
->otg_usb3_port
= -EINVAL
;
1264 for (i
= 0; i
< tegra
->num_usb_phys
; i
++) {
1265 struct phy
*phy
= tegra_xusb_get_phy(tegra
, "usb2", i
);
1270 tegra
->usbphy
[i
] = devm_usb_get_phy_by_node(tegra
->dev
,
1273 if (!IS_ERR(tegra
->usbphy
[i
])) {
1274 dev_dbg(tegra
->dev
, "usbphy-%d registered", i
);
1275 otg_set_host(tegra
->usbphy
[i
]->otg
, &tegra
->hcd
->self
);
1278 * usb-phy is optional, continue if its not available.
1280 tegra
->usbphy
[i
] = NULL
;
1287 static void tegra_xusb_deinit_usb_phy(struct tegra_xusb
*tegra
)
1291 cancel_work_sync(&tegra
->id_work
);
1293 for (i
= 0; i
< tegra
->num_usb_phys
; i
++)
1294 if (tegra
->usbphy
[i
])
1295 otg_set_host(tegra
->usbphy
[i
]->otg
, NULL
);
1298 static int tegra_xusb_probe(struct platform_device
*pdev
)
1300 struct tegra_xusb
*tegra
;
1301 struct resource
*regs
;
1302 struct xhci_hcd
*xhci
;
1303 unsigned int i
, j
, k
;
1307 BUILD_BUG_ON(sizeof(struct tegra_xusb_fw_header
) != 256);
1309 tegra
= devm_kzalloc(&pdev
->dev
, sizeof(*tegra
), GFP_KERNEL
);
1313 tegra
->soc
= of_device_get_match_data(&pdev
->dev
);
1314 mutex_init(&tegra
->lock
);
1315 tegra
->dev
= &pdev
->dev
;
1317 err
= tegra_xusb_init_context(tegra
);
1321 regs
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
1322 tegra
->regs
= devm_ioremap_resource(&pdev
->dev
, regs
);
1323 if (IS_ERR(tegra
->regs
))
1324 return PTR_ERR(tegra
->regs
);
1326 tegra
->fpci_base
= devm_platform_ioremap_resource(pdev
, 1);
1327 if (IS_ERR(tegra
->fpci_base
))
1328 return PTR_ERR(tegra
->fpci_base
);
1330 if (tegra
->soc
->has_ipfs
) {
1331 tegra
->ipfs_base
= devm_platform_ioremap_resource(pdev
, 2);
1332 if (IS_ERR(tegra
->ipfs_base
))
1333 return PTR_ERR(tegra
->ipfs_base
);
1336 tegra
->xhci_irq
= platform_get_irq(pdev
, 0);
1337 if (tegra
->xhci_irq
< 0)
1338 return tegra
->xhci_irq
;
1340 tegra
->mbox_irq
= platform_get_irq(pdev
, 1);
1341 if (tegra
->mbox_irq
< 0)
1342 return tegra
->mbox_irq
;
1344 tegra
->padctl
= tegra_xusb_padctl_get(&pdev
->dev
);
1345 if (IS_ERR(tegra
->padctl
))
1346 return PTR_ERR(tegra
->padctl
);
1348 tegra
->host_clk
= devm_clk_get(&pdev
->dev
, "xusb_host");
1349 if (IS_ERR(tegra
->host_clk
)) {
1350 err
= PTR_ERR(tegra
->host_clk
);
1351 dev_err(&pdev
->dev
, "failed to get xusb_host: %d\n", err
);
1355 tegra
->falcon_clk
= devm_clk_get(&pdev
->dev
, "xusb_falcon_src");
1356 if (IS_ERR(tegra
->falcon_clk
)) {
1357 err
= PTR_ERR(tegra
->falcon_clk
);
1358 dev_err(&pdev
->dev
, "failed to get xusb_falcon_src: %d\n", err
);
1362 tegra
->ss_clk
= devm_clk_get(&pdev
->dev
, "xusb_ss");
1363 if (IS_ERR(tegra
->ss_clk
)) {
1364 err
= PTR_ERR(tegra
->ss_clk
);
1365 dev_err(&pdev
->dev
, "failed to get xusb_ss: %d\n", err
);
1369 tegra
->ss_src_clk
= devm_clk_get(&pdev
->dev
, "xusb_ss_src");
1370 if (IS_ERR(tegra
->ss_src_clk
)) {
1371 err
= PTR_ERR(tegra
->ss_src_clk
);
1372 dev_err(&pdev
->dev
, "failed to get xusb_ss_src: %d\n", err
);
1376 tegra
->hs_src_clk
= devm_clk_get(&pdev
->dev
, "xusb_hs_src");
1377 if (IS_ERR(tegra
->hs_src_clk
)) {
1378 err
= PTR_ERR(tegra
->hs_src_clk
);
1379 dev_err(&pdev
->dev
, "failed to get xusb_hs_src: %d\n", err
);
1383 tegra
->fs_src_clk
= devm_clk_get(&pdev
->dev
, "xusb_fs_src");
1384 if (IS_ERR(tegra
->fs_src_clk
)) {
1385 err
= PTR_ERR(tegra
->fs_src_clk
);
1386 dev_err(&pdev
->dev
, "failed to get xusb_fs_src: %d\n", err
);
1390 tegra
->pll_u_480m
= devm_clk_get(&pdev
->dev
, "pll_u_480m");
1391 if (IS_ERR(tegra
->pll_u_480m
)) {
1392 err
= PTR_ERR(tegra
->pll_u_480m
);
1393 dev_err(&pdev
->dev
, "failed to get pll_u_480m: %d\n", err
);
1397 tegra
->clk_m
= devm_clk_get(&pdev
->dev
, "clk_m");
1398 if (IS_ERR(tegra
->clk_m
)) {
1399 err
= PTR_ERR(tegra
->clk_m
);
1400 dev_err(&pdev
->dev
, "failed to get clk_m: %d\n", err
);
1404 tegra
->pll_e
= devm_clk_get(&pdev
->dev
, "pll_e");
1405 if (IS_ERR(tegra
->pll_e
)) {
1406 err
= PTR_ERR(tegra
->pll_e
);
1407 dev_err(&pdev
->dev
, "failed to get pll_e: %d\n", err
);
1411 if (!of_property_read_bool(pdev
->dev
.of_node
, "power-domains")) {
1412 tegra
->host_rst
= devm_reset_control_get(&pdev
->dev
,
1414 if (IS_ERR(tegra
->host_rst
)) {
1415 err
= PTR_ERR(tegra
->host_rst
);
1417 "failed to get xusb_host reset: %d\n", err
);
1421 tegra
->ss_rst
= devm_reset_control_get(&pdev
->dev
, "xusb_ss");
1422 if (IS_ERR(tegra
->ss_rst
)) {
1423 err
= PTR_ERR(tegra
->ss_rst
);
1424 dev_err(&pdev
->dev
, "failed to get xusb_ss reset: %d\n",
1429 err
= tegra_powergate_sequence_power_up(TEGRA_POWERGATE_XUSBA
,
1434 "failed to enable XUSBA domain: %d\n", err
);
1438 err
= tegra_powergate_sequence_power_up(TEGRA_POWERGATE_XUSBC
,
1442 tegra_powergate_power_off(TEGRA_POWERGATE_XUSBA
);
1444 "failed to enable XUSBC domain: %d\n", err
);
1448 err
= tegra_xusb_powerdomain_init(&pdev
->dev
, tegra
);
1450 goto put_powerdomains
;
1453 tegra
->supplies
= devm_kcalloc(&pdev
->dev
, tegra
->soc
->num_supplies
,
1454 sizeof(*tegra
->supplies
), GFP_KERNEL
);
1455 if (!tegra
->supplies
) {
1457 goto put_powerdomains
;
1460 regulator_bulk_set_supply_names(tegra
->supplies
,
1461 tegra
->soc
->supply_names
,
1462 tegra
->soc
->num_supplies
);
1464 err
= devm_regulator_bulk_get(&pdev
->dev
, tegra
->soc
->num_supplies
,
1467 dev_err(&pdev
->dev
, "failed to get regulators: %d\n", err
);
1468 goto put_powerdomains
;
1471 for (i
= 0; i
< tegra
->soc
->num_types
; i
++) {
1472 if (!strncmp(tegra
->soc
->phy_types
[i
].name
, "usb2", 4))
1473 tegra
->num_usb_phys
= tegra
->soc
->phy_types
[i
].num
;
1474 tegra
->num_phys
+= tegra
->soc
->phy_types
[i
].num
;
1477 tegra
->phys
= devm_kcalloc(&pdev
->dev
, tegra
->num_phys
,
1478 sizeof(*tegra
->phys
), GFP_KERNEL
);
1481 goto put_powerdomains
;
1484 for (i
= 0, k
= 0; i
< tegra
->soc
->num_types
; i
++) {
1487 for (j
= 0; j
< tegra
->soc
->phy_types
[i
].num
; j
++) {
1488 snprintf(prop
, sizeof(prop
), "%s-%d",
1489 tegra
->soc
->phy_types
[i
].name
, j
);
1491 phy
= devm_phy_optional_get(&pdev
->dev
, prop
);
1494 "failed to get PHY %s: %ld\n", prop
,
1497 goto put_powerdomains
;
1500 tegra
->phys
[k
++] = phy
;
1504 tegra
->hcd
= usb_create_hcd(&tegra_xhci_hc_driver
, &pdev
->dev
,
1505 dev_name(&pdev
->dev
));
1508 goto put_powerdomains
;
1511 tegra
->hcd
->regs
= tegra
->regs
;
1512 tegra
->hcd
->rsrc_start
= regs
->start
;
1513 tegra
->hcd
->rsrc_len
= resource_size(regs
);
1516 * This must happen after usb_create_hcd(), because usb_create_hcd()
1517 * will overwrite the drvdata of the device with the hcd it creates.
1519 platform_set_drvdata(pdev
, tegra
);
1521 err
= tegra_xusb_phy_enable(tegra
);
1523 dev_err(&pdev
->dev
, "failed to enable PHYs: %d\n", err
);
1528 * The XUSB Falcon microcontroller can only address 40 bits, so set
1529 * the DMA mask accordingly.
1531 err
= dma_set_mask_and_coherent(tegra
->dev
, DMA_BIT_MASK(40));
1533 dev_err(&pdev
->dev
, "failed to set DMA mask: %d\n", err
);
1537 err
= tegra_xusb_request_firmware(tegra
);
1539 dev_err(&pdev
->dev
, "failed to request firmware: %d\n", err
);
1543 pm_runtime_enable(&pdev
->dev
);
1545 if (!pm_runtime_enabled(&pdev
->dev
))
1546 err
= tegra_xusb_runtime_resume(&pdev
->dev
);
1548 err
= pm_runtime_get_sync(&pdev
->dev
);
1551 dev_err(&pdev
->dev
, "failed to enable device: %d\n", err
);
1555 tegra_xusb_config(tegra
);
1557 err
= tegra_xusb_load_firmware(tegra
);
1559 dev_err(&pdev
->dev
, "failed to load firmware: %d\n", err
);
1563 err
= usb_add_hcd(tegra
->hcd
, tegra
->xhci_irq
, IRQF_SHARED
);
1565 dev_err(&pdev
->dev
, "failed to add USB HCD: %d\n", err
);
1569 device_wakeup_enable(tegra
->hcd
->self
.controller
);
1571 xhci
= hcd_to_xhci(tegra
->hcd
);
1573 xhci
->shared_hcd
= usb_create_shared_hcd(&tegra_xhci_hc_driver
,
1575 dev_name(&pdev
->dev
),
1577 if (!xhci
->shared_hcd
) {
1578 dev_err(&pdev
->dev
, "failed to create shared HCD\n");
1583 err
= usb_add_hcd(xhci
->shared_hcd
, tegra
->xhci_irq
, IRQF_SHARED
);
1585 dev_err(&pdev
->dev
, "failed to add shared HCD: %d\n", err
);
1589 err
= tegra_xusb_enable_firmware_messages(tegra
);
1591 dev_err(&pdev
->dev
, "failed to enable messages: %d\n", err
);
1595 err
= devm_request_threaded_irq(&pdev
->dev
, tegra
->mbox_irq
,
1596 tegra_xusb_mbox_irq
,
1597 tegra_xusb_mbox_thread
, 0,
1598 dev_name(&pdev
->dev
), tegra
);
1600 dev_err(&pdev
->dev
, "failed to request IRQ: %d\n", err
);
1604 err
= tegra_xusb_init_usb_phy(tegra
);
1606 dev_err(&pdev
->dev
, "failed to init USB PHY: %d\n", err
);
1613 usb_remove_hcd(xhci
->shared_hcd
);
1615 usb_put_hcd(xhci
->shared_hcd
);
1617 usb_remove_hcd(tegra
->hcd
);
1619 if (!pm_runtime_status_suspended(&pdev
->dev
))
1620 tegra_xusb_runtime_suspend(&pdev
->dev
);
1622 usb_put_hcd(tegra
->hcd
);
1624 dma_free_coherent(&pdev
->dev
, tegra
->fw
.size
, tegra
->fw
.virt
,
1627 tegra_xusb_phy_disable(tegra
);
1628 pm_runtime_disable(&pdev
->dev
);
1630 if (!of_property_read_bool(pdev
->dev
.of_node
, "power-domains")) {
1631 tegra_powergate_power_off(TEGRA_POWERGATE_XUSBC
);
1632 tegra_powergate_power_off(TEGRA_POWERGATE_XUSBA
);
1634 tegra_xusb_powerdomain_remove(&pdev
->dev
, tegra
);
1637 tegra_xusb_padctl_put(tegra
->padctl
);
1641 static int tegra_xusb_remove(struct platform_device
*pdev
)
1643 struct tegra_xusb
*tegra
= platform_get_drvdata(pdev
);
1644 struct xhci_hcd
*xhci
= hcd_to_xhci(tegra
->hcd
);
1646 tegra_xusb_deinit_usb_phy(tegra
);
1648 usb_remove_hcd(xhci
->shared_hcd
);
1649 usb_put_hcd(xhci
->shared_hcd
);
1650 xhci
->shared_hcd
= NULL
;
1651 usb_remove_hcd(tegra
->hcd
);
1652 usb_put_hcd(tegra
->hcd
);
1654 dma_free_coherent(&pdev
->dev
, tegra
->fw
.size
, tegra
->fw
.virt
,
1657 pm_runtime_put_sync(&pdev
->dev
);
1658 pm_runtime_disable(&pdev
->dev
);
1660 if (!of_property_read_bool(pdev
->dev
.of_node
, "power-domains")) {
1661 tegra_powergate_power_off(TEGRA_POWERGATE_XUSBC
);
1662 tegra_powergate_power_off(TEGRA_POWERGATE_XUSBA
);
1664 tegra_xusb_powerdomain_remove(&pdev
->dev
, tegra
);
1667 tegra_xusb_phy_disable(tegra
);
1669 tegra_xusb_padctl_put(tegra
->padctl
);
1674 #ifdef CONFIG_PM_SLEEP
1675 static bool xhci_hub_ports_suspended(struct xhci_hub
*hub
)
1677 struct device
*dev
= hub
->hcd
->self
.controller
;
1682 for (i
= 0; i
< hub
->num_ports
; i
++) {
1683 value
= readl(hub
->ports
[i
]->addr
);
1684 if ((value
& PORT_PE
) == 0)
1687 if ((value
& PORT_PLS_MASK
) != XDEV_U3
) {
1688 dev_info(dev
, "%u-%u isn't suspended: %#010x\n",
1689 hub
->hcd
->self
.busnum
, i
+ 1, value
);
1697 static int tegra_xusb_check_ports(struct tegra_xusb
*tegra
)
1699 struct xhci_hcd
*xhci
= hcd_to_xhci(tegra
->hcd
);
1700 unsigned long flags
;
1703 spin_lock_irqsave(&xhci
->lock
, flags
);
1705 if (!xhci_hub_ports_suspended(&xhci
->usb2_rhub
) ||
1706 !xhci_hub_ports_suspended(&xhci
->usb3_rhub
))
1709 spin_unlock_irqrestore(&xhci
->lock
, flags
);
1714 static void tegra_xusb_save_context(struct tegra_xusb
*tegra
)
1716 const struct tegra_xusb_context_soc
*soc
= tegra
->soc
->context
;
1717 struct tegra_xusb_context
*ctx
= &tegra
->context
;
1720 if (soc
->ipfs
.num_offsets
> 0) {
1721 for (i
= 0; i
< soc
->ipfs
.num_offsets
; i
++)
1722 ctx
->ipfs
[i
] = ipfs_readl(tegra
, soc
->ipfs
.offsets
[i
]);
1725 if (soc
->fpci
.num_offsets
> 0) {
1726 for (i
= 0; i
< soc
->fpci
.num_offsets
; i
++)
1727 ctx
->fpci
[i
] = fpci_readl(tegra
, soc
->fpci
.offsets
[i
]);
1731 static void tegra_xusb_restore_context(struct tegra_xusb
*tegra
)
1733 const struct tegra_xusb_context_soc
*soc
= tegra
->soc
->context
;
1734 struct tegra_xusb_context
*ctx
= &tegra
->context
;
1737 if (soc
->fpci
.num_offsets
> 0) {
1738 for (i
= 0; i
< soc
->fpci
.num_offsets
; i
++)
1739 fpci_writel(tegra
, ctx
->fpci
[i
], soc
->fpci
.offsets
[i
]);
1742 if (soc
->ipfs
.num_offsets
> 0) {
1743 for (i
= 0; i
< soc
->ipfs
.num_offsets
; i
++)
1744 ipfs_writel(tegra
, ctx
->ipfs
[i
], soc
->ipfs
.offsets
[i
]);
1748 static int tegra_xusb_enter_elpg(struct tegra_xusb
*tegra
, bool wakeup
)
1750 struct xhci_hcd
*xhci
= hcd_to_xhci(tegra
->hcd
);
1753 err
= tegra_xusb_check_ports(tegra
);
1755 dev_err(tegra
->dev
, "not all ports suspended: %d\n", err
);
1759 err
= xhci_suspend(xhci
, wakeup
);
1761 dev_err(tegra
->dev
, "failed to suspend XHCI: %d\n", err
);
1765 tegra_xusb_save_context(tegra
);
1766 tegra_xusb_phy_disable(tegra
);
1767 tegra_xusb_clk_disable(tegra
);
1772 static int tegra_xusb_exit_elpg(struct tegra_xusb
*tegra
, bool wakeup
)
1774 struct xhci_hcd
*xhci
= hcd_to_xhci(tegra
->hcd
);
1777 err
= tegra_xusb_clk_enable(tegra
);
1779 dev_err(tegra
->dev
, "failed to enable clocks: %d\n", err
);
1783 err
= tegra_xusb_phy_enable(tegra
);
1785 dev_err(tegra
->dev
, "failed to enable PHYs: %d\n", err
);
1789 tegra_xusb_config(tegra
);
1790 tegra_xusb_restore_context(tegra
);
1792 err
= tegra_xusb_load_firmware(tegra
);
1794 dev_err(tegra
->dev
, "failed to load firmware: %d\n", err
);
1798 err
= __tegra_xusb_enable_firmware_messages(tegra
);
1800 dev_err(tegra
->dev
, "failed to enable messages: %d\n", err
);
1804 err
= xhci_resume(xhci
, true);
1806 dev_err(tegra
->dev
, "failed to resume XHCI: %d\n", err
);
1813 tegra_xusb_phy_disable(tegra
);
1815 tegra_xusb_clk_disable(tegra
);
1819 static int tegra_xusb_suspend(struct device
*dev
)
1821 struct tegra_xusb
*tegra
= dev_get_drvdata(dev
);
1822 bool wakeup
= device_may_wakeup(dev
);
1825 synchronize_irq(tegra
->mbox_irq
);
1827 mutex_lock(&tegra
->lock
);
1828 err
= tegra_xusb_enter_elpg(tegra
, wakeup
);
1829 mutex_unlock(&tegra
->lock
);
1834 static int tegra_xusb_resume(struct device
*dev
)
1836 struct tegra_xusb
*tegra
= dev_get_drvdata(dev
);
1837 bool wakeup
= device_may_wakeup(dev
);
1840 mutex_lock(&tegra
->lock
);
1841 err
= tegra_xusb_exit_elpg(tegra
, wakeup
);
1842 mutex_unlock(&tegra
->lock
);
1848 static const struct dev_pm_ops tegra_xusb_pm_ops
= {
1849 SET_RUNTIME_PM_OPS(tegra_xusb_runtime_suspend
,
1850 tegra_xusb_runtime_resume
, NULL
)
1851 SET_SYSTEM_SLEEP_PM_OPS(tegra_xusb_suspend
, tegra_xusb_resume
)
1854 static const char * const tegra124_supply_names
[] = {
1861 static const struct tegra_xusb_phy_type tegra124_phy_types
[] = {
1862 { .name
= "usb3", .num
= 2, },
1863 { .name
= "usb2", .num
= 3, },
1864 { .name
= "hsic", .num
= 2, },
1867 static const unsigned int tegra124_xusb_context_ipfs
[] = {
1868 IPFS_XUSB_HOST_MSI_BAR_SZ_0
,
1869 IPFS_XUSB_HOST_MSI_AXI_BAR_ST_0
,
1870 IPFS_XUSB_HOST_MSI_FPCI_BAR_ST_0
,
1871 IPFS_XUSB_HOST_MSI_VEC0_0
,
1872 IPFS_XUSB_HOST_MSI_EN_VEC0_0
,
1873 IPFS_XUSB_HOST_FPCI_ERROR_MASKS_0
,
1874 IPFS_XUSB_HOST_INTR_MASK_0
,
1875 IPFS_XUSB_HOST_INTR_ENABLE_0
,
1876 IPFS_XUSB_HOST_UFPCI_CONFIG_0
,
1877 IPFS_XUSB_HOST_CLKGATE_HYSTERESIS_0
,
1878 IPFS_XUSB_HOST_MCCIF_FIFOCTRL_0
,
1881 static const unsigned int tegra124_xusb_context_fpci
[] = {
1882 XUSB_CFG_ARU_CONTEXT_HS_PLS
,
1883 XUSB_CFG_ARU_CONTEXT_FS_PLS
,
1884 XUSB_CFG_ARU_CONTEXT_HSFS_SPEED
,
1885 XUSB_CFG_ARU_CONTEXT_HSFS_PP
,
1886 XUSB_CFG_ARU_CONTEXT
,
1892 static const struct tegra_xusb_context_soc tegra124_xusb_context
= {
1894 .num_offsets
= ARRAY_SIZE(tegra124_xusb_context_ipfs
),
1895 .offsets
= tegra124_xusb_context_ipfs
,
1898 .num_offsets
= ARRAY_SIZE(tegra124_xusb_context_fpci
),
1899 .offsets
= tegra124_xusb_context_fpci
,
1903 static const struct tegra_xusb_soc tegra124_soc
= {
1904 .firmware
= "nvidia/tegra124/xusb.bin",
1905 .supply_names
= tegra124_supply_names
,
1906 .num_supplies
= ARRAY_SIZE(tegra124_supply_names
),
1907 .phy_types
= tegra124_phy_types
,
1908 .num_types
= ARRAY_SIZE(tegra124_phy_types
),
1909 .context
= &tegra124_xusb_context
,
1911 .usb2
= { .offset
= 4, .count
= 4, },
1912 .hsic
= { .offset
= 6, .count
= 2, },
1913 .usb3
= { .offset
= 0, .count
= 2, },
1915 .scale_ss_clock
= true,
1917 .otg_reset_sspi
= false,
1925 MODULE_FIRMWARE("nvidia/tegra124/xusb.bin");
1927 static const char * const tegra210_supply_names
[] = {
1933 static const struct tegra_xusb_phy_type tegra210_phy_types
[] = {
1934 { .name
= "usb3", .num
= 4, },
1935 { .name
= "usb2", .num
= 4, },
1936 { .name
= "hsic", .num
= 1, },
1939 static const struct tegra_xusb_soc tegra210_soc
= {
1940 .firmware
= "nvidia/tegra210/xusb.bin",
1941 .supply_names
= tegra210_supply_names
,
1942 .num_supplies
= ARRAY_SIZE(tegra210_supply_names
),
1943 .phy_types
= tegra210_phy_types
,
1944 .num_types
= ARRAY_SIZE(tegra210_phy_types
),
1945 .context
= &tegra124_xusb_context
,
1947 .usb2
= { .offset
= 4, .count
= 4, },
1948 .hsic
= { .offset
= 8, .count
= 1, },
1949 .usb3
= { .offset
= 0, .count
= 4, },
1951 .scale_ss_clock
= false,
1953 .otg_reset_sspi
= true,
1961 MODULE_FIRMWARE("nvidia/tegra210/xusb.bin");
1963 static const char * const tegra186_supply_names
[] = {
1965 MODULE_FIRMWARE("nvidia/tegra186/xusb.bin");
1967 static const struct tegra_xusb_phy_type tegra186_phy_types
[] = {
1968 { .name
= "usb3", .num
= 3, },
1969 { .name
= "usb2", .num
= 3, },
1970 { .name
= "hsic", .num
= 1, },
1973 static const struct tegra_xusb_context_soc tegra186_xusb_context
= {
1975 .num_offsets
= ARRAY_SIZE(tegra124_xusb_context_fpci
),
1976 .offsets
= tegra124_xusb_context_fpci
,
1980 static const struct tegra_xusb_soc tegra186_soc
= {
1981 .firmware
= "nvidia/tegra186/xusb.bin",
1982 .supply_names
= tegra186_supply_names
,
1983 .num_supplies
= ARRAY_SIZE(tegra186_supply_names
),
1984 .phy_types
= tegra186_phy_types
,
1985 .num_types
= ARRAY_SIZE(tegra186_phy_types
),
1986 .context
= &tegra186_xusb_context
,
1988 .usb3
= { .offset
= 0, .count
= 3, },
1989 .usb2
= { .offset
= 3, .count
= 3, },
1990 .hsic
= { .offset
= 6, .count
= 1, },
1992 .scale_ss_clock
= false,
1994 .otg_reset_sspi
= false,
2001 .lpm_support
= true,
2004 static const char * const tegra194_supply_names
[] = {
2007 static const struct tegra_xusb_phy_type tegra194_phy_types
[] = {
2008 { .name
= "usb3", .num
= 4, },
2009 { .name
= "usb2", .num
= 4, },
2012 static const struct tegra_xusb_soc tegra194_soc
= {
2013 .firmware
= "nvidia/tegra194/xusb.bin",
2014 .supply_names
= tegra194_supply_names
,
2015 .num_supplies
= ARRAY_SIZE(tegra194_supply_names
),
2016 .phy_types
= tegra194_phy_types
,
2017 .num_types
= ARRAY_SIZE(tegra194_phy_types
),
2018 .context
= &tegra186_xusb_context
,
2020 .usb3
= { .offset
= 0, .count
= 4, },
2021 .usb2
= { .offset
= 4, .count
= 4, },
2023 .scale_ss_clock
= false,
2025 .otg_reset_sspi
= false,
2032 .lpm_support
= true,
2034 MODULE_FIRMWARE("nvidia/tegra194/xusb.bin");
2036 static const struct of_device_id tegra_xusb_of_match
[] = {
2037 { .compatible
= "nvidia,tegra124-xusb", .data
= &tegra124_soc
},
2038 { .compatible
= "nvidia,tegra210-xusb", .data
= &tegra210_soc
},
2039 { .compatible
= "nvidia,tegra186-xusb", .data
= &tegra186_soc
},
2040 { .compatible
= "nvidia,tegra194-xusb", .data
= &tegra194_soc
},
2043 MODULE_DEVICE_TABLE(of
, tegra_xusb_of_match
);
2045 static struct platform_driver tegra_xusb_driver
= {
2046 .probe
= tegra_xusb_probe
,
2047 .remove
= tegra_xusb_remove
,
2049 .name
= "tegra-xusb",
2050 .pm
= &tegra_xusb_pm_ops
,
2051 .of_match_table
= tegra_xusb_of_match
,
2055 static void tegra_xhci_quirks(struct device
*dev
, struct xhci_hcd
*xhci
)
2057 struct tegra_xusb
*tegra
= dev_get_drvdata(dev
);
2059 xhci
->quirks
|= XHCI_PLAT
;
2060 if (tegra
&& tegra
->soc
->lpm_support
)
2061 xhci
->quirks
|= XHCI_LPM_SUPPORT
;
2064 static int tegra_xhci_setup(struct usb_hcd
*hcd
)
2066 return xhci_gen_setup(hcd
, tegra_xhci_quirks
);
2069 static const struct xhci_driver_overrides tegra_xhci_overrides __initconst
= {
2070 .reset
= tegra_xhci_setup
,
2073 static int __init
tegra_xusb_init(void)
2075 xhci_init_driver(&tegra_xhci_hc_driver
, &tegra_xhci_overrides
);
2077 return platform_driver_register(&tegra_xusb_driver
);
2079 module_init(tegra_xusb_init
);
2081 static void __exit
tegra_xusb_exit(void)
2083 platform_driver_unregister(&tegra_xusb_driver
);
2085 module_exit(tegra_xusb_exit
);
2087 MODULE_AUTHOR("Andrew Bresticker <abrestic@chromium.org>");
2088 MODULE_DESCRIPTION("NVIDIA Tegra XUSB xHCI host-controller driver");
2089 MODULE_LICENSE("GPL v2");