wiphy: Coalesce ATTR_WIPHY parsing logic

We parse ATTR_WIPHY and ATTR_WIPHY_NAME in several places.  Implement a
helper function to make this easier and cut down on code size.
This commit is contained in:
Denis Kenzior 2017-03-08 17:32:38 -06:00
parent d67425c936
commit 5dc347ecb1
1 changed files with 81 additions and 60 deletions

View File

@ -323,13 +323,78 @@ static void wiphy_parse_attributes(struct wiphy *wiphy,
}
static bool wiphy_parse_id_and_name(struct l_genl_attr *attr, uint32_t *out_id,
const char **out_name,
uint32_t *out_name_len)
{
uint16_t type, len;
const void *data;
uint32_t id;
const char *name;
uint32_t name_len;
/*
* The wiphy attribute, name and generation are always the first
* three attributes (in that order) in every NEW_WIPHY & DEL_WIPHY
* message. If not, then error out with a warning and ignore the
* whole message.
*/
if (!l_genl_attr_next(attr, &type, &len, &data))
return false;
if (type != NL80211_ATTR_WIPHY)
return false;
if (len != sizeof(uint32_t))
return false;
id = *((uint32_t *) data);
if (!l_genl_attr_next(attr, &type, &len, &data))
return false;
if (type != NL80211_ATTR_WIPHY_NAME)
return false;
if (len > sizeof(((struct wiphy *) 0)->name))
return false;
name = data;
name_len = len;
if (!l_genl_attr_next(attr, &type, &len, &data))
return false;
if (type != NL80211_ATTR_GENERATION)
return false;
if (len != sizeof(uint32_t))
return false;
/*
* TODO: Handle GENERATION. In theory if we detect a changed generation
* number during a dump, it means that our dump needs to be re-started
*/
if (out_id)
*out_id = id;
if (out_name)
*out_name = name;
if (out_name_len)
*out_name_len = name_len;
return true;
}
static void wiphy_dump_callback(struct l_genl_msg *msg, void *user_data)
{
struct wiphy *wiphy;
struct l_genl_attr attr;
uint16_t type, len;
const void *data;
uint32_t id;
const char *name;
uint32_t name_len;
l_debug("");
@ -337,28 +402,13 @@ static void wiphy_dump_callback(struct l_genl_msg *msg, void *user_data)
return;
/*
* The wiphy attribute is always the first attribute in the
* list. If not then error out with a warning and ignore the
* whole message.
*
* In most cases multiple of these message will be send
* In most cases multiple of these message will be sent
* since the information included can not fit into a single
* message.
*/
if (!l_genl_attr_next(&attr, &type, &len, &data))
if (!wiphy_parse_id_and_name(&attr, &id, &name, &name_len))
return;
if (type != NL80211_ATTR_WIPHY)
return;
if (len != sizeof(uint32_t)) {
l_warn("Invalid wiphy attribute");
return;
}
id = *((uint32_t *) data);
wiphy = l_queue_find(wiphy_list, wiphy_match, L_UINT_TO_PTR(id));
if (!wiphy) {
wiphy = l_new(struct wiphy, 1);
@ -367,6 +417,7 @@ static void wiphy_dump_callback(struct l_genl_msg *msg, void *user_data)
l_queue_push_head(wiphy_list, wiphy);
}
memcpy(wiphy->name, name, name_len);
wiphy_parse_attributes(wiphy, &attr);
}
@ -440,35 +491,16 @@ static void wiphy_new_wiphy_event(struct l_genl_msg *msg)
{
struct wiphy *wiphy;
struct l_genl_attr attr;
uint16_t type, len;
const void *data;
uint32_t id;
const char *name;
uint32_t name_len;
l_debug("");
if (!l_genl_attr_init(&attr, msg))
return;
if (!l_genl_attr_next(&attr, &type, &len, &data))
return;
if (type != NL80211_ATTR_WIPHY)
return;
if (len != sizeof(uint32_t)) {
l_warn("Invalid wiphy attribute");
return;
}
id = *((uint32_t *) data);
if (!l_genl_attr_next(&attr, &type, &len, &data))
return;
if (type != NL80211_ATTR_WIPHY_NAME)
return;
if (len > sizeof(wiphy->name))
if (!wiphy_parse_id_and_name(&attr, &id, &name, &name_len))
return;
wiphy = l_queue_find(wiphy_list, wiphy_match, L_UINT_TO_PTR(id));
@ -477,21 +509,20 @@ static void wiphy_new_wiphy_event(struct l_genl_msg *msg)
* WIPHY_NAME is a NLA_NUL_STRING, so the kernel
* enforces the data to be null terminated
*/
if (strcmp(wiphy->name, data)) {
if (strcmp(wiphy->name, name)) {
struct l_dbus *dbus = dbus_get_bus();
memcpy(wiphy->name, data, len);
memcpy(wiphy->name, name, name_len);
l_dbus_property_changed(dbus, wiphy_get_path(wiphy),
IWD_WIPHY_INTERFACE, "Name");
} else
l_info("Wiphy %s[%d] already being tracked",
wiphy->name, wiphy->id);
}
return;
}
wiphy = l_new(struct wiphy, 1);
wiphy->id = id;
memcpy(wiphy->name, data, len);
memcpy(wiphy->name, name, name_len);
wiphy->supported_freqs = scan_freq_set_new();
l_queue_push_head(wiphy_list, wiphy);
@ -505,26 +536,16 @@ static void wiphy_del_wiphy_event(struct l_genl_msg *msg)
{
struct wiphy *wiphy;
struct l_genl_attr attr;
uint16_t type, len;
const void *data;
uint32_t id;
l_debug("");
if (!l_genl_attr_init(&attr, msg))
return;
if (!l_genl_attr_next(&attr, &type, &len, &data))
if (!wiphy_parse_id_and_name(&attr, &id, NULL, NULL))
return;
if (type != NL80211_ATTR_WIPHY)
return;
if (len != sizeof(uint32_t)) {
l_warn("Invalid wiphy attribute");
return;
}
id = *((uint32_t *) data);
wiphy = l_queue_remove_if(wiphy_list, wiphy_match, L_UINT_TO_PTR(id));
if (!wiphy)
return;