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