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
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
|
#include <stdlib.h>
#include <limits.h>
#include <unistd.h>
#include <nvif/client.h>
#include <nvif/device.h>
#include <nvif/class.h>
static void
print_chan(struct nvkm_i2c_port *chan)
{
printf("chan 0x%02x: type %04x\n", chan->index, nv_mclass(chan));
}
int
main(int argc, char **argv)
{
const char *drv = "lib";
const char *cfg = NULL;
const char *dbg = "error";
u64 dev = ~0ULL;
struct nvif_client *client;
struct nvif_device *device;
struct nvkm_i2c_port *chan;
struct nvkm_i2c *i2c;
int action = -1, index = -1;
int addr = -1, val = -1;
int ret, c;
u8 data;
while ((c = getopt(argc, argv, "-a:b:c:d:")) != -1) {
switch (c) {
case 'a': dev = strtoull(optarg, NULL, 0); break;
case 'b': drv = optarg; break;
case 'c': cfg = optarg; break;
case 'd': dbg = optarg; break;
case 1:
if (action < 0) {
if (!strcasecmp(optarg, "rd"))
action = 0;
else
if (!strcasecmp(optarg, "wr"))
action = 1;
else
return -EINVAL;
} else
if (action >= 0 && index < 0) {
index = strtoul(optarg, NULL, 0);
} else
if (action >= 0 && addr < 0) {
addr = strtoul(optarg, NULL, 0);
if (addr > 0x000fffff)
return -EINVAL;
} else
if (action >= 1 && val < 0) {
val = strtoul(optarg, NULL, 0);
if (val > 0xff)
return -EINVAL;
data = val;
} else
return -EINVAL;
break;
}
}
ret = nvif_client_new(drv, argv[0], dev, cfg, dbg, &client);
if (ret)
return ret;
ret = nvif_device_new(nvif_object(client), 0x00000000, NV_DEVICE,
&(struct nv_device_v0) {
.device = ~0ULL,
.disable = ~(NV_DEVICE_V0_DISABLE_MMIO |
NV_DEVICE_V0_DISABLE_IDENTIFY|
NV_DEVICE_V0_DISABLE_VBIOS |
NV_DEVICE_V0_DISABLE_CORE),
.debug0 = ~((1 << NVDEV_SUBDEV_VBIOS) |
(1 << NVDEV_SUBDEV_I2C)),
}, sizeof(struct nv_device_v0), &device);
nvif_client_ref(NULL, &client);
if (ret)
return ret;
i2c = nvxx_i2c(device);
if (action < 0) {
list_for_each_entry(chan, &i2c->ports, head) {
if ((nv_mclass(chan) & 0x00ff) == 0x06)
print_chan(chan);
}
} else {
chan = i2c->find(i2c, index);
if (!chan || (nv_mclass(chan) & 0x00ff) != 0x06) {
ret = -ENOENT;
goto done;
}
print_chan(chan);
}
switch (action) {
case 0:
ret = nv_rdaux(chan, addr, &data, 1);
printf("%05x: ", addr);
if (ret < 0)
printf("%s\n", strerror(ret));
else
printf("%02x\n", data);
break;
case 1:
printf("%05x: %02x", addr, data);
ret = nv_wraux(chan, addr, &data, 1);
if (ret < 0)
printf(" - %s", strerror(ret));
printf("\n");
break;
}
done:
nvif_device_ref(NULL, &device);
return ret;
}
|
