Commit 02b17a41 authored by Lukas Wunner's avatar Lukas Wunner Committed by Greg Kroah-Hartman

thunderbolt: Refactor and fix parsing of port drom entries

Currently tb_drom_parse_entry() is only able to parse drom entries of
type TB_DROM_ENTRY_PORT. Rename it to tb_drom_parse_entry_port().
Fold tb_drom_parse_port_entry() into it.

Its return value is currently ignored. Evaluate it and abort parsing on
error.

Change tb_drom_parse_entries() to accommodate for parsing of other entry
types than TB_DROM_ENTRY_PORT.
Signed-off-by: default avatarLukas Wunner <lukas@wunner.de>
Signed-off-by: default avatarMika Westerberg <mika.westerberg@linux.intel.com>
Reviewed-by: default avatarAndy Shevchenko <andriy.shevchenko@linux.intel.com>
Signed-off-by: default avatarAndreas Noever <andreas.noever@gmail.com>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent 39022945
...@@ -295,25 +295,13 @@ int tb_drom_read_uid_only(struct tb_switch *sw, u64 *uid) ...@@ -295,25 +295,13 @@ int tb_drom_read_uid_only(struct tb_switch *sw, u64 *uid)
return 0; return 0;
} }
static void tb_drom_parse_port_entry(struct tb_port *port, static int tb_drom_parse_entry_port(struct tb_switch *sw,
struct tb_drom_entry_port *entry) struct tb_drom_entry_header *header)
{
port->link_nr = entry->link_nr;
if (entry->has_dual_link_port)
port->dual_link_port =
&port->sw->ports[entry->dual_link_port_nr];
}
static int tb_drom_parse_entry(struct tb_switch *sw,
struct tb_drom_entry_header *header)
{ {
struct tb_port *port; struct tb_port *port;
int res; int res;
enum tb_port_type type; enum tb_port_type type;
if (header->type != TB_DROM_ENTRY_PORT)
return 0;
port = &sw->ports[header->index]; port = &sw->ports[header->index];
port->disabled = header->port_disabled; port->disabled = header->port_disabled;
if (port->disabled) if (port->disabled)
...@@ -332,7 +320,10 @@ static int tb_drom_parse_entry(struct tb_switch *sw, ...@@ -332,7 +320,10 @@ static int tb_drom_parse_entry(struct tb_switch *sw,
header->len, sizeof(struct tb_drom_entry_port)); header->len, sizeof(struct tb_drom_entry_port));
return -EIO; return -EIO;
} }
tb_drom_parse_port_entry(port, entry); port->link_nr = entry->link_nr;
if (entry->has_dual_link_port)
port->dual_link_port =
&port->sw->ports[entry->dual_link_port_nr];
} }
return 0; return 0;
} }
...@@ -347,6 +338,7 @@ static int tb_drom_parse_entries(struct tb_switch *sw) ...@@ -347,6 +338,7 @@ static int tb_drom_parse_entries(struct tb_switch *sw)
struct tb_drom_header *header = (void *) sw->drom; struct tb_drom_header *header = (void *) sw->drom;
u16 pos = sizeof(*header); u16 pos = sizeof(*header);
u16 drom_size = header->data_len + TB_DROM_DATA_START; u16 drom_size = header->data_len + TB_DROM_DATA_START;
int res;
while (pos < drom_size) { while (pos < drom_size) {
struct tb_drom_entry_header *entry = (void *) (sw->drom + pos); struct tb_drom_entry_header *entry = (void *) (sw->drom + pos);
...@@ -356,7 +348,15 @@ static int tb_drom_parse_entries(struct tb_switch *sw) ...@@ -356,7 +348,15 @@ static int tb_drom_parse_entries(struct tb_switch *sw)
return -EIO; return -EIO;
} }
tb_drom_parse_entry(sw, entry); switch (entry->type) {
case TB_DROM_ENTRY_GENERIC:
break;
case TB_DROM_ENTRY_PORT:
res = tb_drom_parse_entry_port(sw, entry);
break;
}
if (res)
return res;
pos += entry->len; pos += entry->len;
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment