s3:tldap: simplify read_ldap_more() by using asn1_peek_full_tag()
[samba.git] / source3 / lib / addrchange.c
1 /*
2  * Samba Unix/Linux SMB client library
3  * Copyright (C) Volker Lendecke 2011
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation; either version 3 of the License, or
8  * (at your option) any later version.
9  *
10  * This program is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  * GNU General Public License for more details.
14  *
15  * You should have received a copy of the GNU General Public License
16  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
17  */
18
19 #include "includes.h"
20 #include "lib/addrchange.h"
21 #include "../lib/util/tevent_ntstatus.h"
22
23 #ifdef HAVE_LINUX_RTNETLINK_H
24
25 #include "asm/types.h"
26 #include "linux/netlink.h"
27 #include "linux/rtnetlink.h"
28 #include "lib/tsocket/tsocket.h"
29
30 struct addrchange_context {
31         struct tdgram_context *sock;
32 };
33
34 NTSTATUS addrchange_context_create(TALLOC_CTX *mem_ctx,
35                                    struct addrchange_context **pctx)
36 {
37         struct addrchange_context *ctx;
38         struct sockaddr_nl addr;
39         NTSTATUS status;
40         int sock = -1;
41         int res;
42         bool ok;
43
44         ctx = talloc(mem_ctx, struct addrchange_context);
45         if (ctx == NULL) {
46                 return NT_STATUS_NO_MEMORY;
47         }
48
49         sock = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
50         if (sock == -1) {
51                 status = map_nt_error_from_unix(errno);
52                 goto fail;
53         }
54
55         ok = smb_set_close_on_exec(sock);
56         if (!ok) {
57                 status = map_nt_error_from_unix(errno);
58                 goto fail;
59         }
60
61         res = set_blocking(sock, false);
62         if (res == -1) {
63                 status = map_nt_error_from_unix(errno);
64                 goto fail;
65         }
66
67         /*
68          * We're interested in address changes
69          */
70         ZERO_STRUCT(addr);
71         addr.nl_family = AF_NETLINK;
72         addr.nl_groups = RTMGRP_IPV6_IFADDR | RTMGRP_IPV4_IFADDR;
73
74         res = bind(sock, (struct sockaddr *)(void *)&addr, sizeof(addr));
75         if (res == -1) {
76                 status = map_nt_error_from_unix(errno);
77                 goto fail;
78         }
79
80         res = tdgram_bsd_existing_socket(ctx, sock, &ctx->sock);
81         if (res == -1) {
82                 status = map_nt_error_from_unix(errno);
83                 goto fail;
84         }
85
86         *pctx = ctx;
87         return NT_STATUS_OK;
88 fail:
89         if (sock != -1) {
90                 close(sock);
91         }
92         TALLOC_FREE(ctx);
93         return status;
94 }
95
96 struct addrchange_state {
97         struct tevent_context *ev;
98         struct addrchange_context *ctx;
99         uint8_t *buf;
100         struct tsocket_address *fromaddr;
101
102         enum addrchange_type type;
103         struct sockaddr_storage addr;
104         uint32_t if_index;
105 };
106
107 static void addrchange_done(struct tevent_req *subreq);
108
109 struct tevent_req *addrchange_send(TALLOC_CTX *mem_ctx,
110                                    struct tevent_context *ev,
111                                    struct addrchange_context *ctx)
112 {
113         struct tevent_req *req, *subreq;
114         struct addrchange_state *state;
115
116         req = tevent_req_create(mem_ctx, &state, struct addrchange_state);
117         if (req == NULL) {
118                 return NULL;
119         }
120         state->ev = ev;
121         state->ctx = ctx;
122
123         subreq = tdgram_recvfrom_send(state, state->ev, state->ctx->sock);
124         if (tevent_req_nomem(subreq, req)) {
125                 return tevent_req_post(req, state->ev);
126         }
127         tevent_req_set_callback(subreq, addrchange_done, req);
128         return req;
129 }
130
131 static void addrchange_done(struct tevent_req *subreq)
132 {
133         struct tevent_req *req = tevent_req_callback_data(
134                 subreq, struct tevent_req);
135         struct addrchange_state *state = tevent_req_data(
136                 req, struct addrchange_state);
137         union {
138                 struct sockaddr sa;
139                 struct sockaddr_nl nl;
140                 struct sockaddr_storage ss;
141         } fromaddr;
142         struct nlmsghdr *h;
143         struct ifaddrmsg *ifa;
144         struct rtattr *rta;
145         ssize_t received;
146         int len;
147         int err;
148         bool found;
149
150         received = tdgram_recvfrom_recv(subreq, &err, state,
151                                         &state->buf,
152                                         &state->fromaddr);
153         TALLOC_FREE(subreq);
154         if (received == -1) {
155                 DEBUG(10, ("tdgram_recvfrom_recv returned %s\n", strerror(err)));
156                 tevent_req_nterror(req, map_nt_error_from_unix(err));
157                 return;
158         }
159         len = tsocket_address_bsd_sockaddr(state->fromaddr,
160                                            &fromaddr.sa,
161                                            sizeof(fromaddr));
162
163         if ((len != sizeof(fromaddr.nl) ||
164             fromaddr.sa.sa_family != AF_NETLINK))
165         {
166                 DEBUG(10, ("Got message from wrong addr\n"));
167                 goto retry;
168         }
169
170         if (fromaddr.nl.nl_pid != 0) {
171                 DEBUG(10, ("Got msg from pid %d, not from the kernel\n",
172                            (int)fromaddr.nl.nl_pid));
173                 goto retry;
174         }
175
176         if (received < sizeof(struct nlmsghdr)) {
177                 DEBUG(10, ("received %d, expected at least %d\n",
178                            (int)received, (int)sizeof(struct nlmsghdr)));
179                 goto retry;
180         }
181
182         h = (struct nlmsghdr *)state->buf;
183         if (h->nlmsg_len < sizeof(struct nlmsghdr)) {
184                 DEBUG(10, ("nlmsg_len=%d, expected at least %d\n",
185                            (int)h->nlmsg_len, (int)sizeof(struct nlmsghdr)));
186                 goto retry;
187         }
188         if (h->nlmsg_len > received) {
189                 DEBUG(10, ("nlmsg_len=%d, expected at most %d\n",
190                            (int)h->nlmsg_len, (int)received));
191                 goto retry;
192         }
193         switch (h->nlmsg_type) {
194         case RTM_NEWADDR:
195                 state->type = ADDRCHANGE_ADD;
196                 break;
197         case RTM_DELADDR:
198                 state->type = ADDRCHANGE_DEL;
199                 break;
200         default:
201                 DEBUG(10, ("Got unexpected type %d - ignoring\n", h->nlmsg_type));
202                 goto retry;
203         }
204
205         if (h->nlmsg_len < sizeof(struct nlmsghdr)+sizeof(struct ifaddrmsg)) {
206                 DEBUG(10, ("nlmsg_len=%d, expected at least %d\n",
207                            (int)h->nlmsg_len,
208                            (int)(sizeof(struct nlmsghdr)
209                                  +sizeof(struct ifaddrmsg))));
210                 tevent_req_nterror(req, NT_STATUS_UNEXPECTED_IO_ERROR);
211                 return;
212         }
213
214         ifa = (struct ifaddrmsg *)NLMSG_DATA(h);
215
216         state->addr.ss_family = ifa->ifa_family;
217         state->if_index = ifa->ifa_index;
218
219         len = h->nlmsg_len - sizeof(struct nlmsghdr) + sizeof(struct ifaddrmsg);
220
221         found = false;
222
223         for (rta = IFA_RTA(ifa); RTA_OK(rta, len); rta = RTA_NEXT(rta, len)) {
224
225                 if ((rta->rta_type != IFA_LOCAL)
226                     && (rta->rta_type != IFA_ADDRESS)) {
227                         continue;
228                 }
229
230                 switch (ifa->ifa_family) {
231                 case AF_INET: {
232                         struct sockaddr_in *v4_addr;
233                         v4_addr = (struct sockaddr_in *)(void *)&state->addr;
234
235                         if (RTA_PAYLOAD(rta) != sizeof(uint32_t)) {
236                                 continue;
237                         }
238                         v4_addr->sin_addr.s_addr = *(uint32_t *)RTA_DATA(rta);
239                         found = true;
240                         break;
241                 }
242                 case AF_INET6: {
243                         struct sockaddr_in6 *v6_addr;
244                         v6_addr = (struct sockaddr_in6 *)(void *)&state->addr;
245
246                         if (RTA_PAYLOAD(rta) !=
247                             sizeof(v6_addr->sin6_addr.s6_addr)) {
248                                 continue;
249                         }
250                         memcpy(v6_addr->sin6_addr.s6_addr, RTA_DATA(rta),
251                                sizeof(v6_addr->sin6_addr.s6_addr));
252                         found = true;
253                         break;
254                 }
255                 }
256         }
257
258         if (!found) {
259                 tevent_req_nterror(req, NT_STATUS_INVALID_ADDRESS);
260                 return;
261         }
262
263         tevent_req_done(req);
264         return;
265
266 retry:
267         TALLOC_FREE(state->buf);
268         TALLOC_FREE(state->fromaddr);
269
270         subreq = tdgram_recvfrom_send(state, state->ev, state->ctx->sock);
271         if (tevent_req_nomem(subreq, req)) {
272                 return;
273         }
274         tevent_req_set_callback(subreq, addrchange_done, req);
275 }
276
277 NTSTATUS addrchange_recv(struct tevent_req *req,
278                          enum addrchange_type *type,
279                          struct sockaddr_storage *addr,
280                          uint32_t *if_index)
281 {
282         struct addrchange_state *state = tevent_req_data(
283                 req, struct addrchange_state);
284         NTSTATUS status;
285
286         if (tevent_req_is_nterror(req, &status)) {
287                 tevent_req_received(req);
288                 return status;
289         }
290
291         *type = state->type;
292         *addr = state->addr;
293         if (if_index != NULL) {
294                 *if_index = state->if_index;
295         }
296         tevent_req_received(req);
297         return NT_STATUS_OK;
298 }
299
300 #else
301
302 NTSTATUS addrchange_context_create(TALLOC_CTX *mem_ctx,
303                                    struct addrchange_context **pctx)
304 {
305         return NT_STATUS_NOT_SUPPORTED;
306 }
307
308 struct tevent_req *addrchange_send(TALLOC_CTX *mem_ctx,
309                                    struct tevent_context *ev,
310                                    struct addrchange_context *ctx)
311 {
312         return NULL;
313 }
314
315 NTSTATUS addrchange_recv(struct tevent_req *req, enum addrchange_type *type,
316                          struct sockaddr_storage *addr, uint32_t *if_index)
317 {
318         return NT_STATUS_NOT_IMPLEMENTED;
319 }
320
321 #endif