1 /* 2 * Copyright 2016 Rockchip Electronics Co., Ltd 3 * 4 * SPDX-License-Identifier: GPL-2.0+ 5 */ 6 7 #include <common.h> 8 #include <asm/arch/clock.h> 9 #include <asm/io.h> 10 #include <fdtdec.h> 11 #include <libfdt.h> 12 #include <syscon.h> 13 14 #include "../gadget/dwc2_udc_otg_priv.h" 15 16 DECLARE_GLOBAL_DATA_PTR; 17 18 #define BIT_WRITEABLE_SHIFT 16 19 20 struct usb2phy_reg { 21 unsigned int offset; 22 unsigned int bitend; 23 unsigned int bitstart; 24 unsigned int disable; 25 unsigned int enable; 26 }; 27 28 /** 29 * struct rockchip_usb2_phy_cfg: usb-phy port configuration 30 * @port_reset: usb otg per-port reset register 31 * @soft_con: software control usb otg register 32 * @suspend: phy suspend register 33 */ 34 struct rockchip_usb2_phy_cfg { 35 struct usb2phy_reg port_reset; 36 struct usb2phy_reg soft_con; 37 struct usb2phy_reg suspend; 38 }; 39 40 struct rockchip_usb2_phy_dt_id { 41 char compatible[128]; 42 const void *data; 43 }; 44 45 static const struct rockchip_usb2_phy_cfg rk3288_pdata = { 46 .port_reset = {0x00, 12, 12, 0, 1}, 47 .soft_con = {0x08, 2, 2, 0, 1}, 48 .suspend = {0x0c, 5, 0, 0x01, 0x2A}, 49 }; 50 51 static struct rockchip_usb2_phy_dt_id rockchip_usb2_phy_dt_ids[] = { 52 { .compatible = "rockchip,rk3288-usb-phy", .data = &rk3288_pdata }, 53 {} 54 }; 55 56 static void property_enable(struct dwc2_plat_otg_data *pdata, 57 const struct usb2phy_reg *reg, bool en) 58 { 59 unsigned int val, mask, tmp; 60 61 tmp = en ? reg->enable : reg->disable; 62 mask = GENMASK(reg->bitend, reg->bitstart); 63 val = (tmp << reg->bitstart) | (mask << BIT_WRITEABLE_SHIFT); 64 65 writel(val, pdata->regs_phy + reg->offset); 66 } 67 68 static int otg_phy_parse(struct dwc2_udc *dev) 69 { 70 int node, phy_node; 71 u32 grf_base, grf_offset; 72 const char *mode; 73 bool matched = false; 74 const void *blob = gd->fdt_blob; 75 struct dwc2_plat_otg_data *pdata = dev->pdata; 76 77 /* Find the usb_otg node */ 78 node = fdt_node_offset_by_compatible(blob, -1, "snps,dwc2"); 79 while (node > 0) { 80 mode = fdt_getprop(blob, node, "dr_mode", NULL); 81 if (mode && strcmp(mode, "otg") == 0) { 82 matched = true; 83 break; 84 } 85 86 node = fdt_node_offset_by_compatible(blob, node, "snps,dwc2"); 87 } 88 89 if (!matched) { 90 pr_err("Not found usb_otg device\n"); 91 return -ENODEV; 92 } 93 94 /* Find the usb phy node */ 95 node = fdtdec_lookup_phandle(blob, node, "phys"); 96 if (node <= 0) { 97 pr_err("Not found usbphy device\n"); 98 return -ENODEV; 99 } 100 101 /* Find the usb otg-phy node */ 102 phy_node = fdt_parent_offset(blob, node); 103 if (phy_node <= 0) { 104 pr_err("Not found sub usbphy device\n"); 105 return -ENODEV; 106 } 107 108 grf_base = (u32)syscon_get_first_range(ROCKCHIP_SYSCON_GRF); 109 grf_offset = fdtdec_get_addr(blob, node, "reg"); 110 111 /* Pad dwc2_plat_otg_data related to phy */ 112 pdata->phy_of_node = phy_node; 113 pdata->regs_phy = grf_base + grf_offset; 114 115 return 0; 116 } 117 118 void otg_phy_init(struct dwc2_udc *dev) 119 { 120 struct dwc2_plat_otg_data *pdata = dev->pdata; 121 struct rockchip_usb2_phy_cfg *phy_cfg = NULL; 122 struct rockchip_usb2_phy_dt_id *of_id; 123 int i; 124 125 if (!pdata->regs_phy && otg_phy_parse(dev)) { 126 pr_err("otg-phy parse error\n"); 127 return; 128 } 129 130 for (i = 0; i < ARRAY_SIZE(rockchip_usb2_phy_dt_ids); i++) { 131 of_id = &rockchip_usb2_phy_dt_ids[i]; 132 if (fdt_node_check_compatible(gd->fdt_blob, pdata->phy_of_node, 133 of_id->compatible) == 0) { 134 phy_cfg = (struct rockchip_usb2_phy_cfg *)of_id->data; 135 break; 136 } 137 } 138 if (!phy_cfg) { 139 debug("Can't find device platform data\n"); 140 141 hang(); 142 return; 143 } 144 pdata->priv = phy_cfg; 145 /* disable software control */ 146 property_enable(pdata, &phy_cfg->soft_con, false); 147 148 /* reset otg port */ 149 property_enable(pdata, &phy_cfg->port_reset, true); 150 mdelay(1); 151 property_enable(pdata, &phy_cfg->port_reset, false); 152 udelay(1); 153 } 154 155 void otg_phy_off(struct dwc2_udc *dev) 156 { 157 struct dwc2_plat_otg_data *pdata = dev->pdata; 158 struct rockchip_usb2_phy_cfg *phy_cfg = pdata->priv; 159 160 if (!pdata->regs_phy && otg_phy_parse(dev)) { 161 pr_err("otg-phy parse error\n"); 162 return; 163 } 164 165 /* enable software control */ 166 property_enable(pdata, &phy_cfg->soft_con, true); 167 /* enter suspend */ 168 property_enable(pdata, &phy_cfg->suspend, true); 169 } 170