1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Thunderbolt link controller support
4  *
5  * Copyright (C) 2019, Intel Corporation
6  * Author: Mika Westerberg <mika.westerberg@linux.intel.com>
7  */
8 
9 #include <linux/delay.h>
10 
11 #include "tb.h"
12 
13 /**
14  * tb_lc_read_uuid() - Read switch UUID from link controller common register
15  * @sw: Switch whose UUID is read
16  * @uuid: UUID is placed here
17  */
tb_lc_read_uuid(struct tb_switch * sw,u32 * uuid)18 int tb_lc_read_uuid(struct tb_switch *sw, u32 *uuid)
19 {
20 	if (!sw->cap_lc)
21 		return -EINVAL;
22 	return tb_sw_read(sw, uuid, TB_CFG_SWITCH, sw->cap_lc + TB_LC_FUSE, 4);
23 }
24 
read_lc_desc(struct tb_switch * sw,u32 * desc)25 static int read_lc_desc(struct tb_switch *sw, u32 *desc)
26 {
27 	if (!sw->cap_lc)
28 		return -EINVAL;
29 	return tb_sw_read(sw, desc, TB_CFG_SWITCH, sw->cap_lc + TB_LC_DESC, 1);
30 }
31 
find_port_lc_cap(struct tb_port * port)32 static int find_port_lc_cap(struct tb_port *port)
33 {
34 	struct tb_switch *sw = port->sw;
35 	int start, phys, ret, size;
36 	u32 desc;
37 
38 	ret = read_lc_desc(sw, &desc);
39 	if (ret)
40 		return ret;
41 
42 	/* Start of port LC registers */
43 	start = (desc & TB_LC_DESC_SIZE_MASK) >> TB_LC_DESC_SIZE_SHIFT;
44 	size = (desc & TB_LC_DESC_PORT_SIZE_MASK) >> TB_LC_DESC_PORT_SIZE_SHIFT;
45 	phys = tb_phy_port_from_link(port->port);
46 
47 	return sw->cap_lc + start + phys * size;
48 }
49 
50 /**
51  * tb_lc_reset_port() - Trigger downstream port reset through LC
52  * @port: Port that is reset
53  *
54  * Triggers downstream port reset through link controller registers.
55  * Returns %0 in case of success negative errno otherwise. Only supports
56  * non-USB4 routers with link controller (that's Thunderbolt 2 and
57  * Thunderbolt 3).
58  */
tb_lc_reset_port(struct tb_port * port)59 int tb_lc_reset_port(struct tb_port *port)
60 {
61 	struct tb_switch *sw = port->sw;
62 	int cap, ret;
63 	u32 mode;
64 
65 	if (sw->generation < 2)
66 		return -EINVAL;
67 
68 	cap = find_port_lc_cap(port);
69 	if (cap < 0)
70 		return cap;
71 
72 	ret = tb_sw_read(sw, &mode, TB_CFG_SWITCH, cap + TB_LC_PORT_MODE, 1);
73 	if (ret)
74 		return ret;
75 
76 	mode |= TB_LC_PORT_MODE_DPR;
77 
78 	ret = tb_sw_write(sw, &mode, TB_CFG_SWITCH, cap + TB_LC_PORT_MODE, 1);
79 	if (ret)
80 		return ret;
81 
82 	fsleep(10000);
83 
84 	ret = tb_sw_read(sw, &mode, TB_CFG_SWITCH, cap + TB_LC_PORT_MODE, 1);
85 	if (ret)
86 		return ret;
87 
88 	mode &= ~TB_LC_PORT_MODE_DPR;
89 
90 	return tb_sw_write(sw, &mode, TB_CFG_SWITCH, cap + TB_LC_PORT_MODE, 1);
91 }
92 
tb_lc_set_port_configured(struct tb_port * port,bool configured)93 static int tb_lc_set_port_configured(struct tb_port *port, bool configured)
94 {
95 	bool upstream = tb_is_upstream_port(port);
96 	struct tb_switch *sw = port->sw;
97 	u32 ctrl, lane;
98 	int cap, ret;
99 
100 	if (sw->generation < 2)
101 		return 0;
102 
103 	cap = find_port_lc_cap(port);
104 	if (cap < 0)
105 		return cap;
106 
107 	ret = tb_sw_read(sw, &ctrl, TB_CFG_SWITCH, cap + TB_LC_SX_CTRL, 1);
108 	if (ret)
109 		return ret;
110 
111 	/* Resolve correct lane */
112 	if (port->port % 2)
113 		lane = TB_LC_SX_CTRL_L1C;
114 	else
115 		lane = TB_LC_SX_CTRL_L2C;
116 
117 	if (configured) {
118 		ctrl |= lane;
119 		if (upstream)
120 			ctrl |= TB_LC_SX_CTRL_UPSTREAM;
121 	} else {
122 		ctrl &= ~lane;
123 		if (upstream)
124 			ctrl &= ~TB_LC_SX_CTRL_UPSTREAM;
125 	}
126 
127 	return tb_sw_write(sw, &ctrl, TB_CFG_SWITCH, cap + TB_LC_SX_CTRL, 1);
128 }
129 
130 /**
131  * tb_lc_configure_port() - Let LC know about configured port
132  * @port: Port that is set as configured
133  *
134  * Sets the port configured for power management purposes.
135  */
tb_lc_configure_port(struct tb_port * port)136 int tb_lc_configure_port(struct tb_port *port)
137 {
138 	return tb_lc_set_port_configured(port, true);
139 }
140 
141 /**
142  * tb_lc_unconfigure_port() - Let LC know about unconfigured port
143  * @port: Port that is set as configured
144  *
145  * Sets the port unconfigured for power management purposes.
146  */
tb_lc_unconfigure_port(struct tb_port * port)147 void tb_lc_unconfigure_port(struct tb_port *port)
148 {
149 	tb_lc_set_port_configured(port, false);
150 }
151 
tb_lc_set_xdomain_configured(struct tb_port * port,bool configure)152 static int tb_lc_set_xdomain_configured(struct tb_port *port, bool configure)
153 {
154 	struct tb_switch *sw = port->sw;
155 	u32 ctrl, lane;
156 	int cap, ret;
157 
158 	if (sw->generation < 2)
159 		return 0;
160 
161 	cap = find_port_lc_cap(port);
162 	if (cap < 0)
163 		return cap;
164 
165 	ret = tb_sw_read(sw, &ctrl, TB_CFG_SWITCH, cap + TB_LC_SX_CTRL, 1);
166 	if (ret)
167 		return ret;
168 
169 	/* Resolve correct lane */
170 	if (port->port % 2)
171 		lane = TB_LC_SX_CTRL_L1D;
172 	else
173 		lane = TB_LC_SX_CTRL_L2D;
174 
175 	if (configure)
176 		ctrl |= lane;
177 	else
178 		ctrl &= ~lane;
179 
180 	return tb_sw_write(sw, &ctrl, TB_CFG_SWITCH, cap + TB_LC_SX_CTRL, 1);
181 }
182 
183 /**
184  * tb_lc_configure_xdomain() - Inform LC that the link is XDomain
185  * @port: Switch downstream port connected to another host
186  *
187  * Sets the lane configured for XDomain accordingly so that the LC knows
188  * about this. Returns %0 in success and negative errno in failure.
189  */
tb_lc_configure_xdomain(struct tb_port * port)190 int tb_lc_configure_xdomain(struct tb_port *port)
191 {
192 	return tb_lc_set_xdomain_configured(port, true);
193 }
194 
195 /**
196  * tb_lc_unconfigure_xdomain() - Unconfigure XDomain from port
197  * @port: Switch downstream port that was connected to another host
198  *
199  * Unsets the lane XDomain configuration.
200  */
tb_lc_unconfigure_xdomain(struct tb_port * port)201 void tb_lc_unconfigure_xdomain(struct tb_port *port)
202 {
203 	tb_lc_set_xdomain_configured(port, false);
204 }
205 
206 /**
207  * tb_lc_start_lane_initialization() - Start lane initialization
208  * @port: Device router lane 0 adapter
209  *
210  * Starts lane initialization for @port after the router resumed from
211  * sleep. Should be called for those downstream lane adapters that were
212  * not connected (tb_lc_configure_port() was not called) before sleep.
213  *
214  * Returns %0 in success and negative errno in case of failure.
215  */
tb_lc_start_lane_initialization(struct tb_port * port)216 int tb_lc_start_lane_initialization(struct tb_port *port)
217 {
218 	struct tb_switch *sw = port->sw;
219 	int ret, cap;
220 	u32 ctrl;
221 
222 	if (!tb_route(sw))
223 		return 0;
224 
225 	if (sw->generation < 2)
226 		return 0;
227 
228 	cap = find_port_lc_cap(port);
229 	if (cap < 0)
230 		return cap;
231 
232 	ret = tb_sw_read(sw, &ctrl, TB_CFG_SWITCH, cap + TB_LC_SX_CTRL, 1);
233 	if (ret)
234 		return ret;
235 
236 	ctrl |= TB_LC_SX_CTRL_SLI;
237 
238 	return tb_sw_write(sw, &ctrl, TB_CFG_SWITCH, cap + TB_LC_SX_CTRL, 1);
239 }
240 
241 /**
242  * tb_lc_is_clx_supported() - Check whether CLx is supported by the lane adapter
243  * @port: Lane adapter
244  *
245  * TB_LC_LINK_ATTR_CPS bit reflects if the link supports CLx including
246  * active cables (if connected on the link).
247  */
tb_lc_is_clx_supported(struct tb_port * port)248 bool tb_lc_is_clx_supported(struct tb_port *port)
249 {
250 	struct tb_switch *sw = port->sw;
251 	int cap, ret;
252 	u32 val;
253 
254 	cap = find_port_lc_cap(port);
255 	if (cap < 0)
256 		return false;
257 
258 	ret = tb_sw_read(sw, &val, TB_CFG_SWITCH, cap + TB_LC_LINK_ATTR, 1);
259 	if (ret)
260 		return false;
261 
262 	return !!(val & TB_LC_LINK_ATTR_CPS);
263 }
264 
265 /**
266  * tb_lc_is_usb_plugged() - Is there USB device connected to port
267  * @port: Device router lane 0 adapter
268  *
269  * Returns true if the @port has USB type-C device connected.
270  */
tb_lc_is_usb_plugged(struct tb_port * port)271 bool tb_lc_is_usb_plugged(struct tb_port *port)
272 {
273 	struct tb_switch *sw = port->sw;
274 	int cap, ret;
275 	u32 val;
276 
277 	if (sw->generation != 3)
278 		return false;
279 
280 	cap = find_port_lc_cap(port);
281 	if (cap < 0)
282 		return false;
283 
284 	ret = tb_sw_read(sw, &val, TB_CFG_SWITCH, cap + TB_LC_CS_42, 1);
285 	if (ret)
286 		return false;
287 
288 	return !!(val & TB_LC_CS_42_USB_PLUGGED);
289 }
290 
291 /**
292  * tb_lc_is_xhci_connected() - Is the internal xHCI connected
293  * @port: Device router lane 0 adapter
294  *
295  * Returns true if the internal xHCI has been connected to @port.
296  */
tb_lc_is_xhci_connected(struct tb_port * port)297 bool tb_lc_is_xhci_connected(struct tb_port *port)
298 {
299 	struct tb_switch *sw = port->sw;
300 	int cap, ret;
301 	u32 val;
302 
303 	if (sw->generation != 3)
304 		return false;
305 
306 	cap = find_port_lc_cap(port);
307 	if (cap < 0)
308 		return false;
309 
310 	ret = tb_sw_read(sw, &val, TB_CFG_SWITCH, cap + TB_LC_LINK_REQ, 1);
311 	if (ret)
312 		return false;
313 
314 	return !!(val & TB_LC_LINK_REQ_XHCI_CONNECT);
315 }
316 
__tb_lc_xhci_connect(struct tb_port * port,bool connect)317 static int __tb_lc_xhci_connect(struct tb_port *port, bool connect)
318 {
319 	struct tb_switch *sw = port->sw;
320 	int cap, ret;
321 	u32 val;
322 
323 	if (sw->generation != 3)
324 		return -EINVAL;
325 
326 	cap = find_port_lc_cap(port);
327 	if (cap < 0)
328 		return cap;
329 
330 	ret = tb_sw_read(sw, &val, TB_CFG_SWITCH, cap + TB_LC_LINK_REQ, 1);
331 	if (ret)
332 		return ret;
333 
334 	if (connect)
335 		val |= TB_LC_LINK_REQ_XHCI_CONNECT;
336 	else
337 		val &= ~TB_LC_LINK_REQ_XHCI_CONNECT;
338 
339 	return tb_sw_write(sw, &val, TB_CFG_SWITCH, cap + TB_LC_LINK_REQ, 1);
340 }
341 
342 /**
343  * tb_lc_xhci_connect() - Connect internal xHCI
344  * @port: Device router lane 0 adapter
345  *
346  * Tells LC to connect the internal xHCI to @port. Returns %0 on success
347  * and negative errno in case of failure. Can be called for Thunderbolt 3
348  * routers only.
349  */
tb_lc_xhci_connect(struct tb_port * port)350 int tb_lc_xhci_connect(struct tb_port *port)
351 {
352 	int ret;
353 
354 	ret = __tb_lc_xhci_connect(port, true);
355 	if (ret)
356 		return ret;
357 
358 	tb_port_dbg(port, "xHCI connected\n");
359 	return 0;
360 }
361 
362 /**
363  * tb_lc_xhci_disconnect() - Disconnect internal xHCI
364  * @port: Device router lane 0 adapter
365  *
366  * Tells LC to disconnect the internal xHCI from @port. Can be called
367  * for Thunderbolt 3 routers only.
368  */
tb_lc_xhci_disconnect(struct tb_port * port)369 void tb_lc_xhci_disconnect(struct tb_port *port)
370 {
371 	__tb_lc_xhci_connect(port, false);
372 	tb_port_dbg(port, "xHCI disconnected\n");
373 }
374 
tb_lc_set_wake_one(struct tb_switch * sw,unsigned int offset,unsigned int flags)375 static int tb_lc_set_wake_one(struct tb_switch *sw, unsigned int offset,
376 			      unsigned int flags)
377 {
378 	u32 ctrl;
379 	int ret;
380 
381 	/*
382 	 * Enable wake on PCIe and USB4 (wake coming from another
383 	 * router).
384 	 */
385 	ret = tb_sw_read(sw, &ctrl, TB_CFG_SWITCH,
386 			 offset + TB_LC_SX_CTRL, 1);
387 	if (ret)
388 		return ret;
389 
390 	ctrl &= ~(TB_LC_SX_CTRL_WOC | TB_LC_SX_CTRL_WOD | TB_LC_SX_CTRL_WODPC |
391 		  TB_LC_SX_CTRL_WODPD | TB_LC_SX_CTRL_WOP | TB_LC_SX_CTRL_WOU4);
392 
393 	if (flags & TB_WAKE_ON_CONNECT)
394 		ctrl |= TB_LC_SX_CTRL_WOC | TB_LC_SX_CTRL_WOD;
395 	if (flags & TB_WAKE_ON_USB4)
396 		ctrl |= TB_LC_SX_CTRL_WOU4;
397 	if (flags & TB_WAKE_ON_PCIE)
398 		ctrl |= TB_LC_SX_CTRL_WOP;
399 	if (flags & TB_WAKE_ON_DP)
400 		ctrl |= TB_LC_SX_CTRL_WODPC | TB_LC_SX_CTRL_WODPD;
401 
402 	return tb_sw_write(sw, &ctrl, TB_CFG_SWITCH, offset + TB_LC_SX_CTRL, 1);
403 }
404 
405 /**
406  * tb_lc_set_wake() - Enable/disable wake
407  * @sw: Switch whose wakes to configure
408  * @flags: Wakeup flags (%0 to disable)
409  *
410  * For each LC sets wake bits accordingly.
411  */
tb_lc_set_wake(struct tb_switch * sw,unsigned int flags)412 int tb_lc_set_wake(struct tb_switch *sw, unsigned int flags)
413 {
414 	int start, size, nlc, ret, i;
415 	u32 desc;
416 
417 	if (sw->generation < 2)
418 		return 0;
419 
420 	if (!tb_route(sw))
421 		return 0;
422 
423 	ret = read_lc_desc(sw, &desc);
424 	if (ret)
425 		return ret;
426 
427 	/* Figure out number of link controllers */
428 	nlc = desc & TB_LC_DESC_NLC_MASK;
429 	start = (desc & TB_LC_DESC_SIZE_MASK) >> TB_LC_DESC_SIZE_SHIFT;
430 	size = (desc & TB_LC_DESC_PORT_SIZE_MASK) >> TB_LC_DESC_PORT_SIZE_SHIFT;
431 
432 	/* For each link controller set sleep bit */
433 	for (i = 0; i < nlc; i++) {
434 		unsigned int offset = sw->cap_lc + start + i * size;
435 
436 		ret = tb_lc_set_wake_one(sw, offset, flags);
437 		if (ret)
438 			return ret;
439 	}
440 
441 	return 0;
442 }
443 
444 /**
445  * tb_lc_set_sleep() - Inform LC that the switch is going to sleep
446  * @sw: Switch to set sleep
447  *
448  * Let the switch link controllers know that the switch is going to
449  * sleep.
450  */
tb_lc_set_sleep(struct tb_switch * sw)451 int tb_lc_set_sleep(struct tb_switch *sw)
452 {
453 	int start, size, nlc, ret, i;
454 	u32 desc;
455 
456 	if (sw->generation < 2)
457 		return 0;
458 
459 	ret = read_lc_desc(sw, &desc);
460 	if (ret)
461 		return ret;
462 
463 	/* Figure out number of link controllers */
464 	nlc = desc & TB_LC_DESC_NLC_MASK;
465 	start = (desc & TB_LC_DESC_SIZE_MASK) >> TB_LC_DESC_SIZE_SHIFT;
466 	size = (desc & TB_LC_DESC_PORT_SIZE_MASK) >> TB_LC_DESC_PORT_SIZE_SHIFT;
467 
468 	/* For each link controller set sleep bit */
469 	for (i = 0; i < nlc; i++) {
470 		unsigned int offset = sw->cap_lc + start + i * size;
471 		u32 ctrl;
472 
473 		ret = tb_sw_read(sw, &ctrl, TB_CFG_SWITCH,
474 				 offset + TB_LC_SX_CTRL, 1);
475 		if (ret)
476 			return ret;
477 
478 		ctrl |= TB_LC_SX_CTRL_SLP;
479 		ret = tb_sw_write(sw, &ctrl, TB_CFG_SWITCH,
480 				  offset + TB_LC_SX_CTRL, 1);
481 		if (ret)
482 			return ret;
483 	}
484 
485 	return 0;
486 }
487 
488 /**
489  * tb_lc_lane_bonding_possible() - Is lane bonding possible towards switch
490  * @sw: Switch to check
491  *
492  * Checks whether conditions for lane bonding from parent to @sw are
493  * possible.
494  */
tb_lc_lane_bonding_possible(struct tb_switch * sw)495 bool tb_lc_lane_bonding_possible(struct tb_switch *sw)
496 {
497 	struct tb_port *up;
498 	int cap, ret;
499 	u32 val;
500 
501 	if (sw->generation < 2)
502 		return false;
503 
504 	up = tb_upstream_port(sw);
505 	cap = find_port_lc_cap(up);
506 	if (cap < 0)
507 		return false;
508 
509 	ret = tb_sw_read(sw, &val, TB_CFG_SWITCH, cap + TB_LC_PORT_ATTR, 1);
510 	if (ret)
511 		return false;
512 
513 	return !!(val & TB_LC_PORT_ATTR_BE);
514 }
515 
tb_lc_dp_sink_from_port(const struct tb_switch * sw,struct tb_port * in)516 static int tb_lc_dp_sink_from_port(const struct tb_switch *sw,
517 				   struct tb_port *in)
518 {
519 	struct tb_port *port;
520 
521 	/* The first DP IN port is sink 0 and second is sink 1 */
522 	tb_switch_for_each_port(sw, port) {
523 		if (tb_port_is_dpin(port))
524 			return in != port;
525 	}
526 
527 	return -EINVAL;
528 }
529 
tb_lc_dp_sink_available(struct tb_switch * sw,int sink)530 static int tb_lc_dp_sink_available(struct tb_switch *sw, int sink)
531 {
532 	u32 val, alloc;
533 	int ret;
534 
535 	ret = tb_sw_read(sw, &val, TB_CFG_SWITCH,
536 			 sw->cap_lc + TB_LC_SNK_ALLOCATION, 1);
537 	if (ret)
538 		return ret;
539 
540 	/*
541 	 * Sink is available for CM/SW to use if the allocation valie is
542 	 * either 0 or 1.
543 	 */
544 	if (!sink) {
545 		alloc = val & TB_LC_SNK_ALLOCATION_SNK0_MASK;
546 		if (!alloc || alloc == TB_LC_SNK_ALLOCATION_SNK0_CM)
547 			return 0;
548 	} else {
549 		alloc = (val & TB_LC_SNK_ALLOCATION_SNK1_MASK) >>
550 			TB_LC_SNK_ALLOCATION_SNK1_SHIFT;
551 		if (!alloc || alloc == TB_LC_SNK_ALLOCATION_SNK1_CM)
552 			return 0;
553 	}
554 
555 	return -EBUSY;
556 }
557 
558 /**
559  * tb_lc_dp_sink_query() - Is DP sink available for DP IN port
560  * @sw: Switch whose DP sink is queried
561  * @in: DP IN port to check
562  *
563  * Queries through LC SNK_ALLOCATION registers whether DP sink is available
564  * for the given DP IN port or not.
565  */
tb_lc_dp_sink_query(struct tb_switch * sw,struct tb_port * in)566 bool tb_lc_dp_sink_query(struct tb_switch *sw, struct tb_port *in)
567 {
568 	int sink;
569 
570 	/*
571 	 * For older generations sink is always available as there is no
572 	 * allocation mechanism.
573 	 */
574 	if (sw->generation < 3)
575 		return true;
576 
577 	sink = tb_lc_dp_sink_from_port(sw, in);
578 	if (sink < 0)
579 		return false;
580 
581 	return !tb_lc_dp_sink_available(sw, sink);
582 }
583 
584 /**
585  * tb_lc_dp_sink_alloc() - Allocate DP sink
586  * @sw: Switch whose DP sink is allocated
587  * @in: DP IN port the DP sink is allocated for
588  *
589  * Allocate DP sink for @in via LC SNK_ALLOCATION registers. If the
590  * resource is available and allocation is successful returns %0. In all
591  * other cases returs negative errno. In particular %-EBUSY is returned if
592  * the resource was not available.
593  */
tb_lc_dp_sink_alloc(struct tb_switch * sw,struct tb_port * in)594 int tb_lc_dp_sink_alloc(struct tb_switch *sw, struct tb_port *in)
595 {
596 	int ret, sink;
597 	u32 val;
598 
599 	if (sw->generation < 3)
600 		return 0;
601 
602 	sink = tb_lc_dp_sink_from_port(sw, in);
603 	if (sink < 0)
604 		return sink;
605 
606 	ret = tb_lc_dp_sink_available(sw, sink);
607 	if (ret)
608 		return ret;
609 
610 	ret = tb_sw_read(sw, &val, TB_CFG_SWITCH,
611 			 sw->cap_lc + TB_LC_SNK_ALLOCATION, 1);
612 	if (ret)
613 		return ret;
614 
615 	if (!sink) {
616 		val &= ~TB_LC_SNK_ALLOCATION_SNK0_MASK;
617 		val |= TB_LC_SNK_ALLOCATION_SNK0_CM;
618 	} else {
619 		val &= ~TB_LC_SNK_ALLOCATION_SNK1_MASK;
620 		val |= TB_LC_SNK_ALLOCATION_SNK1_CM <<
621 			TB_LC_SNK_ALLOCATION_SNK1_SHIFT;
622 	}
623 
624 	ret = tb_sw_write(sw, &val, TB_CFG_SWITCH,
625 			  sw->cap_lc + TB_LC_SNK_ALLOCATION, 1);
626 
627 	if (ret)
628 		return ret;
629 
630 	tb_port_dbg(in, "sink %d allocated\n", sink);
631 	return 0;
632 }
633 
634 /**
635  * tb_lc_dp_sink_dealloc() - De-allocate DP sink
636  * @sw: Switch whose DP sink is de-allocated
637  * @in: DP IN port whose DP sink is de-allocated
638  *
639  * De-allocate DP sink from @in using LC SNK_ALLOCATION registers.
640  */
tb_lc_dp_sink_dealloc(struct tb_switch * sw,struct tb_port * in)641 int tb_lc_dp_sink_dealloc(struct tb_switch *sw, struct tb_port *in)
642 {
643 	int ret, sink;
644 	u32 val;
645 
646 	if (sw->generation < 3)
647 		return 0;
648 
649 	sink = tb_lc_dp_sink_from_port(sw, in);
650 	if (sink < 0)
651 		return sink;
652 
653 	/* Needs to be owned by CM/SW */
654 	ret = tb_lc_dp_sink_available(sw, sink);
655 	if (ret)
656 		return ret;
657 
658 	ret = tb_sw_read(sw, &val, TB_CFG_SWITCH,
659 			 sw->cap_lc + TB_LC_SNK_ALLOCATION, 1);
660 	if (ret)
661 		return ret;
662 
663 	if (!sink)
664 		val &= ~TB_LC_SNK_ALLOCATION_SNK0_MASK;
665 	else
666 		val &= ~TB_LC_SNK_ALLOCATION_SNK1_MASK;
667 
668 	ret = tb_sw_write(sw, &val, TB_CFG_SWITCH,
669 			  sw->cap_lc + TB_LC_SNK_ALLOCATION, 1);
670 	if (ret)
671 		return ret;
672 
673 	tb_port_dbg(in, "sink %d de-allocated\n", sink);
674 	return 0;
675 }
676 
677 /**
678  * tb_lc_force_power() - Forces LC to be powered on
679  * @sw: Thunderbolt switch
680  *
681  * This is useful to let authentication cycle pass even without
682  * a Thunderbolt link present.
683  */
tb_lc_force_power(struct tb_switch * sw)684 int tb_lc_force_power(struct tb_switch *sw)
685 {
686 	u32 in = 0xffff;
687 
688 	return tb_sw_write(sw, &in, TB_CFG_SWITCH, TB_LC_POWER, 1);
689 }
690