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
;
46 struct interface
*iface
;
50 split_netmask(char *str
, unsigned int *netmask
)
52 char *delim
, *err
= NULL
;
54 delim
= strchr(str
, '/');
58 *netmask
= strtoul(delim
, &err
, 10);
66 parse_ip_and_netmask(int af
, const char *str
, void *addr
, unsigned int *netmask
)
68 char *astr
= alloca(strlen(str
) + 1);
71 if (!split_netmask(astr
, netmask
))
82 return inet_pton(af
, str
, addr
);
86 parse_addr(struct static_proto_state
*state
, const char *str
, bool v6
, int mask
)
88 struct device_addr
*addr
;
89 int af
= v6
? AF_INET6
: AF_INET
;
91 addr
= calloc(1, sizeof(*addr
));
92 addr
->flags
= v6
? DEVADDR_INET6
: DEVADDR_INET4
;
95 if (!parse_ip_and_netmask(af
, str
, &addr
->addr
, &addr
->mask
)) {
96 interface_add_error(state
->iface
, "proto-static", "INVALID_ADDRESS", &str
, 1);
100 interface_add_address(state
->iface
, addr
);
105 parse_address_option(struct static_proto_state
*state
, struct blob_attr
*attr
, bool v6
, int netmask
)
107 struct blob_attr
*cur
;
111 blobmsg_for_each_attr(cur
, attr
, rem
) {
113 if (!parse_addr(state
, blobmsg_data(cur
), v6
, netmask
))
121 parse_gateway_option(struct static_proto_state
*state
, struct blob_attr
*attr
, bool v6
)
123 struct device_route
*route
;
124 const char *str
= blobmsg_data(attr
);
125 int af
= v6
? AF_INET6
: AF_INET
;
127 route
= calloc(1, sizeof(*route
));
128 if (!inet_pton(af
, str
, &route
->nexthop
)) {
129 interface_add_error(state
->iface
, "proto-static",
130 "INVALID_GATEWAY", &str
, 1);
135 route
->flags
= DEVADDR_DEVICE
| (v6
? DEVADDR_INET6
: DEVADDR_INET4
);
136 interface_add_route(state
->iface
, route
);
142 static_proto_setup(struct static_proto_state
*state
)
144 struct blob_attr
*tb
[__OPT_MAX
];
148 int n_v4
= 0, n_v6
= 0;
150 blobmsg_parse(static_attrs
, __OPT_MAX
, tb
, blob_data(state
->config
),
151 blob_len(state
->config
));
153 if (tb
[OPT_NETMASK
]) {
154 if (!inet_aton(blobmsg_data(tb
[OPT_NETMASK
]), &ina
)) {
155 error
= "INVALID_NETMASK";
159 netmask
= 32 - fls(~(ntohl(ina
.s_addr
)));
163 n_v4
= parse_address_option(state
, tb
[OPT_IPADDR
], false, netmask
);
166 n_v6
= parse_address_option(state
, tb
[OPT_IP6ADDR
], true, netmask
);
168 if (!n_v4
&& !n_v6
) {
169 error
= "NO_ADDRESS";
173 if (n_v4
< 0 || n_v6
< 0)
176 if (n_v4
&& tb
[OPT_GATEWAY
]) {
177 if (!parse_gateway_option(state
, tb
[OPT_GATEWAY
], false))
181 if (n_v6
&& tb
[OPT_IP6GW
]) {
182 if (!parse_gateway_option(state
, tb
[OPT_IP6GW
], true))
189 interface_add_error(state
->iface
, "proto-static", error
, NULL
, 0);
195 static_handler(struct interface_proto_state
*proto
,
196 enum interface_proto_cmd cmd
, bool force
)
198 struct static_proto_state
*state
;
201 state
= container_of(proto
, struct static_proto_state
, proto
);
204 case PROTO_CMD_SETUP
:
205 if (static_proto_setup(state
))
209 case PROTO_CMD_TEARDOWN
:
210 interface_del_ctx_addr(state
->iface
, state
);
217 static_free(struct interface_proto_state
*proto
)
219 struct static_proto_state
*state
;
221 state
= container_of(proto
, struct static_proto_state
, proto
);
226 struct interface_proto_state
*
227 static_attach(const struct proto_handler
*h
, struct interface
*iface
,
228 struct blob_attr
*attr
)
230 struct static_proto_state
*state
;
232 state
= calloc(1, sizeof(*state
));
236 state
->iface
= iface
;
237 state
->config
= malloc(blob_pad_len(attr
));
241 memcpy(state
->config
, attr
, blob_pad_len(attr
));
242 state
->proto
.free
= static_free
;
243 state
->proto
.handler
= static_handler
;
244 state
->proto
.flags
= PROTO_FLAG_IMMEDIATE
;
246 return &state
->proto
;
253 static struct proto_handler static_proto
= {
255 .config_params
= &static_attr_list
,
256 .attach
= static_attach
,
260 static_proto_init(void)
262 add_proto_handler(&static_proto
);