| 1 |
/* SPDX-License-Identifier: LGPL-2.1-or-later */ |
| 2 |
|
| 3 |
#include "sd-netlink.h" |
| 4 |
|
| 5 |
#include "alloc-util.h" |
| 6 |
#include "ether-addr-util.h" |
| 7 |
#include "log.h" |
| 8 |
#include "string-table.h" |
| 9 |
#include "string-util.h" |
| 10 |
#include "wifi-util.h" |
| 11 |
|
| 12 |
int wifi_get_interface(sd_netlink *genl, int ifindex, enum nl80211_iftype *ret_iftype, char **ret_ssid) { |
| 13 |
_cleanup_(sd_netlink_message_unrefp) sd_netlink_message *m = NULL, *reply = NULL; |
| 14 |
_cleanup_free_ char *ssid = NULL; |
| 15 |
const char *family; |
| 16 |
uint32_t iftype; |
| 17 |
size_t len; |
| 18 |
int r; |
| 19 |
|
| 20 |
assert(genl); |
| 21 |
assert(ifindex > 0); |
| 22 |
|
| 23 |
r = sd_genl_message_new(genl, NL80211_GENL_NAME, NL80211_CMD_GET_INTERFACE, &m); |
| 24 |
if (r < 0) |
| 25 |
return log_debug_errno(r, "Failed to create generic netlink message: %m"); |
| 26 |
|
| 27 |
r = sd_netlink_message_append_u32(m, NL80211_ATTR_IFINDEX, ifindex); |
| 28 |
if (r < 0) |
| 29 |
return log_debug_errno(r, "Could not append NL80211_ATTR_IFINDEX attribute: %m"); |
| 30 |
|
| 31 |
r = sd_netlink_call(genl, m, 0, &reply); |
| 32 |
if (r == -ENODEV) { |
| 33 |
/* For obsolete WEXT driver. */ |
| 34 |
log_debug_errno(r, "Failed to request information about wifi interface %d. " |
| 35 |
"The device doesn't seem to have nl80211 interface. Ignoring.", |
| 36 |
ifindex); |
| 37 |
goto nodata; |
| 38 |
} |
| 39 |
if (r < 0) |
| 40 |
return log_debug_errno(r, "Failed to request information about wifi interface %d: %m", ifindex); |
| 41 |
if (!reply) { |
| 42 |
log_debug("No reply received to request for information about wifi interface %d, ignoring.", ifindex); |
| 43 |
goto nodata; |
| 44 |
} |
| 45 |
|
| 46 |
r = sd_netlink_message_get_errno(reply); |
| 47 |
if (r < 0) |
| 48 |
return log_debug_errno(r, "Failed to get information about wifi interface %d: %m", ifindex); |
| 49 |
|
| 50 |
r = sd_genl_message_get_family_name(genl, reply, &family); |
| 51 |
if (r < 0) |
| 52 |
return log_debug_errno(r, "Failed to determine genl family: %m"); |
| 53 |
if (!streq(family, NL80211_GENL_NAME)) { |
| 54 |
log_debug("Received message of unexpected genl family '%s', ignoring.", family); |
| 55 |
goto nodata; |
| 56 |
} |
| 57 |
|
| 58 |
r = sd_netlink_message_read_u32(reply, NL80211_ATTR_IFTYPE, &iftype); |
| 59 |
if (r < 0) |
| 60 |
return log_debug_errno(r, "Failed to get NL80211_ATTR_IFTYPE attribute: %m"); |
| 61 |
|
| 62 |
r = sd_netlink_message_read_data(reply, NL80211_ATTR_SSID, &len, (void**) &ssid); |
| 63 |
if (r < 0 && r != -ENODATA) |
| 64 |
return log_debug_errno(r, "Failed to get NL80211_ATTR_SSID attribute: %m"); |
| 65 |
if (r >= 0) { |
| 66 |
if (len == 0) { |
| 67 |
log_debug("SSID has zero length, ignoring it."); |
| 68 |
ssid = mfree(ssid); |
| 69 |
} else if (strlen_ptr(ssid) != len) { |
| 70 |
log_debug("SSID contains NUL characters, ignoring it."); |
| 71 |
ssid = mfree(ssid); |
| 72 |
} |
| 73 |
} |
| 74 |
|
| 75 |
if (ret_iftype) |
| 76 |
*ret_iftype = iftype; |
| 77 |
|
| 78 |
if (ret_ssid) |
| 79 |
*ret_ssid = TAKE_PTR(ssid); |
| 80 |
|
| 81 |
return 1; |
| 82 |
|
| 83 |
nodata: |
| 84 |
if (ret_iftype) |
| 85 |
*ret_iftype = 0; |
| 86 |
if (ret_ssid) |
| 87 |
*ret_ssid = NULL; |
| 88 |
return 0; |
| 89 |
} |
| 90 |
|
| 91 |
int wifi_get_station(sd_netlink *genl, int ifindex, struct ether_addr *ret_bssid) { |
| 92 |
_cleanup_(sd_netlink_message_unrefp) sd_netlink_message *m = NULL, *reply = NULL; |
| 93 |
const char *family; |
| 94 |
int r; |
| 95 |
|
| 96 |
assert(genl); |
| 97 |
assert(ifindex > 0); |
| 98 |
assert(ret_bssid); |
| 99 |
|
| 100 |
r = sd_genl_message_new(genl, NL80211_GENL_NAME, NL80211_CMD_GET_STATION, &m); |
| 101 |
if (r < 0) |
| 102 |
return log_debug_errno(r, "Failed to create generic netlink message: %m"); |
| 103 |
|
| 104 |
r = sd_netlink_message_set_flags(m, NLM_F_REQUEST | NLM_F_ACK | NLM_F_DUMP); |
| 105 |
if (r < 0) |
| 106 |
return log_debug_errno(r, "Failed to set dump flag: %m"); |
| 107 |
|
| 108 |
r = sd_netlink_message_append_u32(m, NL80211_ATTR_IFINDEX, ifindex); |
| 109 |
if (r < 0) |
| 110 |
return log_debug_errno(r, "Could not append NL80211_ATTR_IFINDEX attribute: %m"); |
| 111 |
|
| 112 |
r = sd_netlink_call(genl, m, 0, &reply); |
| 113 |
if (r < 0) |
| 114 |
return log_debug_errno(r, "Failed to request information about wifi station: %m"); |
| 115 |
if (!reply) { |
| 116 |
log_debug("No reply received to request for information about wifi station, ignoring."); |
| 117 |
goto nodata; |
| 118 |
} |
| 119 |
|
| 120 |
r = sd_netlink_message_get_errno(reply); |
| 121 |
if (r < 0) |
| 122 |
return log_debug_errno(r, "Failed to get information about wifi station: %m"); |
| 123 |
|
| 124 |
r = sd_genl_message_get_family_name(genl, reply, &family); |
| 125 |
if (r < 0) |
| 126 |
return log_debug_errno(r, "Failed to determine genl family: %m"); |
| 127 |
if (!streq(family, NL80211_GENL_NAME)) { |
| 128 |
log_debug("Received message of unexpected genl family '%s', ignoring.", family); |
| 129 |
goto nodata; |
| 130 |
} |
| 131 |
|
| 132 |
r = sd_netlink_message_read_ether_addr(reply, NL80211_ATTR_MAC, ret_bssid); |
| 133 |
if (r == -ENODATA) |
| 134 |
goto nodata; |
| 135 |
if (r < 0) |
| 136 |
return log_debug_errno(r, "Failed to get NL80211_ATTR_MAC attribute: %m"); |
| 137 |
|
| 138 |
return 1; |
| 139 |
|
| 140 |
nodata: |
| 141 |
*ret_bssid = ETHER_ADDR_NULL; |
| 142 |
return 0; |
| 143 |
} |
| 144 |
|
| 145 |
static const char * const nl80211_iftype_table[NUM_NL80211_IFTYPES] = { |
| 146 |
[NL80211_IFTYPE_ADHOC] = "ad-hoc", |
| 147 |
[NL80211_IFTYPE_STATION] = "station", |
| 148 |
[NL80211_IFTYPE_AP] = "ap", |
| 149 |
[NL80211_IFTYPE_AP_VLAN] = "ap-vlan", |
| 150 |
[NL80211_IFTYPE_WDS] = "wds", |
| 151 |
[NL80211_IFTYPE_MONITOR] = "monitor", |
| 152 |
[NL80211_IFTYPE_MESH_POINT] = "mesh-point", |
| 153 |
[NL80211_IFTYPE_P2P_CLIENT] = "p2p-client", |
| 154 |
[NL80211_IFTYPE_P2P_GO] = "p2p-go", |
| 155 |
[NL80211_IFTYPE_P2P_DEVICE] = "p2p-device", |
| 156 |
[NL80211_IFTYPE_OCB] = "ocb", |
| 157 |
[NL80211_IFTYPE_NAN] = "nan", |
| 158 |
}; |
| 159 |
|
| 160 |
DEFINE_STRING_TABLE_LOOKUP(nl80211_iftype, enum nl80211_iftype); |
| 161 |
|
| 162 |
static const char * const nl80211_cmd_table[__NL80211_CMD_AFTER_LAST] = { |
| 163 |
[NL80211_CMD_GET_WIPHY] = "get_wiphy", |
| 164 |
[NL80211_CMD_SET_WIPHY] = "set_wiphy", |
| 165 |
[NL80211_CMD_NEW_WIPHY] = "new_wiphy", |
| 166 |
[NL80211_CMD_DEL_WIPHY] = "del_wiphy", |
| 167 |
[NL80211_CMD_GET_INTERFACE] = "get_interface", |
| 168 |
[NL80211_CMD_SET_INTERFACE] = "set_interface", |
| 169 |
[NL80211_CMD_NEW_INTERFACE] = "new_interface", |
| 170 |
[NL80211_CMD_DEL_INTERFACE] = "del_interface", |
| 171 |
[NL80211_CMD_GET_KEY] = "get_key", |
| 172 |
[NL80211_CMD_SET_KEY] = "set_key", |
| 173 |
[NL80211_CMD_NEW_KEY] = "new_key", |
| 174 |
[NL80211_CMD_DEL_KEY] = "del_key", |
| 175 |
[NL80211_CMD_GET_BEACON] = "get_beacon", |
| 176 |
[NL80211_CMD_SET_BEACON] = "set_beacon", |
| 177 |
[NL80211_CMD_START_AP] = "start_ap", |
| 178 |
[NL80211_CMD_STOP_AP] = "stop_ap", |
| 179 |
[NL80211_CMD_GET_STATION] = "get_station", |
| 180 |
[NL80211_CMD_SET_STATION] = "set_station", |
| 181 |
[NL80211_CMD_NEW_STATION] = "new_station", |
| 182 |
[NL80211_CMD_DEL_STATION] = "del_station", |
| 183 |
[NL80211_CMD_GET_MPATH] = "get_mpath", |
| 184 |
[NL80211_CMD_SET_MPATH] = "set_mpath", |
| 185 |
[NL80211_CMD_NEW_MPATH] = "new_mpath", |
| 186 |
[NL80211_CMD_DEL_MPATH] = "del_mpath", |
| 187 |
[NL80211_CMD_SET_BSS] = "set_bss", |
| 188 |
[NL80211_CMD_SET_REG] = "set_reg", |
| 189 |
[NL80211_CMD_REQ_SET_REG] = "req_set_reg", |
| 190 |
[NL80211_CMD_GET_MESH_CONFIG] = "get_mesh_config", |
| 191 |
[NL80211_CMD_SET_MESH_CONFIG] = "set_mesh_config", |
| 192 |
[NL80211_CMD_SET_MGMT_EXTRA_IE] = "set_mgmt_extra_ie", |
| 193 |
[NL80211_CMD_GET_REG] = "get_reg", |
| 194 |
[NL80211_CMD_GET_SCAN] = "get_scan", |
| 195 |
[NL80211_CMD_TRIGGER_SCAN] = "trigger_scan", |
| 196 |
[NL80211_CMD_NEW_SCAN_RESULTS] = "new_scan_results", |
| 197 |
[NL80211_CMD_SCAN_ABORTED] = "scan_aborted", |
| 198 |
[NL80211_CMD_REG_CHANGE] = "reg_change", |
| 199 |
[NL80211_CMD_AUTHENTICATE] = "authenticate", |
| 200 |
[NL80211_CMD_ASSOCIATE] = "associate", |
| 201 |
[NL80211_CMD_DEAUTHENTICATE] = "deauthenticate", |
| 202 |
[NL80211_CMD_DISASSOCIATE] = "disassociate", |
| 203 |
[NL80211_CMD_MICHAEL_MIC_FAILURE] = "michael_mic_failure", |
| 204 |
[NL80211_CMD_REG_BEACON_HINT] = "reg_beacon_hint", |
| 205 |
[NL80211_CMD_JOIN_IBSS] = "join_ibss", |
| 206 |
[NL80211_CMD_LEAVE_IBSS] = "leave_ibss", |
| 207 |
[NL80211_CMD_TESTMODE] = "testmode", |
| 208 |
[NL80211_CMD_CONNECT] = "connect", |
| 209 |
[NL80211_CMD_ROAM] = "roam", |
| 210 |
[NL80211_CMD_DISCONNECT] = "disconnect", |
| 211 |
[NL80211_CMD_SET_WIPHY_NETNS] = "set_wiphy_netns", |
| 212 |
[NL80211_CMD_GET_SURVEY] = "get_survey", |
| 213 |
[NL80211_CMD_NEW_SURVEY_RESULTS] = "new_survey_results", |
| 214 |
[NL80211_CMD_SET_PMKSA] = "set_pmksa", |
| 215 |
[NL80211_CMD_DEL_PMKSA] = "del_pmksa", |
| 216 |
[NL80211_CMD_FLUSH_PMKSA] = "flush_pmksa", |
| 217 |
[NL80211_CMD_REMAIN_ON_CHANNEL] = "remain_on_channel", |
| 218 |
[NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL] = "cancel_remain_on_channel", |
| 219 |
[NL80211_CMD_SET_TX_BITRATE_MASK] = "set_tx_bitrate_mask", |
| 220 |
[NL80211_CMD_REGISTER_FRAME] = "register_frame", |
| 221 |
[NL80211_CMD_FRAME] = "frame", |
| 222 |
[NL80211_CMD_FRAME_TX_STATUS] = "frame_tx_status", |
| 223 |
[NL80211_CMD_SET_POWER_SAVE] = "set_power_save", |
| 224 |
[NL80211_CMD_GET_POWER_SAVE] = "get_power_save", |
| 225 |
[NL80211_CMD_SET_CQM] = "set_cqm", |
| 226 |
[NL80211_CMD_NOTIFY_CQM] = "notify_cqm", |
| 227 |
[NL80211_CMD_SET_CHANNEL] = "set_channel", |
| 228 |
[NL80211_CMD_SET_WDS_PEER] = "set_wds_peer", |
| 229 |
[NL80211_CMD_FRAME_WAIT_CANCEL] = "frame_wait_cancel", |
| 230 |
[NL80211_CMD_JOIN_MESH] = "join_mesh", |
| 231 |
[NL80211_CMD_LEAVE_MESH] = "leave_mesh", |
| 232 |
[NL80211_CMD_UNPROT_DEAUTHENTICATE] = "unprot_deauthenticate", |
| 233 |
[NL80211_CMD_UNPROT_DISASSOCIATE] = "unprot_disassociate", |
| 234 |
[NL80211_CMD_NEW_PEER_CANDIDATE] = "new_peer_candidate", |
| 235 |
[NL80211_CMD_GET_WOWLAN] = "get_wowlan", |
| 236 |
[NL80211_CMD_SET_WOWLAN] = "set_wowlan", |
| 237 |
[NL80211_CMD_START_SCHED_SCAN] = "start_sched_scan", |
| 238 |
[NL80211_CMD_STOP_SCHED_SCAN] = "stop_sched_scan", |
| 239 |
[NL80211_CMD_SCHED_SCAN_RESULTS] = "sched_scan_results", |
| 240 |
[NL80211_CMD_SCHED_SCAN_STOPPED] = "sched_scan_stopped", |
| 241 |
[NL80211_CMD_SET_REKEY_OFFLOAD] = "set_rekey_offload", |
| 242 |
[NL80211_CMD_PMKSA_CANDIDATE] = "pmksa_candidate", |
| 243 |
[NL80211_CMD_TDLS_OPER] = "tdls_oper", |
| 244 |
[NL80211_CMD_TDLS_MGMT] = "tdls_mgmt", |
| 245 |
[NL80211_CMD_UNEXPECTED_FRAME] = "unexpected_frame", |
| 246 |
[NL80211_CMD_PROBE_CLIENT] = "probe_client", |
| 247 |
[NL80211_CMD_REGISTER_BEACONS] = "register_beacons", |
| 248 |
[NL80211_CMD_UNEXPECTED_4ADDR_FRAME] = "unexpected_4addr_frame", |
| 249 |
[NL80211_CMD_SET_NOACK_MAP] = "set_noack_map", |
| 250 |
[NL80211_CMD_CH_SWITCH_NOTIFY] = "ch_switch_notify", |
| 251 |
[NL80211_CMD_START_P2P_DEVICE] = "start_p2p_device", |
| 252 |
[NL80211_CMD_STOP_P2P_DEVICE] = "stop_p2p_device", |
| 253 |
[NL80211_CMD_CONN_FAILED] = "conn_failed", |
| 254 |
[NL80211_CMD_SET_MCAST_RATE] = "set_mcast_rate", |
| 255 |
[NL80211_CMD_SET_MAC_ACL] = "set_mac_acl", |
| 256 |
[NL80211_CMD_RADAR_DETECT] = "radar_detect", |
| 257 |
[NL80211_CMD_GET_PROTOCOL_FEATURES] = "get_protocol_features", |
| 258 |
[NL80211_CMD_UPDATE_FT_IES] = "update_ft_ies", |
| 259 |
[NL80211_CMD_FT_EVENT] = "ft_event", |
| 260 |
[NL80211_CMD_CRIT_PROTOCOL_START] = "crit_protocol_start", |
| 261 |
[NL80211_CMD_CRIT_PROTOCOL_STOP] = "crit_protocol_stop", |
| 262 |
[NL80211_CMD_GET_COALESCE] = "get_coalesce", |
| 263 |
[NL80211_CMD_SET_COALESCE] = "set_coalesce", |
| 264 |
[NL80211_CMD_CHANNEL_SWITCH] = "channel_switch", |
| 265 |
[NL80211_CMD_VENDOR] = "vendor", |
| 266 |
[NL80211_CMD_SET_QOS_MAP] = "set_qos_map", |
| 267 |
[NL80211_CMD_ADD_TX_TS] = "add_tx_ts", |
| 268 |
[NL80211_CMD_DEL_TX_TS] = "del_tx_ts", |
| 269 |
[NL80211_CMD_GET_MPP] = "get_mpp", |
| 270 |
[NL80211_CMD_JOIN_OCB] = "join_ocb", |
| 271 |
[NL80211_CMD_LEAVE_OCB] = "leave_ocb", |
| 272 |
[NL80211_CMD_CH_SWITCH_STARTED_NOTIFY] = "ch_switch_started_notify", |
| 273 |
[NL80211_CMD_TDLS_CHANNEL_SWITCH] = "tdls_channel_switch", |
| 274 |
[NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH] = "tdls_cancel_channel_switch", |
| 275 |
[NL80211_CMD_WIPHY_REG_CHANGE] = "wiphy_reg_change", |
| 276 |
[NL80211_CMD_ABORT_SCAN] = "abort_scan", |
| 277 |
[NL80211_CMD_START_NAN] = "start_nan", |
| 278 |
[NL80211_CMD_STOP_NAN] = "stop_nan", |
| 279 |
[NL80211_CMD_ADD_NAN_FUNCTION] = "add_nan_function", |
| 280 |
[NL80211_CMD_DEL_NAN_FUNCTION] = "del_nan_function", |
| 281 |
[NL80211_CMD_CHANGE_NAN_CONFIG] = "change_nan_config", |
| 282 |
[NL80211_CMD_NAN_MATCH] = "nan_match", |
| 283 |
[NL80211_CMD_SET_MULTICAST_TO_UNICAST] = "set_multicast_to_unicast", |
| 284 |
[NL80211_CMD_UPDATE_CONNECT_PARAMS] = "update_connect_params", |
| 285 |
[NL80211_CMD_SET_PMK] = "set_pmk", |
| 286 |
[NL80211_CMD_DEL_PMK] = "del_pmk", |
| 287 |
[NL80211_CMD_PORT_AUTHORIZED] = "port_authorized", |
| 288 |
[NL80211_CMD_RELOAD_REGDB] = "reload_regdb", |
| 289 |
[NL80211_CMD_EXTERNAL_AUTH] = "external_auth", |
| 290 |
[NL80211_CMD_STA_OPMODE_CHANGED] = "sta_opmode_changed", |
| 291 |
[NL80211_CMD_CONTROL_PORT_FRAME] = "control_port_frame", |
| 292 |
[NL80211_CMD_GET_FTM_RESPONDER_STATS] = "get_ftm_responder_stats", |
| 293 |
[NL80211_CMD_PEER_MEASUREMENT_START] = "peer_measurement_start", |
| 294 |
[NL80211_CMD_PEER_MEASUREMENT_RESULT] = "peer_measurement_result", |
| 295 |
[NL80211_CMD_PEER_MEASUREMENT_COMPLETE] = "peer_measurement_complete", |
| 296 |
[NL80211_CMD_NOTIFY_RADAR] = "notify_radar", |
| 297 |
[NL80211_CMD_UPDATE_OWE_INFO] = "update_owe_info", |
| 298 |
[NL80211_CMD_PROBE_MESH_LINK] = "probe_mesh_link", |
| 299 |
[NL80211_CMD_SET_TID_CONFIG] = "set_tid_config", |
| 300 |
[NL80211_CMD_UNPROT_BEACON] = "unprot_beacon", |
| 301 |
[NL80211_CMD_CONTROL_PORT_FRAME_TX_STATUS] = "control_port_frame_tx_status", |
| 302 |
[NL80211_CMD_SET_SAR_SPECS] = "set_sar_specs", |
| 303 |
[NL80211_CMD_OBSS_COLOR_COLLISION] = "obss_color_collision", |
| 304 |
[NL80211_CMD_COLOR_CHANGE_REQUEST] = "color_change_request", |
| 305 |
[NL80211_CMD_COLOR_CHANGE_STARTED] = "color_change_started", |
| 306 |
[NL80211_CMD_COLOR_CHANGE_ABORTED] = "color_change_aborted", |
| 307 |
[NL80211_CMD_COLOR_CHANGE_COMPLETED] = "color_change_completed", |
| 308 |
}; |
| 309 |
|
| 310 |
DEFINE_STRING_TABLE_LOOKUP_TO_STRING(nl80211_cmd, int); |