hc
2024-05-10 23fa18eaa71266feff7ba8d83022d9e1cc83c65a
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
/*
 * (C) Copyright 2014, Xilinx, Inc
 *
 * USB Low level initialization(Specific to zynq)
 *
 * SPDX-License-Identifier:    GPL-2.0+
 */
 
#include <common.h>
#include <dm.h>
#include <usb.h>
#include <asm/arch/hardware.h>
#include <asm/arch/sys_proto.h>
#include <asm/io.h>
#include <usb/ehci-ci.h>
#include <usb/ulpi.h>
 
#include "ehci.h"
 
struct zynq_ehci_priv {
   struct ehci_ctrl ehcictrl;
   struct usb_ehci *ehci;
};
 
static int ehci_zynq_ofdata_to_platdata(struct udevice *dev)
{
   struct zynq_ehci_priv *priv = dev_get_priv(dev);
 
   priv->ehci = (struct usb_ehci *)devfdt_get_addr_ptr(dev);
   if (!priv->ehci)
       return -EINVAL;
 
   return 0;
}
 
static int ehci_zynq_probe(struct udevice *dev)
{
   struct usb_platdata *plat = dev_get_platdata(dev);
   struct zynq_ehci_priv *priv = dev_get_priv(dev);
   struct ehci_hccr *hccr;
   struct ehci_hcor *hcor;
   struct ulpi_viewport ulpi_vp;
   /* Used for writing the ULPI data address */
   struct ulpi_regs *ulpi = (struct ulpi_regs *)0;
   int ret;
 
   hccr = (struct ehci_hccr *)((uint32_t)&priv->ehci->caplength);
   hcor = (struct ehci_hcor *)((uint32_t) hccr +
           HC_LENGTH(ehci_readl(&hccr->cr_capbase)));
 
   ulpi_vp.viewport_addr = (u32)&priv->ehci->ulpi_viewpoint;
   ulpi_vp.port_num = 0;
 
   ret = ulpi_init(&ulpi_vp);
   if (ret) {
       puts("zynq ULPI viewport init failed\n");
       return -1;
   }
 
   /* ULPI set flags */
   ulpi_write(&ulpi_vp, &ulpi->otg_ctrl,
          ULPI_OTG_DP_PULLDOWN | ULPI_OTG_DM_PULLDOWN |
          ULPI_OTG_EXTVBUSIND);
   ulpi_write(&ulpi_vp, &ulpi->function_ctrl,
          ULPI_FC_FULL_SPEED | ULPI_FC_OPMODE_NORMAL |
          ULPI_FC_SUSPENDM);
   ulpi_write(&ulpi_vp, &ulpi->iface_ctrl, 0);
 
   /* Set VBus */
   ulpi_write(&ulpi_vp, &ulpi->otg_ctrl_set,
          ULPI_OTG_DRVVBUS | ULPI_OTG_DRVVBUS_EXT);
 
   return ehci_register(dev, hccr, hcor, NULL, 0, plat->init_type);
}
 
static const struct udevice_id ehci_zynq_ids[] = {
   { .compatible = "xlnx,zynq-usb-2.20a" },
   { }
};
 
U_BOOT_DRIVER(ehci_zynq) = {
   .name    = "ehci_zynq",
   .id    = UCLASS_USB,
   .of_match = ehci_zynq_ids,
   .ofdata_to_platdata = ehci_zynq_ofdata_to_platdata,
   .probe = ehci_zynq_probe,
   .remove = ehci_deregister,
   .ops    = &ehci_usb_ops,
   .platdata_auto_alloc_size = sizeof(struct usb_platdata),
   .priv_auto_alloc_size = sizeof(struct zynq_ehci_priv),
   .flags    = DM_FLAG_ALLOC_PRIV_DMA,
};