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 "aux.h"
25#include "pad.h"
26
27static int
28nvkm_i2c_aux_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num)
29{
30 struct nvkm_i2c_aux *aux = container_of(adap, typeof(*aux), i2c);
31 struct i2c_msg *msg = msgs;
32 int ret, mcnt = num;
33
34 ret = nvkm_i2c_aux_acquire(aux);
35 if (ret)
36 return ret;
37
38 while (mcnt--) {
39 u8 remaining = msg->len;
40 u8 *ptr = msg->buf;
41
42 while (remaining) {
43 u8 cnt, retries, cmd;
44
45 if (msg->flags & I2C_M_RD)
46 cmd = 1;
47 else
48 cmd = 0;
49
50 if (mcnt || remaining > 16)
51 cmd |= 4;
52
53 for (retries = 0, cnt = 0;
54 retries < 32 && !cnt;
55 retries++) {
56 cnt = min_t(u8, remaining, 16);
57 ret = aux->func->xfer(aux, true, cmd,
58 msg->addr, ptr, &cnt);
59 if (ret < 0)
60 goto out;
61 }
62 if (!cnt) {
63 AUX_TRACE(aux, "no data after 32 retries");
64 ret = -EIO;
65 goto out;
66 }
67
68 ptr += cnt;
69 remaining -= cnt;
70 }
71
72 msg++;
73 }
74
75 ret = num;
76out:
77 nvkm_i2c_aux_release(aux);
78 return ret;
79}
80
81static u32
82nvkm_i2c_aux_i2c_func(struct i2c_adapter *adap)
83{
84 return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
85}
86
87static const struct i2c_algorithm
88nvkm_i2c_aux_i2c_algo = {
89 .master_xfer = nvkm_i2c_aux_i2c_xfer,
90 .functionality = nvkm_i2c_aux_i2c_func
91};
92
93void
94nvkm_i2c_aux_monitor(struct nvkm_i2c_aux *aux, bool monitor)
95{
96 struct nvkm_i2c_pad *pad = aux->pad;
97 AUX_TRACE(aux, "monitor: %s", monitor ? "yes" : "no");
98 if (monitor)
99 nvkm_i2c_pad_mode(pad, NVKM_I2C_PAD_AUX);
100 else
101 nvkm_i2c_pad_mode(pad, NVKM_I2C_PAD_OFF);
102}
103
104void
105nvkm_i2c_aux_release(struct nvkm_i2c_aux *aux)
106{
107 struct nvkm_i2c_pad *pad = aux->pad;
108 AUX_TRACE(aux, "release");
109 nvkm_i2c_pad_release(pad);
110 mutex_unlock(&aux->mutex);
111}
112
113int
114nvkm_i2c_aux_acquire(struct nvkm_i2c_aux *aux)
115{
116 struct nvkm_i2c_pad *pad = aux->pad;
117 int ret;
118
119 AUX_TRACE(aux, "acquire");
120 mutex_lock(&aux->mutex);
121
122 if (aux->enabled)
123 ret = nvkm_i2c_pad_acquire(pad, NVKM_I2C_PAD_AUX);
124 else
125 ret = -EIO;
126
127 if (ret)
128 mutex_unlock(&aux->mutex);
129 return ret;
130}
131
132int
133nvkm_i2c_aux_xfer(struct nvkm_i2c_aux *aux, bool retry, u8 type,
134 u32 addr, u8 *data, u8 *size)
135{
136 if (!*size && !aux->func->address_only) {
137 AUX_ERR(aux, "address-only transaction dropped");
138 return -ENOSYS;
139 }
140 return aux->func->xfer(aux, retry, type, addr, data, size);
141}
142
143int
144nvkm_i2c_aux_lnk_ctl(struct nvkm_i2c_aux *aux, int nr, int bw, bool ef)
145{
146 if (aux->func->lnk_ctl)
147 return aux->func->lnk_ctl(aux, nr, bw, ef);
148 return -ENODEV;
149}
150
151void
152nvkm_i2c_aux_del(struct nvkm_i2c_aux **paux)
153{
154 struct nvkm_i2c_aux *aux = *paux;
155 if (aux && !WARN_ON(!aux->func)) {
156 AUX_TRACE(aux, "dtor");
157 list_del(&aux->head);
158 i2c_del_adapter(&aux->i2c);
159 kfree(*paux);
160 *paux = NULL;
161 }
162}
163
164void
165nvkm_i2c_aux_init(struct nvkm_i2c_aux *aux)
166{
167 AUX_TRACE(aux, "init");
168 mutex_lock(&aux->mutex);
169 aux->enabled = true;
170 mutex_unlock(&aux->mutex);
171}
172
173void
174nvkm_i2c_aux_fini(struct nvkm_i2c_aux *aux)
175{
176 AUX_TRACE(aux, "fini");
177 mutex_lock(&aux->mutex);
178 aux->enabled = false;
179 mutex_unlock(&aux->mutex);
180}
181
182int
183nvkm_i2c_aux_ctor(const struct nvkm_i2c_aux_func *func,
184 struct nvkm_i2c_pad *pad, int id,
185 struct nvkm_i2c_aux *aux)
186{
187 struct nvkm_device *device = pad->i2c->subdev.device;
188
189 aux->func = func;
190 aux->pad = pad;
191 aux->id = id;
192 mutex_init(&aux->mutex);
193 list_add_tail(&aux->head, &pad->i2c->aux);
194 AUX_TRACE(aux, "ctor");
195
196 snprintf(aux->i2c.name, sizeof(aux->i2c.name), "nvkm-%s-aux-%04x",
197 dev_name(device->dev), id);
198 aux->i2c.owner = THIS_MODULE;
199 aux->i2c.dev.parent = device->dev;
200 aux->i2c.algo = &nvkm_i2c_aux_i2c_algo;
201 return i2c_add_adapter(&aux->i2c);
202}
203
204int
205nvkm_i2c_aux_new_(const struct nvkm_i2c_aux_func *func,
206 struct nvkm_i2c_pad *pad, int id,
207 struct nvkm_i2c_aux **paux)
208{
209 if (!(*paux = kzalloc(sizeof(**paux), GFP_KERNEL)))
210 return -ENOMEM;
211 return nvkm_i2c_aux_ctor(func, pad, id, *paux);
212}
213