| // SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause) | |
| /* | |
| * Copyright (C) 2004-2016 Synopsys, Inc. | |
| */ | |
| #include <linux/kernel.h> | |
| #include <linux/module.h> | |
| #include <linux/of.h> | |
| #include <linux/usb/of.h> | |
| #include <linux/pci_ids.h> | |
| #include <linux/pci.h> | |
| #include "core.h" | |
| #define PCI_PRODUCT_ID_HAPS_HSOTG 0xabc0 | |
| #define PCI_DEVICE_ID_LOONGSON_DWC2 0x7a04 | |
| static void dwc2_set_bcm_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->host_rx_fifo_size = 774; | |
| p->max_transfer_size = 65535; | |
| p->max_packet_count = 511; | |
| p->ahbcfg = 0x10; | |
| } | |
| static void dwc2_set_his_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->otg_caps.srp_support = false; | |
| p->speed = DWC2_SPEED_PARAM_HIGH; | |
| p->host_rx_fifo_size = 512; | |
| p->host_nperio_tx_fifo_size = 512; | |
| p->host_perio_tx_fifo_size = 512; | |
| p->max_transfer_size = 65535; | |
| p->max_packet_count = 511; | |
| p->host_channels = 16; | |
| p->phy_type = DWC2_PHY_TYPE_PARAM_UTMI; | |
| p->phy_utmi_width = 8; | |
| p->i2c_enable = false; | |
| p->reload_ctl = false; | |
| p->ahbcfg = GAHBCFG_HBSTLEN_INCR16 << | |
| GAHBCFG_HBSTLEN_SHIFT; | |
| p->change_speed_quirk = true; | |
| p->power_down = DWC2_POWER_DOWN_PARAM_NONE; | |
| } | |
| static void dwc2_set_jz4775_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->speed = DWC2_SPEED_PARAM_HIGH; | |
| p->phy_type = DWC2_PHY_TYPE_PARAM_UTMI; | |
| p->phy_utmi_width = 16; | |
| p->activate_ingenic_overcurrent_detection = | |
| !device_property_read_bool(hsotg->dev, "disable-over-current"); | |
| } | |
| static void dwc2_set_loongson_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->phy_utmi_width = 8; | |
| p->power_down = DWC2_POWER_DOWN_PARAM_PARTIAL; | |
| } | |
| static void dwc2_set_x1600_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->speed = DWC2_SPEED_PARAM_HIGH; | |
| p->host_channels = 16; | |
| p->phy_type = DWC2_PHY_TYPE_PARAM_UTMI; | |
| p->phy_utmi_width = 16; | |
| p->activate_ingenic_overcurrent_detection = | |
| !device_property_read_bool(hsotg->dev, "disable-over-current"); | |
| } | |
| static void dwc2_set_x2000_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->speed = DWC2_SPEED_PARAM_HIGH; | |
| p->host_rx_fifo_size = 1024; | |
| p->host_nperio_tx_fifo_size = 1024; | |
| p->host_perio_tx_fifo_size = 1024; | |
| p->host_channels = 16; | |
| p->phy_type = DWC2_PHY_TYPE_PARAM_UTMI; | |
| p->phy_utmi_width = 16; | |
| p->activate_ingenic_overcurrent_detection = | |
| !device_property_read_bool(hsotg->dev, "disable-over-current"); | |
| } | |
| static void dwc2_set_s3c6400_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->power_down = DWC2_POWER_DOWN_PARAM_NONE; | |
| p->no_clock_gating = true; | |
| p->phy_utmi_width = 8; | |
| } | |
| static void dwc2_set_socfpga_agilex_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->power_down = DWC2_POWER_DOWN_PARAM_NONE; | |
| p->no_clock_gating = true; | |
| } | |
| static void dwc2_set_rk_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->otg_caps.srp_support = false; | |
| p->host_rx_fifo_size = 525; | |
| p->host_nperio_tx_fifo_size = 128; | |
| p->host_perio_tx_fifo_size = 256; | |
| p->ahbcfg = GAHBCFG_HBSTLEN_INCR16 << | |
| GAHBCFG_HBSTLEN_SHIFT; | |
| p->power_down = DWC2_POWER_DOWN_PARAM_NONE; | |
| p->lpm = false; | |
| p->lpm_clock_gating = false; | |
| p->besl = false; | |
| p->hird_threshold_en = false; | |
| p->no_clock_gating = true; | |
| } | |
| static void dwc2_set_ltq_danube_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->otg_caps.srp_support = false; | |
| } | |
| static void dwc2_set_ltq_ase_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->otg_caps.srp_support = false; | |
| p->host_rx_fifo_size = 288; | |
| p->host_nperio_tx_fifo_size = 128; | |
| p->host_perio_tx_fifo_size = 96; | |
| p->ahbcfg = GAHBCFG_HBSTLEN_INCR16 << | |
| GAHBCFG_HBSTLEN_SHIFT; | |
| } | |
| static void dwc2_set_ltq_xrx200_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->otg_caps.srp_support = false; | |
| p->host_rx_fifo_size = 288; | |
| p->host_nperio_tx_fifo_size = 128; | |
| p->host_perio_tx_fifo_size = 136; | |
| } | |
| static void dwc2_set_amlogic_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->otg_caps.srp_support = false; | |
| p->speed = DWC2_SPEED_PARAM_HIGH; | |
| p->host_rx_fifo_size = 512; | |
| p->host_nperio_tx_fifo_size = 500; | |
| p->host_perio_tx_fifo_size = 500; | |
| p->host_channels = 16; | |
| p->phy_type = DWC2_PHY_TYPE_PARAM_UTMI; | |
| p->ahbcfg = GAHBCFG_HBSTLEN_INCR8 << | |
| GAHBCFG_HBSTLEN_SHIFT; | |
| p->power_down = DWC2_POWER_DOWN_PARAM_NONE; | |
| } | |
| static void dwc2_set_amlogic_g12a_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->lpm = false; | |
| p->lpm_clock_gating = false; | |
| p->besl = false; | |
| p->hird_threshold_en = false; | |
| } | |
| static void dwc2_set_amlogic_a1_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->otg_caps.srp_support = false; | |
| p->speed = DWC2_SPEED_PARAM_HIGH; | |
| p->host_rx_fifo_size = 192; | |
| p->host_nperio_tx_fifo_size = 128; | |
| p->host_perio_tx_fifo_size = 128; | |
| p->phy_type = DWC2_PHY_TYPE_PARAM_UTMI; | |
| p->phy_utmi_width = 8; | |
| p->ahbcfg = GAHBCFG_HBSTLEN_INCR8 << GAHBCFG_HBSTLEN_SHIFT; | |
| p->lpm = false; | |
| p->lpm_clock_gating = false; | |
| p->besl = false; | |
| p->hird_threshold_en = false; | |
| } | |
| static void dwc2_set_amcc_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->ahbcfg = GAHBCFG_HBSTLEN_INCR16 << GAHBCFG_HBSTLEN_SHIFT; | |
| } | |
| static void dwc2_set_cv1800_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->otg_caps.srp_support = false; | |
| p->host_dma = false; | |
| p->g_dma = false; | |
| p->speed = DWC2_SPEED_PARAM_HIGH; | |
| p->phy_type = DWC2_PHY_TYPE_PARAM_UTMI; | |
| p->phy_utmi_width = 16; | |
| p->ahbcfg = GAHBCFG_HBSTLEN_INCR16 << GAHBCFG_HBSTLEN_SHIFT; | |
| p->lpm = false; | |
| p->lpm_clock_gating = false; | |
| p->besl = false; | |
| p->hird_threshold_en = false; | |
| p->power_down = DWC2_POWER_DOWN_PARAM_NONE; | |
| } | |
| static void dwc2_set_stm32f4x9_fsotg_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->otg_caps.srp_support = false; | |
| p->speed = DWC2_SPEED_PARAM_FULL; | |
| p->host_rx_fifo_size = 128; | |
| p->host_nperio_tx_fifo_size = 96; | |
| p->host_perio_tx_fifo_size = 96; | |
| p->max_packet_count = 256; | |
| p->phy_type = DWC2_PHY_TYPE_PARAM_FS; | |
| p->i2c_enable = false; | |
| p->activate_stm_fs_transceiver = true; | |
| } | |
| static void dwc2_set_stm32f7_hsotg_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->host_rx_fifo_size = 622; | |
| p->host_nperio_tx_fifo_size = 128; | |
| p->host_perio_tx_fifo_size = 256; | |
| } | |
| static void dwc2_set_stm32mp15_fsotg_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->otg_caps.srp_support = false; | |
| p->otg_caps.otg_rev = 0x200; | |
| p->speed = DWC2_SPEED_PARAM_FULL; | |
| p->host_rx_fifo_size = 128; | |
| p->host_nperio_tx_fifo_size = 96; | |
| p->host_perio_tx_fifo_size = 96; | |
| p->max_packet_count = 256; | |
| p->phy_type = DWC2_PHY_TYPE_PARAM_FS; | |
| p->i2c_enable = false; | |
| p->activate_stm_fs_transceiver = true; | |
| p->activate_stm_id_vb_detection = true; | |
| p->ahbcfg = GAHBCFG_HBSTLEN_INCR16 << GAHBCFG_HBSTLEN_SHIFT; | |
| p->power_down = DWC2_POWER_DOWN_PARAM_NONE; | |
| p->host_support_fs_ls_low_power = true; | |
| p->host_ls_low_power_phy_clk = true; | |
| } | |
| static void dwc2_set_stm32mp15_hsotg_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->otg_caps.hnp_support = false; | |
| p->otg_caps.srp_support = false; | |
| p->otg_caps.otg_rev = 0x200; | |
| p->activate_stm_id_vb_detection = !device_property_read_bool(hsotg->dev, "usb-role-switch"); | |
| p->host_rx_fifo_size = 440; | |
| p->host_nperio_tx_fifo_size = 256; | |
| p->host_perio_tx_fifo_size = 256; | |
| p->ahbcfg = GAHBCFG_HBSTLEN_INCR16 << GAHBCFG_HBSTLEN_SHIFT; | |
| p->power_down = DWC2_POWER_DOWN_PARAM_NONE; | |
| p->lpm = false; | |
| p->lpm_clock_gating = false; | |
| p->besl = false; | |
| p->hird_threshold_en = false; | |
| } | |
| const struct of_device_id dwc2_of_match_table[] = { | |
| { .compatible = "brcm,bcm2835-usb", .data = dwc2_set_bcm_params }, | |
| { .compatible = "hisilicon,hi6220-usb", .data = dwc2_set_his_params }, | |
| { .compatible = "ingenic,jz4775-otg", .data = dwc2_set_jz4775_params }, | |
| { .compatible = "ingenic,jz4780-otg", .data = dwc2_set_jz4775_params }, | |
| { .compatible = "ingenic,x1000-otg", .data = dwc2_set_jz4775_params }, | |
| { .compatible = "ingenic,x1600-otg", .data = dwc2_set_x1600_params }, | |
| { .compatible = "ingenic,x1700-otg", .data = dwc2_set_x1600_params }, | |
| { .compatible = "ingenic,x1830-otg", .data = dwc2_set_x1600_params }, | |
| { .compatible = "ingenic,x2000-otg", .data = dwc2_set_x2000_params }, | |
| { .compatible = "rockchip,rk3066-usb", .data = dwc2_set_rk_params }, | |
| { .compatible = "lantiq,danube-usb", .data = &dwc2_set_ltq_danube_params }, | |
| { .compatible = "lantiq,ase-usb", .data = &dwc2_set_ltq_ase_params }, | |
| { .compatible = "lantiq,arx100-usb", .data = &dwc2_set_ltq_ase_params }, | |
| { .compatible = "lantiq,xrx200-usb", .data = &dwc2_set_ltq_xrx200_params }, | |
| { .compatible = "lantiq,xrx300-usb", .data = &dwc2_set_ltq_xrx200_params }, | |
| { .compatible = "snps,dwc2" }, | |
| { .compatible = "samsung,s3c6400-hsotg", | |
| .data = dwc2_set_s3c6400_params }, | |
| { .compatible = "amlogic,meson8-usb", | |
| .data = dwc2_set_amlogic_params }, | |
| { .compatible = "amlogic,meson8b-usb", | |
| .data = dwc2_set_amlogic_params }, | |
| { .compatible = "amlogic,meson-gxbb-usb", | |
| .data = dwc2_set_amlogic_params }, | |
| { .compatible = "amlogic,meson-g12a-usb", | |
| .data = dwc2_set_amlogic_g12a_params }, | |
| { .compatible = "amlogic,meson-a1-usb", | |
| .data = dwc2_set_amlogic_a1_params }, | |
| { .compatible = "amcc,dwc-otg", .data = dwc2_set_amcc_params }, | |
| { .compatible = "apm,apm82181-dwc-otg", .data = dwc2_set_amcc_params }, | |
| { .compatible = "sophgo,cv1800b-usb", | |
| .data = dwc2_set_cv1800_params }, | |
| { .compatible = "st,stm32f4x9-fsotg", | |
| .data = dwc2_set_stm32f4x9_fsotg_params }, | |
| { .compatible = "st,stm32f4x9-hsotg" }, | |
| { .compatible = "st,stm32f7-hsotg", | |
| .data = dwc2_set_stm32f7_hsotg_params }, | |
| { .compatible = "st,stm32mp15-fsotg", | |
| .data = dwc2_set_stm32mp15_fsotg_params }, | |
| { .compatible = "st,stm32mp15-hsotg", | |
| .data = dwc2_set_stm32mp15_hsotg_params }, | |
| { .compatible = "intel,socfpga-agilex-hsotg", | |
| .data = dwc2_set_socfpga_agilex_params }, | |
| {}, | |
| }; | |
| MODULE_DEVICE_TABLE(of, dwc2_of_match_table); | |
| const struct acpi_device_id dwc2_acpi_match[] = { | |
| /* This ID refers to the same USB IP as of_device_id brcm,bcm2835-usb */ | |
| { "BCM2848", (kernel_ulong_t)dwc2_set_bcm_params }, | |
| { }, | |
| }; | |
| MODULE_DEVICE_TABLE(acpi, dwc2_acpi_match); | |
| const struct pci_device_id dwc2_pci_ids[] = { | |
| { | |
| PCI_DEVICE(PCI_VENDOR_ID_SYNOPSYS, PCI_PRODUCT_ID_HAPS_HSOTG), | |
| }, | |
| { | |
| PCI_DEVICE(PCI_VENDOR_ID_STMICRO, | |
| PCI_DEVICE_ID_STMICRO_USB_OTG), | |
| }, | |
| { | |
| PCI_DEVICE(PCI_VENDOR_ID_LOONGSON, PCI_DEVICE_ID_LOONGSON_DWC2), | |
| .driver_data = (unsigned long)dwc2_set_loongson_params, | |
| }, | |
| { /* end: all zeroes */ } | |
| }; | |
| MODULE_DEVICE_TABLE(pci, dwc2_pci_ids); | |
| EXPORT_SYMBOL_GPL(dwc2_pci_ids); | |
| static void dwc2_set_param_otg_cap(struct dwc2_hsotg *hsotg) | |
| { | |
| switch (hsotg->hw_params.op_mode) { | |
| case GHWCFG2_OP_MODE_HNP_SRP_CAPABLE: | |
| hsotg->params.otg_caps.hnp_support = true; | |
| hsotg->params.otg_caps.srp_support = true; | |
| break; | |
| case GHWCFG2_OP_MODE_SRP_ONLY_CAPABLE: | |
| case GHWCFG2_OP_MODE_SRP_CAPABLE_DEVICE: | |
| case GHWCFG2_OP_MODE_SRP_CAPABLE_HOST: | |
| hsotg->params.otg_caps.hnp_support = false; | |
| hsotg->params.otg_caps.srp_support = true; | |
| break; | |
| default: | |
| hsotg->params.otg_caps.hnp_support = false; | |
| hsotg->params.otg_caps.srp_support = false; | |
| break; | |
| } | |
| } | |
| static void dwc2_set_param_phy_type(struct dwc2_hsotg *hsotg) | |
| { | |
| int val; | |
| u32 hs_phy_type = hsotg->hw_params.hs_phy_type; | |
| val = DWC2_PHY_TYPE_PARAM_FS; | |
| if (hs_phy_type != GHWCFG2_HS_PHY_TYPE_NOT_SUPPORTED) { | |
| if (hs_phy_type == GHWCFG2_HS_PHY_TYPE_UTMI || | |
| hs_phy_type == GHWCFG2_HS_PHY_TYPE_UTMI_ULPI) | |
| val = DWC2_PHY_TYPE_PARAM_UTMI; | |
| else | |
| val = DWC2_PHY_TYPE_PARAM_ULPI; | |
| } | |
| if (dwc2_is_fs_iot(hsotg)) | |
| hsotg->params.phy_type = DWC2_PHY_TYPE_PARAM_FS; | |
| hsotg->params.phy_type = val; | |
| } | |
| static void dwc2_set_param_speed(struct dwc2_hsotg *hsotg) | |
| { | |
| int val; | |
| val = hsotg->params.phy_type == DWC2_PHY_TYPE_PARAM_FS ? | |
| DWC2_SPEED_PARAM_FULL : DWC2_SPEED_PARAM_HIGH; | |
| if (dwc2_is_fs_iot(hsotg)) | |
| val = DWC2_SPEED_PARAM_FULL; | |
| if (dwc2_is_hs_iot(hsotg)) | |
| val = DWC2_SPEED_PARAM_HIGH; | |
| hsotg->params.speed = val; | |
| } | |
| static void dwc2_set_param_phy_utmi_width(struct dwc2_hsotg *hsotg) | |
| { | |
| int val; | |
| val = (hsotg->hw_params.utmi_phy_data_width == | |
| GHWCFG4_UTMI_PHY_DATA_WIDTH_8) ? 8 : 16; | |
| if (hsotg->phy) { | |
| /* | |
| * If using the generic PHY framework, check if the PHY bus | |
| * width is 8-bit and set the phyif appropriately. | |
| */ | |
| if (phy_get_bus_width(hsotg->phy) == 8) | |
| val = 8; | |
| } | |
| hsotg->params.phy_utmi_width = val; | |
| } | |
| static void dwc2_set_param_tx_fifo_sizes(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| int depth_average; | |
| int fifo_count; | |
| int i; | |
| fifo_count = dwc2_hsotg_tx_fifo_count(hsotg); | |
| memset(p->g_tx_fifo_size, 0, sizeof(p->g_tx_fifo_size)); | |
| depth_average = dwc2_hsotg_tx_fifo_average_depth(hsotg); | |
| for (i = 1; i <= fifo_count; i++) | |
| p->g_tx_fifo_size[i] = depth_average; | |
| } | |
| static void dwc2_set_param_power_down(struct dwc2_hsotg *hsotg) | |
| { | |
| int val; | |
| if (hsotg->hw_params.hibernation) | |
| val = DWC2_POWER_DOWN_PARAM_HIBERNATION; | |
| else if (hsotg->hw_params.power_optimized) | |
| val = DWC2_POWER_DOWN_PARAM_PARTIAL; | |
| else | |
| val = DWC2_POWER_DOWN_PARAM_NONE; | |
| hsotg->params.power_down = val; | |
| } | |
| static void dwc2_set_param_lpm(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| p->lpm = hsotg->hw_params.lpm_mode; | |
| if (p->lpm) { | |
| p->lpm_clock_gating = true; | |
| p->besl = true; | |
| p->hird_threshold_en = true; | |
| p->hird_threshold = 4; | |
| } else { | |
| p->lpm_clock_gating = false; | |
| p->besl = false; | |
| p->hird_threshold_en = false; | |
| } | |
| } | |
| /** | |
| * dwc2_set_default_params() - Set all core parameters to their | |
| * auto-detected default values. | |
| * | |
| * @hsotg: Programming view of the DWC_otg controller | |
| * | |
| */ | |
| static void dwc2_set_default_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_hw_params *hw = &hsotg->hw_params; | |
| struct dwc2_core_params *p = &hsotg->params; | |
| bool dma_capable = !(hw->arch == GHWCFG2_SLAVE_ONLY_ARCH); | |
| dwc2_set_param_otg_cap(hsotg); | |
| dwc2_set_param_phy_type(hsotg); | |
| dwc2_set_param_speed(hsotg); | |
| dwc2_set_param_phy_utmi_width(hsotg); | |
| dwc2_set_param_power_down(hsotg); | |
| dwc2_set_param_lpm(hsotg); | |
| p->phy_ulpi_ddr = false; | |
| p->phy_ulpi_ext_vbus = false; | |
| p->eusb2_disc = false; | |
| p->enable_dynamic_fifo = hw->enable_dynamic_fifo; | |
| p->en_multiple_tx_fifo = hw->en_multiple_tx_fifo; | |
| p->i2c_enable = hw->i2c_enable; | |
| p->acg_enable = hw->acg_enable; | |
| p->ulpi_fs_ls = false; | |
| p->ts_dline = false; | |
| p->reload_ctl = (hw->snpsid >= DWC2_CORE_REV_2_92a); | |
| p->uframe_sched = true; | |
| p->external_id_pin_ctl = false; | |
| p->ipg_isoc_en = false; | |
| p->service_interval = false; | |
| p->max_packet_count = hw->max_packet_count; | |
| p->max_transfer_size = hw->max_transfer_size; | |
| p->ahbcfg = GAHBCFG_HBSTLEN_INCR << GAHBCFG_HBSTLEN_SHIFT; | |
| p->ref_clk_per = 33333; | |
| p->sof_cnt_wkup_alert = 100; | |
| if ((hsotg->dr_mode == USB_DR_MODE_HOST) || | |
| (hsotg->dr_mode == USB_DR_MODE_OTG)) { | |
| p->host_dma = dma_capable; | |
| p->dma_desc_enable = false; | |
| p->dma_desc_fs_enable = false; | |
| p->host_support_fs_ls_low_power = false; | |
| p->host_ls_low_power_phy_clk = false; | |
| p->host_channels = hw->host_channels; | |
| p->host_rx_fifo_size = hw->rx_fifo_size; | |
| p->host_nperio_tx_fifo_size = hw->host_nperio_tx_fifo_size; | |
| p->host_perio_tx_fifo_size = hw->host_perio_tx_fifo_size; | |
| } | |
| if ((hsotg->dr_mode == USB_DR_MODE_PERIPHERAL) || | |
| (hsotg->dr_mode == USB_DR_MODE_OTG)) { | |
| p->g_dma = dma_capable; | |
| p->g_dma_desc = hw->dma_desc_enable; | |
| /* | |
| * The values for g_rx_fifo_size (2048) and | |
| * g_np_tx_fifo_size (1024) come from the legacy s3c | |
| * gadget driver. These defaults have been hard-coded | |
| * for some time so many platforms depend on these | |
| * values. Leave them as defaults for now and only | |
| * auto-detect if the hardware does not support the | |
| * default. | |
| */ | |
| p->g_rx_fifo_size = 2048; | |
| p->g_np_tx_fifo_size = 1024; | |
| dwc2_set_param_tx_fifo_sizes(hsotg); | |
| } | |
| } | |
| /** | |
| * dwc2_get_device_properties() - Read in device properties. | |
| * | |
| * @hsotg: Programming view of the DWC_otg controller | |
| * | |
| * Read in the device properties and adjust core parameters if needed. | |
| */ | |
| static void dwc2_get_device_properties(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_core_params *p = &hsotg->params; | |
| int num; | |
| if ((hsotg->dr_mode == USB_DR_MODE_PERIPHERAL) || | |
| (hsotg->dr_mode == USB_DR_MODE_OTG)) { | |
| device_property_read_u32(hsotg->dev, "g-rx-fifo-size", | |
| &p->g_rx_fifo_size); | |
| device_property_read_u32(hsotg->dev, "g-np-tx-fifo-size", | |
| &p->g_np_tx_fifo_size); | |
| num = device_property_count_u32(hsotg->dev, "g-tx-fifo-size"); | |
| if (num > 0) { | |
| num = min(num, 15); | |
| memset(p->g_tx_fifo_size, 0, | |
| sizeof(p->g_tx_fifo_size)); | |
| device_property_read_u32_array(hsotg->dev, | |
| "g-tx-fifo-size", | |
| &p->g_tx_fifo_size[1], | |
| num); | |
| } | |
| of_usb_update_otg_caps(hsotg->dev->of_node, &p->otg_caps); | |
| } | |
| p->oc_disable = of_property_read_bool(hsotg->dev->of_node, "disable-over-current"); | |
| } | |
| static void dwc2_check_param_otg_cap(struct dwc2_hsotg *hsotg) | |
| { | |
| int valid = 1; | |
| if (hsotg->params.otg_caps.hnp_support && hsotg->params.otg_caps.srp_support) { | |
| /* check HNP && SRP capable */ | |
| if (hsotg->hw_params.op_mode != GHWCFG2_OP_MODE_HNP_SRP_CAPABLE) | |
| valid = 0; | |
| } else if (!hsotg->params.otg_caps.hnp_support) { | |
| /* check SRP only capable */ | |
| if (hsotg->params.otg_caps.srp_support) { | |
| switch (hsotg->hw_params.op_mode) { | |
| case GHWCFG2_OP_MODE_HNP_SRP_CAPABLE: | |
| case GHWCFG2_OP_MODE_SRP_ONLY_CAPABLE: | |
| case GHWCFG2_OP_MODE_SRP_CAPABLE_DEVICE: | |
| case GHWCFG2_OP_MODE_SRP_CAPABLE_HOST: | |
| break; | |
| default: | |
| valid = 0; | |
| break; | |
| } | |
| } | |
| /* else: NO HNP && NO SRP capable: always valid */ | |
| } else { | |
| valid = 0; | |
| } | |
| if (!valid) | |
| dwc2_set_param_otg_cap(hsotg); | |
| } | |
| static void dwc2_check_param_phy_type(struct dwc2_hsotg *hsotg) | |
| { | |
| int valid = 0; | |
| u32 hs_phy_type; | |
| u32 fs_phy_type; | |
| hs_phy_type = hsotg->hw_params.hs_phy_type; | |
| fs_phy_type = hsotg->hw_params.fs_phy_type; | |
| switch (hsotg->params.phy_type) { | |
| case DWC2_PHY_TYPE_PARAM_FS: | |
| if (fs_phy_type == GHWCFG2_FS_PHY_TYPE_DEDICATED) | |
| valid = 1; | |
| break; | |
| case DWC2_PHY_TYPE_PARAM_UTMI: | |
| if ((hs_phy_type == GHWCFG2_HS_PHY_TYPE_UTMI) || | |
| (hs_phy_type == GHWCFG2_HS_PHY_TYPE_UTMI_ULPI)) | |
| valid = 1; | |
| break; | |
| case DWC2_PHY_TYPE_PARAM_ULPI: | |
| if ((hs_phy_type == GHWCFG2_HS_PHY_TYPE_UTMI) || | |
| (hs_phy_type == GHWCFG2_HS_PHY_TYPE_UTMI_ULPI)) | |
| valid = 1; | |
| break; | |
| default: | |
| break; | |
| } | |
| if (!valid) | |
| dwc2_set_param_phy_type(hsotg); | |
| } | |
| static void dwc2_check_param_speed(struct dwc2_hsotg *hsotg) | |
| { | |
| int valid = 1; | |
| int phy_type = hsotg->params.phy_type; | |
| int speed = hsotg->params.speed; | |
| switch (speed) { | |
| case DWC2_SPEED_PARAM_HIGH: | |
| if ((hsotg->params.speed == DWC2_SPEED_PARAM_HIGH) && | |
| (phy_type == DWC2_PHY_TYPE_PARAM_FS)) | |
| valid = 0; | |
| break; | |
| case DWC2_SPEED_PARAM_FULL: | |
| case DWC2_SPEED_PARAM_LOW: | |
| break; | |
| default: | |
| valid = 0; | |
| break; | |
| } | |
| if (!valid) | |
| dwc2_set_param_speed(hsotg); | |
| } | |
| static void dwc2_check_param_phy_utmi_width(struct dwc2_hsotg *hsotg) | |
| { | |
| int valid = 0; | |
| int param = hsotg->params.phy_utmi_width; | |
| int width = hsotg->hw_params.utmi_phy_data_width; | |
| switch (width) { | |
| case GHWCFG4_UTMI_PHY_DATA_WIDTH_8: | |
| valid = (param == 8); | |
| break; | |
| case GHWCFG4_UTMI_PHY_DATA_WIDTH_16: | |
| valid = (param == 16); | |
| break; | |
| case GHWCFG4_UTMI_PHY_DATA_WIDTH_8_OR_16: | |
| valid = (param == 8 || param == 16); | |
| break; | |
| } | |
| if (!valid) | |
| dwc2_set_param_phy_utmi_width(hsotg); | |
| } | |
| static void dwc2_check_param_power_down(struct dwc2_hsotg *hsotg) | |
| { | |
| int param = hsotg->params.power_down; | |
| switch (param) { | |
| case DWC2_POWER_DOWN_PARAM_NONE: | |
| break; | |
| case DWC2_POWER_DOWN_PARAM_PARTIAL: | |
| if (hsotg->hw_params.power_optimized) | |
| break; | |
| dev_dbg(hsotg->dev, | |
| "Partial power down isn't supported by HW\n"); | |
| param = DWC2_POWER_DOWN_PARAM_NONE; | |
| break; | |
| case DWC2_POWER_DOWN_PARAM_HIBERNATION: | |
| if (hsotg->hw_params.hibernation) | |
| break; | |
| dev_dbg(hsotg->dev, | |
| "Hibernation isn't supported by HW\n"); | |
| param = DWC2_POWER_DOWN_PARAM_NONE; | |
| break; | |
| default: | |
| dev_err(hsotg->dev, | |
| "%s: Invalid parameter power_down=%d\n", | |
| __func__, param); | |
| param = DWC2_POWER_DOWN_PARAM_NONE; | |
| break; | |
| } | |
| hsotg->params.power_down = param; | |
| } | |
| static void dwc2_check_param_tx_fifo_sizes(struct dwc2_hsotg *hsotg) | |
| { | |
| int fifo_count; | |
| int fifo; | |
| int min; | |
| u32 total = 0; | |
| u32 dptxfszn; | |
| fifo_count = dwc2_hsotg_tx_fifo_count(hsotg); | |
| min = hsotg->hw_params.en_multiple_tx_fifo ? 16 : 4; | |
| for (fifo = 1; fifo <= fifo_count; fifo++) | |
| total += hsotg->params.g_tx_fifo_size[fifo]; | |
| if (total > dwc2_hsotg_tx_fifo_total_depth(hsotg) || !total) { | |
| dev_warn(hsotg->dev, "%s: Invalid parameter g-tx-fifo-size, setting to default average\n", | |
| __func__); | |
| dwc2_set_param_tx_fifo_sizes(hsotg); | |
| } | |
| for (fifo = 1; fifo <= fifo_count; fifo++) { | |
| dptxfszn = hsotg->hw_params.g_tx_fifo_size[fifo]; | |
| if (hsotg->params.g_tx_fifo_size[fifo] < min || | |
| hsotg->params.g_tx_fifo_size[fifo] > dptxfszn) { | |
| dev_warn(hsotg->dev, "%s: Invalid parameter g_tx_fifo_size[%d]=%d\n", | |
| __func__, fifo, | |
| hsotg->params.g_tx_fifo_size[fifo]); | |
| hsotg->params.g_tx_fifo_size[fifo] = dptxfszn; | |
| } | |
| } | |
| } | |
| static void dwc2_check_param_eusb2_disc(struct dwc2_hsotg *hsotg) | |
| { | |
| u32 gsnpsid; | |
| if (!hsotg->params.eusb2_disc) | |
| return; | |
| gsnpsid = dwc2_readl(hsotg, GSNPSID); | |
| /* | |
| * eusb2_disc not supported by FS IOT devices. | |
| * For other cores, it supported starting from version 5.00a | |
| */ | |
| if ((gsnpsid & ~DWC2_CORE_REV_MASK) == DWC2_FS_IOT_ID || | |
| (gsnpsid & DWC2_CORE_REV_MASK) < | |
| (DWC2_CORE_REV_5_00a & DWC2_CORE_REV_MASK)) { | |
| hsotg->params.eusb2_disc = false; | |
| return; | |
| } | |
| } | |
| #define CHECK_RANGE(_param, _min, _max, _def) do { \ | |
| if ((int)(hsotg->params._param) < (_min) || \ | |
| (hsotg->params._param) > (_max)) { \ | |
| dev_warn(hsotg->dev, "%s: Invalid parameter %s=%d\n", \ | |
| __func__, #_param, hsotg->params._param); \ | |
| hsotg->params._param = (_def); \ | |
| } \ | |
| } while (0) | |
| #define CHECK_BOOL(_param, _check) do { \ | |
| if (hsotg->params._param && !(_check)) { \ | |
| dev_warn(hsotg->dev, "%s: Invalid parameter %s=%d\n", \ | |
| __func__, #_param, hsotg->params._param); \ | |
| hsotg->params._param = false; \ | |
| } \ | |
| } while (0) | |
| static void dwc2_check_params(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_hw_params *hw = &hsotg->hw_params; | |
| struct dwc2_core_params *p = &hsotg->params; | |
| bool dma_capable = !(hw->arch == GHWCFG2_SLAVE_ONLY_ARCH); | |
| dwc2_check_param_otg_cap(hsotg); | |
| dwc2_check_param_phy_type(hsotg); | |
| dwc2_check_param_speed(hsotg); | |
| dwc2_check_param_phy_utmi_width(hsotg); | |
| dwc2_check_param_power_down(hsotg); | |
| dwc2_check_param_eusb2_disc(hsotg); | |
| CHECK_BOOL(enable_dynamic_fifo, hw->enable_dynamic_fifo); | |
| CHECK_BOOL(en_multiple_tx_fifo, hw->en_multiple_tx_fifo); | |
| CHECK_BOOL(i2c_enable, hw->i2c_enable); | |
| CHECK_BOOL(ipg_isoc_en, hw->ipg_isoc_en); | |
| CHECK_BOOL(acg_enable, hw->acg_enable); | |
| CHECK_BOOL(reload_ctl, (hsotg->hw_params.snpsid > DWC2_CORE_REV_2_92a)); | |
| CHECK_BOOL(lpm, (hsotg->hw_params.snpsid >= DWC2_CORE_REV_2_80a)); | |
| CHECK_BOOL(lpm, hw->lpm_mode); | |
| CHECK_BOOL(lpm_clock_gating, hsotg->params.lpm); | |
| CHECK_BOOL(besl, hsotg->params.lpm); | |
| CHECK_BOOL(besl, (hsotg->hw_params.snpsid >= DWC2_CORE_REV_3_00a)); | |
| CHECK_BOOL(hird_threshold_en, hsotg->params.lpm); | |
| CHECK_RANGE(hird_threshold, 0, hsotg->params.besl ? 12 : 7, 0); | |
| CHECK_BOOL(service_interval, hw->service_interval_mode); | |
| CHECK_RANGE(max_packet_count, | |
| 15, hw->max_packet_count, | |
| hw->max_packet_count); | |
| CHECK_RANGE(max_transfer_size, | |
| 2047, hw->max_transfer_size, | |
| hw->max_transfer_size); | |
| if ((hsotg->dr_mode == USB_DR_MODE_HOST) || | |
| (hsotg->dr_mode == USB_DR_MODE_OTG)) { | |
| CHECK_BOOL(host_dma, dma_capable); | |
| CHECK_BOOL(dma_desc_enable, p->host_dma); | |
| CHECK_BOOL(dma_desc_fs_enable, p->dma_desc_enable); | |
| CHECK_BOOL(host_ls_low_power_phy_clk, | |
| p->phy_type == DWC2_PHY_TYPE_PARAM_FS); | |
| CHECK_RANGE(host_channels, | |
| 1, hw->host_channels, | |
| hw->host_channels); | |
| CHECK_RANGE(host_rx_fifo_size, | |
| 16, hw->rx_fifo_size, | |
| hw->rx_fifo_size); | |
| CHECK_RANGE(host_nperio_tx_fifo_size, | |
| 16, hw->host_nperio_tx_fifo_size, | |
| hw->host_nperio_tx_fifo_size); | |
| CHECK_RANGE(host_perio_tx_fifo_size, | |
| 16, hw->host_perio_tx_fifo_size, | |
| hw->host_perio_tx_fifo_size); | |
| } | |
| if ((hsotg->dr_mode == USB_DR_MODE_PERIPHERAL) || | |
| (hsotg->dr_mode == USB_DR_MODE_OTG)) { | |
| CHECK_BOOL(g_dma, dma_capable); | |
| CHECK_BOOL(g_dma_desc, (p->g_dma && hw->dma_desc_enable)); | |
| CHECK_RANGE(g_rx_fifo_size, | |
| 16, hw->rx_fifo_size, | |
| hw->rx_fifo_size); | |
| CHECK_RANGE(g_np_tx_fifo_size, | |
| 16, hw->dev_nperio_tx_fifo_size, | |
| hw->dev_nperio_tx_fifo_size); | |
| dwc2_check_param_tx_fifo_sizes(hsotg); | |
| } | |
| } | |
| /* | |
| * Gets host hardware parameters. Forces host mode if not currently in | |
| * host mode. Should be called immediately after a core soft reset in | |
| * order to get the reset values. | |
| */ | |
| static void dwc2_get_host_hwparams(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_hw_params *hw = &hsotg->hw_params; | |
| u32 gnptxfsiz; | |
| u32 hptxfsiz; | |
| if (hsotg->dr_mode == USB_DR_MODE_PERIPHERAL) | |
| return; | |
| dwc2_force_mode(hsotg, true); | |
| gnptxfsiz = dwc2_readl(hsotg, GNPTXFSIZ); | |
| hptxfsiz = dwc2_readl(hsotg, HPTXFSIZ); | |
| hw->host_nperio_tx_fifo_size = (gnptxfsiz & FIFOSIZE_DEPTH_MASK) >> | |
| FIFOSIZE_DEPTH_SHIFT; | |
| hw->host_perio_tx_fifo_size = (hptxfsiz & FIFOSIZE_DEPTH_MASK) >> | |
| FIFOSIZE_DEPTH_SHIFT; | |
| } | |
| /* | |
| * Gets device hardware parameters. Forces device mode if not | |
| * currently in device mode. Should be called immediately after a core | |
| * soft reset in order to get the reset values. | |
| */ | |
| static void dwc2_get_dev_hwparams(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_hw_params *hw = &hsotg->hw_params; | |
| u32 gnptxfsiz; | |
| int fifo, fifo_count; | |
| if (hsotg->dr_mode == USB_DR_MODE_HOST) | |
| return; | |
| dwc2_force_mode(hsotg, false); | |
| gnptxfsiz = dwc2_readl(hsotg, GNPTXFSIZ); | |
| fifo_count = dwc2_hsotg_tx_fifo_count(hsotg); | |
| for (fifo = 1; fifo <= fifo_count; fifo++) { | |
| hw->g_tx_fifo_size[fifo] = | |
| (dwc2_readl(hsotg, DPTXFSIZN(fifo)) & | |
| FIFOSIZE_DEPTH_MASK) >> FIFOSIZE_DEPTH_SHIFT; | |
| } | |
| hw->dev_nperio_tx_fifo_size = (gnptxfsiz & FIFOSIZE_DEPTH_MASK) >> | |
| FIFOSIZE_DEPTH_SHIFT; | |
| } | |
| /** | |
| * dwc2_get_hwparams() - During device initialization, read various hardware | |
| * configuration registers and interpret the contents. | |
| * | |
| * @hsotg: Programming view of the DWC_otg controller | |
| * | |
| */ | |
| int dwc2_get_hwparams(struct dwc2_hsotg *hsotg) | |
| { | |
| struct dwc2_hw_params *hw = &hsotg->hw_params; | |
| unsigned int width; | |
| u32 hwcfg1, hwcfg2, hwcfg3, hwcfg4; | |
| u32 grxfsiz; | |
| hwcfg1 = dwc2_readl(hsotg, GHWCFG1); | |
| hwcfg2 = dwc2_readl(hsotg, GHWCFG2); | |
| hwcfg3 = dwc2_readl(hsotg, GHWCFG3); | |
| hwcfg4 = dwc2_readl(hsotg, GHWCFG4); | |
| grxfsiz = dwc2_readl(hsotg, GRXFSIZ); | |
| /* hwcfg1 */ | |
| hw->dev_ep_dirs = hwcfg1; | |
| /* hwcfg2 */ | |
| hw->op_mode = (hwcfg2 & GHWCFG2_OP_MODE_MASK) >> | |
| GHWCFG2_OP_MODE_SHIFT; | |
| hw->arch = (hwcfg2 & GHWCFG2_ARCHITECTURE_MASK) >> | |
| GHWCFG2_ARCHITECTURE_SHIFT; | |
| hw->enable_dynamic_fifo = !!(hwcfg2 & GHWCFG2_DYNAMIC_FIFO); | |
| hw->host_channels = 1 + ((hwcfg2 & GHWCFG2_NUM_HOST_CHAN_MASK) >> | |
| GHWCFG2_NUM_HOST_CHAN_SHIFT); | |
| hw->hs_phy_type = (hwcfg2 & GHWCFG2_HS_PHY_TYPE_MASK) >> | |
| GHWCFG2_HS_PHY_TYPE_SHIFT; | |
| hw->fs_phy_type = (hwcfg2 & GHWCFG2_FS_PHY_TYPE_MASK) >> | |
| GHWCFG2_FS_PHY_TYPE_SHIFT; | |
| hw->num_dev_ep = (hwcfg2 & GHWCFG2_NUM_DEV_EP_MASK) >> | |
| GHWCFG2_NUM_DEV_EP_SHIFT; | |
| hw->nperio_tx_q_depth = | |
| (hwcfg2 & GHWCFG2_NONPERIO_TX_Q_DEPTH_MASK) >> | |
| GHWCFG2_NONPERIO_TX_Q_DEPTH_SHIFT << 1; | |
| hw->host_perio_tx_q_depth = | |
| (hwcfg2 & GHWCFG2_HOST_PERIO_TX_Q_DEPTH_MASK) >> | |
| GHWCFG2_HOST_PERIO_TX_Q_DEPTH_SHIFT << 1; | |
| hw->dev_token_q_depth = | |
| (hwcfg2 & GHWCFG2_DEV_TOKEN_Q_DEPTH_MASK) >> | |
| GHWCFG2_DEV_TOKEN_Q_DEPTH_SHIFT; | |
| /* hwcfg3 */ | |
| width = (hwcfg3 & GHWCFG3_XFER_SIZE_CNTR_WIDTH_MASK) >> | |
| GHWCFG3_XFER_SIZE_CNTR_WIDTH_SHIFT; | |
| hw->max_transfer_size = (1 << (width + 11)) - 1; | |
| width = (hwcfg3 & GHWCFG3_PACKET_SIZE_CNTR_WIDTH_MASK) >> | |
| GHWCFG3_PACKET_SIZE_CNTR_WIDTH_SHIFT; | |
| hw->max_packet_count = (1 << (width + 4)) - 1; | |
| hw->i2c_enable = !!(hwcfg3 & GHWCFG3_I2C); | |
| hw->total_fifo_size = (hwcfg3 & GHWCFG3_DFIFO_DEPTH_MASK) >> | |
| GHWCFG3_DFIFO_DEPTH_SHIFT; | |
| hw->lpm_mode = !!(hwcfg3 & GHWCFG3_OTG_LPM_EN); | |
| /* hwcfg4 */ | |
| hw->en_multiple_tx_fifo = !!(hwcfg4 & GHWCFG4_DED_FIFO_EN); | |
| hw->num_dev_perio_in_ep = (hwcfg4 & GHWCFG4_NUM_DEV_PERIO_IN_EP_MASK) >> | |
| GHWCFG4_NUM_DEV_PERIO_IN_EP_SHIFT; | |
| hw->num_dev_in_eps = (hwcfg4 & GHWCFG4_NUM_IN_EPS_MASK) >> | |
| GHWCFG4_NUM_IN_EPS_SHIFT; | |
| hw->dma_desc_enable = !!(hwcfg4 & GHWCFG4_DESC_DMA); | |
| hw->power_optimized = !!(hwcfg4 & GHWCFG4_POWER_OPTIMIZ); | |
| hw->hibernation = !!(hwcfg4 & GHWCFG4_HIBER); | |
| hw->utmi_phy_data_width = (hwcfg4 & GHWCFG4_UTMI_PHY_DATA_WIDTH_MASK) >> | |
| GHWCFG4_UTMI_PHY_DATA_WIDTH_SHIFT; | |
| hw->acg_enable = !!(hwcfg4 & GHWCFG4_ACG_SUPPORTED); | |
| hw->ipg_isoc_en = !!(hwcfg4 & GHWCFG4_IPG_ISOC_SUPPORTED); | |
| hw->service_interval_mode = !!(hwcfg4 & | |
| GHWCFG4_SERVICE_INTERVAL_SUPPORTED); | |
| /* fifo sizes */ | |
| hw->rx_fifo_size = (grxfsiz & GRXFSIZ_DEPTH_MASK) >> | |
| GRXFSIZ_DEPTH_SHIFT; | |
| /* | |
| * Host specific hardware parameters. Reading these parameters | |
| * requires the controller to be in host mode. The mode will | |
| * be forced, if necessary, to read these values. | |
| */ | |
| dwc2_get_host_hwparams(hsotg); | |
| dwc2_get_dev_hwparams(hsotg); | |
| return 0; | |
| } | |
| static int dwc2_limit_speed(struct dwc2_hsotg *hsotg) | |
| { | |
| enum usb_device_speed usb_speed; | |
| usb_speed = usb_get_maximum_speed(hsotg->dev); | |
| switch (usb_speed) { | |
| case USB_SPEED_LOW: | |
| dev_err(hsotg->dev, "Maximum speed cannot be forced to low-speed\n"); | |
| return -EINVAL; | |
| case USB_SPEED_FULL: | |
| if (hsotg->params.speed == DWC2_SPEED_PARAM_LOW) | |
| break; | |
| hsotg->params.speed = DWC2_SPEED_PARAM_FULL; | |
| break; | |
| default: | |
| break; | |
| } | |
| return 0; | |
| } | |
| typedef void (*set_params_cb)(struct dwc2_hsotg *data); | |
| int dwc2_init_params(struct dwc2_hsotg *hsotg) | |
| { | |
| set_params_cb set_params; | |
| int ret; | |
| dwc2_set_default_params(hsotg); | |
| dwc2_get_device_properties(hsotg); | |
| set_params = device_get_match_data(hsotg->dev); | |
| if (set_params) { | |
| set_params(hsotg); | |
| } else { | |
| const struct pci_device_id *pmatch = | |
| pci_match_id(dwc2_pci_ids, to_pci_dev(hsotg->dev->parent)); | |
| if (pmatch && pmatch->driver_data) { | |
| set_params = (set_params_cb)pmatch->driver_data; | |
| set_params(hsotg); | |
| } | |
| } | |
| ret = dwc2_limit_speed(hsotg); | |
| if (ret) | |
| return ret; | |
| dwc2_check_params(hsotg); | |
| return 0; | |
| } |