projects / linux-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Merge tag 'wireless-2024-01-22' of git://git.kernel.org/pub/scm/linux/kernel/git...
[linux-block.git] / drivers / greybus / svc.c
CommitLineData
eb50fd3a 1// SPDX-License-Identifier: GPL-2.0
30c6d9d7
AE		 2/*
3 * SVC Greybus driver.
4 *
5 * Copyright 2015 Google Inc.
6 * Copyright 2015 Linaro Ltd.
30c6d9d7
AE		 7 */
8
9504677c 9#include <linux/debugfs.h>
0d4a030b 10#include <linux/kstrtox.h>
067906f6 11#include <linux/workqueue.h>
ec0ad868 12#include <linux/greybus.h>
f66427ad 13
140026b3
JC		 14#define SVC_INTF_EJECT_TIMEOUT 9000
15#define SVC_INTF_ACTIVATE_TIMEOUT 6000
1f3e09e7 16#define SVC_INTF_RESUME_TIMEOUT 3000
d18da86b 17
9ae4109e 18struct gb_svc_deferred_request {
067906f6 19 struct work_struct work;
9ae4109e 20 struct gb_operation *operation;
067906f6
VK		 21};
22
ee2f2074
MT		 23static int gb_svc_queue_deferred_request(struct gb_operation *operation);
24
66069fb0 25static ssize_t endo_id_show(struct device *dev,
8478c35a 26 struct device_attribute *attr, char *buf)
66069fb0
JH		 27{
28 struct gb_svc *svc = to_gb_svc(dev);
29
30 return sprintf(buf, "0x%04x\n", svc->endo_id);
31}
32static DEVICE_ATTR_RO(endo_id);
33
34static ssize_t ap_intf_id_show(struct device *dev,
8478c35a 35 struct device_attribute *attr, char *buf)
66069fb0
JH		 36{
37 struct gb_svc *svc = to_gb_svc(dev);
38
39 return sprintf(buf, "%u\n", svc->ap_intf_id);
40}
41static DEVICE_ATTR_RO(ap_intf_id);
42
2c92bd52
RMS		 43// FIXME
44// This is a hack, we need to do this "right" and clean the interface up
45// properly, not just forcibly yank the thing out of the system and hope for the
46// best. But for now, people want their modules to come out without having to
47// throw the thing to the ground or get out a screwdriver.
48static ssize_t intf_eject_store(struct device *dev,
49 struct device_attribute *attr, const char *buf,
50 size_t len)
51{
52 struct gb_svc *svc = to_gb_svc(dev);
53 unsigned short intf_id;
54 int ret;
55
56 ret = kstrtou16(buf, 10, &intf_id);
57 if (ret < 0)
58 return ret;
59
60 dev_warn(dev, "Forcibly trying to eject interface %d\n", intf_id);
61
62 ret = gb_svc_intf_eject(svc, intf_id);
63 if (ret < 0)
64 return ret;
65
66 return len;
67}
68static DEVICE_ATTR_WO(intf_eject);
69
d562853d
GKH		 70static ssize_t watchdog_show(struct device *dev, struct device_attribute *attr,
71 char *buf)
72{
73 struct gb_svc *svc = to_gb_svc(dev);
74
75 return sprintf(buf, "%s\n",
76 gb_svc_watchdog_enabled(svc) ? "enabled" : "disabled");
77}
78
79static ssize_t watchdog_store(struct device *dev,
80 struct device_attribute *attr, const char *buf,
81 size_t len)
82{
83 struct gb_svc *svc = to_gb_svc(dev);
84 int retval;
85 bool user_request;
86
0d4a030b 87 retval = kstrtobool(buf, &user_request);
d562853d
GKH		 88 if (retval)
89 return retval;
90
91 if (user_request)
92 retval = gb_svc_watchdog_enable(svc);
93 else
94 retval = gb_svc_watchdog_disable(svc);
95 if (retval)
96 return retval;
97 return len;
98}
99static DEVICE_ATTR_RW(watchdog);
100
7c4a0edb
DL		 101static ssize_t watchdog_action_show(struct device *dev,
102 struct device_attribute *attr, char *buf)
103{
104 struct gb_svc *svc = to_gb_svc(dev);
105
106 if (svc->action == GB_SVC_WATCHDOG_BITE_PANIC_KERNEL)
107 return sprintf(buf, "panic\n");
108 else if (svc->action == GB_SVC_WATCHDOG_BITE_RESET_UNIPRO)
109 return sprintf(buf, "reset\n");
110
111 return -EINVAL;
112}
113
114static ssize_t watchdog_action_store(struct device *dev,
115 struct device_attribute *attr,
116 const char *buf, size_t len)
117{
118 struct gb_svc *svc = to_gb_svc(dev);
119
120 if (sysfs_streq(buf, "panic"))
121 svc->action = GB_SVC_WATCHDOG_BITE_PANIC_KERNEL;
122 else if (sysfs_streq(buf, "reset"))
123 svc->action = GB_SVC_WATCHDOG_BITE_RESET_UNIPRO;
124 else
125 return -EINVAL;
126
127 return len;
128}
129static DEVICE_ATTR_RW(watchdog_action);
130
9504677c
DL		 131static int gb_svc_pwrmon_rail_count_get(struct gb_svc *svc, u8 *value)
132{
133 struct gb_svc_pwrmon_rail_count_get_response response;
134 int ret;
135
136 ret = gb_operation_sync(svc->connection,
137 GB_SVC_TYPE_PWRMON_RAIL_COUNT_GET, NULL, 0,
138 &response, sizeof(response));
139 if (ret) {
89f2df43 140 dev_err(&svc->dev, "failed to get rail count: %d\n", ret);
9504677c
DL		 141 return ret;
142 }
143
144 *value = response.rail_count;
145
146 return 0;
147}
148
149static int gb_svc_pwrmon_rail_names_get(struct gb_svc *svc,
f35fdb2f
JH		 150 struct gb_svc_pwrmon_rail_names_get_response *response,
151 size_t bufsize)
9504677c
DL		 152{
153 int ret;
154
155 ret = gb_operation_sync(svc->connection,
156 GB_SVC_TYPE_PWRMON_RAIL_NAMES_GET, NULL, 0,
157 response, bufsize);
158 if (ret) {
89f2df43 159 dev_err(&svc->dev, "failed to get rail names: %d\n", ret);
9504677c
DL		 160 return ret;
161 }
162
8fb76c3c
DL		 163 if (response->status != GB_SVC_OP_SUCCESS) {
164 dev_err(&svc->dev,
165 "SVC error while getting rail names: %u\n",
166 response->status);
167 return -EREMOTEIO;
168 }
169
9504677c
DL		 170 return 0;
171}
172
173static int gb_svc_pwrmon_sample_get(struct gb_svc *svc, u8 rail_id,
174 u8 measurement_type, u32 *value)
175{
176 struct gb_svc_pwrmon_sample_get_request request;
177 struct gb_svc_pwrmon_sample_get_response response;
178 int ret;
179
180 request.rail_id = rail_id;
181 request.measurement_type = measurement_type;
182
183 ret = gb_operation_sync(svc->connection, GB_SVC_TYPE_PWRMON_SAMPLE_GET,
184 &request, sizeof(request),
185 &response, sizeof(response));
186 if (ret) {
89f2df43 187 dev_err(&svc->dev, "failed to get rail sample: %d\n", ret);
9504677c
DL		 188 return ret;
189 }
190
191 if (response.result) {
192 dev_err(&svc->dev,
193 "UniPro error while getting rail power sample (%d %d): %d\n",
194 rail_id, measurement_type, response.result);
195 switch (response.result) {
196 case GB_SVC_PWRMON_GET_SAMPLE_INVAL:
197 return -EINVAL;
198 case GB_SVC_PWRMON_GET_SAMPLE_NOSUPP:
5b35ef95 199 return -ENOMSG;
9504677c 200 default:
4aea5a15 201 return -EREMOTEIO;
9504677c
DL		 202 }
203 }
204
205 *value = le32_to_cpu(response.measurement);
206
207 return 0;
208}
209
ddb10c8a
DL		 210int gb_svc_pwrmon_intf_sample_get(struct gb_svc *svc, u8 intf_id,
211 u8 measurement_type, u32 *value)
212{
213 struct gb_svc_pwrmon_intf_sample_get_request request;
214 struct gb_svc_pwrmon_intf_sample_get_response response;
215 int ret;
216
217 request.intf_id = intf_id;
218 request.measurement_type = measurement_type;
219
220 ret = gb_operation_sync(svc->connection,
221 GB_SVC_TYPE_PWRMON_INTF_SAMPLE_GET,
222 &request, sizeof(request),
223 &response, sizeof(response));
224 if (ret) {
89f2df43 225 dev_err(&svc->dev, "failed to get intf sample: %d\n", ret);
ddb10c8a
DL		 226 return ret;
227 }
228
229 if (response.result) {
230 dev_err(&svc->dev,
231 "UniPro error while getting intf power sample (%d %d): %d\n",
232 intf_id, measurement_type, response.result);
233 switch (response.result) {
234 case GB_SVC_PWRMON_GET_SAMPLE_INVAL:
235 return -EINVAL;
236 case GB_SVC_PWRMON_GET_SAMPLE_NOSUPP:
0bba4fb5 237 return -ENOMSG;
ddb10c8a 238 default:
4aea5a15 239 return -EREMOTEIO;
ddb10c8a
DL		 240 }
241 }
242
243 *value = le32_to_cpu(response.measurement);
244
245 return 0;
246}
247
66069fb0
JH		 248static struct attribute *svc_attrs[] = {
249 &dev_attr_endo_id.attr,
250 &dev_attr_ap_intf_id.attr,
2c92bd52 251 &dev_attr_intf_eject.attr,
d562853d 252 &dev_attr_watchdog.attr,
7c4a0edb 253 &dev_attr_watchdog_action.attr,
66069fb0
JH		 254 NULL,
255};
256ATTRIBUTE_GROUPS(svc);
257
4d5f6218 258int gb_svc_intf_device_id(struct gb_svc *svc, u8 intf_id, u8 device_id)
30c6d9d7
AE		 259{
260 struct gb_svc_intf_device_id_request request;
261
262 request.intf_id = intf_id;
263 request.device_id = device_id;
264
265 return gb_operation_sync(svc->connection, GB_SVC_TYPE_INTF_DEVICE_ID,
266 &request, sizeof(request), NULL, 0);
267}
268
c5d55fb3
RMS		 269int gb_svc_intf_eject(struct gb_svc *svc, u8 intf_id)
270{
271 struct gb_svc_intf_eject_request request;
e676ccd7 272 int ret;
c5d55fb3
RMS		 273
274 request.intf_id = intf_id;
275
276 /*
277 * The pulse width for module release in svc is long so we need to
278 * increase the timeout so the operation will not return to soon.
279 */
e676ccd7
JH		 280 ret = gb_operation_sync_timeout(svc->connection,
281 GB_SVC_TYPE_INTF_EJECT, &request,
282 sizeof(request), NULL, 0,
d18da86b 283 SVC_INTF_EJECT_TIMEOUT);
e676ccd7
JH		 284 if (ret) {
285 dev_err(&svc->dev, "failed to eject interface %u\n", intf_id);
286 return ret;
287 }
288
289 return 0;
c5d55fb3 290}
c5d55fb3 291
017482b2
JH		 292int gb_svc_intf_vsys_set(struct gb_svc *svc, u8 intf_id, bool enable)
293{
144763bf
JC		 294 struct gb_svc_intf_vsys_request request;
295 struct gb_svc_intf_vsys_response response;
296 int type, ret;
297
298 request.intf_id = intf_id;
017482b2 299
144763bf
JC		 300 if (enable)
301 type = GB_SVC_TYPE_INTF_VSYS_ENABLE;
302 else
303 type = GB_SVC_TYPE_INTF_VSYS_DISABLE;
304
305 ret = gb_operation_sync(svc->connection, type,
8478c35a
CS		 306 &request, sizeof(request),
307 &response, sizeof(response));
144763bf
JC		 308 if (ret < 0)
309 return ret;
310 if (response.result_code != GB_SVC_INTF_VSYS_OK)
311 return -EREMOTEIO;
017482b2
JH		 312 return 0;
313}
314
315int gb_svc_intf_refclk_set(struct gb_svc *svc, u8 intf_id, bool enable)
316{
144763bf
JC		 317 struct gb_svc_intf_refclk_request request;
318 struct gb_svc_intf_refclk_response response;
319 int type, ret;
017482b2 320
144763bf
JC		 321 request.intf_id = intf_id;
322
323 if (enable)
324 type = GB_SVC_TYPE_INTF_REFCLK_ENABLE;
325 else
326 type = GB_SVC_TYPE_INTF_REFCLK_DISABLE;
327
328 ret = gb_operation_sync(svc->connection, type,
8478c35a
CS		 329 &request, sizeof(request),
330 &response, sizeof(response));
144763bf
JC		 331 if (ret < 0)
332 return ret;
333 if (response.result_code != GB_SVC_INTF_REFCLK_OK)
334 return -EREMOTEIO;
017482b2
JH		 335 return 0;
336}
337
338int gb_svc_intf_unipro_set(struct gb_svc *svc, u8 intf_id, bool enable)
339{
144763bf
JC		 340 struct gb_svc_intf_unipro_request request;
341 struct gb_svc_intf_unipro_response response;
342 int type, ret;
343
344 request.intf_id = intf_id;
345
346 if (enable)
347 type = GB_SVC_TYPE_INTF_UNIPRO_ENABLE;
348 else
349 type = GB_SVC_TYPE_INTF_UNIPRO_DISABLE;
017482b2 350
144763bf 351 ret = gb_operation_sync(svc->connection, type,
8478c35a
CS		 352 &request, sizeof(request),
353 &response, sizeof(response));
144763bf
JC		 354 if (ret < 0)
355 return ret;
356 if (response.result_code != GB_SVC_INTF_UNIPRO_OK)
357 return -EREMOTEIO;
017482b2
JH		 358 return 0;
359}
360
1e8e22b5
JH		 361int gb_svc_intf_activate(struct gb_svc *svc, u8 intf_id, u8 *intf_type)
362{
140026b3
JC		 363 struct gb_svc_intf_activate_request request;
364 struct gb_svc_intf_activate_response response;
365 int ret;
366
367 request.intf_id = intf_id;
368
369 ret = gb_operation_sync_timeout(svc->connection,
8478c35a
CS		 370 GB_SVC_TYPE_INTF_ACTIVATE,
371 &request, sizeof(request),
372 &response, sizeof(response),
373 SVC_INTF_ACTIVATE_TIMEOUT);
140026b3
JC		 374 if (ret < 0)
375 return ret;
03fba180
JC		 376 if (response.status != GB_SVC_OP_SUCCESS) {
377 dev_err(&svc->dev, "failed to activate interface %u: %u\n",
8478c35a 378 intf_id, response.status);
03fba180
JC		 379 return -EREMOTEIO;
380 }
1e8e22b5 381
140026b3 382 *intf_type = response.intf_type;
1e8e22b5
JH		 383
384 return 0;
385}
386
fc8a4027
DL		 387int gb_svc_intf_resume(struct gb_svc *svc, u8 intf_id)
388{
389 struct gb_svc_intf_resume_request request;
390 struct gb_svc_intf_resume_response response;
391 int ret;
392
393 request.intf_id = intf_id;
394
395 ret = gb_operation_sync_timeout(svc->connection,
396 GB_SVC_TYPE_INTF_RESUME,
397 &request, sizeof(request),
398 &response, sizeof(response),
399 SVC_INTF_RESUME_TIMEOUT);
400 if (ret < 0) {
401 dev_err(&svc->dev, "failed to send interface resume %u: %d\n",
402 intf_id, ret);
403 return ret;
404 }
405
406 if (response.status != GB_SVC_OP_SUCCESS) {
407 dev_err(&svc->dev, "failed to resume interface %u: %u\n",
408 intf_id, response.status);
409 return -EREMOTEIO;
410 }
411
412 return 0;
413}
414
19151c3d
VK		 415int gb_svc_dme_peer_get(struct gb_svc *svc, u8 intf_id, u16 attr, u16 selector,
416 u32 *value)
417{
418 struct gb_svc_dme_peer_get_request request;
419 struct gb_svc_dme_peer_get_response response;
420 u16 result;
421 int ret;
422
423 request.intf_id = intf_id;
424 request.attr = cpu_to_le16(attr);
425 request.selector = cpu_to_le16(selector);
426
427 ret = gb_operation_sync(svc->connection, GB_SVC_TYPE_DME_PEER_GET,
428 &request, sizeof(request),
429 &response, sizeof(response));
430 if (ret) {
b933fa4a 431 dev_err(&svc->dev, "failed to get DME attribute (%u 0x%04x %u): %d\n",
8478c35a 432 intf_id, attr, selector, ret);
19151c3d
VK		 433 return ret;
434 }
435
436 result = le16_to_cpu(response.result_code);
437 if (result) {
b933fa4a 438 dev_err(&svc->dev, "UniPro error while getting DME attribute (%u 0x%04x %u): %u\n",
8478c35a 439 intf_id, attr, selector, result);
4aea5a15 440 return -EREMOTEIO;
19151c3d
VK		 441 }
442
443 if (value)
444 *value = le32_to_cpu(response.attr_value);
445
446 return 0;
447}
19151c3d
VK		 448
449int gb_svc_dme_peer_set(struct gb_svc *svc, u8 intf_id, u16 attr, u16 selector,
450 u32 value)
451{
452 struct gb_svc_dme_peer_set_request request;
453 struct gb_svc_dme_peer_set_response response;
454 u16 result;
455 int ret;
456
457 request.intf_id = intf_id;
458 request.attr = cpu_to_le16(attr);
459 request.selector = cpu_to_le16(selector);
460 request.value = cpu_to_le32(value);
461
462 ret = gb_operation_sync(svc->connection, GB_SVC_TYPE_DME_PEER_SET,
463 &request, sizeof(request),
464 &response, sizeof(response));
465 if (ret) {
b933fa4a 466 dev_err(&svc->dev, "failed to set DME attribute (%u 0x%04x %u %u): %d\n",
8478c35a 467 intf_id, attr, selector, value, ret);
19151c3d
VK		 468 return ret;
469 }
470
471 result = le16_to_cpu(response.result_code);
472 if (result) {
b933fa4a 473 dev_err(&svc->dev, "UniPro error while setting DME attribute (%u 0x%04x %u %u): %u\n",
8478c35a 474 intf_id, attr, selector, value, result);
4aea5a15 475 return -EREMOTEIO;
19151c3d
VK		 476 }
477
478 return 0;
479}
19151c3d 480
3f0e9183 481int gb_svc_connection_create(struct gb_svc *svc,
8478c35a
CS		 482 u8 intf1_id, u16 cport1_id,
483 u8 intf2_id, u16 cport2_id,
484 u8 cport_flags)
30c6d9d7
AE		 485{
486 struct gb_svc_conn_create_request request;
487
488 request.intf1_id = intf1_id;
2498050b 489 request.cport1_id = cpu_to_le16(cport1_id);
30c6d9d7 490 request.intf2_id = intf2_id;
2498050b 491 request.cport2_id = cpu_to_le16(cport2_id);
34145b60 492 request.tc = 0; /* TC0 */
27f25c17 493 request.flags = cport_flags;
30c6d9d7
AE		 494
495 return gb_operation_sync(svc->connection, GB_SVC_TYPE_CONN_CREATE,
496 &request, sizeof(request), NULL, 0);
497}
498
3f0e9183
VK		 499void gb_svc_connection_destroy(struct gb_svc *svc, u8 intf1_id, u16 cport1_id,
500 u8 intf2_id, u16 cport2_id)
30c6d9d7
AE		 501{
502 struct gb_svc_conn_destroy_request request;
d9fcffff
VK		 503 struct gb_connection *connection = svc->connection;
504 int ret;
30c6d9d7
AE		 505
506 request.intf1_id = intf1_id;
2498050b 507 request.cport1_id = cpu_to_le16(cport1_id);
30c6d9d7 508 request.intf2_id = intf2_id;
2498050b 509 request.cport2_id = cpu_to_le16(cport2_id);
30c6d9d7 510
d9fcffff
VK		 511 ret = gb_operation_sync(connection, GB_SVC_TYPE_CONN_DESTROY,
512 &request, sizeof(request), NULL, 0);
684156a9 513 if (ret) {
2f3db927 514 dev_err(&svc->dev, "failed to destroy connection (%u:%u %u:%u): %d\n",
8478c35a 515 intf1_id, cport1_id, intf2_id, cport2_id, ret);
684156a9 516 }
30c6d9d7
AE		 517}
518
bb106852 519/* Creates bi-directional routes between the devices */
4d5f6218 520int gb_svc_route_create(struct gb_svc *svc, u8 intf1_id, u8 dev1_id,
8478c35a 521 u8 intf2_id, u8 dev2_id)
e08aaa49
PH		 522{
523 struct gb_svc_route_create_request request;
524
525 request.intf1_id = intf1_id;
526 request.dev1_id = dev1_id;
527 request.intf2_id = intf2_id;
528 request.dev2_id = dev2_id;
529
530 return gb_operation_sync(svc->connection, GB_SVC_TYPE_ROUTE_CREATE,
531 &request, sizeof(request), NULL, 0);
532}
e08aaa49 533
0a020570 534/* Destroys bi-directional routes between the devices */
4d5f6218 535void gb_svc_route_destroy(struct gb_svc *svc, u8 intf1_id, u8 intf2_id)
0a020570
VK		 536{
537 struct gb_svc_route_destroy_request request;
538 int ret;
539
540 request.intf1_id = intf1_id;
541 request.intf2_id = intf2_id;
542
543 ret = gb_operation_sync(svc->connection, GB_SVC_TYPE_ROUTE_DESTROY,
544 &request, sizeof(request), NULL, 0);
684156a9 545 if (ret) {
2f3db927 546 dev_err(&svc->dev, "failed to destroy route (%u %u): %d\n",
8478c35a 547 intf1_id, intf2_id, ret);
684156a9 548 }
0a020570
VK		 549}
550
aab4a1a3
LP		 551int gb_svc_intf_set_power_mode(struct gb_svc *svc, u8 intf_id, u8 hs_series,
552 u8 tx_mode, u8 tx_gear, u8 tx_nlanes,
8c2522d8 553 u8 tx_amplitude, u8 tx_hs_equalizer,
aab4a1a3 554 u8 rx_mode, u8 rx_gear, u8 rx_nlanes,
8c2522d8
ES		 555 u8 flags, u32 quirks,
556 struct gb_svc_l2_timer_cfg *local,
557 struct gb_svc_l2_timer_cfg *remote)
784f8761 558{
aab4a1a3
LP		 559 struct gb_svc_intf_set_pwrm_request request;
560 struct gb_svc_intf_set_pwrm_response response;
561 int ret;
8c2522d8
ES		 562 u16 result_code;
563
564 memset(&request, 0, sizeof(request));
784f8761
LP		 565
566 request.intf_id = intf_id;
aab4a1a3
LP		 567 request.hs_series = hs_series;
568 request.tx_mode = tx_mode;
569 request.tx_gear = tx_gear;
570 request.tx_nlanes = tx_nlanes;
8c2522d8
ES		 571 request.tx_amplitude = tx_amplitude;
572 request.tx_hs_equalizer = tx_hs_equalizer;
aab4a1a3
LP		 573 request.rx_mode = rx_mode;
574 request.rx_gear = rx_gear;
575 request.rx_nlanes = rx_nlanes;
784f8761 576 request.flags = flags;
aab4a1a3 577 request.quirks = cpu_to_le32(quirks);
8c2522d8
ES		 578 if (local)
579 request.local_l2timerdata = *local;
580 if (remote)
581 request.remote_l2timerdata = *remote;
784f8761 582
aab4a1a3
LP		 583 ret = gb_operation_sync(svc->connection, GB_SVC_TYPE_INTF_SET_PWRM,
584 &request, sizeof(request),
585 &response, sizeof(response));
586 if (ret < 0)
587 return ret;
588
8c2522d8
ES		 589 result_code = response.result_code;
590 if (result_code != GB_SVC_SETPWRM_PWR_LOCAL) {
591 dev_err(&svc->dev, "set power mode = %d\n", result_code);
592 return -EIO;
593 }
594
595 return 0;
784f8761 596}
46bb647b 597EXPORT_SYMBOL_GPL(gb_svc_intf_set_power_mode);
784f8761 598
c7dc28ff
DL		 599int gb_svc_intf_set_power_mode_hibernate(struct gb_svc *svc, u8 intf_id)
600{
601 struct gb_svc_intf_set_pwrm_request request;
602 struct gb_svc_intf_set_pwrm_response response;
603 int ret;
604 u16 result_code;
605
606 memset(&request, 0, sizeof(request));
607
608 request.intf_id = intf_id;
609 request.hs_series = GB_SVC_UNIPRO_HS_SERIES_A;
610 request.tx_mode = GB_SVC_UNIPRO_HIBERNATE_MODE;
611 request.rx_mode = GB_SVC_UNIPRO_HIBERNATE_MODE;
612
613 ret = gb_operation_sync(svc->connection, GB_SVC_TYPE_INTF_SET_PWRM,
614 &request, sizeof(request),
615 &response, sizeof(response));
616 if (ret < 0) {
617 dev_err(&svc->dev,
618 "failed to send set power mode operation to interface %u: %d\n",
619 intf_id, ret);
620 return ret;
621 }
622
623 result_code = response.result_code;
624 if (result_code != GB_SVC_SETPWRM_PWR_OK) {
625 dev_err(&svc->dev,
626 "failed to hibernate the link for interface %u: %u\n",
627 intf_id, result_code);
628 return -EIO;
629 }
630
631 return 0;
632}
633
55ec09e8
GKH		 634int gb_svc_ping(struct gb_svc *svc)
635{
839ac5b9
GKH		 636 return gb_operation_sync_timeout(svc->connection, GB_SVC_TYPE_PING,
637 NULL, 0, NULL, 0,
638 GB_OPERATION_TIMEOUT_DEFAULT * 2);
55ec09e8 639}
55ec09e8 640
ead35460
VK		 641static int gb_svc_version_request(struct gb_operation *op)
642{
643 struct gb_connection *connection = op->connection;
0ec30632 644 struct gb_svc *svc = gb_connection_get_data(connection);
a2cf2e59
JH		 645 struct gb_svc_version_request *request;
646 struct gb_svc_version_response *response;
ead35460 647
55510843 648 if (op->request->payload_size < sizeof(*request)) {
684156a9 649 dev_err(&svc->dev, "short version request (%zu < %zu)\n",
8478c35a
CS		 650 op->request->payload_size,
651 sizeof(*request));
55510843
JH		 652 return -EINVAL;
653 }
654
cfb16906 655 request = op->request->payload;
ead35460 656
cfb16906 657 if (request->major > GB_SVC_VERSION_MAJOR) {
2f3db927 658 dev_warn(&svc->dev, "unsupported major version (%u > %u)\n",
8478c35a 659 request->major, GB_SVC_VERSION_MAJOR);
ead35460
VK		 660 return -ENOTSUPP;
661 }
662
357de006
JH		 663 svc->protocol_major = request->major;
664 svc->protocol_minor = request->minor;
3ea959e3 665
684156a9 666 if (!gb_operation_response_alloc(op, sizeof(*response), GFP_KERNEL))
ead35460 667 return -ENOMEM;
ead35460 668
cfb16906 669 response = op->response->payload;
357de006
JH		 670 response->major = svc->protocol_major;
671 response->minor = svc->protocol_minor;
59832931 672
ead35460
VK		 673 return 0;
674}
675
9504677c
DL		 676static ssize_t pwr_debugfs_voltage_read(struct file *file, char __user *buf,
677 size_t len, loff_t *offset)
678{
461ab807
GK		 679 struct svc_debugfs_pwrmon_rail *pwrmon_rails =
680 file_inode(file)->i_private;
9504677c
DL		 681 struct gb_svc *svc = pwrmon_rails->svc;
682 int ret, desc;
683 u32 value;
684 char buff[16];
685
686 ret = gb_svc_pwrmon_sample_get(svc, pwrmon_rails->id,
687 GB_SVC_PWRMON_TYPE_VOL, &value);
688 if (ret) {
689 dev_err(&svc->dev,
89f2df43
JH		 690 "failed to get voltage sample %u: %d\n",
691 pwrmon_rails->id, ret);
9504677c
DL		 692 return ret;
693 }
694
695 desc = scnprintf(buff, sizeof(buff), "%u\n", value);
696
697 return simple_read_from_buffer(buf, len, offset, buff, desc);
698}
699
700static ssize_t pwr_debugfs_current_read(struct file *file, char __user *buf,
701 size_t len, loff_t *offset)
702{
461ab807
GK		 703 struct svc_debugfs_pwrmon_rail *pwrmon_rails =
704 file_inode(file)->i_private;
9504677c
DL		 705 struct gb_svc *svc = pwrmon_rails->svc;
706 int ret, desc;
707 u32 value;
708 char buff[16];
709
710 ret = gb_svc_pwrmon_sample_get(svc, pwrmon_rails->id,
711 GB_SVC_PWRMON_TYPE_CURR, &value);
712 if (ret) {
713 dev_err(&svc->dev,
89f2df43
JH		 714 "failed to get current sample %u: %d\n",
715 pwrmon_rails->id, ret);
9504677c
DL		 716 return ret;
717 }
718
719 desc = scnprintf(buff, sizeof(buff), "%u\n", value);
720
721 return simple_read_from_buffer(buf, len, offset, buff, desc);
722}
723
724static ssize_t pwr_debugfs_power_read(struct file *file, char __user *buf,
725 size_t len, loff_t *offset)
726{
461ab807
GK		 727 struct svc_debugfs_pwrmon_rail *pwrmon_rails =
728 file_inode(file)->i_private;
9504677c
DL		 729 struct gb_svc *svc = pwrmon_rails->svc;
730 int ret, desc;
731 u32 value;
732 char buff[16];
733
734 ret = gb_svc_pwrmon_sample_get(svc, pwrmon_rails->id,
735 GB_SVC_PWRMON_TYPE_PWR, &value);
736 if (ret) {
89f2df43
JH		 737 dev_err(&svc->dev, "failed to get power sample %u: %d\n",
738 pwrmon_rails->id, ret);
9504677c
DL		 739 return ret;
740 }
741
742 desc = scnprintf(buff, sizeof(buff), "%u\n", value);
743
744 return simple_read_from_buffer(buf, len, offset, buff, desc);
745}
746
747static const struct file_operations pwrmon_debugfs_voltage_fops = {
748 .read = pwr_debugfs_voltage_read,
749};
750
751static const struct file_operations pwrmon_debugfs_current_fops = {
752 .read = pwr_debugfs_current_read,
753};
754
755static const struct file_operations pwrmon_debugfs_power_fops = {
756 .read = pwr_debugfs_power_read,
757};
758
12185197 759static void gb_svc_pwrmon_debugfs_init(struct gb_svc *svc)
9504677c
DL		 760{
761 int i;
762 size_t bufsize;
763 struct dentry *dent;
3fd747a6
DL		 764 struct gb_svc_pwrmon_rail_names_get_response *rail_names;
765 u8 rail_count;
9504677c
DL		 766
767 dent = debugfs_create_dir("pwrmon", svc->debugfs_dentry);
768 if (IS_ERR_OR_NULL(dent))
769 return;
770
3fd747a6 771 if (gb_svc_pwrmon_rail_count_get(svc, &rail_count))
9504677c
DL		 772 goto err_pwrmon_debugfs;
773
3fd747a6 774 if (!rail_count || rail_count > GB_SVC_PWRMON_MAX_RAIL_COUNT)
9504677c
DL		 775 goto err_pwrmon_debugfs;
776
8fb76c3c
DL		 777 bufsize = sizeof(*rail_names) +
778 GB_SVC_PWRMON_RAIL_NAME_BUFSIZE * rail_count;
9504677c 779
3fd747a6
DL		 780 rail_names = kzalloc(bufsize, GFP_KERNEL);
781 if (!rail_names)
9504677c
DL		 782 goto err_pwrmon_debugfs;
783
3fd747a6 784 svc->pwrmon_rails = kcalloc(rail_count, sizeof(*svc->pwrmon_rails),
9504677c
DL		 785 GFP_KERNEL);
786 if (!svc->pwrmon_rails)
787 goto err_pwrmon_debugfs_free;
788
3fd747a6 789 if (gb_svc_pwrmon_rail_names_get(svc, rail_names, bufsize))
9504677c
DL		 790 goto err_pwrmon_debugfs_free;
791
3fd747a6 792 for (i = 0; i < rail_count; i++) {
9504677c
DL		 793 struct dentry *dir;
794 struct svc_debugfs_pwrmon_rail *rail = &svc->pwrmon_rails[i];
795 char fname[GB_SVC_PWRMON_RAIL_NAME_BUFSIZE];
796
797 snprintf(fname, sizeof(fname), "%s",
3fd747a6 798 (char *)&rail_names->name[i]);
9504677c
DL		 799
800 rail->id = i;
801 rail->svc = svc;
802
803 dir = debugfs_create_dir(fname, dent);
563a8412 804 debugfs_create_file("voltage_now", 0444, dir, rail,
9504677c 805 &pwrmon_debugfs_voltage_fops);
563a8412 806 debugfs_create_file("current_now", 0444, dir, rail,
9504677c 807 &pwrmon_debugfs_current_fops);
563a8412 808 debugfs_create_file("power_now", 0444, dir, rail,
9504677c 809 &pwrmon_debugfs_power_fops);
898d75f4 810 }
3fd747a6
DL		 811
812 kfree(rail_names);
9504677c
DL		 813 return;
814
815err_pwrmon_debugfs_free:
3fd747a6 816 kfree(rail_names);
9504677c
DL		 817 kfree(svc->pwrmon_rails);
818 svc->pwrmon_rails = NULL;
819
820err_pwrmon_debugfs:
821 debugfs_remove(dent);
822}
823
12185197 824static void gb_svc_debugfs_init(struct gb_svc *svc)
9504677c
DL		 825{
826 svc->debugfs_dentry = debugfs_create_dir(dev_name(&svc->dev),
827 gb_debugfs_get());
12185197 828 gb_svc_pwrmon_debugfs_init(svc);
9504677c
DL		 829}
830
12185197 831static void gb_svc_debugfs_exit(struct gb_svc *svc)
9504677c
DL		 832{
833 debugfs_remove_recursive(svc->debugfs_dentry);
9983ea6b
DL		 834 kfree(svc->pwrmon_rails);
835 svc->pwrmon_rails = NULL;
9504677c
DL		 836}
837
ead35460
VK		 838static int gb_svc_hello(struct gb_operation *op)
839{
840 struct gb_connection *connection = op->connection;
0ec30632 841 struct gb_svc *svc = gb_connection_get_data(connection);
ead35460 842 struct gb_svc_hello_request *hello_request;
ead35460
VK		 843 int ret;
844
0c32d2a5 845 if (op->request->payload_size < sizeof(*hello_request)) {
684156a9 846 dev_warn(&svc->dev, "short hello request (%zu < %zu)\n",
8478c35a
CS		 847 op->request->payload_size,
848 sizeof(*hello_request));
ead35460
VK		 849 return -EINVAL;
850 }
851
852 hello_request = op->request->payload;
66069fb0
JH		 853 svc->endo_id = le16_to_cpu(hello_request->endo_id);
854 svc->ap_intf_id = hello_request->interface_id;
ead35460 855
88f7b96d
JH		 856 ret = device_add(&svc->dev);
857 if (ret) {
858 dev_err(&svc->dev, "failed to register svc device: %d\n", ret);
859 return ret;
860 }
861
ed7279ae
GKH		 862 ret = gb_svc_watchdog_create(svc);
863 if (ret) {
864 dev_err(&svc->dev, "failed to create watchdog: %d\n", ret);
5f648e00 865 goto err_deregister_svc;
ed7279ae
GKH		 866 }
867
a74e7263
JH		 868 /*
869 * FIXME: This is a temporary hack to reconfigure the link at HELLO
870 * (which abuses the deferred request processing mechanism).
871 */
5f8583a3
DC		 872 ret = gb_svc_queue_deferred_request(op);
873 if (ret)
a74e7263
JH		 874 goto err_destroy_watchdog;
875
876 gb_svc_debugfs_init(svc);
4a448427 877
5f8583a3
DC		 878 return 0;
879
a74e7263 880err_destroy_watchdog:
4a448427 881 gb_svc_watchdog_destroy(svc);
5f648e00 882err_deregister_svc:
4a448427 883 device_del(&svc->dev);
5f648e00 884
4a448427 885 return ret;
ead35460
VK		 886}
887
b482b0d6 888static struct gb_interface *gb_svc_interface_lookup(struct gb_svc *svc,
8478c35a 889 u8 intf_id)
b482b0d6
JH		 890{
891 struct gb_host_device *hd = svc->hd;
892 struct gb_module *module;
893 size_t num_interfaces;
894 u8 module_id;
895
896 list_for_each_entry(module, &hd->modules, hd_node) {
897 module_id = module->module_id;
898 num_interfaces = module->num_interfaces;
899
900 if (intf_id >= module_id &&
8478c35a 901 intf_id < module_id + num_interfaces) {
b482b0d6
JH		 902 return module->interfaces[intf_id - module_id];
903 }
904 }
905
906 return NULL;
907}
908
b15d97d7
JH		 909static struct gb_module *gb_svc_module_lookup(struct gb_svc *svc, u8 module_id)
910{
911 struct gb_host_device *hd = svc->hd;
912 struct gb_module *module;
913
914 list_for_each_entry(module, &hd->modules, hd_node) {
915 if (module->module_id == module_id)
916 return module;
917 }
918
919 return NULL;
920}
921
ee2f2074
MT		 922static void gb_svc_process_hello_deferred(struct gb_operation *operation)
923{
924 struct gb_connection *connection = operation->connection;
925 struct gb_svc *svc = gb_connection_get_data(connection);
926 int ret;
927
928 /*
929 * XXX This is a hack/work-around to reconfigure the APBridgeA-Switch
930 * link to PWM G2, 1 Lane, Slow Auto, so that it has sufficient
931 * bandwidth for 3 audio streams plus boot-over-UniPro of a hot-plugged
932 * module.
933 *
934 * The code should be removed once SW-2217, Heuristic for UniPro
935 * Power Mode Changes is resolved.
936 */
937 ret = gb_svc_intf_set_power_mode(svc, svc->ap_intf_id,
461ab807
GK		 938 GB_SVC_UNIPRO_HS_SERIES_A,
939 GB_SVC_UNIPRO_SLOW_AUTO_MODE,
940 2, 1,
941 GB_SVC_SMALL_AMPLITUDE,
942 GB_SVC_NO_DE_EMPHASIS,
943 GB_SVC_UNIPRO_SLOW_AUTO_MODE,
944 2, 1,
945 0, 0,
946 NULL, NULL);
ee2f2074
MT		 947
948 if (ret)
949 dev_warn(&svc->dev,
8478c35a
CS		 950 "power mode change failed on AP to switch link: %d\n",
951 ret);
ee2f2074
MT		 952}
953
22bb9380
JH		 954static void gb_svc_process_module_inserted(struct gb_operation *operation)
955{
956 struct gb_svc_module_inserted_request *request;
957 struct gb_connection *connection = operation->connection;
958 struct gb_svc *svc = gb_connection_get_data(connection);
959 struct gb_host_device *hd = svc->hd;
960 struct gb_module *module;
961 size_t num_interfaces;
962 u8 module_id;
963 u16 flags;
964 int ret;
965
966 /* The request message size has already been verified. */
967 request = operation->request->payload;
968 module_id = request->primary_intf_id;
969 num_interfaces = request->intf_count;
970 flags = le16_to_cpu(request->flags);
971
972 dev_dbg(&svc->dev, "%s - id = %u, num_interfaces = %zu, flags = 0x%04x\n",
8478c35a 973 __func__, module_id, num_interfaces, flags);
22bb9380
JH		 974
975 if (flags & GB_SVC_MODULE_INSERTED_FLAG_NO_PRIMARY) {
976 dev_warn(&svc->dev, "no primary interface detected on module %u\n",
8478c35a 977 module_id);
22bb9380
JH		 978 }
979
980 module = gb_svc_module_lookup(svc, module_id);
981 if (module) {
982 dev_warn(&svc->dev, "unexpected module-inserted event %u\n",
8478c35a 983 module_id);
22bb9380
JH		 984 return;
985 }
986
987 module = gb_module_create(hd, module_id, num_interfaces);
988 if (!module) {
989 dev_err(&svc->dev, "failed to create module\n");
990 return;
991 }
992
993 ret = gb_module_add(module);
994 if (ret) {
995 gb_module_put(module);
996 return;
997 }
998
999 list_add(&module->hd_node, &hd->modules);
1000}
1001
1002static void gb_svc_process_module_removed(struct gb_operation *operation)
1003{
1004 struct gb_svc_module_removed_request *request;
1005 struct gb_connection *connection = operation->connection;
1006 struct gb_svc *svc = gb_connection_get_data(connection);
1007 struct gb_module *module;
1008 u8 module_id;
1009
1010 /* The request message size has already been verified. */
1011 request = operation->request->payload;
1012 module_id = request->primary_intf_id;
1013
1014 dev_dbg(&svc->dev, "%s - id = %u\n", __func__, module_id);
1015
1016 module = gb_svc_module_lookup(svc, module_id);
1017 if (!module) {
1018 dev_warn(&svc->dev, "unexpected module-removed event %u\n",
8478c35a 1019 module_id);
22bb9380
JH		 1020 return;
1021 }
1022
1023 module->disconnected = true;
1024
1025 gb_module_del(module);
1026 list_del(&module->hd_node);
1027 gb_module_put(module);
1028}
1029
57fa2de1
GD		 1030static void gb_svc_process_intf_oops(struct gb_operation *operation)
1031{
1032 struct gb_svc_intf_oops_request *request;
1033 struct gb_connection *connection = operation->connection;
1034 struct gb_svc *svc = gb_connection_get_data(connection);
1035 struct gb_interface *intf;
1036 u8 intf_id;
1037 u8 reason;
1038
1039 /* The request message size has already been verified. */
1040 request = operation->request->payload;
1041 intf_id = request->intf_id;
1042 reason = request->reason;
1043
1044 intf = gb_svc_interface_lookup(svc, intf_id);
1045 if (!intf) {
1046 dev_warn(&svc->dev, "unexpected interface-oops event %u\n",
1047 intf_id);
1048 return;
1049 }
1050
1051 dev_info(&svc->dev, "Deactivating interface %u, interface oops reason = %u\n",
1052 intf_id, reason);
1053
1054 mutex_lock(&intf->mutex);
1055 intf->disconnected = true;
1056 gb_interface_disable(intf);
1057 gb_interface_deactivate(intf);
1058 mutex_unlock(&intf->mutex);
1059}
1060
b482b0d6
JH		 1061static void gb_svc_process_intf_mailbox_event(struct gb_operation *operation)
1062{
1063 struct gb_svc_intf_mailbox_event_request *request;
1064 struct gb_connection *connection = operation->connection;
1065 struct gb_svc *svc = gb_connection_get_data(connection);
1066 struct gb_interface *intf;
1067 u8 intf_id;
1068 u16 result_code;
1069 u32 mailbox;
1070
1071 /* The request message size has already been verified. */
1072 request = operation->request->payload;
1073 intf_id = request->intf_id;
1074 result_code = le16_to_cpu(request->result_code);
1075 mailbox = le32_to_cpu(request->mailbox);
1076
1077 dev_dbg(&svc->dev, "%s - id = %u, result = 0x%04x, mailbox = 0x%08x\n",
8478c35a 1078 __func__, intf_id, result_code, mailbox);
b482b0d6
JH		 1079
1080 intf = gb_svc_interface_lookup(svc, intf_id);
1081 if (!intf) {
1082 dev_warn(&svc->dev, "unexpected mailbox event %u\n", intf_id);
1083 return;
1084 }
1085
55742d2a 1086 gb_interface_mailbox_event(intf, result_code, mailbox);
b482b0d6
JH		 1087}
1088
9ae4109e
JH		 1089static void gb_svc_process_deferred_request(struct work_struct *work)
1090{
1091 struct gb_svc_deferred_request *dr;
1092 struct gb_operation *operation;
1093 struct gb_svc *svc;
1094 u8 type;
1095
1096 dr = container_of(work, struct gb_svc_deferred_request, work);
1097 operation = dr->operation;
0ec30632 1098 svc = gb_connection_get_data(operation->connection);
9ae4109e
JH		 1099 type = operation->request->header->type;
1100
1101 switch (type) {
ee2f2074
MT		 1102 case GB_SVC_TYPE_SVC_HELLO:
1103 gb_svc_process_hello_deferred(operation);
1104 break;
22bb9380
JH		 1105 case GB_SVC_TYPE_MODULE_INSERTED:
1106 gb_svc_process_module_inserted(operation);
1107 break;
1108 case GB_SVC_TYPE_MODULE_REMOVED:
1109 gb_svc_process_module_removed(operation);
1110 break;
b482b0d6
JH		 1111 case GB_SVC_TYPE_INTF_MAILBOX_EVENT:
1112 gb_svc_process_intf_mailbox_event(operation);
1113 break;
57fa2de1
GD		 1114 case GB_SVC_TYPE_INTF_OOPS:
1115 gb_svc_process_intf_oops(operation);
1116 break;
9ae4109e 1117 default:
b933fa4a 1118 dev_err(&svc->dev, "bad deferred request type: 0x%02x\n", type);
9ae4109e
JH		 1119 }
1120
1121 gb_operation_put(operation);
1122 kfree(dr);
1123}
1124
1125static int gb_svc_queue_deferred_request(struct gb_operation *operation)
1126{
0ec30632 1127 struct gb_svc *svc = gb_connection_get_data(operation->connection);
9ae4109e
JH		 1128 struct gb_svc_deferred_request *dr;
1129
1130 dr = kmalloc(sizeof(*dr), GFP_KERNEL);
1131 if (!dr)
1132 return -ENOMEM;
1133
1134 gb_operation_get(operation);
1135
1136 dr->operation = operation;
1137 INIT_WORK(&dr->work, gb_svc_process_deferred_request);
1138
3e48acac 1139 queue_work(svc->wq, &dr->work);
9ae4109e
JH		 1140
1141 return 0;
067906f6 1142}
ead35460 1143
30c6d9d7
AE		 1144static int gb_svc_intf_reset_recv(struct gb_operation *op)
1145{
0ec30632 1146 struct gb_svc *svc = gb_connection_get_data(op->connection);
30c6d9d7
AE		 1147 struct gb_message *request = op->request;
1148 struct gb_svc_intf_reset_request *reset;
30c6d9d7
AE		 1149
1150 if (request->payload_size < sizeof(*reset)) {
684156a9 1151 dev_warn(&svc->dev, "short reset request received (%zu < %zu)\n",
8478c35a 1152 request->payload_size, sizeof(*reset));
30c6d9d7
AE		 1153 return -EINVAL;
1154 }
1155 reset = request->payload;
1156
30c6d9d7
AE		 1157 /* FIXME Reset the interface here */
1158
1159 return 0;
1160}
1161
22bb9380
JH		 1162static int gb_svc_module_inserted_recv(struct gb_operation *op)
1163{
1164 struct gb_svc *svc = gb_connection_get_data(op->connection);
1165 struct gb_svc_module_inserted_request *request;
1166
1167 if (op->request->payload_size < sizeof(*request)) {
1168 dev_warn(&svc->dev, "short module-inserted request received (%zu < %zu)\n",
8478c35a 1169 op->request->payload_size, sizeof(*request));
22bb9380
JH		 1170 return -EINVAL;
1171 }
1172
1173 request = op->request->payload;
1174
1175 dev_dbg(&svc->dev, "%s - id = %u\n", __func__,
8478c35a 1176 request->primary_intf_id);
22bb9380
JH		 1177
1178 return gb_svc_queue_deferred_request(op);
1179}
1180
1181static int gb_svc_module_removed_recv(struct gb_operation *op)
1182{
1183 struct gb_svc *svc = gb_connection_get_data(op->connection);
1184 struct gb_svc_module_removed_request *request;
1185
1186 if (op->request->payload_size < sizeof(*request)) {
1187 dev_warn(&svc->dev, "short module-removed request received (%zu < %zu)\n",
8478c35a 1188 op->request->payload_size, sizeof(*request));
22bb9380
JH		 1189 return -EINVAL;
1190 }
1191
1192 request = op->request->payload;
1193
1194 dev_dbg(&svc->dev, "%s - id = %u\n", __func__,
8478c35a 1195 request->primary_intf_id);
22bb9380
JH		 1196
1197 return gb_svc_queue_deferred_request(op);
1198}
1199
57fa2de1
GD		 1200static int gb_svc_intf_oops_recv(struct gb_operation *op)
1201{
1202 struct gb_svc *svc = gb_connection_get_data(op->connection);
1203 struct gb_svc_intf_oops_request *request;
1204
1205 if (op->request->payload_size < sizeof(*request)) {
1206 dev_warn(&svc->dev, "short intf-oops request received (%zu < %zu)\n",
1207 op->request->payload_size, sizeof(*request));
1208 return -EINVAL;
1209 }
1210
1211 return gb_svc_queue_deferred_request(op);
1212}
1213
b482b0d6
JH		 1214static int gb_svc_intf_mailbox_event_recv(struct gb_operation *op)
1215{
1216 struct gb_svc *svc = gb_connection_get_data(op->connection);
1217 struct gb_svc_intf_mailbox_event_request *request;
1218
1219 if (op->request->payload_size < sizeof(*request)) {
1220 dev_warn(&svc->dev, "short mailbox request received (%zu < %zu)\n",
8478c35a 1221 op->request->payload_size, sizeof(*request));
b482b0d6
JH		 1222 return -EINVAL;
1223 }
1224
1225 request = op->request->payload;
1226
1227 dev_dbg(&svc->dev, "%s - id = %u\n", __func__, request->intf_id);
1228
1229 return gb_svc_queue_deferred_request(op);
1230}
1231
84427943 1232static int gb_svc_request_handler(struct gb_operation *op)
30c6d9d7 1233{
3ccb1600 1234 struct gb_connection *connection = op->connection;
0ec30632 1235 struct gb_svc *svc = gb_connection_get_data(connection);
84427943 1236 u8 type = op->type;
3ccb1600
VK		 1237 int ret = 0;
1238
1239 /*
1240 * SVC requests need to follow a specific order (at least initially) and
1241 * below code takes care of enforcing that. The expected order is:
1242 * - PROTOCOL_VERSION
1243 * - SVC_HELLO
1244 * - Any other request, but the earlier two.
1245 *
1246 * Incoming requests are guaranteed to be serialized and so we don't
1247 * need to protect 'state' for any races.
1248 */
30c6d9d7 1249 switch (type) {
a2cf2e59 1250 case GB_SVC_TYPE_PROTOCOL_VERSION:
3ccb1600
VK		 1251 if (svc->state != GB_SVC_STATE_RESET)
1252 ret = -EINVAL;
1253 break;
ead35460 1254 case GB_SVC_TYPE_SVC_HELLO:
3ccb1600
VK		 1255 if (svc->state != GB_SVC_STATE_PROTOCOL_VERSION)
1256 ret = -EINVAL;
1257 break;
1258 default:
1259 if (svc->state != GB_SVC_STATE_SVC_HELLO)
1260 ret = -EINVAL;
1261 break;
1262 }
1263
1264 if (ret) {
684156a9 1265 dev_warn(&svc->dev, "unexpected request 0x%02x received (state %u)\n",
8478c35a 1266 type, svc->state);
3ccb1600
VK		 1267 return ret;
1268 }
1269
1270 switch (type) {
a2cf2e59 1271 case GB_SVC_TYPE_PROTOCOL_VERSION:
3ccb1600
VK		 1272 ret = gb_svc_version_request(op);
1273 if (!ret)
1274 svc->state = GB_SVC_STATE_PROTOCOL_VERSION;
1275 return ret;
1276 case GB_SVC_TYPE_SVC_HELLO:
1277 ret = gb_svc_hello(op);
1278 if (!ret)
1279 svc->state = GB_SVC_STATE_SVC_HELLO;
1280 return ret;
30c6d9d7
AE		 1281 case GB_SVC_TYPE_INTF_RESET:
1282 return gb_svc_intf_reset_recv(op);
22bb9380
JH		 1283 case GB_SVC_TYPE_MODULE_INSERTED:
1284 return gb_svc_module_inserted_recv(op);
1285 case GB_SVC_TYPE_MODULE_REMOVED:
1286 return gb_svc_module_removed_recv(op);
b482b0d6
JH		 1287 case GB_SVC_TYPE_INTF_MAILBOX_EVENT:
1288 return gb_svc_intf_mailbox_event_recv(op);
57fa2de1
GD		 1289 case GB_SVC_TYPE_INTF_OOPS:
1290 return gb_svc_intf_oops_recv(op);
30c6d9d7 1291 default:
684156a9 1292 dev_warn(&svc->dev, "unsupported request 0x%02x\n", type);
30c6d9d7
AE		 1293 return -EINVAL;
1294 }
1295}
1296
efe6ef76
JH		 1297static void gb_svc_release(struct device *dev)
1298{
88f7b96d 1299 struct gb_svc *svc = to_gb_svc(dev);
efe6ef76 1300
7adeaae7
JH		 1301 if (svc->connection)
1302 gb_connection_destroy(svc->connection);
efe6ef76 1303 ida_destroy(&svc->device_id_map);
3e48acac 1304 destroy_workqueue(svc->wq);
efe6ef76
JH		 1305 kfree(svc);
1306}
1307
1308struct device_type greybus_svc_type = {
1309 .name = "greybus_svc",
1310 .release = gb_svc_release,
1311};
1312
7adeaae7 1313struct gb_svc *gb_svc_create(struct gb_host_device *hd)
30c6d9d7
AE		 1314{
1315 struct gb_svc *svc;
30c6d9d7
AE		 1316
1317 svc = kzalloc(sizeof(*svc), GFP_KERNEL);
1318 if (!svc)
7adeaae7 1319 return NULL;
30c6d9d7 1320
44d69dd9 1321 svc->wq = alloc_ordered_workqueue("%s:svc", 0, dev_name(&hd->dev));
3e48acac
JH		 1322 if (!svc->wq) {
1323 kfree(svc);
7adeaae7 1324 return NULL;
3e48acac
JH		 1325 }
1326
efe6ef76
JH		 1327 svc->dev.parent = &hd->dev;
1328 svc->dev.bus = &greybus_bus_type;
1329 svc->dev.type = &greybus_svc_type;
66069fb0 1330 svc->dev.groups = svc_groups;
efe6ef76
JH		 1331 svc->dev.dma_mask = svc->dev.parent->dma_mask;
1332 device_initialize(&svc->dev);
1333
1334 dev_set_name(&svc->dev, "%d-svc", hd->bus_id);
1335
6106e51b 1336 ida_init(&svc->device_id_map);
3ccb1600 1337 svc->state = GB_SVC_STATE_RESET;
f0960d05 1338 svc->hd = hd;
d3d44840 1339
f7ee081e 1340 svc->connection = gb_connection_create_static(hd, GB_SVC_CPORT_ID,
8478c35a 1341 gb_svc_request_handler);
24e094d6
JH		 1342 if (IS_ERR(svc->connection)) {
1343 dev_err(&svc->dev, "failed to create connection: %ld\n",
8478c35a 1344 PTR_ERR(svc->connection));
1beb1fae 1345 goto err_put_device;
7adeaae7
JH		 1346 }
1347
0ec30632 1348 gb_connection_set_data(svc->connection, svc);
efe6ef76 1349
7adeaae7 1350 return svc;
ebe99d61 1351
ebe99d61
RMS		 1352err_put_device:
1353 put_device(&svc->dev);
1354 return NULL;
30c6d9d7
AE		 1355}
1356
7adeaae7 1357int gb_svc_add(struct gb_svc *svc)
30c6d9d7 1358{
7adeaae7 1359 int ret;
30c6d9d7 1360
7adeaae7
JH		 1361 /*
1362 * The SVC protocol is currently driven by the SVC, so the SVC device
1363 * is added from the connection request handler when enough
1364 * information has been received.
1365 */
f7ee081e 1366 ret = gb_connection_enable(svc->connection);
7adeaae7
JH		 1367 if (ret)
1368 return ret;
1369
1370 return 0;
1371}
1372
b15d97d7 1373static void gb_svc_remove_modules(struct gb_svc *svc)
66d674cf 1374{
b15d97d7
JH		 1375 struct gb_host_device *hd = svc->hd;
1376 struct gb_module *module, *tmp;
66d674cf 1377
b15d97d7
JH		 1378 list_for_each_entry_safe(module, tmp, &hd->modules, hd_node) {
1379 gb_module_del(module);
1380 list_del(&module->hd_node);
1381 gb_module_put(module);
629c0d00 1382 }
66d674cf
JH		 1383}
1384
7adeaae7
JH		 1385void gb_svc_del(struct gb_svc *svc)
1386{
d1a8c36e 1387 gb_connection_disable_rx(svc->connection);
ebe99d61 1388
7adeaae7 1389 /*
1beb1fae 1390 * The SVC device may have been registered from the request handler.
7adeaae7 1391 */
ebe99d61 1392 if (device_is_registered(&svc->dev)) {
12185197 1393 gb_svc_debugfs_exit(svc);
ed7279ae 1394 gb_svc_watchdog_destroy(svc);
88f7b96d 1395 device_del(&svc->dev);
ebe99d61 1396 }
1cacb456 1397
7adeaae7 1398 flush_workqueue(svc->wq);
66d674cf 1399
b15d97d7 1400 gb_svc_remove_modules(svc);
d1a8c36e
VK		 1401
1402 gb_connection_disable(svc->connection);
7adeaae7 1403}
efe6ef76 1404
7adeaae7
JH		 1405void gb_svc_put(struct gb_svc *svc)
1406{
efe6ef76 1407 put_device(&svc->dev);
30c6d9d7 1408}
Linux 6.x block layer and io_uring tree(s)