Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 | // SPDX-License-Identifier: GPL-2.0+ /* Copyright (C) 2019 Stephan Gerhold */ #include <dm.h> #include <generic-phy.h> #include <dm/device_compat.h> #include "musb_uboot.h" static struct musb_hdrc_config ux500_musb_hdrc_config = { .multipoint = true, .dyn_fifo = true, .num_eps = 16, .ram_bits = 16, }; struct ux500_glue { struct musb_host_data mdata; struct device dev; struct phy phy; bool enabled; }; #define to_ux500_glue(d) container_of(d, struct ux500_glue, dev) static int ux500_musb_enable(struct musb *musb) { struct ux500_glue *glue = to_ux500_glue(musb->controller); int ret; if (glue->enabled) return 0; ret = generic_phy_power_on(&glue->phy); if (ret) { printf("%s: failed to power on USB PHY\n", __func__); return ret; } glue->enabled = true; return 0; } static void ux500_musb_disable(struct musb *musb) { struct ux500_glue *glue = to_ux500_glue(musb->controller); int ret; if (!glue->enabled) return; ret = generic_phy_power_off(&glue->phy); if (ret) { printf("%s: failed to power off USB PHY\n", __func__); return; } glue->enabled = false; } static int ux500_musb_init(struct musb *musb) { struct ux500_glue *glue = to_ux500_glue(musb->controller); int ret; ret = generic_phy_init(&glue->phy); if (ret) { printf("%s: failed to init USB PHY\n", __func__); return ret; } return 0; } static int ux500_musb_exit(struct musb *musb) { struct ux500_glue *glue = to_ux500_glue(musb->controller); int ret; ret = generic_phy_exit(&glue->phy); if (ret) { printf("%s: failed to exit USB PHY\n", __func__); return ret; } return 0; } static const struct musb_platform_ops ux500_musb_ops = { .init = ux500_musb_init, .exit = ux500_musb_exit, .enable = ux500_musb_enable, .disable = ux500_musb_disable, }; static int ux500_musb_probe(struct udevice *dev) { #ifdef CONFIG_USB_MUSB_HOST struct usb_bus_priv *priv = dev_get_uclass_priv(dev); #endif struct ux500_glue *glue = dev_get_priv(dev); struct musb_host_data *host = &glue->mdata; struct musb_hdrc_platform_data pdata; void *base = dev_read_addr_ptr(dev); int ret; if (!base) return -EINVAL; ret = generic_phy_get_by_name(dev, "usb", &glue->phy); if (ret) { dev_err(dev, "failed to get USB PHY: %d\n", ret); return ret; } memset(&pdata, 0, sizeof(pdata)); pdata.platform_ops = &ux500_musb_ops; pdata.config = &ux500_musb_hdrc_config; #ifdef CONFIG_USB_MUSB_HOST priv->desc_before_addr = true; pdata.mode = MUSB_HOST; host->host = musb_init_controller(&pdata, &glue->dev, base); if (!host->host) return -EIO; return musb_lowlevel_init(host); #else pdata.mode = MUSB_PERIPHERAL; host->host = musb_init_controller(&pdata, &glue->dev, base); if (!host->host) return -EIO; return usb_add_gadget_udc(&glue->dev, &host->host->g); #endif } static int ux500_musb_remove(struct udevice *dev) { struct ux500_glue *glue = dev_get_priv(dev); struct musb_host_data *host = &glue->mdata; usb_del_gadget_udc(&host->host->g); musb_stop(host->host); free(host->host); host->host = NULL; return 0; } static int ux500_gadget_handle_interrupts(struct udevice *dev) { struct ux500_glue *glue = dev_get_priv(dev); glue->mdata.host->isr(0, glue->mdata.host); return 0; } static const struct usb_gadget_generic_ops ux500_gadget_ops = { .handle_interrupts = ux500_gadget_handle_interrupts, }; static const struct udevice_id ux500_musb_ids[] = { { .compatible = "stericsson,db8500-musb" }, { } }; U_BOOT_DRIVER(ux500_musb) = { .name = "ux500-musb", #ifdef CONFIG_USB_MUSB_HOST .id = UCLASS_USB, .ops = &musb_usb_ops, #else .id = UCLASS_USB_GADGET_GENERIC, .ops = &ux500_gadget_ops, #endif .of_match = ux500_musb_ids, .probe = ux500_musb_probe, .remove = ux500_musb_remove, .plat_auto = sizeof(struct usb_plat), .priv_auto = sizeof(struct ux500_glue), }; |