1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#define gf119_i2c_bus(p) container_of((p), struct gf119_i2c_bus, base)
25#include "bus.h"
26
27struct gf119_i2c_bus {
28 struct nvkm_i2c_bus base;
29 u32 addr;
30};
31
32static void
33gf119_i2c_bus_drive_scl(struct nvkm_i2c_bus *base, int state)
34{
35 struct gf119_i2c_bus *bus = gf119_i2c_bus(base);
36 struct nvkm_device *device = bus->base.pad->i2c->subdev.device;
37 nvkm_mask(device, bus->addr, 0x00000001, state ? 0x00000001 : 0);
38}
39
40static void
41gf119_i2c_bus_drive_sda(struct nvkm_i2c_bus *base, int state)
42{
43 struct gf119_i2c_bus *bus = gf119_i2c_bus(base);
44 struct nvkm_device *device = bus->base.pad->i2c->subdev.device;
45 nvkm_mask(device, bus->addr, 0x00000002, state ? 0x00000002 : 0);
46}
47
48static int
49gf119_i2c_bus_sense_scl(struct nvkm_i2c_bus *base)
50{
51 struct gf119_i2c_bus *bus = gf119_i2c_bus(base);
52 struct nvkm_device *device = bus->base.pad->i2c->subdev.device;
53 return !!(nvkm_rd32(device, bus->addr) & 0x00000010);
54}
55
56static int
57gf119_i2c_bus_sense_sda(struct nvkm_i2c_bus *base)
58{
59 struct gf119_i2c_bus *bus = gf119_i2c_bus(base);
60 struct nvkm_device *device = bus->base.pad->i2c->subdev.device;
61 return !!(nvkm_rd32(device, bus->addr) & 0x00000020);
62}
63
64static void
65gf119_i2c_bus_init(struct nvkm_i2c_bus *base)
66{
67 struct gf119_i2c_bus *bus = gf119_i2c_bus(base);
68 struct nvkm_device *device = bus->base.pad->i2c->subdev.device;
69 nvkm_wr32(device, bus->addr, 0x00000007);
70}
71
72static const struct nvkm_i2c_bus_func
73gf119_i2c_bus_func = {
74 .init = gf119_i2c_bus_init,
75 .drive_scl = gf119_i2c_bus_drive_scl,
76 .drive_sda = gf119_i2c_bus_drive_sda,
77 .sense_scl = gf119_i2c_bus_sense_scl,
78 .sense_sda = gf119_i2c_bus_sense_sda,
79 .xfer = nvkm_i2c_bit_xfer,
80};
81
82int
83gf119_i2c_bus_new(struct nvkm_i2c_pad *pad, int id, u8 drive,
84 struct nvkm_i2c_bus **pbus)
85{
86 struct gf119_i2c_bus *bus;
87
88 if (!(bus = kzalloc(sizeof(*bus), GFP_KERNEL)))
89 return -ENOMEM;
90 *pbus = &bus->base;
91
92 nvkm_i2c_bus_ctor(&gf119_i2c_bus_func, pad, id, &bus->base);
93 bus->addr = 0x00d014 + (drive * 0x20);
94 return 0;
95}
96