1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
// Copyright (C) 2020 - Will Glozer. All rights reserved.

use std::net::UdpSocket;
use std::os::raw::c_int;
use std::os::unix::io::{AsRawFd, FromRawFd, RawFd};
use errno::errno;
use libc::{AF_NETLINK, SOCK_DGRAM};
use crate::{Family, Message, Netlink, Result};
use crate::sys::{write, Bytes};
use super::{bind, buffer::{Buffer, Either}};
use super::option::{list_memberships, getsockopt, setsockopt, Level, Name, Opt};

pub struct Socket {
    sock:  UdpSocket,
    read:  Buffer,
    write: Vec<u8>,
}

impl Socket {
    pub fn new(family: Family) -> Result<Self> {
        Ok(Self {
            sock:  socket(family)?,
            read:  Buffer::new(),
            write: vec![0u8; 4096],
        })
    }

    pub fn bind(&self, pid: u32, groups: u32) -> Result<()> {
        bind(&self.sock, pid, groups)
    }

    pub fn send<T: Bytes>(&mut self, msg: &Message<T>) -> Result<usize> {
        let bytes = write(&mut self.write, msg)?;
        Ok(self.sock.send(bytes)?)
    }

    pub fn recv<T: Bytes>(&mut self) -> Result<Netlink<Message<T>>> {
        let sock = &mut self.sock;
        let read = &mut self.read;
        loop {
            let n = match unsafe { read.next() }? {
                Either::A(msg) => return Ok(msg),
                Either::B(buf) => sock.recv(buf)?,
            };
            read.provide(n);
        }
    }

    pub fn add_membership(&self, group: c_int) -> Result<()> {
        self.set_sockopt(Level::NETLINK, Name::NETLINK_ADD_MEMBERSHIP, &group)
    }

    pub fn drop_membership(&self, group: c_int) -> Result<()> {
        self.set_sockopt(Level::NETLINK, Name::NETLINK_DROP_MEMBERSHIP, &group)
    }

    pub fn list_memberships(&self) -> Result<Vec<u32>> {
        Ok(list_memberships(&self.sock)?)
    }

    pub fn get_sockopt<O: Opt>(&self, level: Level, name: Name) -> Result<O> {
        getsockopt(&self.sock, level, name)
    }

    pub fn set_sockopt<O: Opt>(&self, level: Level, name: Name, value: &O) -> Result<()> {
        setsockopt(&self.sock, level, name, value)
    }
}

pub fn socket(family: Family) -> Result<UdpSocket> {
    unsafe {
        match libc::socket(AF_NETLINK, SOCK_DGRAM, family.into()) {
            -1 => Err(errno().into()),
            fd => Ok(UdpSocket::from_raw_fd(fd)),
        }
    }
}

impl AsRawFd for Socket {
    fn as_raw_fd(&self) -> RawFd {
        self.sock.as_raw_fd()
    }
}