wifi: switch to nl80211 interface
This commit is contained in:
Joakim Sindholt
@ -15,86 +15,234 @@
|
|||||||
(2 * (rssi + 100)))
|
(2 * (rssi + 100)))
|
||||||
|
|
||||||
#if defined(__linux__)
|
#if defined(__linux__)
|
||||||
#include <limits.h>
|
#include <stdint.h>
|
||||||
#include <linux/wireless.h>
|
#include <net/if.h>
|
||||||
|
#include <linux/netlink.h>
|
||||||
|
#include <linux/genetlink.h>
|
||||||
|
#include <linux/nl80211.h>
|
||||||
|
|
||||||
#define NET_OPERSTATE "/sys/class/net/%s/operstate"
|
static int nlsock = -1;
|
||||||
|
static uint32_t seq = 1;
|
||||||
|
static char resp[4096];
|
||||||
|
|
||||||
const char *
|
static char *
|
||||||
wifi_perc(const char *interface)
|
findattr(int attr, char *p, char *e, size_t *len)
|
||||||
{
|
{
|
||||||
int cur;
|
struct nlattr nla;
|
||||||
size_t i;
|
size_t alen;
|
||||||
char *p, *datastart;
|
|
||||||
char path[PATH_MAX];
|
|
||||||
char status[5];
|
|
||||||
FILE *fp;
|
|
||||||
|
|
||||||
if (esnprintf(path, sizeof(path), NET_OPERSTATE, interface) < 0)
|
while ((size_t)(e-p) >= sizeof(nla)) {
|
||||||
return NULL;
|
memcpy(&nla, p, sizeof(nla));
|
||||||
if (!(fp = fopen(path, "r"))) {
|
if (nla.nla_len < NLA_HDRLEN)
|
||||||
warn("fopen '%s':", path);
|
return NULL;
|
||||||
return NULL;
|
if (nla.nla_type == attr) {
|
||||||
|
p += NLA_HDRLEN;
|
||||||
|
*len = nla.nla_len-NLA_HDRLEN;
|
||||||
|
return (size_t)(e-p)>=*len?p:NULL;
|
||||||
|
}
|
||||||
|
alen = NLA_ALIGN(nla.nla_len);
|
||||||
|
if ((size_t)(e-p) < alen)
|
||||||
|
return NULL;
|
||||||
|
p += alen;
|
||||||
}
|
}
|
||||||
p = fgets(status, 5, fp);
|
return NULL;
|
||||||
fclose(fp);
|
}
|
||||||
if (!p || strcmp(status, "up\n") != 0)
|
|
||||||
return NULL;
|
|
||||||
|
|
||||||
if (!(fp = fopen("/proc/net/wireless", "r"))) {
|
static uint16_t
|
||||||
warn("fopen '/proc/net/wireless':");
|
nl80211fam(void)
|
||||||
return NULL;
|
{
|
||||||
|
static const char family[] = "nl80211";
|
||||||
|
static uint16_t id;
|
||||||
|
ssize_t r;
|
||||||
|
size_t len;
|
||||||
|
char ctrl[NLMSG_HDRLEN+GENL_HDRLEN+NLA_HDRLEN+NLA_ALIGN(sizeof(family))] = {0}, *p = ctrl;
|
||||||
|
|
||||||
|
if (id)
|
||||||
|
return id;
|
||||||
|
|
||||||
|
memcpy(p, &(struct nlmsghdr){
|
||||||
|
.nlmsg_len = sizeof(ctrl),
|
||||||
|
.nlmsg_type = GENL_ID_CTRL,
|
||||||
|
.nlmsg_flags = NLM_F_REQUEST,
|
||||||
|
.nlmsg_seq = seq++,
|
||||||
|
.nlmsg_pid = 0,
|
||||||
|
}, sizeof(struct nlmsghdr));
|
||||||
|
p += NLMSG_HDRLEN;
|
||||||
|
memcpy(p, &(struct genlmsghdr){
|
||||||
|
.cmd = CTRL_CMD_GETFAMILY,
|
||||||
|
.version = 1,
|
||||||
|
}, sizeof(struct genlmsghdr));
|
||||||
|
p += GENL_HDRLEN;
|
||||||
|
memcpy(p, &(struct nlattr){
|
||||||
|
.nla_len = NLA_HDRLEN+sizeof(family),
|
||||||
|
.nla_type = CTRL_ATTR_FAMILY_NAME,
|
||||||
|
}, sizeof(struct nlattr));
|
||||||
|
p += NLA_HDRLEN;
|
||||||
|
memcpy(p, family, sizeof(family));
|
||||||
|
|
||||||
|
if (nlsock < 0)
|
||||||
|
nlsock = socket(AF_NETLINK, SOCK_RAW, NETLINK_GENERIC);
|
||||||
|
if (nlsock < 0) {
|
||||||
|
warn("socket 'AF_NETLINK':");
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
if (send(nlsock, ctrl, sizeof(ctrl), 0) != sizeof(ctrl)) {
|
||||||
|
warn("send 'AF_NETLINK':");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
r = recv(nlsock, resp, sizeof(resp), 0);
|
||||||
|
if (r < 0) {
|
||||||
|
warn("recv 'AF_NETLINK':");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
if ((size_t)r <= sizeof(ctrl))
|
||||||
|
return 0;
|
||||||
|
p = findattr(CTRL_ATTR_FAMILY_ID, resp+sizeof(ctrl), resp+r, &len);
|
||||||
|
if (p && len == 2)
|
||||||
|
memcpy(&id, p, 2);
|
||||||
|
return id;
|
||||||
|
}
|
||||||
|
|
||||||
for (i = 0; i < 3; i++)
|
static int
|
||||||
if (!(p = fgets(buf, sizeof(buf) - 1, fp)))
|
ifindex(const char *interface)
|
||||||
break;
|
{
|
||||||
|
static struct ifreq ifr;
|
||||||
|
static int ifsock = -1;
|
||||||
|
|
||||||
fclose(fp);
|
if (ifsock < 0)
|
||||||
if (i < 2 || !p)
|
ifsock = socket(AF_UNIX, SOCK_DGRAM, 0);
|
||||||
return NULL;
|
if (ifsock < 0) {
|
||||||
|
warn("socket 'AF_UNIX':");
|
||||||
if (!(datastart = strstr(buf, interface)))
|
return -1;
|
||||||
return NULL;
|
}
|
||||||
|
if (strcmp(ifr.ifr_name, interface) != 0) {
|
||||||
datastart = (datastart+(strlen(interface)+1));
|
strcpy(ifr.ifr_name, interface);
|
||||||
sscanf(datastart + 1, " %*d %d %*d %*d\t\t %*d\t "
|
if (ioctl(ifsock, SIOCGIFINDEX, &ifr) != 0) {
|
||||||
"%*d\t\t%*d\t\t %*d\t %*d\t\t %*d", &cur);
|
warn("ioctl 'SIOCGIFINDEX':");
|
||||||
|
return -1;
|
||||||
/* 70 is the max of /proc/net/wireless */
|
}
|
||||||
return bprintf("%d", (int)((float)cur / 70 * 100));
|
}
|
||||||
|
return ifr.ifr_ifindex;
|
||||||
}
|
}
|
||||||
|
|
||||||
const char *
|
const char *
|
||||||
wifi_essid(const char *interface)
|
wifi_essid(const char *interface)
|
||||||
{
|
{
|
||||||
static char id[IW_ESSID_MAX_SIZE+1];
|
uint16_t fam = nl80211fam();
|
||||||
int sockfd;
|
ssize_t r;
|
||||||
struct iwreq wreq;
|
size_t len;
|
||||||
|
char req[NLMSG_HDRLEN+GENL_HDRLEN+NLA_HDRLEN+NLA_ALIGN(4)] = {0}, *p = req;
|
||||||
memset(&wreq, 0, sizeof(struct iwreq));
|
int idx = ifindex(interface);
|
||||||
wreq.u.essid.length = IW_ESSID_MAX_SIZE+1;
|
if (!fam) {
|
||||||
if (esnprintf(wreq.ifr_name, sizeof(wreq.ifr_name), "%s",
|
fprintf(stderr, "nl80211 family not found\n");
|
||||||
interface) < 0)
|
|
||||||
return NULL;
|
|
||||||
|
|
||||||
if ((sockfd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
|
|
||||||
warn("socket 'AF_INET':");
|
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
wreq.u.essid.pointer = id;
|
if (idx < 0) {
|
||||||
if (ioctl(sockfd,SIOCGIWESSID, &wreq) < 0) {
|
fprintf(stderr, "interface %s not found\n", interface);
|
||||||
warn("ioctl 'SIOCGIWESSID':");
|
|
||||||
close(sockfd);
|
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
close(sockfd);
|
memcpy(p, &(struct nlmsghdr){
|
||||||
|
.nlmsg_len = sizeof(req),
|
||||||
|
.nlmsg_type = fam,
|
||||||
|
.nlmsg_flags = NLM_F_REQUEST,
|
||||||
|
.nlmsg_seq = seq++,
|
||||||
|
.nlmsg_pid = 0,
|
||||||
|
}, sizeof(struct nlmsghdr));
|
||||||
|
p += NLMSG_HDRLEN;
|
||||||
|
memcpy(p, &(struct genlmsghdr){
|
||||||
|
.cmd = NL80211_CMD_GET_INTERFACE,
|
||||||
|
.version = 1,
|
||||||
|
}, sizeof(struct genlmsghdr));
|
||||||
|
p += GENL_HDRLEN;
|
||||||
|
memcpy(p, &(struct nlattr){
|
||||||
|
.nla_len = NLA_HDRLEN+4,
|
||||||
|
.nla_type = NL80211_ATTR_IFINDEX,
|
||||||
|
}, sizeof(struct nlattr));
|
||||||
|
p += NLA_HDRLEN;
|
||||||
|
memcpy(p, &(uint32_t){idx}, 4);
|
||||||
|
|
||||||
if (!strcmp(id, ""))
|
if (send(nlsock, req, sizeof(req), 0) != sizeof(req)) {
|
||||||
|
warn("send 'AF_NETLINK':");
|
||||||
return NULL;
|
return NULL;
|
||||||
|
}
|
||||||
|
r = recv(nlsock, resp, sizeof(resp), 0);
|
||||||
|
if (r < 0) {
|
||||||
|
warn("recv 'AF_NETLINK':");
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
return id;
|
if ((size_t)r <= NLMSG_HDRLEN+GENL_HDRLEN)
|
||||||
|
return NULL;
|
||||||
|
p = findattr(NL80211_ATTR_SSID, resp+NLMSG_HDRLEN+GENL_HDRLEN, resp+r, &len);
|
||||||
|
if (p)
|
||||||
|
p[len] = 0;
|
||||||
|
return p;
|
||||||
|
}
|
||||||
|
|
||||||
|
const char *
|
||||||
|
wifi_perc(const char *interface)
|
||||||
|
{
|
||||||
|
static char strength[4];
|
||||||
|
struct nlmsghdr hdr;
|
||||||
|
uint16_t fam = nl80211fam();
|
||||||
|
ssize_t r;
|
||||||
|
size_t len;
|
||||||
|
char req[NLMSG_HDRLEN+GENL_HDRLEN+NLA_HDRLEN+NLA_ALIGN(4)] = {0}, *p = req, *e;
|
||||||
|
int idx = ifindex(interface);
|
||||||
|
if (idx < 0) {
|
||||||
|
fprintf(stderr, "interface %s not found\n", interface);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
memcpy(p, &(struct nlmsghdr){
|
||||||
|
.nlmsg_len = sizeof(req),
|
||||||
|
.nlmsg_type = fam,
|
||||||
|
.nlmsg_flags = NLM_F_REQUEST|NLM_F_DUMP,
|
||||||
|
.nlmsg_seq = seq++,
|
||||||
|
.nlmsg_pid = 0,
|
||||||
|
}, sizeof(struct nlmsghdr));
|
||||||
|
p += NLMSG_HDRLEN;
|
||||||
|
memcpy(p, &(struct genlmsghdr){
|
||||||
|
.cmd = NL80211_CMD_GET_STATION,
|
||||||
|
.version = 1,
|
||||||
|
}, sizeof(struct genlmsghdr));
|
||||||
|
p += GENL_HDRLEN;
|
||||||
|
memcpy(p, &(struct nlattr){
|
||||||
|
.nla_len = NLA_HDRLEN+4,
|
||||||
|
.nla_type = NL80211_ATTR_IFINDEX,
|
||||||
|
}, sizeof(struct nlattr));
|
||||||
|
p += NLA_HDRLEN;
|
||||||
|
memcpy(p, &(uint32_t){idx}, 4);
|
||||||
|
|
||||||
|
if (send(nlsock, req, sizeof(req), 0) != sizeof(req)) {
|
||||||
|
warn("send 'AF_NETLINK':");
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
*strength = 0;
|
||||||
|
while (1) {
|
||||||
|
r = recv(nlsock, resp, sizeof(resp), 0);
|
||||||
|
if (r < 0) {
|
||||||
|
warn("recv 'AF_NETLINK':");
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
if ((size_t)r < sizeof(hdr))
|
||||||
|
return NULL;
|
||||||
|
for (p = resp; p != resp+r && (size_t)(resp+r-p) >= sizeof(hdr); p = e) {
|
||||||
|
memcpy(&hdr, p, sizeof(hdr));
|
||||||
|
e = resp+r-p<hdr.nlmsg_len?resp+r:p+hdr.nlmsg_len;
|
||||||
|
if (!*strength && hdr.nlmsg_len > NLMSG_HDRLEN+GENL_HDRLEN) {
|
||||||
|
p += NLMSG_HDRLEN+GENL_HDRLEN;
|
||||||
|
p = findattr(NL80211_ATTR_STA_INFO, p, e, &len);
|
||||||
|
if (p)
|
||||||
|
p = findattr(NL80211_STA_INFO_SIGNAL_AVG, p, e, &len);
|
||||||
|
if (p && len == 1)
|
||||||
|
snprintf(strength, sizeof(strength), "%d", RSSI_TO_PERC(*p));
|
||||||
|
}
|
||||||
|
if (hdr.nlmsg_type == NLMSG_DONE)
|
||||||
|
return *strength?strength:NULL;
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
#elif defined(__OpenBSD__)
|
#elif defined(__OpenBSD__)
|
||||||
#include <net/if.h>
|
#include <net/if.h>
|
||||||
|
|||||||
Reference in New Issue
Block a user