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 int family_id; 77 78 ifconfig_error_clear(h); 79 80 if (! snl_init(&ss, NETLINK_GENERIC)) { 81 ifconfig_error(h, NETLINK, ENOTSUP); 82 return (-1); 83 } 84 85 snl_init_writer(&ss, &nw); 86 87 family_id = snl_get_genl_family(&ss, CARP_NL_FAMILY_NAME); 88 if (family_id == 0) { 89 ifconfig_error(h, NETLINK, EPROTONOSUPPORT); 90 goto out; 91 } 92 93 hdr = snl_create_genl_msg_request(&nw, family_id, CARP_NL_CMD_GET); 94 hdr->nlmsg_flags |= NLM_F_DUMP; 95 96 snl_add_msg_attr_string(&nw, CARP_NL_IFNAME, name); 97 98 if (vhid != 0) 99 snl_add_msg_attr_u32(&nw, CARP_NL_VHID, vhid); 100 101 hdr = snl_finalize_msg(&nw); 102 if (hdr == NULL) { 103 ifconfig_error(h, NETLINK, ENOMEM); 104 goto out; 105 } 106 seq_id = hdr->nlmsg_seq; 107 if (! snl_send_message(&ss, hdr)) { 108 ifconfig_error(h, NETLINK, EIO); 109 goto out; 110 } 111 112 while ((hdr = snl_read_reply_multi(&ss, seq_id, &e)) != NULL) { 113 if (e.error != 0) { 114 ifconfig_error(h, NETLINK, e.error); 115 break; 116 } 117 118 if (i >= ncarp) { 119 ifconfig_error(h, NETLINK, E2BIG); 120 break; 121 } 122 123 memset(&carp[i], 0, sizeof(carp[0])); 124 if (! snl_parse_nlmsg(&ss, hdr, &carp_get_parser, &carp[i])) 125 continue; 126 127 i++; 128 carp[0].carpr_count = i; 129 130 if (i > ncarp) { 131 ifconfig_error(h, NETLINK, E2BIG); 132 break; 133 } 134 } 135 136 out: 137 snl_free(&ss); 138 139 return (h->error.errcode ? -1 : 0); 140 } 141 142 int 143 ifconfig_carp_set_info(ifconfig_handle_t *h, const char *name, 144 const struct ifconfig_carp *carpr) 145 { 146 struct snl_state ss = {}; 147 struct snl_writer nw; 148 struct nlmsghdr *hdr; 149 int family_id; 150 uint32_t seq_id; 151 152 ifconfig_error_clear(h); 153 154 if (! snl_init(&ss, NETLINK_GENERIC)) { 155 ifconfig_error(h, NETLINK, ENOTSUP); 156 return (-1); 157 } 158 159 snl_init_writer(&ss, &nw); 160 161 family_id = snl_get_genl_family(&ss, CARP_NL_FAMILY_NAME); 162 if (family_id == 0) { 163 ifconfig_error(h, NETLINK, EPROTONOSUPPORT); 164 return (-1); 165 } 166 hdr = snl_create_genl_msg_request(&nw, family_id, CARP_NL_CMD_SET); 167 168 snl_add_msg_attr_u32(&nw, CARP_NL_VHID, carpr->carpr_vhid); 169 snl_add_msg_attr_u32(&nw, CARP_NL_STATE, carpr->carpr_state); 170 snl_add_msg_attr_s32(&nw, CARP_NL_ADVBASE, carpr->carpr_advbase); 171 snl_add_msg_attr_s32(&nw, CARP_NL_ADVSKEW, carpr->carpr_advskew); 172 snl_add_msg_attr_string(&nw, CARP_NL_IFNAME, name); 173 snl_add_msg_attr(&nw, CARP_NL_ADDR, sizeof(carpr->carpr_addr), 174 &carpr->carpr_addr); 175 snl_add_msg_attr(&nw, CARP_NL_ADDR6, sizeof(carpr->carpr_addr6), 176 &carpr->carpr_addr6); 177 178 hdr = snl_finalize_msg(&nw); 179 if (hdr == NULL) { 180 ifconfig_error(h, NETLINK, ENOMEM); 181 goto out; 182 } 183 184 seq_id = hdr->nlmsg_seq; 185 if (! snl_send_message(&ss, hdr)) { 186 ifconfig_error(h, NETLINK, EIO); 187 goto out; 188 } 189 190 struct snl_errmsg_data e = { }; 191 if (! snl_read_reply_code(&ss, seq_id, &e)) 192 ifconfig_error(h, NETLINK, e.error); 193 194 out: 195 snl_free(&ss); 196 197 return (h->error.errcode ? -1 : 0); 198 } 199 200 int 201 ifconfig_carp_get_vhid(ifconfig_handle_t *h, const char *name, 202 struct ifconfig_carp *carp, uint32_t vhid) 203 { 204 return (_ifconfig_carp_get(h, name, carp, 1, vhid)); 205 } 206 207 int 208 ifconfig_carp_get_info(ifconfig_handle_t *h, const char *name, 209 struct ifconfig_carp *carp, size_t ncarp) 210 { 211 return (_ifconfig_carp_get(h, name, carp, ncarp, 0)); 212 } 213