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: Lukas Wunner <lukas@wunner.de> Signed-off-by: Mika Westerberg <mika.westerberg@linux.intel.com> Reviewed-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com> Signed-off-by: Andreas Noever <andreas.noever@gmail.com> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
parent
3902294555
commit
02b17a41ad
|
@ -295,25 +295,13 @@ int tb_drom_read_uid_only(struct tb_switch *sw, u64 *uid)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void tb_drom_parse_port_entry(struct tb_port *port,
|
||||
struct tb_drom_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];
|
||||
}
|
||||
|
||||
static int tb_drom_parse_entry(struct tb_switch *sw,
|
||||
struct tb_drom_entry_header *header)
|
||||
static int tb_drom_parse_entry_port(struct tb_switch *sw,
|
||||
struct tb_drom_entry_header *header)
|
||||
{
|
||||
struct tb_port *port;
|
||||
int res;
|
||||
enum tb_port_type type;
|
||||
|
||||
if (header->type != TB_DROM_ENTRY_PORT)
|
||||
return 0;
|
||||
|
||||
port = &sw->ports[header->index];
|
||||
port->disabled = header->port_disabled;
|
||||
if (port->disabled)
|
||||
|
@ -332,7 +320,10 @@ static int tb_drom_parse_entry(struct tb_switch *sw,
|
|||
header->len, sizeof(struct tb_drom_entry_port));
|
||||
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;
|
||||
}
|
||||
|
@ -347,6 +338,7 @@ static int tb_drom_parse_entries(struct tb_switch *sw)
|
|||
struct tb_drom_header *header = (void *) sw->drom;
|
||||
u16 pos = sizeof(*header);
|
||||
u16 drom_size = header->data_len + TB_DROM_DATA_START;
|
||||
int res;
|
||||
|
||||
while (pos < drom_size) {
|
||||
struct tb_drom_entry_header *entry = (void *) (sw->drom + pos);
|
||||
|
@ -356,7 +348,15 @@ static int tb_drom_parse_entries(struct tb_switch *sw)
|
|||
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;
|
||||
}
|
||||
|
|
Loading…
Reference in New Issue