1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include "priv.h"
25#include "pad.h"
26
27void
28g94_aux_stat(struct nvkm_i2c *i2c, u32 *hi, u32 *lo, u32 *rq, u32 *tx)
29{
30 struct nvkm_device *device = i2c->subdev.device;
31 u32 intr = nvkm_rd32(device, 0x00e06c);
32 u32 stat = nvkm_rd32(device, 0x00e068) & intr, i;
33 for (i = 0, *hi = *lo = *rq = *tx = 0; i < 8; i++) {
34 if ((stat & (1 << (i * 4)))) *hi |= 1 << i;
35 if ((stat & (2 << (i * 4)))) *lo |= 1 << i;
36 if ((stat & (4 << (i * 4)))) *rq |= 1 << i;
37 if ((stat & (8 << (i * 4)))) *tx |= 1 << i;
38 }
39 nvkm_wr32(device, 0x00e06c, intr);
40}
41
42void
43g94_aux_mask(struct nvkm_i2c *i2c, u32 type, u32 mask, u32 data)
44{
45 struct nvkm_device *device = i2c->subdev.device;
46 u32 temp = nvkm_rd32(device, 0x00e068), i;
47 for (i = 0; i < 8; i++) {
48 if (mask & (1 << i)) {
49 if (!(data & (1 << i))) {
50 temp &= ~(type << (i * 4));
51 continue;
52 }
53 temp |= type << (i * 4);
54 }
55 }
56 nvkm_wr32(device, 0x00e068, temp);
57}
58
59static const struct nvkm_i2c_func
60g94_i2c = {
61 .pad_x_new = g94_i2c_pad_x_new,
62 .pad_s_new = g94_i2c_pad_s_new,
63 .aux = 4,
64 .aux_stat = g94_aux_stat,
65 .aux_mask = g94_aux_mask,
66};
67
68int
69g94_i2c_new(struct nvkm_device *device, int index, struct nvkm_i2c **pi2c)
70{
71 return nvkm_i2c_new_(&g94_i2c, device, index, pi2c);
72}
73