/* Copyright 2019 by sysmocom s.f.m.c. GmbH * * All Rights Reserved * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU Affero General Public License as published by * the Free Software Foundation; either version 3 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU Affero General Public License for more details. * * You should have received a copy of the GNU Affero General Public License * along with this program. If not, see . * */ #include #include #include #include #include #include #include #include static void osmo_mslookup_server_mdns_tx(struct osmo_mslookup_server_mdns *server, uint16_t packet_id, const struct osmo_mslookup_query *query, const struct osmo_mslookup_result *result) { struct msgb *msg; const char *errmsg = NULL; void *ctx = talloc_named_const(server, 0, __func__); msg = osmo_mdns_result_encode(ctx, packet_id, query, result, server->domain_suffix); if (!msg) errmsg = "Error encoding mDNS answer packet"; else if (osmo_mdns_sock_send(server->sock, msg)) errmsg = "Error sending mDNS answer"; if (errmsg) LOGP(DMSLOOKUP, LOGL_ERROR, "%s: mDNS: %s\n", osmo_mslookup_result_name_c(ctx, query, result), errmsg); talloc_free(ctx); } static void osmo_mslookup_server_mdns_handle_request(uint16_t packet_id, struct osmo_mslookup_server_mdns *server, const struct osmo_mslookup_query *query) { struct osmo_mslookup_result result; mslookup_server_rx(query, &result); /* Error logging already happens in mslookup_server_rx() */ if (result.rc != OSMO_MSLOOKUP_RC_RESULT) return; osmo_mslookup_server_mdns_tx(server, packet_id, query, &result); } static int osmo_mslookup_server_mdns_rx(struct osmo_fd *osmo_fd, unsigned int what) { struct osmo_mslookup_server_mdns *server = osmo_fd->data; struct osmo_mslookup_query *query; uint16_t packet_id; int n; uint8_t buffer[1024]; void *ctx; /* Parse the message and print it */ n = read(osmo_fd->fd, buffer, sizeof(buffer)); if (n <= 0) return n; ctx = talloc_named_const(server, 0, __func__); query = osmo_mdns_query_decode(ctx, buffer, n, &packet_id, server->domain_suffix); if (!query) { talloc_free(ctx); return -1; } osmo_mslookup_id_name_buf((char *)buffer, sizeof(buffer), &query->id); LOGP(DMSLOOKUP, LOGL_DEBUG, "mDNS rx request: %s.%s\n", query->service, buffer); osmo_mslookup_server_mdns_handle_request(packet_id, server, query); talloc_free(ctx); return n; } struct osmo_mslookup_server_mdns *osmo_mslookup_server_mdns_start(void *ctx, const struct osmo_sockaddr_str *bind_addr, const char *domain_suffix) { struct osmo_mslookup_server_mdns *server = talloc_zero(ctx, struct osmo_mslookup_server_mdns); OSMO_ASSERT(server); *server = (struct osmo_mslookup_server_mdns){ .bind_addr = *bind_addr, .domain_suffix = talloc_strdup(server, domain_suffix) }; server->sock = osmo_mdns_sock_init(server, bind_addr->ip, bind_addr->port, osmo_mslookup_server_mdns_rx, server, 0); if (!server->sock) { LOGP(DMSLOOKUP, LOGL_ERROR, "mslookup mDNS server: error initializing multicast bind on " OSMO_SOCKADDR_STR_FMT "\n", OSMO_SOCKADDR_STR_FMT_ARGS(bind_addr)); talloc_free(server); return NULL; } return server; } void osmo_mslookup_server_mdns_stop(struct osmo_mslookup_server_mdns *server) { if (!server) return; osmo_mdns_sock_cleanup(server->sock); talloc_free(server); } void mslookup_server_mdns_config_apply() { /* Check whether to start/stop/restart mDNS server */ bool should_run; bool should_stop; should_run = g_hlr->mslookup.allow_startup && g_hlr->mslookup.server.enable && g_hlr->mslookup.server.mdns.enable; should_stop = g_hlr->mslookup.server.mdns.running && (!should_run || osmo_sockaddr_str_cmp(&g_hlr->mslookup.server.mdns.bind_addr, &g_hlr->mslookup.server.mdns.running->bind_addr) || strcmp(g_hlr->mslookup.server.mdns.domain_suffix, g_hlr->mslookup.server.mdns.running->domain_suffix)); if (should_stop) { osmo_mslookup_server_mdns_stop(g_hlr->mslookup.server.mdns.running); g_hlr->mslookup.server.mdns.running = NULL; LOGP(DMSLOOKUP, LOGL_NOTICE, "Stopped mslookup mDNS server\n"); } if (should_run && !g_hlr->mslookup.server.mdns.running) { g_hlr->mslookup.server.mdns.running = osmo_mslookup_server_mdns_start(g_hlr, &g_hlr->mslookup.server.mdns.bind_addr, g_hlr->mslookup.server.mdns.domain_suffix); if (!g_hlr->mslookup.server.mdns.running) LOGP(DMSLOOKUP, LOGL_ERROR, "Failed to start mslookup mDNS server on " OSMO_SOCKADDR_STR_FMT "\n", OSMO_SOCKADDR_STR_FMT_ARGS(&g_hlr->mslookup.server.mdns.bind_addr)); else LOGP(DMSLOOKUP, LOGL_NOTICE, "Started mslookup mDNS server, receiving mDNS requests at multicast " OSMO_SOCKADDR_STR_FMT "\n", OSMO_SOCKADDR_STR_FMT_ARGS(&g_hlr->mslookup.server.mdns.running->bind_addr)); } }