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
|
// SPDX-License-Identifier: GPL-2.0+
/*
* Copyright (C) 2012 Oleksandr Tymoshenko <gonzo@freebsd.org>
* Copyright (C) 2014 Marek Vasut <marex@denx.de>
*
* Copied from u-Boot
*/
#include <common.h>
#include <of.h>
#include <dma.h>
#include <init.h>
#include <errno.h>
#include <driver.h>
#include <linux/clk.h>
#include "dwc2.h"
static int dwc2_set_mode(void *ctx, enum usb_dr_mode mode)
{
struct dwc2 *dwc2 = ctx;
int ret = -ENODEV;
if (mode == USB_DR_MODE_HOST || mode == USB_DR_MODE_OTG) {
if (IS_ENABLED(CONFIG_USB_DWC2_HOST))
ret = dwc2_register_host(dwc2);
else
dwc2_err(dwc2, "Host support not available\n");
}
if (mode == USB_DR_MODE_PERIPHERAL || mode == USB_DR_MODE_OTG) {
if (IS_ENABLED(CONFIG_USB_DWC2_GADGET))
ret = dwc2_gadget_init(dwc2);
else
dwc2_err(dwc2, "Peripheral support not available\n");
}
return ret;
}
static int dwc2_probe(struct device_d *dev)
{
struct resource *iores;
struct dwc2 *dwc2;
int ret;
dwc2 = xzalloc(sizeof(*dwc2));
iores = dev_request_mem_resource(dev, 0);
if (IS_ERR(iores))
return PTR_ERR(iores);
dwc2->regs = IOMEM(iores->start);
dwc2->dev = dev;
ret = dwc2_core_snpsid(dwc2);
if (ret)
goto error;
/*
* Reset before dwc2_get_hwparams() then it could get power-on real
* reset value form registers.
*/
ret = dwc2_core_reset(dwc2);
if (ret)
goto error;
/* Detect config values from hardware */
dwc2_get_hwparams(dwc2);
ret = dwc2_get_dr_mode(dwc2);
dwc2_set_default_params(dwc2);
dma_set_mask(dev, DMA_BIT_MASK(32));
dev->priv = dwc2;
if (dwc2->dr_mode == USB_DR_MODE_OTG)
ret = usb_register_otg_device(dwc2->dev, dwc2_set_mode, dwc2);
else
ret = dwc2_set_mode(dwc2, dwc2->dr_mode);
error:
return ret;
}
static void dwc2_remove(struct device_d *dev)
{
struct dwc2 *dwc2 = dev->priv;
dwc2_host_uninit(dwc2);
dwc2_gadget_uninit(dwc2);
}
static const struct of_device_id dwc2_platform_dt_ids[] = {
{ .compatible = "brcm,bcm2835-usb", },
{ .compatible = "brcm,bcm2708-usb", },
{ .compatible = "snps,dwc2", },
{ }
};
static struct driver_d dwc2_driver = {
.name = "dwc2",
.probe = dwc2_probe,
.remove = dwc2_remove,
.of_compatible = DRV_OF_COMPAT(dwc2_platform_dt_ids),
};
device_platform_driver(dwc2_driver);
|
