/*
 * Thunderbolt Cactus Ridge driver - capabilities lookup
 *
 * Copyright (c) 2014 Andreas Noever <andreas.noever@gmail.com>
 */

#include <linux/slab.h>
#include <linux/errno.h>

#include "tb.h"


struct tb_cap_any {
	union {
		struct tb_cap_basic basic;
		struct tb_cap_extended_short extended_short;
		struct tb_cap_extended_long extended_long;
	};
} __packed;

static bool tb_cap_is_basic(struct tb_cap_any *cap)
{
	/* basic.cap is u8. This checks only the lower 8 bit of cap. */
	return cap->basic.cap != 5;
}

static bool tb_cap_is_long(struct tb_cap_any *cap)
{
	return !tb_cap_is_basic(cap)
	       && cap->extended_short.next == 0
	       && cap->extended_short.length == 0;
}

static enum tb_cap tb_cap(struct tb_cap_any *cap)
{
	if (tb_cap_is_basic(cap))
		return cap->basic.cap;
	else
		/* extended_short/long have cap at the same offset. */
		return cap->extended_short.cap;
}

static u32 tb_cap_next(struct tb_cap_any *cap, u32 offset)
{
	int next;
	if (offset == 1) {
		/*
		 * The first pointer is part of the switch header and always
		 * a simple pointer.
		 */
		next = cap->basic.next;
	} else {
		/*
		 * Somehow Intel decided to use 3 different types of capability
		 * headers. It is not like anyone could have predicted that
		 * single byte offsets are not enough...
		 */
		if (tb_cap_is_basic(cap))
			next = cap->basic.next;
		else if (!tb_cap_is_long(cap))
			next = cap->extended_short.next;
		else
			next = cap->extended_long.next;
	}
	/*
	 * "Hey, we could terminate some capability lists with a null offset
	 *  and others with a pointer to the last element." - "Great idea!"
	 */
	if (next == offset)
		return 0;
	return next;
}

/**
 * tb_find_cap() - find a capability
 *
 * Return: Returns a positive offset if the capability was found and 0 if not.
 * Returns an error code on failure.
 */
