1
2
3
4
5
6
7#include <common.h>
8#include <dm.h>
9#include <i2c.h>
10#include <asm/io.h>
11#include <asm/arch/cpu.h>
12#include <asm/arch/soc.h>
13
14DECLARE_GLOBAL_DATA_PTR;
15
16
17
18
19
20
21
22#define I2C_IO_EXP_ADDR 0x21
23#define I2C_IO_CFG_REG_0 0x6
24#define I2C_IO_DATA_OUT_REG_0 0x2
25
26#define I2C_IO_REG_0_USB_H0_OFF 0
27#define I2C_IO_REG_0_USB_H1_OFF 1
28#define I2C_IO_REG_VBUS ((1 << I2C_IO_REG_0_USB_H0_OFF) | \
29 (1 << I2C_IO_REG_0_USB_H1_OFF))
30
31#define I2C_IO_REG_0_USB_H0_CL 4
32#define I2C_IO_REG_0_USB_H1_CL 5
33#define I2C_IO_REG_CL ((1 << I2C_IO_REG_0_USB_H0_CL) | \
34 (1 << I2C_IO_REG_0_USB_H1_CL))
35
36static int usb_enabled = 0;
37
38
39
40
41
42
43
44
45
46
47int board_xhci_config(void)
48{
49 struct udevice *dev;
50 int ret;
51 u8 buf[8];
52
53 if (of_machine_is_compatible("marvell,armada7040-db")) {
54
55 ret = i2c_get_chip_for_busnum(0, I2C_IO_EXP_ADDR, 1, &dev);
56 if (ret) {
57 printf("Cannot find PCA9555: %d\n", ret);
58 return 0;
59 }
60
61
62
63
64
65 ret = dm_i2c_read(dev, I2C_IO_CFG_REG_0, buf, 1);
66 if (ret) {
67 printf("Failed to read IO expander value via I2C\n");
68 return -EIO;
69 }
70 buf[0] &= ~I2C_IO_REG_VBUS;
71 buf[0] &= ~I2C_IO_REG_CL;
72 ret = dm_i2c_write(dev, I2C_IO_CFG_REG_0, buf, 1);
73 if (ret) {
74 printf("Failed to set IO expander via I2C\n");
75 return -EIO;
76 }
77
78
79 ret = dm_i2c_read(dev, I2C_IO_DATA_OUT_REG_0, buf, 1);
80 if (ret) {
81 printf("Failed to read IO expander value via I2C\n");
82 return -EIO;
83 }
84 buf[0] &= ~I2C_IO_REG_VBUS;
85 buf[0] |= I2C_IO_REG_CL;
86 ret = dm_i2c_write(dev, I2C_IO_DATA_OUT_REG_0, buf, 1);
87 if (ret) {
88 printf("Failed to set IO expander via I2C\n");
89 return -EIO;
90 }
91
92 mdelay(500);
93 }
94
95 return 0;
96}
97
98int board_xhci_enable(void)
99{
100 struct udevice *dev;
101 int ret;
102 u8 buf[8];
103
104 if (of_machine_is_compatible("marvell,armada7040-db")) {
105
106
107
108
109 if (usb_enabled)
110 return 0;
111
112
113 ret = i2c_get_chip_for_busnum(0, I2C_IO_EXP_ADDR, 1, &dev);
114 if (ret) {
115 printf("Cannot find PCA9555: %d\n", ret);
116 return 0;
117 }
118
119
120 ret = dm_i2c_read(dev, I2C_IO_DATA_OUT_REG_0, buf, 1);
121 if (ret) {
122 printf("Failed to read IO expander value via I2C\n");
123 return -EIO;
124 }
125
126
127 buf[0] |= I2C_IO_REG_VBUS;
128 ret = dm_i2c_write(dev, I2C_IO_DATA_OUT_REG_0, buf, 1);
129 if (ret) {
130 printf("Failed to set IO expander via I2C\n");
131 return -EIO;
132 }
133
134 mdelay(500);
135 usb_enabled = 1;
136 }
137
138 return 0;
139}
140
141int board_early_init_f(void)
142{
143
144
145 return 0;
146}
147
148int board_init(void)
149{
150
151 gd->bd->bi_boot_params = CONFIG_SYS_SDRAM_BASE + 0x100;
152
153 return 0;
154}
155
156int board_late_init(void)
157{
158
159 board_xhci_config();
160
161 return 0;
162}
163