| /* |
| * Copyright (C) 2015 The Android Open Source Project |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * * Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * * Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in |
| * the documentation and/or other materials provided with the |
| * distribution. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
| * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
| * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS |
| * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE |
| * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, |
| * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, |
| * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS |
| * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED |
| * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
| * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT |
| * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
| * SUCH DAMAGE. |
| */ |
| |
| #include "bionic_netlink.h" |
| |
| #include <errno.h> |
| #include <linux/netlink.h> |
| #include <linux/rtnetlink.h> |
| #include <string.h> |
| #include <stdlib.h> |
| #include <sys/socket.h> |
| #include <unistd.h> |
| |
| #include "private/ErrnoRestorer.h" |
| |
| NetlinkConnection::NetlinkConnection() { |
| fd_ = -1; |
| |
| // The kernel keeps packets under 8KiB (NLMSG_GOODSIZE), |
| // but that's a bit too large to go on the stack. |
| size_ = 8192; |
| data_ = new char[size_]; |
| } |
| |
| NetlinkConnection::~NetlinkConnection() { |
| ErrnoRestorer errno_restorer; |
| if (fd_ != -1) close(fd_); |
| delete[] data_; |
| } |
| |
| bool NetlinkConnection::SendRequest(int type) { |
| // Rather than force all callers to check for the unlikely event of being |
| // unable to allocate 8KiB, check here. |
| if (data_ == nullptr) return false; |
| |
| // Did we open a netlink socket yet? |
| if (fd_ == -1) { |
| fd_ = socket(PF_NETLINK, SOCK_RAW | SOCK_CLOEXEC, NETLINK_ROUTE); |
| if (fd_ == -1) return false; |
| } |
| |
| // Construct and send the message. |
| struct NetlinkMessage { |
| nlmsghdr hdr; |
| rtgenmsg msg; |
| } request; |
| memset(&request, 0, sizeof(request)); |
| request.hdr.nlmsg_flags = NLM_F_DUMP | NLM_F_REQUEST; |
| request.hdr.nlmsg_type = type; |
| request.hdr.nlmsg_len = sizeof(request); |
| request.msg.rtgen_family = AF_UNSPEC; // All families. |
| return (TEMP_FAILURE_RETRY(send(fd_, &request, sizeof(request), 0)) == sizeof(request)); |
| } |
| |
| bool NetlinkConnection::ReadResponses(void callback(void*, nlmsghdr*), void* context) { |
| // Read through all the responses, handing interesting ones to the callback. |
| ssize_t bytes_read; |
| while ((bytes_read = TEMP_FAILURE_RETRY(recv(fd_, data_, size_, 0))) > 0) { |
| nlmsghdr* hdr = reinterpret_cast<nlmsghdr*>(data_); |
| for (; NLMSG_OK(hdr, static_cast<size_t>(bytes_read)); hdr = NLMSG_NEXT(hdr, bytes_read)) { |
| if (hdr->nlmsg_type == NLMSG_DONE) return true; |
| if (hdr->nlmsg_type == NLMSG_ERROR) { |
| nlmsgerr* err = reinterpret_cast<nlmsgerr*>(NLMSG_DATA(hdr)); |
| errno = (hdr->nlmsg_len >= NLMSG_LENGTH(sizeof(nlmsgerr))) ? -err->error : EIO; |
| return false; |
| } |
| callback(context, hdr); |
| } |
| } |
| |
| // We only get here if recv fails before we see a NLMSG_DONE. |
| return false; |
| } |