int tb_find_cap(struct tb_port *port, enum tb_cfg_space space, enum tb_cap cap)
{
	u32 offset = 1;
	struct tb_cap_any header;
	int res;
	int retries = 10;
	while (retries--) {
		res = tb_port_read(port, &header, space, offset, 1);
		if (res) {
			/* Intel needs some help with linked lists. */
			if (space == TB_CFG_PORT && offset == 0xa
			    && port->config.type == TB_TYPE_DP_HDMI_OUT) {
				offset = 0x39;
				continue;
			}
			return res;
		}
		if (offset != 1) {
			if (tb_cap(&header) == cap)
				return offset;
			if (tb_cap_is_long(&header)) {
				/* tb_cap_extended_long is 2 dwords */
				res = tb_port_read(port, &header, space,
						   offset, 2);
				if (res)
					return res;
			}
		}
		offset = tb_cap_next(&header, offset);
		if (!offset)
			return 0;
	}
	tb_port_WARN(port,
		     "run out of retries while looking for cap %#x in config space %d, last offset: %#x\n",
		     cap, space, offset);
	return -EIO;
}
/>
</form>
</td></tr></table>
<div class='path'>path: <a href='/cgit.cgi/linux/net-next.git/commit/?id=424414947da3dd5cb0d60e4f299f7c51e472ae77'>root</a>/<a href='/cgit.cgi/linux/net-next.git/commit/drivers?id=424414947da3dd5cb0d60e4f299f7c51e472ae77'>drivers</a>/<a href='/cgit.cgi/linux/net-next.git/commit/drivers/usb?id=424414947da3dd5cb0d60e4f299f7c51e472ae77'>usb</a>/<a href='/cgit.cgi/linux/net-next.git/commit/drivers/usb/gadget?id=424414947da3dd5cb0d60e4f299f7c51e472ae77'>gadget</a>/<a href='/cgit.cgi/linux/net-next.git/commit/drivers/usb/gadget/function?id=424414947da3dd5cb0d60e4f299f7c51e472ae77'>function</a>/<a href='/cgit.cgi/linux/net-next.git/commit/drivers/usb/gadget/function/u_tcm.h?id=424414947da3dd5cb0d60e4f299f7c51e472ae77'>u_tcm.h</a></div><div class='content'><div class='cgit-panel'><b>diff options</b><form method='get'><input type='hidden' name='id' value='424414947da3dd5cb0d60e4f299f7c51e472ae77'/><table><tr><td colspan='2'/></tr><tr><td class='label'>context:</td><td class='ctrl'><select name='context' onchange='this.form.submit();'><option value='1'>1</option><option value='2'>2</option><option value='3' selected='selected'>3</option><option value='4'>4</option><option value='5'>5</option><option value='6'>6</option><option value='7'>7</option><option value='8'>8</option><option value='9'>9</option><option value='10'>10</option><option value='15'>15</option><option value='20'>20</option><option value='25'>25</option><option value='30'>30</option><option value='35'>35</option><option value='40'>40</option></select></td></tr><tr><td class='label'>space:</td><td class='ctrl'><select name='ignorews' onchange='this.form.submit();'><option value='0' selected='selected'>include</option><option value='1'>ignore</option></select></td></tr><tr><td class='label'>mode:</td><td class='ctrl'><select name='dt' onchange='this.form.submit();'><option value='0' selected='selected'>unified</option><option value='1'>ssdiff</option><option value='2'>stat only</option></select></td></tr><tr><td/><td class='ctrl'><noscript><input type='submit' value='reload'/></noscript></td></tr></table></form></div><table summary='commit info' class='commit-info'>
<tr><th>author</th><td>Greg Kroah-Hartman &lt;gregkh@linuxfoundation.org&gt;</td><td class='right'>2017-02-03 22:19:15 +0100</td></tr>
<tr><th>committer</th><td>Greg Kroah-Hartman &lt;gregkh@linuxfoundation.org&gt;</td><td class='right'>2017-02-03 22:19:15 +0100</td></tr>
<tr><th>commit</th><td colspan='2' class='oid'><a href='/cgit.cgi/linux/net-next.git/commit/drivers/usb/gadget/function/u_tcm.h?id=424414947da3dd5cb0d60e4f299f7c51e472ae77'>424414947da3dd5cb0d60e4f299f7c51e472ae77</a> (<a href='/cgit.cgi/linux/net-next.git/patch/drivers/usb/gadget/function/u_tcm.h?id=424414947da3dd5cb0d60e4f299f7c51e472ae77'>patch</a>)</td></tr>
<tr><th>tree</th><td colspan='2' class='oid'><a href='/cgit.cgi/linux/net-next.git/tree/?id=424414947da3dd5cb0d60e4f299f7c51e472ae77'>a4067480c4256c80ae8f8438a3e4bb88e32050bc</a> /<a href='/cgit.cgi/linux/net-next.git/tree/drivers/usb/gadget/function/u_tcm.h?id=424414947da3dd5cb0d60e4f299f7c51e472ae77'>drivers/usb/gadget/function/u_tcm.h</a></td></tr>
<tr><th>parent</th><td colspan='2' class='oid'><a href='/cgit.cgi/linux/net-next.git/commit/drivers/usb/gadget/function/u_tcm.h?id=a3683e0c1410c5c8136a7a93b0336ce88d3b893a'>a3683e0c1410c5c8136a7a93b0336ce88d3b893a</a> (<a href='/cgit.cgi/linux/net-next.git/diff/drivers/usb/gadget/function/u_tcm.h?id=424414947da3dd5cb0d60e4f299f7c51e472ae77&amp;id2=a3683e0c1410c5c8136a7a93b0336ce88d3b893a'>diff</a>)</td></tr><tr><th>parent</th><td colspan='2' class='oid'><a href='/cgit.cgi/linux/net-next.git/commit/drivers/usb/gadget/function/u_tcm.h?id=d07830db1bdb254e4b50d366010b219286b8c937'>d07830db1bdb254e4b50d366010b219286b8c937</a> (<a href='/cgit.cgi/linux/net-next.git/diff/drivers/usb/gadget/function/u_tcm.h?id=424414947da3dd5cb0d60e4f299f7c51e472ae77&amp;id2=d07830db1bdb254e4b50d366010b219286b8c937'>diff</a>)</td></tr></table>
<div class='commit-subject'>Merge tag 'usb-serial-4.10-rc7' of git://git.kernel.org/pub/scm/linux/kernel/git/johan/usb-serial into usb-linus</div><div class='commit-msg'>Johan writes:

USB-serial fixes for v4.10-rc7

One more device ID for pl2303.

Signed-off-by: Johan Hovold &lt;johan@kernel.org&gt;
</div><div class='diffstat-header'><a href='/cgit.cgi/linux/net-next.git/diff/?id=424414947da3dd5cb0d60e4f299f7c51e472ae77'>Diffstat</a> (limited to 'drivers/usb/gadget/function/u_tcm.h')</div><table summary='diffstat' class='diffstat'>