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
|
// SPDX-License-Identifier: GPL-2.0-or-later
// SPDX-FileCopyrightText: 2018 Zodiac Inflight Innovation
#include <command.h>
#include <common.h>
#include <i2c/i2c.h>
#include <linux/mfd/rave-sp.h>
static int do_rdu2_switch_reset(void)
{
struct device_node *np;
struct i2c_client *client;
int ret;
u8 reg;
np = of_find_compatible_node(NULL, NULL, "zii,rave-wdt");
if (!np) {
pr_err("No switch watchdog node found\n");
return -ENODEV;
}
if (!of_device_is_available(np)) {
/*
* If switch watchdog device is not available assume
* it was removed for a reason and switch reset
* command should be a no-op
*/
return 0;
}
client = of_find_i2c_device_by_node(np);
if (!client) {
pr_err("No switch watchdog I2C device found\n");
return -ENODEV;
}
reg = 0x78;
/* set switch reset time to 100ms */
ret = i2c_write_reg(client, 0x0a, ®, 1);
if (ret < 0) {
pr_err("Failed to set switch reset time\n");
return ret;
}
/* reset the switch */
reg = 0x01;
ret = i2c_write_reg(client, 0x0d, ®, 1);
if (ret < 0) {
pr_err("Failed to reset the switch\n");
return ret;
}
/* issue dummy command to work around firmware bug */
ret = i2c_read_reg(client, 0x01, ®, 1);
if (ret < 0) {
pr_err("Failed to issue a dummy command\n");
return ret;
}
return 0;
}
static int do_rdu1_switch_reset(void)
{
struct device *sp_dev = get_device_by_name("sp");
struct rave_sp *sp = sp_dev->parent->priv;
u8 cmd[] = {
[0] = RAVE_SP_CMD_RESET_ETH_SWITCH,
[1] = 0
};
if (IS_ENABLED(CONFIG_RAVE_SP_CORE))
return rave_sp_exec(sp, cmd, sizeof(cmd), NULL, 0);
else
return -ENODEV;
}
static int do_rave_switch_reset(int argc, char *argv[])
{
if (of_machine_is_compatible("zii,imx6q-zii-rdu2") ||
of_machine_is_compatible("zii,imx6qp-zii-rdu2") ||
of_machine_is_compatible("zii,imx8mq-ultra"))
return do_rdu2_switch_reset();
if (of_machine_is_compatible("zii,imx51-rdu1"))
return do_rdu1_switch_reset();
return -ENODEV;
}
BAREBOX_CMD_START(rave_reset_switch)
.cmd = do_rave_switch_reset,
BAREBOX_CMD_DESC("reset ethernet switch on RDU")
BAREBOX_CMD_GROUP(CMD_GRP_HWMANIP)
BAREBOX_CMD_END
|