6 #include <netinet/in.h>
10 #include "interface-ip.h"
23 static const struct blobmsg_policy static_attrs[__OPT_MAX] = {
24 [OPT_IPADDR] = { .name = "ipaddr", .type = BLOBMSG_TYPE_ARRAY },
25 [OPT_IP6ADDR] = { .name = "ip6addr", .type = BLOBMSG_TYPE_ARRAY },
26 [OPT_NETMASK] = { .name = "netmask", .type = BLOBMSG_TYPE_STRING },
27 [OPT_GATEWAY] = { .name = "gateway", .type = BLOBMSG_TYPE_STRING },
28 [OPT_IP6GW] = { .name = "ip6gw", .type = BLOBMSG_TYPE_STRING },
31 static const union config_param_info static_attr_info[__OPT_MAX] = {
32 [OPT_IPADDR] = { .type = BLOBMSG_TYPE_STRING },
33 [OPT_IP6ADDR] = { .type = BLOBMSG_TYPE_STRING },
36 static const struct config_param_list static_attr_list = {
37 .n_params = __OPT_MAX,
38 .params = static_attrs,
39 .info = static_attr_info,
42 struct static_proto_state {
43 struct interface_proto_state proto;
45 struct blob_attr *config;
49 split_netmask(char *str, unsigned int *netmask)
51 char *delim, *err = NULL;
53 delim = strchr(str, '/');
57 *netmask = strtoul(delim, &err, 10);
65 parse_ip_and_netmask(int af, const char *str, void *addr, unsigned int *netmask)
67 char *astr = alloca(strlen(str) + 1);
70 if (!split_netmask(astr, netmask))
81 return inet_pton(af, str, addr);
85 parse_addr(struct interface_proto_state *state, const char *str, bool v6, int mask)
87 struct device_addr *addr;
88 int af = v6 ? AF_INET6 : AF_INET;
90 addr = calloc(1, sizeof(*addr));
91 addr->flags = v6 ? DEVADDR_INET6 : DEVADDR_INET4;
93 if (!parse_ip_and_netmask(af, str, &addr->addr, &addr->mask)) {
94 interface_add_error(state->iface, "proto-static", "INVALID_ADDRESS", &str, 1);
98 vlist_add(&state->iface->proto_addr, &addr->node);
103 parse_address_option(struct interface_proto_state *state, struct blob_attr *attr, bool v6, int netmask)
105 struct blob_attr *cur;
109 blobmsg_for_each_attr(cur, attr, rem) {
111 if (!parse_addr(state, blobmsg_data(cur), v6, netmask))
119 parse_gateway_option(struct interface_proto_state *state, struct blob_attr *attr, bool v6)
121 struct device_route *route;
122 const char *str = blobmsg_data(attr);
123 int af = v6 ? AF_INET6 : AF_INET;
125 route = calloc(1, sizeof(*route));
126 if (!inet_pton(af, str, &route->nexthop)) {
127 interface_add_error(state->iface, "proto-static",
128 "INVALID_GATEWAY", &str, 1);
133 route->flags = DEVADDR_DEVICE | (v6 ? DEVADDR_INET6 : DEVADDR_INET4);
134 vlist_add(&state->iface->proto_route, &route->node);
140 proto_apply_static_settings(struct interface_proto_state *state, struct blob_attr *attr)
142 struct blob_attr *tb[__OPT_MAX];
146 int n_v4 = 0, n_v6 = 0;
148 blobmsg_parse(static_attrs, __OPT_MAX, tb, blob_data(attr), blob_len(attr));
150 if (tb[OPT_NETMASK]) {
151 if (!inet_aton(blobmsg_data(tb[OPT_NETMASK]), &ina)) {
152 error = "INVALID_NETMASK";
156 netmask = 32 - fls(~(ntohl(ina.s_addr)));
160 n_v4 = parse_address_option(state, tb[OPT_IPADDR], false, netmask);
163 n_v6 = parse_address_option(state, tb[OPT_IP6ADDR], true, netmask);
165 if (!n_v4 && !n_v6) {
166 error = "NO_ADDRESS";
170 if (n_v4 < 0 || n_v6 < 0)
173 if (n_v4 && tb[OPT_GATEWAY]) {
174 if (!parse_gateway_option(state, tb[OPT_GATEWAY], false))
178 if (n_v6 && tb[OPT_IP6GW]) {
179 if (!parse_gateway_option(state, tb[OPT_IP6GW], true))
186 interface_add_error(state->iface, "proto-static", error, NULL, 0);
192 static_proto_setup(struct static_proto_state *state)
194 return proto_apply_static_settings(&state->proto, state->config) == 0;
198 static_handler(struct interface_proto_state *proto,
199 enum interface_proto_cmd cmd, bool force)
201 struct static_proto_state *state;
204 state = container_of(proto, struct static_proto_state, proto);
207 case PROTO_CMD_SETUP:
208 if (static_proto_setup(state))
212 case PROTO_CMD_TEARDOWN:
219 static_free(struct interface_proto_state *proto)
221 struct static_proto_state *state;
223 state = container_of(proto, struct static_proto_state, proto);
228 struct interface_proto_state *
229 static_attach(const struct proto_handler *h, struct interface *iface,
230 struct blob_attr *attr)
232 struct static_proto_state *state;
234 state = calloc(1, sizeof(*state));
238 state->config = malloc(blob_pad_len(attr));
242 memcpy(state->config, attr, blob_pad_len(attr));
243 state->proto.free = static_free;
244 state->proto.handler = static_handler;
245 state->proto.flags = PROTO_FLAG_IMMEDIATE;
247 return &state->proto;
254 static struct proto_handler static_proto = {
256 .config_params = &static_attr_list,
257 .attach = static_attach,
261 static_proto_init(void)
263 add_proto_handler(&static_proto);