lib/libifconfig/libifconfig_carp.c

   1 /*
   2  * Copyright (c) 1983, 1993
   3  *  The Regents of the University of California.  All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  * 3. Neither the name of the University nor the names of its contributors
  14  *    may be used to endorse or promote products derived from this software
  15  *    without specific prior written permission.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  27  * SUCH DAMAGE.
  28  *
  29  * $FreeBSD$
  30  */
  31 #include <sys/param.h>
  32 #include <sys/ioctl.h>
  33
  34 #include <net/if.h>
  35 #include <netinet/ip_carp.h>
  36 #include <netinet/ip_carp_nl.h>
  37
  38 #include <netlink/netlink.h>
  39 #include <netlink/netlink_generic.h>
  40 #include <netlink/netlink_snl.h>
  41 #include <netlink/netlink_snl_generic.h>
  42 #include <netlink/netlink_snl_route.h>
  43
  44 #include <string.h>
  45 #include <strings.h>
  46
  47 #include "libifconfig.h"
  48 #include "libifconfig_internal.h"
  49
  50 #include <stdio.h>
  51
  52 #define _OUT(_field)    offsetof(struct ifconfig_carp, _field)
  53 static struct snl_attr_parser ap_carp_get[] = {
  54         { .type = CARP_NL_VHID, .off = _OUT(carpr_vhid), .cb = snl_attr_get_uint32 },
  55         { .type = CARP_NL_STATE, .off = _OUT(carpr_state), .cb = snl_attr_get_uint32 },
  56         { .type = CARP_NL_ADVBASE, .off = _OUT(carpr_advbase), .cb = snl_attr_get_int32 },
  57         { .type = CARP_NL_ADVSKEW, .off = _OUT(carpr_advskew), .cb = snl_attr_get_int32 },
  58         { .type = CARP_NL_KEY, .off = _OUT(carpr_key), .cb = snl_attr_get_string },
  59         { .type = CARP_NL_ADDR, .off = _OUT(carpr_addr), .cb = snl_attr_get_in_addr },
  60         { .type = CARP_NL_ADDR6, .off = _OUT(carpr_addr6), .cb = snl_attr_get_in6_addr },
  61 };
  62 #undef _OUT
  63
  64 SNL_DECLARE_GENL_PARSER(carp_get_parser, ap_carp_get);
  65
  66 static int
  67 _ifconfig_carp_get(ifconfig_handle_t *h, const char *name,
  68     struct ifconfig_carp *carp, size_t ncarp, uint32_t vhid)
  69 {
  70         struct snl_state ss = {};
  71         struct snl_errmsg_data e = {};
  72         struct snl_writer nw;
  73         struct nlmsghdr *hdr;
  74         size_t i = 0;
  75         uint32_t seq_id;
  76         unsigned int ifindex;
  77         int family_id;
  78
  79         ifconfig_error_clear(h);
  80
  81         ifindex = if_nametoindex(name);
  82         if (ifindex == 0) {
  83                 ifconfig_error(h, NETLINK, ENOENT);
  84                 return (-1);
  85         }
  86
  87         if (! snl_init(&ss, NETLINK_GENERIC)) {
  88                 ifconfig_error(h, NETLINK, ENOTSUP);
  89                 return (-1);
  90         }
  91
  92         snl_init_writer(&ss, &nw);
  93
  94         family_id = snl_get_genl_family(&ss, CARP_NL_FAMILY_NAME);
  95         if (family_id == 0) {
  96                 ifconfig_error(h, NETLINK, EPROTONOSUPPORT);
  97                 goto out;
  98         }
  99
 100         hdr = snl_create_genl_msg_request(&nw, family_id, CARP_NL_CMD_GET);
 101         hdr->nlmsg_flags |= NLM_F_DUMP;
 102
 103         snl_add_msg_attr_u32(&nw, CARP_NL_IFINDEX, ifindex);
 104
 105         if (vhid != 0)
 106                 snl_add_msg_attr_u32(&nw, CARP_NL_VHID, vhid);
 107
 108         hdr = snl_finalize_msg(&nw);
 109         if (hdr == NULL) {
 110                 ifconfig_error(h, NETLINK, ENOMEM);
 111                 goto out;
 112         }
 113         seq_id = hdr->nlmsg_seq;
 114         if (! snl_send_message(&ss, hdr)) {
 115                 ifconfig_error(h, NETLINK, EIO);
 116                 goto out;
 117         }
 118
 119         while ((hdr = snl_read_reply_multi(&ss, seq_id, &e)) != NULL) {
 120                 if (e.error != 0) {
 121                         ifconfig_error(h, NETLINK, e.error);
 122                         break;
 123                 }
 124
 125                 if (i >= ncarp) {
 126                         ifconfig_error(h, NETLINK, E2BIG);
 127                         break;
 128                 }
 129
 130                 memset(&carp[i], 0, sizeof(carp[0]));
 131                 if (! snl_parse_nlmsg(&ss, hdr, &carp_get_parser, &carp[i]))
 132                         continue;
 133
 134                 i++;
 135                 carp[0].carpr_count = i;
 136
 137                 if (i > ncarp) {
 138                         ifconfig_error(h, NETLINK, E2BIG);
 139                         break;
 140                 }
 141         }
 142
 143 out:
 144         snl_free(&ss);
 145
 146         return (h->error.errcode ? -1 : 0);
 147 }
 148
 149 int
 150 ifconfig_carp_set_info(ifconfig_handle_t *h, const char *name,
 151     const struct ifconfig_carp *carpr)
 152 {
 153         struct snl_state ss = {};
 154         struct snl_writer nw;
 155         struct nlmsghdr *hdr;
 156         unsigned int ifindex;
 157         int family_id;
 158         uint32_t seq_id;
 159
 160         ifconfig_error_clear(h);
 161
 162         ifindex = if_nametoindex(name);
 163         if (ifindex == 0) {
 164                 ifconfig_error(h, NETLINK, ENOENT);
 165                 return (-1);
 166         }
 167
 168         if (! snl_init(&ss, NETLINK_GENERIC)) {
 169                 ifconfig_error(h, NETLINK, ENOTSUP);
 170                 return (-1);
 171         }
 172
 173         snl_init_writer(&ss, &nw);
 174
 175         family_id = snl_get_genl_family(&ss, CARP_NL_FAMILY_NAME);
 176         if (family_id == 0) {
 177                 ifconfig_error(h, NETLINK, EPROTONOSUPPORT);
 178                 return (-1);
 179         }
 180         hdr = snl_create_genl_msg_request(&nw, family_id, CARP_NL_CMD_SET);
 181
 182         snl_add_msg_attr_u32(&nw, CARP_NL_VHID, carpr->carpr_vhid);
 183         snl_add_msg_attr_u32(&nw, CARP_NL_STATE, carpr->carpr_state);
 184         snl_add_msg_attr_s32(&nw, CARP_NL_ADVBASE, carpr->carpr_advbase);
 185         snl_add_msg_attr_s32(&nw, CARP_NL_ADVSKEW, carpr->carpr_advskew);
 186         snl_add_msg_attr_u32(&nw, CARP_NL_IFINDEX, ifindex);
 187         snl_add_msg_attr(&nw, CARP_NL_ADDR, sizeof(carpr->carpr_addr),
 188             &carpr->carpr_addr);
 189         snl_add_msg_attr(&nw, CARP_NL_ADDR6, sizeof(carpr->carpr_addr6),
 190             &carpr->carpr_addr6);
 191
 192         hdr = snl_finalize_msg(&nw);
 193         if (hdr == NULL) {
 194                 ifconfig_error(h, NETLINK, ENOMEM);
 195                 goto out;
 196         }
 197
 198         seq_id = hdr->nlmsg_seq;
 199         if (! snl_send_message(&ss, hdr)) {
 200                 ifconfig_error(h, NETLINK, EIO);
 201                 goto out;
 202         }
 203
 204         struct snl_errmsg_data e = { };
 205         if (! snl_read_reply_code(&ss, seq_id, &e))
 206                 ifconfig_error(h, NETLINK, e.error);
 207
 208 out:
 209         snl_free(&ss);
 210
 211         return (h->error.errcode ? -1 : 0);
 212 }
 213
 214 int
 215 ifconfig_carp_get_vhid(ifconfig_handle_t *h, const char *name,
 216     struct ifconfig_carp *carp, uint32_t vhid)
 217 {
 218         return (_ifconfig_carp_get(h, name, carp, 1, vhid));
 219 }
 220
 221 int
 222 ifconfig_carp_get_info(ifconfig_handle_t *h, const char *name,
 223     struct ifconfig_carp *carp, size_t ncarp)
 224 {
 225         return (_ifconfig_carp_get(h, name, carp, ncarp, 0));
 226 }