]> git.proxmox.com Git - mirror_ubuntu-hirsute-kernel.git/blob - drivers/thunderbolt/xdomain.c
selftests: kvm: consolidate VMX support checks
[mirror_ubuntu-hirsute-kernel.git] / drivers / thunderbolt / xdomain.c
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Thunderbolt XDomain discovery protocol support
4 *
5 * Copyright (C) 2017, Intel Corporation
6 * Authors: Michael Jamet <michael.jamet@intel.com>
7 * Mika Westerberg <mika.westerberg@linux.intel.com>
8 */
9
10 #include <linux/device.h>
11 #include <linux/kmod.h>
12 #include <linux/module.h>
13 #include <linux/pm_runtime.h>
14 #include <linux/utsname.h>
15 #include <linux/uuid.h>
16 #include <linux/workqueue.h>
17
18 #include "tb.h"
19
20 #define XDOMAIN_DEFAULT_TIMEOUT 5000 /* ms */
21 #define XDOMAIN_UUID_RETRIES 10
22 #define XDOMAIN_PROPERTIES_RETRIES 60
23 #define XDOMAIN_PROPERTIES_CHANGED_RETRIES 10
24
25 struct xdomain_request_work {
26 struct work_struct work;
27 struct tb_xdp_header *pkg;
28 struct tb *tb;
29 };
30
31 /* Serializes access to the properties and protocol handlers below */
32 static DEFINE_MUTEX(xdomain_lock);
33
34 /* Properties exposed to the remote domains */
35 static struct tb_property_dir *xdomain_property_dir;
36 static u32 *xdomain_property_block;
37 static u32 xdomain_property_block_len;
38 static u32 xdomain_property_block_gen;
39
40 /* Additional protocol handlers */
41 static LIST_HEAD(protocol_handlers);
42
43 /* UUID for XDomain discovery protocol: b638d70e-42ff-40bb-97c2-90e2c0b2ff07 */
44 static const uuid_t tb_xdp_uuid =
45 UUID_INIT(0xb638d70e, 0x42ff, 0x40bb,
46 0x97, 0xc2, 0x90, 0xe2, 0xc0, 0xb2, 0xff, 0x07);
47
48 static bool tb_xdomain_match(const struct tb_cfg_request *req,
49 const struct ctl_pkg *pkg)
50 {
51 switch (pkg->frame.eof) {
52 case TB_CFG_PKG_ERROR:
53 return true;
54
55 case TB_CFG_PKG_XDOMAIN_RESP: {
56 const struct tb_xdp_header *res_hdr = pkg->buffer;
57 const struct tb_xdp_header *req_hdr = req->request;
58
59 if (pkg->frame.size < req->response_size / 4)
60 return false;
61
62 /* Make sure route matches */
63 if ((res_hdr->xd_hdr.route_hi & ~BIT(31)) !=
64 req_hdr->xd_hdr.route_hi)
65 return false;
66 if ((res_hdr->xd_hdr.route_lo) != req_hdr->xd_hdr.route_lo)
67 return false;
68
69 /* Check that the XDomain protocol matches */
70 if (!uuid_equal(&res_hdr->uuid, &req_hdr->uuid))
71 return false;
72
73 return true;
74 }
75
76 default:
77 return false;
78 }
79 }
80
81 static bool tb_xdomain_copy(struct tb_cfg_request *req,
82 const struct ctl_pkg *pkg)
83 {
84 memcpy(req->response, pkg->buffer, req->response_size);
85 req->result.err = 0;
86 return true;
87 }
88
89 static void response_ready(void *data)
90 {
91 tb_cfg_request_put(data);
92 }
93
94 static int __tb_xdomain_response(struct tb_ctl *ctl, const void *response,
95 size_t size, enum tb_cfg_pkg_type type)
96 {
97 struct tb_cfg_request *req;
98
99 req = tb_cfg_request_alloc();
100 if (!req)
101 return -ENOMEM;
102
103 req->match = tb_xdomain_match;
104 req->copy = tb_xdomain_copy;
105 req->request = response;
106 req->request_size = size;
107 req->request_type = type;
108
109 return tb_cfg_request(ctl, req, response_ready, req);
110 }
111
112 /**
113 * tb_xdomain_response() - Send a XDomain response message
114 * @xd: XDomain to send the message
115 * @response: Response to send
116 * @size: Size of the response
117 * @type: PDF type of the response
118 *
119 * This can be used to send a XDomain response message to the other
120 * domain. No response for the message is expected.
121 *
122 * Return: %0 in case of success and negative errno in case of failure
123 */
124 int tb_xdomain_response(struct tb_xdomain *xd, const void *response,
125 size_t size, enum tb_cfg_pkg_type type)
126 {
127 return __tb_xdomain_response(xd->tb->ctl, response, size, type);
128 }
129 EXPORT_SYMBOL_GPL(tb_xdomain_response);
130
131 static int __tb_xdomain_request(struct tb_ctl *ctl, const void *request,
132 size_t request_size, enum tb_cfg_pkg_type request_type, void *response,
133 size_t response_size, enum tb_cfg_pkg_type response_type,
134 unsigned int timeout_msec)
135 {
136 struct tb_cfg_request *req;
137 struct tb_cfg_result res;
138
139 req = tb_cfg_request_alloc();
140 if (!req)
141 return -ENOMEM;
142
143 req->match = tb_xdomain_match;
144 req->copy = tb_xdomain_copy;
145 req->request = request;
146 req->request_size = request_size;
147 req->request_type = request_type;
148 req->response = response;
149 req->response_size = response_size;
150 req->response_type = response_type;
151
152 res = tb_cfg_request_sync(ctl, req, timeout_msec);
153
154 tb_cfg_request_put(req);
155
156 return res.err == 1 ? -EIO : res.err;
157 }
158
159 /**
160 * tb_xdomain_request() - Send a XDomain request
161 * @xd: XDomain to send the request
162 * @request: Request to send
163 * @request_size: Size of the request in bytes
164 * @request_type: PDF type of the request
165 * @response: Response is copied here
166 * @response_size: Expected size of the response in bytes
167 * @response_type: Expected PDF type of the response
168 * @timeout_msec: Timeout in milliseconds to wait for the response
169 *
170 * This function can be used to send XDomain control channel messages to
171 * the other domain. The function waits until the response is received
172 * or when timeout triggers. Whichever comes first.
173 *
174 * Return: %0 in case of success and negative errno in case of failure
175 */
176 int tb_xdomain_request(struct tb_xdomain *xd, const void *request,
177 size_t request_size, enum tb_cfg_pkg_type request_type,
178 void *response, size_t response_size,
179 enum tb_cfg_pkg_type response_type, unsigned int timeout_msec)
180 {
181 return __tb_xdomain_request(xd->tb->ctl, request, request_size,
182 request_type, response, response_size,
183 response_type, timeout_msec);
184 }
185 EXPORT_SYMBOL_GPL(tb_xdomain_request);
186
187 static inline void tb_xdp_fill_header(struct tb_xdp_header *hdr, u64 route,
188 u8 sequence, enum tb_xdp_type type, size_t size)
189 {
190 u32 length_sn;
191
192 length_sn = (size - sizeof(hdr->xd_hdr)) / 4;
193 length_sn |= (sequence << TB_XDOMAIN_SN_SHIFT) & TB_XDOMAIN_SN_MASK;
194
195 hdr->xd_hdr.route_hi = upper_32_bits(route);
196 hdr->xd_hdr.route_lo = lower_32_bits(route);
197 hdr->xd_hdr.length_sn = length_sn;
198 hdr->type = type;
199 memcpy(&hdr->uuid, &tb_xdp_uuid, sizeof(tb_xdp_uuid));
200 }
201
202 static int tb_xdp_handle_error(const struct tb_xdp_header *hdr)
203 {
204 const struct tb_xdp_error_response *error;
205
206 if (hdr->type != ERROR_RESPONSE)
207 return 0;
208
209 error = (const struct tb_xdp_error_response *)hdr;
210
211 switch (error->error) {
212 case ERROR_UNKNOWN_PACKET:
213 case ERROR_UNKNOWN_DOMAIN:
214 return -EIO;
215 case ERROR_NOT_SUPPORTED:
216 return -ENOTSUPP;
217 case ERROR_NOT_READY:
218 return -EAGAIN;
219 default:
220 break;
221 }
222
223 return 0;
224 }
225
226 static int tb_xdp_uuid_request(struct tb_ctl *ctl, u64 route, int retry,
227 uuid_t *uuid)
228 {
229 struct tb_xdp_uuid_response res;
230 struct tb_xdp_uuid req;
231 int ret;
232
233 memset(&req, 0, sizeof(req));
234 tb_xdp_fill_header(&req.hdr, route, retry % 4, UUID_REQUEST,
235 sizeof(req));
236
237 memset(&res, 0, sizeof(res));
238 ret = __tb_xdomain_request(ctl, &req, sizeof(req),
239 TB_CFG_PKG_XDOMAIN_REQ, &res, sizeof(res),
240 TB_CFG_PKG_XDOMAIN_RESP,
241 XDOMAIN_DEFAULT_TIMEOUT);
242 if (ret)
243 return ret;
244
245 ret = tb_xdp_handle_error(&res.hdr);
246 if (ret)
247 return ret;
248
249 uuid_copy(uuid, &res.src_uuid);
250 return 0;
251 }
252
253 static int tb_xdp_uuid_response(struct tb_ctl *ctl, u64 route, u8 sequence,
254 const uuid_t *uuid)
255 {
256 struct tb_xdp_uuid_response res;
257
258 memset(&res, 0, sizeof(res));
259 tb_xdp_fill_header(&res.hdr, route, sequence, UUID_RESPONSE,
260 sizeof(res));
261
262 uuid_copy(&res.src_uuid, uuid);
263 res.src_route_hi = upper_32_bits(route);
264 res.src_route_lo = lower_32_bits(route);
265
266 return __tb_xdomain_response(ctl, &res, sizeof(res),
267 TB_CFG_PKG_XDOMAIN_RESP);
268 }
269
270 static int tb_xdp_error_response(struct tb_ctl *ctl, u64 route, u8 sequence,
271 enum tb_xdp_error error)
272 {
273 struct tb_xdp_error_response res;
274
275 memset(&res, 0, sizeof(res));
276 tb_xdp_fill_header(&res.hdr, route, sequence, ERROR_RESPONSE,
277 sizeof(res));
278 res.error = error;
279
280 return __tb_xdomain_response(ctl, &res, sizeof(res),
281 TB_CFG_PKG_XDOMAIN_RESP);
282 }
283
284 static int tb_xdp_properties_request(struct tb_ctl *ctl, u64 route,
285 const uuid_t *src_uuid, const uuid_t *dst_uuid, int retry,
286 u32 **block, u32 *generation)
287 {
288 struct tb_xdp_properties_response *res;
289 struct tb_xdp_properties req;
290 u16 data_len, len;
291 size_t total_size;
292 u32 *data = NULL;
293 int ret;
294
295 total_size = sizeof(*res) + TB_XDP_PROPERTIES_MAX_DATA_LENGTH * 4;
296 res = kzalloc(total_size, GFP_KERNEL);
297 if (!res)
298 return -ENOMEM;
299
300 memset(&req, 0, sizeof(req));
301 tb_xdp_fill_header(&req.hdr, route, retry % 4, PROPERTIES_REQUEST,
302 sizeof(req));
303 memcpy(&req.src_uuid, src_uuid, sizeof(*src_uuid));
304 memcpy(&req.dst_uuid, dst_uuid, sizeof(*dst_uuid));
305
306 len = 0;
307 data_len = 0;
308
309 do {
310 ret = __tb_xdomain_request(ctl, &req, sizeof(req),
311 TB_CFG_PKG_XDOMAIN_REQ, res,
312 total_size, TB_CFG_PKG_XDOMAIN_RESP,
313 XDOMAIN_DEFAULT_TIMEOUT);
314 if (ret)
315 goto err;
316
317 ret = tb_xdp_handle_error(&res->hdr);
318 if (ret)
319 goto err;
320
321 /*
322 * Package length includes the whole payload without the
323 * XDomain header. Validate first that the package is at
324 * least size of the response structure.
325 */
326 len = res->hdr.xd_hdr.length_sn & TB_XDOMAIN_LENGTH_MASK;
327 if (len < sizeof(*res) / 4) {
328 ret = -EINVAL;
329 goto err;
330 }
331
332 len += sizeof(res->hdr.xd_hdr) / 4;
333 len -= sizeof(*res) / 4;
334
335 if (res->offset != req.offset) {
336 ret = -EINVAL;
337 goto err;
338 }
339
340 /*
341 * First time allocate block that has enough space for
342 * the whole properties block.
343 */
344 if (!data) {
345 data_len = res->data_length;
346 if (data_len > TB_XDP_PROPERTIES_MAX_LENGTH) {
347 ret = -E2BIG;
348 goto err;
349 }
350
351 data = kcalloc(data_len, sizeof(u32), GFP_KERNEL);
352 if (!data) {
353 ret = -ENOMEM;
354 goto err;
355 }
356 }
357
358 memcpy(data + req.offset, res->data, len * 4);
359 req.offset += len;
360 } while (!data_len || req.offset < data_len);
361
362 *block = data;
363 *generation = res->generation;
364
365 kfree(res);
366
367 return data_len;
368
369 err:
370 kfree(data);
371 kfree(res);
372
373 return ret;
374 }
375
376 static int tb_xdp_properties_response(struct tb *tb, struct tb_ctl *ctl,
377 u64 route, u8 sequence, const uuid_t *src_uuid,
378 const struct tb_xdp_properties *req)
379 {
380 struct tb_xdp_properties_response *res;
381 size_t total_size;
382 u16 len;
383 int ret;
384
385 /*
386 * Currently we expect all requests to be directed to us. The
387 * protocol supports forwarding, though which we might add
388 * support later on.
389 */
390 if (!uuid_equal(src_uuid, &req->dst_uuid)) {
391 tb_xdp_error_response(ctl, route, sequence,
392 ERROR_UNKNOWN_DOMAIN);
393 return 0;
394 }
395
396 mutex_lock(&xdomain_lock);
397
398 if (req->offset >= xdomain_property_block_len) {
399 mutex_unlock(&xdomain_lock);
400 return -EINVAL;
401 }
402
403 len = xdomain_property_block_len - req->offset;
404 len = min_t(u16, len, TB_XDP_PROPERTIES_MAX_DATA_LENGTH);
405 total_size = sizeof(*res) + len * 4;
406
407 res = kzalloc(total_size, GFP_KERNEL);
408 if (!res) {
409 mutex_unlock(&xdomain_lock);
410 return -ENOMEM;
411 }
412
413 tb_xdp_fill_header(&res->hdr, route, sequence, PROPERTIES_RESPONSE,
414 total_size);
415 res->generation = xdomain_property_block_gen;
416 res->data_length = xdomain_property_block_len;
417 res->offset = req->offset;
418 uuid_copy(&res->src_uuid, src_uuid);
419 uuid_copy(&res->dst_uuid, &req->src_uuid);
420 memcpy(res->data, &xdomain_property_block[req->offset], len * 4);
421
422 mutex_unlock(&xdomain_lock);
423
424 ret = __tb_xdomain_response(ctl, res, total_size,
425 TB_CFG_PKG_XDOMAIN_RESP);
426
427 kfree(res);
428 return ret;
429 }
430
431 static int tb_xdp_properties_changed_request(struct tb_ctl *ctl, u64 route,
432 int retry, const uuid_t *uuid)
433 {
434 struct tb_xdp_properties_changed_response res;
435 struct tb_xdp_properties_changed req;
436 int ret;
437
438 memset(&req, 0, sizeof(req));
439 tb_xdp_fill_header(&req.hdr, route, retry % 4,
440 PROPERTIES_CHANGED_REQUEST, sizeof(req));
441 uuid_copy(&req.src_uuid, uuid);
442
443 memset(&res, 0, sizeof(res));
444 ret = __tb_xdomain_request(ctl, &req, sizeof(req),
445 TB_CFG_PKG_XDOMAIN_REQ, &res, sizeof(res),
446 TB_CFG_PKG_XDOMAIN_RESP,
447 XDOMAIN_DEFAULT_TIMEOUT);
448 if (ret)
449 return ret;
450
451 return tb_xdp_handle_error(&res.hdr);
452 }
453
454 static int
455 tb_xdp_properties_changed_response(struct tb_ctl *ctl, u64 route, u8 sequence)
456 {
457 struct tb_xdp_properties_changed_response res;
458
459 memset(&res, 0, sizeof(res));
460 tb_xdp_fill_header(&res.hdr, route, sequence,
461 PROPERTIES_CHANGED_RESPONSE, sizeof(res));
462 return __tb_xdomain_response(ctl, &res, sizeof(res),
463 TB_CFG_PKG_XDOMAIN_RESP);
464 }
465
466 /**
467 * tb_register_protocol_handler() - Register protocol handler
468 * @handler: Handler to register
469 *
470 * This allows XDomain service drivers to hook into incoming XDomain
471 * messages. After this function is called the service driver needs to
472 * be able to handle calls to callback whenever a package with the
473 * registered protocol is received.
474 */
475 int tb_register_protocol_handler(struct tb_protocol_handler *handler)
476 {
477 if (!handler->uuid || !handler->callback)
478 return -EINVAL;
479 if (uuid_equal(handler->uuid, &tb_xdp_uuid))
480 return -EINVAL;
481
482 mutex_lock(&xdomain_lock);
483 list_add_tail(&handler->list, &protocol_handlers);
484 mutex_unlock(&xdomain_lock);
485
486 return 0;
487 }
488 EXPORT_SYMBOL_GPL(tb_register_protocol_handler);
489
490 /**
491 * tb_unregister_protocol_handler() - Unregister protocol handler
492 * @handler: Handler to unregister
493 *
494 * Removes the previously registered protocol handler.
495 */
496 void tb_unregister_protocol_handler(struct tb_protocol_handler *handler)
497 {
498 mutex_lock(&xdomain_lock);
499 list_del_init(&handler->list);
500 mutex_unlock(&xdomain_lock);
501 }
502 EXPORT_SYMBOL_GPL(tb_unregister_protocol_handler);
503
504 static void tb_xdp_handle_request(struct work_struct *work)
505 {
506 struct xdomain_request_work *xw = container_of(work, typeof(*xw), work);
507 const struct tb_xdp_header *pkg = xw->pkg;
508 const struct tb_xdomain_header *xhdr = &pkg->xd_hdr;
509 struct tb *tb = xw->tb;
510 struct tb_ctl *ctl = tb->ctl;
511 const uuid_t *uuid;
512 int ret = 0;
513 u32 sequence;
514 u64 route;
515
516 route = ((u64)xhdr->route_hi << 32 | xhdr->route_lo) & ~BIT_ULL(63);
517 sequence = xhdr->length_sn & TB_XDOMAIN_SN_MASK;
518 sequence >>= TB_XDOMAIN_SN_SHIFT;
519
520 mutex_lock(&tb->lock);
521 if (tb->root_switch)
522 uuid = tb->root_switch->uuid;
523 else
524 uuid = NULL;
525 mutex_unlock(&tb->lock);
526
527 if (!uuid) {
528 tb_xdp_error_response(ctl, route, sequence, ERROR_NOT_READY);
529 goto out;
530 }
531
532 switch (pkg->type) {
533 case PROPERTIES_REQUEST:
534 ret = tb_xdp_properties_response(tb, ctl, route, sequence, uuid,
535 (const struct tb_xdp_properties *)pkg);
536 break;
537
538 case PROPERTIES_CHANGED_REQUEST: {
539 const struct tb_xdp_properties_changed *xchg =
540 (const struct tb_xdp_properties_changed *)pkg;
541 struct tb_xdomain *xd;
542
543 ret = tb_xdp_properties_changed_response(ctl, route, sequence);
544
545 /*
546 * Since the properties have been changed, let's update
547 * the xdomain related to this connection as well in
548 * case there is a change in services it offers.
549 */
550 xd = tb_xdomain_find_by_uuid_locked(tb, &xchg->src_uuid);
551 if (xd) {
552 queue_delayed_work(tb->wq, &xd->get_properties_work,
553 msecs_to_jiffies(50));
554 tb_xdomain_put(xd);
555 }
556
557 break;
558 }
559
560 case UUID_REQUEST_OLD:
561 case UUID_REQUEST:
562 ret = tb_xdp_uuid_response(ctl, route, sequence, uuid);
563 break;
564
565 default:
566 tb_xdp_error_response(ctl, route, sequence,
567 ERROR_NOT_SUPPORTED);
568 break;
569 }
570
571 if (ret) {
572 tb_warn(tb, "failed to send XDomain response for %#x\n",
573 pkg->type);
574 }
575
576 out:
577 kfree(xw->pkg);
578 kfree(xw);
579
580 tb_domain_put(tb);
581 }
582
583 static bool
584 tb_xdp_schedule_request(struct tb *tb, const struct tb_xdp_header *hdr,
585 size_t size)
586 {
587 struct xdomain_request_work *xw;
588
589 xw = kmalloc(sizeof(*xw), GFP_KERNEL);
590 if (!xw)
591 return false;
592
593 INIT_WORK(&xw->work, tb_xdp_handle_request);
594 xw->pkg = kmemdup(hdr, size, GFP_KERNEL);
595 if (!xw->pkg) {
596 kfree(xw);
597 return false;
598 }
599 xw->tb = tb_domain_get(tb);
600
601 schedule_work(&xw->work);
602 return true;
603 }
604
605 /**
606 * tb_register_service_driver() - Register XDomain service driver
607 * @drv: Driver to register
608 *
609 * Registers new service driver from @drv to the bus.
610 */
611 int tb_register_service_driver(struct tb_service_driver *drv)
612 {
613 drv->driver.bus = &tb_bus_type;
614 return driver_register(&drv->driver);
615 }
616 EXPORT_SYMBOL_GPL(tb_register_service_driver);
617
618 /**
619 * tb_unregister_service_driver() - Unregister XDomain service driver
620 * @xdrv: Driver to unregister
621 *
622 * Unregisters XDomain service driver from the bus.
623 */
624 void tb_unregister_service_driver(struct tb_service_driver *drv)
625 {
626 driver_unregister(&drv->driver);
627 }
628 EXPORT_SYMBOL_GPL(tb_unregister_service_driver);
629
630 static ssize_t key_show(struct device *dev, struct device_attribute *attr,
631 char *buf)
632 {
633 struct tb_service *svc = container_of(dev, struct tb_service, dev);
634
635 /*
636 * It should be null terminated but anything else is pretty much
637 * allowed.
638 */
639 return sprintf(buf, "%*pE\n", (int)strlen(svc->key), svc->key);
640 }
641 static DEVICE_ATTR_RO(key);
642
643 static int get_modalias(struct tb_service *svc, char *buf, size_t size)
644 {
645 return snprintf(buf, size, "tbsvc:k%sp%08Xv%08Xr%08X", svc->key,
646 svc->prtcid, svc->prtcvers, svc->prtcrevs);
647 }
648
649 static ssize_t modalias_show(struct device *dev, struct device_attribute *attr,
650 char *buf)
651 {
652 struct tb_service *svc = container_of(dev, struct tb_service, dev);
653
654 /* Full buffer size except new line and null termination */
655 get_modalias(svc, buf, PAGE_SIZE - 2);
656 return sprintf(buf, "%s\n", buf);
657 }
658 static DEVICE_ATTR_RO(modalias);
659
660 static ssize_t prtcid_show(struct device *dev, struct device_attribute *attr,
661 char *buf)
662 {
663 struct tb_service *svc = container_of(dev, struct tb_service, dev);
664
665 return sprintf(buf, "%u\n", svc->prtcid);
666 }
667 static DEVICE_ATTR_RO(prtcid);
668
669 static ssize_t prtcvers_show(struct device *dev, struct device_attribute *attr,
670 char *buf)
671 {
672 struct tb_service *svc = container_of(dev, struct tb_service, dev);
673
674 return sprintf(buf, "%u\n", svc->prtcvers);
675 }
676 static DEVICE_ATTR_RO(prtcvers);
677
678 static ssize_t prtcrevs_show(struct device *dev, struct device_attribute *attr,
679 char *buf)
680 {
681 struct tb_service *svc = container_of(dev, struct tb_service, dev);
682
683 return sprintf(buf, "%u\n", svc->prtcrevs);
684 }
685 static DEVICE_ATTR_RO(prtcrevs);
686
687 static ssize_t prtcstns_show(struct device *dev, struct device_attribute *attr,
688 char *buf)
689 {
690 struct tb_service *svc = container_of(dev, struct tb_service, dev);
691
692 return sprintf(buf, "0x%08x\n", svc->prtcstns);
693 }
694 static DEVICE_ATTR_RO(prtcstns);
695
696 static struct attribute *tb_service_attrs[] = {
697 &dev_attr_key.attr,
698 &dev_attr_modalias.attr,
699 &dev_attr_prtcid.attr,
700 &dev_attr_prtcvers.attr,
701 &dev_attr_prtcrevs.attr,
702 &dev_attr_prtcstns.attr,
703 NULL,
704 };
705
706 static struct attribute_group tb_service_attr_group = {
707 .attrs = tb_service_attrs,
708 };
709
710 static const struct attribute_group *tb_service_attr_groups[] = {
711 &tb_service_attr_group,
712 NULL,
713 };
714
715 static int tb_service_uevent(struct device *dev, struct kobj_uevent_env *env)
716 {
717 struct tb_service *svc = container_of(dev, struct tb_service, dev);
718 char modalias[64];
719
720 get_modalias(svc, modalias, sizeof(modalias));
721 return add_uevent_var(env, "MODALIAS=%s", modalias);
722 }
723
724 static void tb_service_release(struct device *dev)
725 {
726 struct tb_service *svc = container_of(dev, struct tb_service, dev);
727 struct tb_xdomain *xd = tb_service_parent(svc);
728
729 ida_simple_remove(&xd->service_ids, svc->id);
730 kfree(svc->key);
731 kfree(svc);
732 }
733
734 struct device_type tb_service_type = {
735 .name = "thunderbolt_service",
736 .groups = tb_service_attr_groups,
737 .uevent = tb_service_uevent,
738 .release = tb_service_release,
739 };
740 EXPORT_SYMBOL_GPL(tb_service_type);
741
742 static int remove_missing_service(struct device *dev, void *data)
743 {
744 struct tb_xdomain *xd = data;
745 struct tb_service *svc;
746
747 svc = tb_to_service(dev);
748 if (!svc)
749 return 0;
750
751 if (!tb_property_find(xd->properties, svc->key,
752 TB_PROPERTY_TYPE_DIRECTORY))
753 device_unregister(dev);
754
755 return 0;
756 }
757
758 static int find_service(struct device *dev, void *data)
759 {
760 const struct tb_property *p = data;
761 struct tb_service *svc;
762
763 svc = tb_to_service(dev);
764 if (!svc)
765 return 0;
766
767 return !strcmp(svc->key, p->key);
768 }
769
770 static int populate_service(struct tb_service *svc,
771 struct tb_property *property)
772 {
773 struct tb_property_dir *dir = property->value.dir;
774 struct tb_property *p;
775
776 /* Fill in standard properties */
777 p = tb_property_find(dir, "prtcid", TB_PROPERTY_TYPE_VALUE);
778 if (p)
779 svc->prtcid = p->value.immediate;
780 p = tb_property_find(dir, "prtcvers", TB_PROPERTY_TYPE_VALUE);
781 if (p)
782 svc->prtcvers = p->value.immediate;
783 p = tb_property_find(dir, "prtcrevs", TB_PROPERTY_TYPE_VALUE);
784 if (p)
785 svc->prtcrevs = p->value.immediate;
786 p = tb_property_find(dir, "prtcstns", TB_PROPERTY_TYPE_VALUE);
787 if (p)
788 svc->prtcstns = p->value.immediate;
789
790 svc->key = kstrdup(property->key, GFP_KERNEL);
791 if (!svc->key)
792 return -ENOMEM;
793
794 return 0;
795 }
796
797 static void enumerate_services(struct tb_xdomain *xd)
798 {
799 struct tb_service *svc;
800 struct tb_property *p;
801 struct device *dev;
802 int id;
803
804 /*
805 * First remove all services that are not available anymore in
806 * the updated property block.
807 */
808 device_for_each_child_reverse(&xd->dev, xd, remove_missing_service);
809
810 /* Then re-enumerate properties creating new services as we go */
811 tb_property_for_each(xd->properties, p) {
812 if (p->type != TB_PROPERTY_TYPE_DIRECTORY)
813 continue;
814
815 /* If the service exists already we are fine */
816 dev = device_find_child(&xd->dev, p, find_service);
817 if (dev) {
818 put_device(dev);
819 continue;
820 }
821
822 svc = kzalloc(sizeof(*svc), GFP_KERNEL);
823 if (!svc)
824 break;
825
826 if (populate_service(svc, p)) {
827 kfree(svc);
828 break;
829 }
830
831 id = ida_simple_get(&xd->service_ids, 0, 0, GFP_KERNEL);
832 if (id < 0) {
833 kfree(svc);
834 break;
835 }
836 svc->id = id;
837 svc->dev.bus = &tb_bus_type;
838 svc->dev.type = &tb_service_type;
839 svc->dev.parent = &xd->dev;
840 dev_set_name(&svc->dev, "%s.%d", dev_name(&xd->dev), svc->id);
841
842 if (device_register(&svc->dev)) {
843 put_device(&svc->dev);
844 break;
845 }
846 }
847 }
848
849 static int populate_properties(struct tb_xdomain *xd,
850 struct tb_property_dir *dir)
851 {
852 const struct tb_property *p;
853
854 /* Required properties */
855 p = tb_property_find(dir, "deviceid", TB_PROPERTY_TYPE_VALUE);
856 if (!p)
857 return -EINVAL;
858 xd->device = p->value.immediate;
859
860 p = tb_property_find(dir, "vendorid", TB_PROPERTY_TYPE_VALUE);
861 if (!p)
862 return -EINVAL;
863 xd->vendor = p->value.immediate;
864
865 kfree(xd->device_name);
866 xd->device_name = NULL;
867 kfree(xd->vendor_name);
868 xd->vendor_name = NULL;
869
870 /* Optional properties */
871 p = tb_property_find(dir, "deviceid", TB_PROPERTY_TYPE_TEXT);
872 if (p)
873 xd->device_name = kstrdup(p->value.text, GFP_KERNEL);
874 p = tb_property_find(dir, "vendorid", TB_PROPERTY_TYPE_TEXT);
875 if (p)
876 xd->vendor_name = kstrdup(p->value.text, GFP_KERNEL);
877
878 return 0;
879 }
880
881 /* Called with @xd->lock held */
882 static void tb_xdomain_restore_paths(struct tb_xdomain *xd)
883 {
884 if (!xd->resume)
885 return;
886
887 xd->resume = false;
888 if (xd->transmit_path) {
889 dev_dbg(&xd->dev, "re-establishing DMA path\n");
890 tb_domain_approve_xdomain_paths(xd->tb, xd);
891 }
892 }
893
894 static void tb_xdomain_get_uuid(struct work_struct *work)
895 {
896 struct tb_xdomain *xd = container_of(work, typeof(*xd),
897 get_uuid_work.work);
898 struct tb *tb = xd->tb;
899 uuid_t uuid;
900 int ret;
901
902 ret = tb_xdp_uuid_request(tb->ctl, xd->route, xd->uuid_retries, &uuid);
903 if (ret < 0) {
904 if (xd->uuid_retries-- > 0) {
905 queue_delayed_work(xd->tb->wq, &xd->get_uuid_work,
906 msecs_to_jiffies(100));
907 } else {
908 dev_dbg(&xd->dev, "failed to read remote UUID\n");
909 }
910 return;
911 }
912
913 if (uuid_equal(&uuid, xd->local_uuid)) {
914 dev_dbg(&xd->dev, "intra-domain loop detected\n");
915 return;
916 }
917
918 /*
919 * If the UUID is different, there is another domain connected
920 * so mark this one unplugged and wait for the connection
921 * manager to replace it.
922 */
923 if (xd->remote_uuid && !uuid_equal(&uuid, xd->remote_uuid)) {
924 dev_dbg(&xd->dev, "remote UUID is different, unplugging\n");
925 xd->is_unplugged = true;
926 return;
927 }
928
929 /* First time fill in the missing UUID */
930 if (!xd->remote_uuid) {
931 xd->remote_uuid = kmemdup(&uuid, sizeof(uuid_t), GFP_KERNEL);
932 if (!xd->remote_uuid)
933 return;
934 }
935
936 /* Now we can start the normal properties exchange */
937 queue_delayed_work(xd->tb->wq, &xd->properties_changed_work,
938 msecs_to_jiffies(100));
939 queue_delayed_work(xd->tb->wq, &xd->get_properties_work,
940 msecs_to_jiffies(1000));
941 }
942
943 static void tb_xdomain_get_properties(struct work_struct *work)
944 {
945 struct tb_xdomain *xd = container_of(work, typeof(*xd),
946 get_properties_work.work);
947 struct tb_property_dir *dir;
948 struct tb *tb = xd->tb;
949 bool update = false;
950 u32 *block = NULL;
951 u32 gen = 0;
952 int ret;
953
954 ret = tb_xdp_properties_request(tb->ctl, xd->route, xd->local_uuid,
955 xd->remote_uuid, xd->properties_retries,
956 &block, &gen);
957 if (ret < 0) {
958 if (xd->properties_retries-- > 0) {
959 queue_delayed_work(xd->tb->wq, &xd->get_properties_work,
960 msecs_to_jiffies(1000));
961 } else {
962 /* Give up now */
963 dev_err(&xd->dev,
964 "failed read XDomain properties from %pUb\n",
965 xd->remote_uuid);
966 }
967 return;
968 }
969
970 xd->properties_retries = XDOMAIN_PROPERTIES_RETRIES;
971
972 mutex_lock(&xd->lock);
973
974 /* Only accept newer generation properties */
975 if (xd->properties && gen <= xd->property_block_gen) {
976 /*
977 * On resume it is likely that the properties block is
978 * not changed (unless the other end added or removed
979 * services). However, we need to make sure the existing
980 * DMA paths are restored properly.
981 */
982 tb_xdomain_restore_paths(xd);
983 goto err_free_block;
984 }
985
986 dir = tb_property_parse_dir(block, ret);
987 if (!dir) {
988 dev_err(&xd->dev, "failed to parse XDomain properties\n");
989 goto err_free_block;
990 }
991
992 ret = populate_properties(xd, dir);
993 if (ret) {
994 dev_err(&xd->dev, "missing XDomain properties in response\n");
995 goto err_free_dir;
996 }
997
998 /* Release the existing one */
999 if (xd->properties) {
1000 tb_property_free_dir(xd->properties);
1001 update = true;
1002 }
1003
1004 xd->properties = dir;
1005 xd->property_block_gen = gen;
1006
1007 tb_xdomain_restore_paths(xd);
1008
1009 mutex_unlock(&xd->lock);
1010
1011 kfree(block);
1012
1013 /*
1014 * Now the device should be ready enough so we can add it to the
1015 * bus and let userspace know about it. If the device is already
1016 * registered, we notify the userspace that it has changed.
1017 */
1018 if (!update) {
1019 if (device_add(&xd->dev)) {
1020 dev_err(&xd->dev, "failed to add XDomain device\n");
1021 return;
1022 }
1023 } else {
1024 kobject_uevent(&xd->dev.kobj, KOBJ_CHANGE);
1025 }
1026
1027 enumerate_services(xd);
1028 return;
1029
1030 err_free_dir:
1031 tb_property_free_dir(dir);
1032 err_free_block:
1033 kfree(block);
1034 mutex_unlock(&xd->lock);
1035 }
1036
1037 static void tb_xdomain_properties_changed(struct work_struct *work)
1038 {
1039 struct tb_xdomain *xd = container_of(work, typeof(*xd),
1040 properties_changed_work.work);
1041 int ret;
1042
1043 ret = tb_xdp_properties_changed_request(xd->tb->ctl, xd->route,
1044 xd->properties_changed_retries, xd->local_uuid);
1045 if (ret) {
1046 if (xd->properties_changed_retries-- > 0)
1047 queue_delayed_work(xd->tb->wq,
1048 &xd->properties_changed_work,
1049 msecs_to_jiffies(1000));
1050 return;
1051 }
1052
1053 xd->properties_changed_retries = XDOMAIN_PROPERTIES_CHANGED_RETRIES;
1054 }
1055
1056 static ssize_t device_show(struct device *dev, struct device_attribute *attr,
1057 char *buf)
1058 {
1059 struct tb_xdomain *xd = container_of(dev, struct tb_xdomain, dev);
1060
1061 return sprintf(buf, "%#x\n", xd->device);
1062 }
1063 static DEVICE_ATTR_RO(device);
1064
1065 static ssize_t
1066 device_name_show(struct device *dev, struct device_attribute *attr, char *buf)
1067 {
1068 struct tb_xdomain *xd = container_of(dev, struct tb_xdomain, dev);
1069 int ret;
1070
1071 if (mutex_lock_interruptible(&xd->lock))
1072 return -ERESTARTSYS;
1073 ret = sprintf(buf, "%s\n", xd->device_name ? xd->device_name : "");
1074 mutex_unlock(&xd->lock);
1075
1076 return ret;
1077 }
1078 static DEVICE_ATTR_RO(device_name);
1079
1080 static ssize_t vendor_show(struct device *dev, struct device_attribute *attr,
1081 char *buf)
1082 {
1083 struct tb_xdomain *xd = container_of(dev, struct tb_xdomain, dev);
1084
1085 return sprintf(buf, "%#x\n", xd->vendor);
1086 }
1087 static DEVICE_ATTR_RO(vendor);
1088
1089 static ssize_t
1090 vendor_name_show(struct device *dev, struct device_attribute *attr, char *buf)
1091 {
1092 struct tb_xdomain *xd = container_of(dev, struct tb_xdomain, dev);
1093 int ret;
1094
1095 if (mutex_lock_interruptible(&xd->lock))
1096 return -ERESTARTSYS;
1097 ret = sprintf(buf, "%s\n", xd->vendor_name ? xd->vendor_name : "");
1098 mutex_unlock(&xd->lock);
1099
1100 return ret;
1101 }
1102 static DEVICE_ATTR_RO(vendor_name);
1103
1104 static ssize_t unique_id_show(struct device *dev, struct device_attribute *attr,
1105 char *buf)
1106 {
1107 struct tb_xdomain *xd = container_of(dev, struct tb_xdomain, dev);
1108
1109 return sprintf(buf, "%pUb\n", xd->remote_uuid);
1110 }
1111 static DEVICE_ATTR_RO(unique_id);
1112
1113 static struct attribute *xdomain_attrs[] = {
1114 &dev_attr_device.attr,
1115 &dev_attr_device_name.attr,
1116 &dev_attr_unique_id.attr,
1117 &dev_attr_vendor.attr,
1118 &dev_attr_vendor_name.attr,
1119 NULL,
1120 };
1121
1122 static struct attribute_group xdomain_attr_group = {
1123 .attrs = xdomain_attrs,
1124 };
1125
1126 static const struct attribute_group *xdomain_attr_groups[] = {
1127 &xdomain_attr_group,
1128 NULL,
1129 };
1130
1131 static void tb_xdomain_release(struct device *dev)
1132 {
1133 struct tb_xdomain *xd = container_of(dev, struct tb_xdomain, dev);
1134
1135 put_device(xd->dev.parent);
1136
1137 tb_property_free_dir(xd->properties);
1138 ida_destroy(&xd->service_ids);
1139
1140 kfree(xd->local_uuid);
1141 kfree(xd->remote_uuid);
1142 kfree(xd->device_name);
1143 kfree(xd->vendor_name);
1144 kfree(xd);
1145 }
1146
1147 static void start_handshake(struct tb_xdomain *xd)
1148 {
1149 xd->uuid_retries = XDOMAIN_UUID_RETRIES;
1150 xd->properties_retries = XDOMAIN_PROPERTIES_RETRIES;
1151 xd->properties_changed_retries = XDOMAIN_PROPERTIES_CHANGED_RETRIES;
1152
1153 if (xd->needs_uuid) {
1154 queue_delayed_work(xd->tb->wq, &xd->get_uuid_work,
1155 msecs_to_jiffies(100));
1156 } else {
1157 /* Start exchanging properties with the other host */
1158 queue_delayed_work(xd->tb->wq, &xd->properties_changed_work,
1159 msecs_to_jiffies(100));
1160 queue_delayed_work(xd->tb->wq, &xd->get_properties_work,
1161 msecs_to_jiffies(1000));
1162 }
1163 }
1164
1165 static void stop_handshake(struct tb_xdomain *xd)
1166 {
1167 xd->uuid_retries = 0;
1168 xd->properties_retries = 0;
1169 xd->properties_changed_retries = 0;
1170
1171 cancel_delayed_work_sync(&xd->get_uuid_work);
1172 cancel_delayed_work_sync(&xd->get_properties_work);
1173 cancel_delayed_work_sync(&xd->properties_changed_work);
1174 }
1175
1176 static int __maybe_unused tb_xdomain_suspend(struct device *dev)
1177 {
1178 stop_handshake(tb_to_xdomain(dev));
1179 return 0;
1180 }
1181
1182 static int __maybe_unused tb_xdomain_resume(struct device *dev)
1183 {
1184 struct tb_xdomain *xd = tb_to_xdomain(dev);
1185
1186 /*
1187 * Ask tb_xdomain_get_properties() restore any existing DMA
1188 * paths after properties are re-read.
1189 */
1190 xd->resume = true;
1191 start_handshake(xd);
1192
1193 return 0;
1194 }
1195
1196 static const struct dev_pm_ops tb_xdomain_pm_ops = {
1197 SET_SYSTEM_SLEEP_PM_OPS(tb_xdomain_suspend, tb_xdomain_resume)
1198 };
1199
1200 struct device_type tb_xdomain_type = {
1201 .name = "thunderbolt_xdomain",
1202 .release = tb_xdomain_release,
1203 .pm = &tb_xdomain_pm_ops,
1204 };
1205 EXPORT_SYMBOL_GPL(tb_xdomain_type);
1206
1207 /**
1208 * tb_xdomain_alloc() - Allocate new XDomain object
1209 * @tb: Domain where the XDomain belongs
1210 * @parent: Parent device (the switch through the connection to the
1211 * other domain is reached).
1212 * @route: Route string used to reach the other domain
1213 * @local_uuid: Our local domain UUID
1214 * @remote_uuid: UUID of the other domain (optional)
1215 *
1216 * Allocates new XDomain structure and returns pointer to that. The
1217 * object must be released by calling tb_xdomain_put().
1218 */
1219 struct tb_xdomain *tb_xdomain_alloc(struct tb *tb, struct device *parent,
1220 u64 route, const uuid_t *local_uuid,
1221 const uuid_t *remote_uuid)
1222 {
1223 struct tb_xdomain *xd;
1224
1225 xd = kzalloc(sizeof(*xd), GFP_KERNEL);
1226 if (!xd)
1227 return NULL;
1228
1229 xd->tb = tb;
1230 xd->route = route;
1231 ida_init(&xd->service_ids);
1232 mutex_init(&xd->lock);
1233 INIT_DELAYED_WORK(&xd->get_uuid_work, tb_xdomain_get_uuid);
1234 INIT_DELAYED_WORK(&xd->get_properties_work, tb_xdomain_get_properties);
1235 INIT_DELAYED_WORK(&xd->properties_changed_work,
1236 tb_xdomain_properties_changed);
1237
1238 xd->local_uuid = kmemdup(local_uuid, sizeof(uuid_t), GFP_KERNEL);
1239 if (!xd->local_uuid)
1240 goto err_free;
1241
1242 if (remote_uuid) {
1243 xd->remote_uuid = kmemdup(remote_uuid, sizeof(uuid_t),
1244 GFP_KERNEL);
1245 if (!xd->remote_uuid)
1246 goto err_free_local_uuid;
1247 } else {
1248 xd->needs_uuid = true;
1249 }
1250
1251 device_initialize(&xd->dev);
1252 xd->dev.parent = get_device(parent);
1253 xd->dev.bus = &tb_bus_type;
1254 xd->dev.type = &tb_xdomain_type;
1255 xd->dev.groups = xdomain_attr_groups;
1256 dev_set_name(&xd->dev, "%u-%llx", tb->index, route);
1257
1258 /*
1259 * This keeps the DMA powered on as long as we have active
1260 * connection to another host.
1261 */
1262 pm_runtime_set_active(&xd->dev);
1263 pm_runtime_get_noresume(&xd->dev);
1264 pm_runtime_enable(&xd->dev);
1265
1266 return xd;
1267
1268 err_free_local_uuid:
1269 kfree(xd->local_uuid);
1270 err_free:
1271 kfree(xd);
1272
1273 return NULL;
1274 }
1275
1276 /**
1277 * tb_xdomain_add() - Add XDomain to the bus
1278 * @xd: XDomain to add
1279 *
1280 * This function starts XDomain discovery protocol handshake and
1281 * eventually adds the XDomain to the bus. After calling this function
1282 * the caller needs to call tb_xdomain_remove() in order to remove and
1283 * release the object regardless whether the handshake succeeded or not.
1284 */
1285 void tb_xdomain_add(struct tb_xdomain *xd)
1286 {
1287 /* Start exchanging properties with the other host */
1288 start_handshake(xd);
1289 }
1290
1291 static int unregister_service(struct device *dev, void *data)
1292 {
1293 device_unregister(dev);
1294 return 0;
1295 }
1296
1297 /**
1298 * tb_xdomain_remove() - Remove XDomain from the bus
1299 * @xd: XDomain to remove
1300 *
1301 * This will stop all ongoing configuration work and remove the XDomain
1302 * along with any services from the bus. When the last reference to @xd
1303 * is released the object will be released as well.
1304 */
1305 void tb_xdomain_remove(struct tb_xdomain *xd)
1306 {
1307 stop_handshake(xd);
1308
1309 device_for_each_child_reverse(&xd->dev, xd, unregister_service);
1310
1311 /*
1312 * Undo runtime PM here explicitly because it is possible that
1313 * the XDomain was never added to the bus and thus device_del()
1314 * is not called for it (device_del() would handle this otherwise).
1315 */
1316 pm_runtime_disable(&xd->dev);
1317 pm_runtime_put_noidle(&xd->dev);
1318 pm_runtime_set_suspended(&xd->dev);
1319
1320 if (!device_is_registered(&xd->dev))
1321 put_device(&xd->dev);
1322 else
1323 device_unregister(&xd->dev);
1324 }
1325
1326 /**
1327 * tb_xdomain_enable_paths() - Enable DMA paths for XDomain connection
1328 * @xd: XDomain connection
1329 * @transmit_path: HopID of the transmit path the other end is using to
1330 * send packets
1331 * @transmit_ring: DMA ring used to receive packets from the other end
1332 * @receive_path: HopID of the receive path the other end is using to
1333 * receive packets
1334 * @receive_ring: DMA ring used to send packets to the other end
1335 *
1336 * The function enables DMA paths accordingly so that after successful
1337 * return the caller can send and receive packets using high-speed DMA
1338 * path.
1339 *
1340 * Return: %0 in case of success and negative errno in case of error
1341 */
1342 int tb_xdomain_enable_paths(struct tb_xdomain *xd, u16 transmit_path,
1343 u16 transmit_ring, u16 receive_path,
1344 u16 receive_ring)
1345 {
1346 int ret;
1347
1348 mutex_lock(&xd->lock);
1349
1350 if (xd->transmit_path) {
1351 ret = xd->transmit_path == transmit_path ? 0 : -EBUSY;
1352 goto exit_unlock;
1353 }
1354
1355 xd->transmit_path = transmit_path;
1356 xd->transmit_ring = transmit_ring;
1357 xd->receive_path = receive_path;
1358 xd->receive_ring = receive_ring;
1359
1360 ret = tb_domain_approve_xdomain_paths(xd->tb, xd);
1361
1362 exit_unlock:
1363 mutex_unlock(&xd->lock);
1364
1365 return ret;
1366 }
1367 EXPORT_SYMBOL_GPL(tb_xdomain_enable_paths);
1368
1369 /**
1370 * tb_xdomain_disable_paths() - Disable DMA paths for XDomain connection
1371 * @xd: XDomain connection
1372 *
1373 * This does the opposite of tb_xdomain_enable_paths(). After call to
1374 * this the caller is not expected to use the rings anymore.
1375 *
1376 * Return: %0 in case of success and negative errno in case of error
1377 */
1378 int tb_xdomain_disable_paths(struct tb_xdomain *xd)
1379 {
1380 int ret = 0;
1381
1382 mutex_lock(&xd->lock);
1383 if (xd->transmit_path) {
1384 xd->transmit_path = 0;
1385 xd->transmit_ring = 0;
1386 xd->receive_path = 0;
1387 xd->receive_ring = 0;
1388
1389 ret = tb_domain_disconnect_xdomain_paths(xd->tb, xd);
1390 }
1391 mutex_unlock(&xd->lock);
1392
1393 return ret;
1394 }
1395 EXPORT_SYMBOL_GPL(tb_xdomain_disable_paths);
1396
1397 struct tb_xdomain_lookup {
1398 const uuid_t *uuid;
1399 u8 link;
1400 u8 depth;
1401 u64 route;
1402 };
1403
1404 static struct tb_xdomain *switch_find_xdomain(struct tb_switch *sw,
1405 const struct tb_xdomain_lookup *lookup)
1406 {
1407 int i;
1408
1409 for (i = 1; i <= sw->config.max_port_number; i++) {
1410 struct tb_port *port = &sw->ports[i];
1411 struct tb_xdomain *xd;
1412
1413 if (port->xdomain) {
1414 xd = port->xdomain;
1415
1416 if (lookup->uuid) {
1417 if (xd->remote_uuid &&
1418 uuid_equal(xd->remote_uuid, lookup->uuid))
1419 return xd;
1420 } else if (lookup->link &&
1421 lookup->link == xd->link &&
1422 lookup->depth == xd->depth) {
1423 return xd;
1424 } else if (lookup->route &&
1425 lookup->route == xd->route) {
1426 return xd;
1427 }
1428 } else if (tb_port_has_remote(port)) {
1429 xd = switch_find_xdomain(port->remote->sw, lookup);
1430 if (xd)
1431 return xd;
1432 }
1433 }
1434
1435 return NULL;
1436 }
1437
1438 /**
1439 * tb_xdomain_find_by_uuid() - Find an XDomain by UUID
1440 * @tb: Domain where the XDomain belongs to
1441 * @uuid: UUID to look for
1442 *
1443 * Finds XDomain by walking through the Thunderbolt topology below @tb.
1444 * The returned XDomain will have its reference count increased so the
1445 * caller needs to call tb_xdomain_put() when it is done with the
1446 * object.
1447 *
1448 * This will find all XDomains including the ones that are not yet added
1449 * to the bus (handshake is still in progress).
1450 *
1451 * The caller needs to hold @tb->lock.
1452 */
1453 struct tb_xdomain *tb_xdomain_find_by_uuid(struct tb *tb, const uuid_t *uuid)
1454 {
1455 struct tb_xdomain_lookup lookup;
1456 struct tb_xdomain *xd;
1457
1458 memset(&lookup, 0, sizeof(lookup));
1459 lookup.uuid = uuid;
1460
1461 xd = switch_find_xdomain(tb->root_switch, &lookup);
1462 return tb_xdomain_get(xd);
1463 }
1464 EXPORT_SYMBOL_GPL(tb_xdomain_find_by_uuid);
1465
1466 /**
1467 * tb_xdomain_find_by_link_depth() - Find an XDomain by link and depth
1468 * @tb: Domain where the XDomain belongs to
1469 * @link: Root switch link number
1470 * @depth: Depth in the link
1471 *
1472 * Finds XDomain by walking through the Thunderbolt topology below @tb.
1473 * The returned XDomain will have its reference count increased so the
1474 * caller needs to call tb_xdomain_put() when it is done with the
1475 * object.
1476 *
1477 * This will find all XDomains including the ones that are not yet added
1478 * to the bus (handshake is still in progress).
1479 *
1480 * The caller needs to hold @tb->lock.
1481 */
1482 struct tb_xdomain *tb_xdomain_find_by_link_depth(struct tb *tb, u8 link,
1483 u8 depth)
1484 {
1485 struct tb_xdomain_lookup lookup;
1486 struct tb_xdomain *xd;
1487
1488 memset(&lookup, 0, sizeof(lookup));
1489 lookup.link = link;
1490 lookup.depth = depth;
1491
1492 xd = switch_find_xdomain(tb->root_switch, &lookup);
1493 return tb_xdomain_get(xd);
1494 }
1495
1496 /**
1497 * tb_xdomain_find_by_route() - Find an XDomain by route string
1498 * @tb: Domain where the XDomain belongs to
1499 * @route: XDomain route string
1500 *
1501 * Finds XDomain by walking through the Thunderbolt topology below @tb.
1502 * The returned XDomain will have its reference count increased so the
1503 * caller needs to call tb_xdomain_put() when it is done with the
1504 * object.
1505 *
1506 * This will find all XDomains including the ones that are not yet added
1507 * to the bus (handshake is still in progress).
1508 *
1509 * The caller needs to hold @tb->lock.
1510 */
1511 struct tb_xdomain *tb_xdomain_find_by_route(struct tb *tb, u64 route)
1512 {
1513 struct tb_xdomain_lookup lookup;
1514 struct tb_xdomain *xd;
1515
1516 memset(&lookup, 0, sizeof(lookup));
1517 lookup.route = route;
1518
1519 xd = switch_find_xdomain(tb->root_switch, &lookup);
1520 return tb_xdomain_get(xd);
1521 }
1522 EXPORT_SYMBOL_GPL(tb_xdomain_find_by_route);
1523
1524 bool tb_xdomain_handle_request(struct tb *tb, enum tb_cfg_pkg_type type,
1525 const void *buf, size_t size)
1526 {
1527 const struct tb_protocol_handler *handler, *tmp;
1528 const struct tb_xdp_header *hdr = buf;
1529 unsigned int length;
1530 int ret = 0;
1531
1532 /* We expect the packet is at least size of the header */
1533 length = hdr->xd_hdr.length_sn & TB_XDOMAIN_LENGTH_MASK;
1534 if (length != size / 4 - sizeof(hdr->xd_hdr) / 4)
1535 return true;
1536 if (length < sizeof(*hdr) / 4 - sizeof(hdr->xd_hdr) / 4)
1537 return true;
1538
1539 /*
1540 * Handle XDomain discovery protocol packets directly here. For
1541 * other protocols (based on their UUID) we call registered
1542 * handlers in turn.
1543 */
1544 if (uuid_equal(&hdr->uuid, &tb_xdp_uuid)) {
1545 if (type == TB_CFG_PKG_XDOMAIN_REQ)
1546 return tb_xdp_schedule_request(tb, hdr, size);
1547 return false;
1548 }
1549
1550 mutex_lock(&xdomain_lock);
1551 list_for_each_entry_safe(handler, tmp, &protocol_handlers, list) {
1552 if (!uuid_equal(&hdr->uuid, handler->uuid))
1553 continue;
1554
1555 mutex_unlock(&xdomain_lock);
1556 ret = handler->callback(buf, size, handler->data);
1557 mutex_lock(&xdomain_lock);
1558
1559 if (ret)
1560 break;
1561 }
1562 mutex_unlock(&xdomain_lock);
1563
1564 return ret > 0;
1565 }
1566
1567 static int rebuild_property_block(void)
1568 {
1569 u32 *block, len;
1570 int ret;
1571
1572 ret = tb_property_format_dir(xdomain_property_dir, NULL, 0);
1573 if (ret < 0)
1574 return ret;
1575
1576 len = ret;
1577
1578 block = kcalloc(len, sizeof(u32), GFP_KERNEL);
1579 if (!block)
1580 return -ENOMEM;
1581
1582 ret = tb_property_format_dir(xdomain_property_dir, block, len);
1583 if (ret) {
1584 kfree(block);
1585 return ret;
1586 }
1587
1588 kfree(xdomain_property_block);
1589 xdomain_property_block = block;
1590 xdomain_property_block_len = len;
1591 xdomain_property_block_gen++;
1592
1593 return 0;
1594 }
1595
1596 static int update_xdomain(struct device *dev, void *data)
1597 {
1598 struct tb_xdomain *xd;
1599
1600 xd = tb_to_xdomain(dev);
1601 if (xd) {
1602 queue_delayed_work(xd->tb->wq, &xd->properties_changed_work,
1603 msecs_to_jiffies(50));
1604 }
1605
1606 return 0;
1607 }
1608
1609 static void update_all_xdomains(void)
1610 {
1611 bus_for_each_dev(&tb_bus_type, NULL, NULL, update_xdomain);
1612 }
1613
1614 static bool remove_directory(const char *key, const struct tb_property_dir *dir)
1615 {
1616 struct tb_property *p;
1617
1618 p = tb_property_find(xdomain_property_dir, key,
1619 TB_PROPERTY_TYPE_DIRECTORY);
1620 if (p && p->value.dir == dir) {
1621 tb_property_remove(p);
1622 return true;
1623 }
1624 return false;
1625 }
1626
1627 /**
1628 * tb_register_property_dir() - Register property directory to the host
1629 * @key: Key (name) of the directory to add
1630 * @dir: Directory to add
1631 *
1632 * Service drivers can use this function to add new property directory
1633 * to the host available properties. The other connected hosts are
1634 * notified so they can re-read properties of this host if they are
1635 * interested.
1636 *
1637 * Return: %0 on success and negative errno on failure
1638 */
1639 int tb_register_property_dir(const char *key, struct tb_property_dir *dir)
1640 {
1641 int ret;
1642
1643 if (WARN_ON(!xdomain_property_dir))
1644 return -EAGAIN;
1645
1646 if (!key || strlen(key) > 8)
1647 return -EINVAL;
1648
1649 mutex_lock(&xdomain_lock);
1650 if (tb_property_find(xdomain_property_dir, key,
1651 TB_PROPERTY_TYPE_DIRECTORY)) {
1652 ret = -EEXIST;
1653 goto err_unlock;
1654 }
1655
1656 ret = tb_property_add_dir(xdomain_property_dir, key, dir);
1657 if (ret)
1658 goto err_unlock;
1659
1660 ret = rebuild_property_block();
1661 if (ret) {
1662 remove_directory(key, dir);
1663 goto err_unlock;
1664 }
1665
1666 mutex_unlock(&xdomain_lock);
1667 update_all_xdomains();
1668 return 0;
1669
1670 err_unlock:
1671 mutex_unlock(&xdomain_lock);
1672 return ret;
1673 }
1674 EXPORT_SYMBOL_GPL(tb_register_property_dir);
1675
1676 /**
1677 * tb_unregister_property_dir() - Removes property directory from host
1678 * @key: Key (name) of the directory
1679 * @dir: Directory to remove
1680 *
1681 * This will remove the existing directory from this host and notify the
1682 * connected hosts about the change.
1683 */
1684 void tb_unregister_property_dir(const char *key, struct tb_property_dir *dir)
1685 {
1686 int ret = 0;
1687
1688 mutex_lock(&xdomain_lock);
1689 if (remove_directory(key, dir))
1690 ret = rebuild_property_block();
1691 mutex_unlock(&xdomain_lock);
1692
1693 if (!ret)
1694 update_all_xdomains();
1695 }
1696 EXPORT_SYMBOL_GPL(tb_unregister_property_dir);
1697
1698 int tb_xdomain_init(void)
1699 {
1700 int ret;
1701
1702 xdomain_property_dir = tb_property_create_dir(NULL);
1703 if (!xdomain_property_dir)
1704 return -ENOMEM;
1705
1706 /*
1707 * Initialize standard set of properties without any service
1708 * directories. Those will be added by service drivers
1709 * themselves when they are loaded.
1710 */
1711 tb_property_add_immediate(xdomain_property_dir, "vendorid",
1712 PCI_VENDOR_ID_INTEL);
1713 tb_property_add_text(xdomain_property_dir, "vendorid", "Intel Corp.");
1714 tb_property_add_immediate(xdomain_property_dir, "deviceid", 0x1);
1715 tb_property_add_text(xdomain_property_dir, "deviceid",
1716 utsname()->nodename);
1717 tb_property_add_immediate(xdomain_property_dir, "devicerv", 0x80000100);
1718
1719 ret = rebuild_property_block();
1720 if (ret) {
1721 tb_property_free_dir(xdomain_property_dir);
1722 xdomain_property_dir = NULL;
1723 }
1724
1725 return ret;
1726 }
1727
1728 void tb_xdomain_exit(void)
1729 {
1730 kfree(xdomain_property_block);
1731 tb_property_free_dir(xdomain_property_dir);
1732 }