1 /*
2 * Copyright (C) 2016 Stefan Roese <sr@denx.de>
3 *
4 * SPDX-License-Identifier: GPL-2.0+
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
14 DECLARE_GLOBAL_DATA_PTR;
15
16 /*
17 * Information specific to the DB-88F7040 eval board. We strive to use
18 * DT for such platform specfic configurations. At some point, this
19 * might be removed here and implemented via DT.
20 */
21 /* IO expander I2C device */
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 /* VBus enable */
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 /* Current limit */
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
36 static int usb_enabled = 0;
37
38 /* Board specific xHCI dis-/enable code */
39
40 /*
41 * Set USB VBUS signals (via I2C IO expander/GPIO) as output and set
42 * output value as disabled
43 *
44 * Set USB Current Limit signals (via I2C IO expander/GPIO) as output
45 * and set output value as enabled
46 */
board_xhci_config(void)47 int 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 /* Configure IO exander PCA9555: 7bit address 0x21 */
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 * Read configuration (direction) and set VBUS pin as output
63 * (reset pin = output)
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 /* Read output value and configure it */
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); /* required delay to let output value settle */
93 }
94
95 return 0;
96 }
97
board_xhci_enable(fdt_addr_t base)98 int board_xhci_enable(fdt_addr_t base)
99 {
100 struct udevice *dev;
101 int ret;
102 u8 buf[8];
103
104 if (of_machine_is_compatible("marvell,armada7040-db")) {
105 /*
106 * This function enables all USB ports simultaniously,
107 * it only needs to get called once
108 */
109 if (usb_enabled)
110 return 0;
111
112 /* Configure IO exander PCA9555: 7bit address 0x21 */
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 /* Read VBUS output value */
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 /* Enable VBUS power: Set output value of VBUS pin as enabled */
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); /* required delay to let output value settle */
135 usb_enabled = 1;
136 }
137
138 return 0;
139 }
140
board_early_init_f(void)141 int board_early_init_f(void)
142 {
143 /* Nothing to do (yet), perhaps later some pin-muxing etc */
144
145 return 0;
146 }
147
board_init(void)148 int board_init(void)
149 {
150 /* adress of boot parameters */
151 gd->bd->bi_boot_params = CONFIG_SYS_SDRAM_BASE + 0x100;
152
153 return 0;
154 }
155
board_late_init(void)156 int board_late_init(void)
157 {
158 /* Pre-configure the USB ports (overcurrent, VBus) */
159 board_xhci_config();
160
161 return 0;
162 }
163