| /* OsmoSMLC cell locations configuration */ |
| /* |
| * (C) 2020 by sysmocom - s.f.m.c. GmbH <info@sysmocom.de> |
| * All Rights Reserved |
| * |
| * Author: Neels Hofmeyr <neels@hofmeyr.de> |
| * |
| * SPDX-License-Identifier: GPL-2.0+ |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 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 General Public License for more details. |
| * |
| */ |
| |
| #include <limits.h> |
| #include <inttypes.h> |
| #include <errno.h> |
| |
| #include <osmocom/core/utils.h> |
| #include <osmocom/gsm/protocol/gsm_08_08.h> |
| #include <osmocom/gsm/gsm0808_utils.h> |
| #include <osmocom/gsm/gad.h> |
| #include <osmocom/smlc/smlc_data.h> |
| #include <osmocom/smlc/smlc_vty.h> |
| #include <osmocom/smlc/cell_locations.h> |
| |
| static uint32_t ta_to_m(uint8_t ta) |
| { |
| return ((uint32_t)ta) * 550; |
| } |
| |
| static struct cell_location *cell_location_find(const struct gsm0808_cell_id *cell_id) |
| { |
| struct cell_location *cell_location; |
| llist_for_each_entry(cell_location, &g_smlc->cell_locations, entry) { |
| if (gsm0808_cell_ids_match(&cell_location->cell_id, cell_id, true)) |
| return cell_location; |
| } |
| llist_for_each_entry(cell_location, &g_smlc->cell_locations, entry) { |
| if (gsm0808_cell_ids_match(&cell_location->cell_id, cell_id, false)) |
| return cell_location; |
| } |
| return NULL; |
| } |
| |
| int cell_location_from_ta(struct osmo_gad *location_estimate, |
| const struct gsm0808_cell_id *cell_id, |
| uint8_t ta) |
| { |
| const struct cell_location *cell; |
| cell = cell_location_find(cell_id); |
| if (!cell) |
| return -ENOENT; |
| |
| *location_estimate = (struct osmo_gad){ |
| .type = GAD_TYPE_ELL_POINT_UNC_CIRCLE, |
| .ell_point_unc_circle = { |
| .lat = cell->lat, |
| .lon = cell->lon, |
| .unc = osmo_gad_dec_unc(osmo_gad_enc_unc(ta_to_m(ta) * 1000)), |
| }, |
| }; |
| |
| return 0; |
| } |
| |
| static struct cell_location *cell_location_find_or_create(const struct gsm0808_cell_id *cell_id) |
| { |
| struct cell_location *cell_location = cell_location_find(cell_id); |
| if (!cell_location) { |
| cell_location = talloc_zero(g_smlc, struct cell_location); |
| OSMO_ASSERT(cell_location); |
| cell_location->cell_id = *cell_id; |
| llist_add_tail(&cell_location->entry, &g_smlc->cell_locations); |
| } |
| return cell_location; |
| |
| } |
| |
| static const struct cell_location *cell_location_set(const struct gsm0808_cell_id *cell_id, int32_t lat, int32_t lon) |
| { |
| struct cell_location *cell_location = cell_location_find_or_create(cell_id); |
| cell_location->lat = lat; |
| cell_location->lon = lon; |
| return 0; |
| } |
| |
| static int cell_location_remove(const struct gsm0808_cell_id *cell_id) |
| { |
| struct cell_location *cell_location = cell_location_find(cell_id); |
| if (!cell_location) |
| return -ENOENT; |
| llist_del(&cell_location->entry); |
| talloc_free(cell_location); |
| return 0; |
| } |
| |
| #define LAC_CI_PARAMS "lac-ci <0-65535> <0-65535>" |
| #define LAC_CI_DOC "Cell location by LAC and CI\n" "LAC\n" "CI\n" |
| |
| #define CGI_PARAMS "cgi <0-999> <0-999> <0-65535> <0-65535>" |
| #define CGI_DOC "Cell location by Cell-Global ID\n" "MCC\n" "MNC\n" "LAC\n" "CI\n" |
| |
| #define LAT_LON_PARAMS "lat LATITUDE lon LONGITUDE" |
| #define LAT_LON_DOC "Global latitute coordinate\n" "Latitude floating-point number, -90.0 (S) to 90.0 (N)\n" \ |
| "Global longitude coordinate\n" "Longitude as floating-point number, -180.0 (W) to 180.0 (E)\n" |
| |
| static int vty_parse_lac_ci(struct vty *vty, struct gsm0808_cell_id *dst, const char **argv) |
| { |
| *dst = (struct gsm0808_cell_id){ |
| .id_discr = CELL_IDENT_LAC_AND_CI, |
| .id.lac_and_ci = { |
| .lac = atoi(argv[0]), |
| .ci = atoi(argv[1]), |
| }, |
| }; |
| return 0; |
| } |
| |
| static int vty_parse_cgi(struct vty *vty, struct gsm0808_cell_id *dst, const char **argv) |
| { |
| *dst = (struct gsm0808_cell_id){ |
| .id_discr = CELL_IDENT_WHOLE_GLOBAL, |
| }; |
| struct osmo_cell_global_id *cgi = &dst->id.global; |
| const char *mcc = argv[0]; |
| const char *mnc = argv[1]; |
| const char *lac = argv[2]; |
| const char *ci = argv[3]; |
| |
| if (osmo_mcc_from_str(mcc, &cgi->lai.plmn.mcc)) { |
| vty_out(vty, "%% Error decoding MCC: %s%s", mcc, VTY_NEWLINE); |
| return -EINVAL; |
| } |
| |
| if (osmo_mnc_from_str(mnc, &cgi->lai.plmn.mnc, &cgi->lai.plmn.mnc_3_digits)) { |
| vty_out(vty, "%% Error decoding MNC: %s%s", mnc, VTY_NEWLINE); |
| return -EINVAL; |
| } |
| |
| cgi->lai.lac = atoi(lac); |
| cgi->cell_identity = atoi(ci); |
| return 0; |
| } |
| |
| static int vty_parse_location(struct vty *vty, const struct gsm0808_cell_id *cell_id, const char **argv) |
| { |
| const char *lat_str = argv[0]; |
| const char *lon_str = argv[1]; |
| int64_t val; |
| int32_t lat, lon; |
| |
| if (osmo_float_str_to_int(&val, lat_str, 6) |
| || val < -90000000 || val > 90000000) { |
| vty_out(vty, "%% Invalid latitude: '%s'%s", lat_str, VTY_NEWLINE); |
| return CMD_WARNING; |
| } |
| lat = val; |
| |
| if (osmo_float_str_to_int(&val, lon_str, 6) |
| || val < -180000000 || val > 180000000) { |
| vty_out(vty, "%% Invalid longitude: '%s'%s", lon_str, VTY_NEWLINE); |
| return CMD_WARNING; |
| } |
| lon = val; |
| |
| if (cell_location_set(cell_id, lat, lon)) { |
| vty_out(vty, "%% Failed to add cell location%s", VTY_NEWLINE); |
| return CMD_WARNING; |
| } |
| return CMD_SUCCESS; |
| } |
| |
| DEFUN(cfg_cells, cfg_cells_cmd, |
| "cells", |
| "Configure cell locations\n") |
| { |
| vty->node = CELLS_NODE; |
| return CMD_SUCCESS; |
| } |
| |
| DEFUN(cfg_cells_lac_ci, cfg_cells_lac_ci_cmd, |
| LAC_CI_PARAMS " " LAT_LON_PARAMS, |
| LAC_CI_DOC LAT_LON_DOC) |
| { |
| struct gsm0808_cell_id cell_id; |
| |
| if (vty_parse_lac_ci(vty, &cell_id, argv)) |
| return CMD_WARNING; |
| |
| return vty_parse_location(vty, &cell_id, argv + 2); |
| } |
| |
| DEFUN(cfg_cells_no_lac_ci, cfg_cells_no_lac_ci_cmd, |
| "no " LAC_CI_PARAMS, |
| NO_STR "Remove " LAC_CI_DOC) |
| { |
| struct gsm0808_cell_id cell_id; |
| |
| if (vty_parse_lac_ci(vty, &cell_id, argv)) |
| return CMD_WARNING; |
| if (cell_location_remove(&cell_id)) { |
| vty_out(vty, "%% cannot remove, no such entry%s", VTY_NEWLINE); |
| return CMD_WARNING; |
| } |
| return CMD_SUCCESS; |
| } |
| |
| DEFUN(cfg_cells_cgi, cfg_cells_cgi_cmd, |
| CGI_PARAMS " " LAT_LON_PARAMS, |
| CGI_DOC LAT_LON_DOC) |
| { |
| struct gsm0808_cell_id cell_id; |
| |
| if (vty_parse_cgi(vty, &cell_id, argv)) |
| return CMD_WARNING; |
| |
| return vty_parse_location(vty, &cell_id, argv + 4); |
| } |
| |
| DEFUN(cfg_cells_no_cgi, cfg_cells_no_cgi_cmd, |
| "no " CGI_PARAMS, |
| NO_STR "Remove " CGI_DOC) |
| { |
| struct gsm0808_cell_id cell_id; |
| |
| if (vty_parse_cgi(vty, &cell_id, argv)) |
| return CMD_WARNING; |
| if (cell_location_remove(&cell_id)) { |
| vty_out(vty, "%% cannot remove, no such entry%s", VTY_NEWLINE); |
| return CMD_WARNING; |
| } |
| return CMD_SUCCESS; |
| } |
| |
| /* The above are omnidirectional cells. If we add configuration sector antennae, it would add arguments to the above, |
| * something like this: |
| * cgi 001 01 23 42 lat 23.23 lon 42.42 arc 270 30 |
| */ |
| |
| struct cmd_node cells_node = { |
| CELLS_NODE, |
| "%s(config-cells)# ", |
| 1, |
| }; |
| |
| static int config_write_cells(struct vty *vty) |
| { |
| struct cell_location *cell; |
| const struct osmo_cell_global_id *cgi; |
| |
| if (llist_empty(&g_smlc->cell_locations)) |
| return 0; |
| |
| vty_out(vty, "cells%s", VTY_NEWLINE); |
| |
| llist_for_each_entry(cell, &g_smlc->cell_locations, entry) { |
| switch (cell->cell_id.id_discr) { |
| case CELL_IDENT_LAC_AND_CI: |
| vty_out(vty, " lac-ci %u %u", cell->cell_id.id.lac_and_ci.lac, cell->cell_id.id.lac_and_ci.ci); |
| break; |
| case CELL_IDENT_WHOLE_GLOBAL: |
| cgi = &cell->cell_id.id.global; |
| vty_out(vty, " cgi %s %s %u %u", |
| osmo_mcc_name(cgi->lai.plmn.mcc), |
| osmo_mnc_name(cgi->lai.plmn.mnc, cgi->lai.plmn.mnc_3_digits), |
| cgi->lai.lac, cgi->cell_identity); |
| break; |
| default: |
| vty_out(vty, " %% [unsupported cell id type: %d]", |
| cell->cell_id.id_discr); |
| break; |
| } |
| |
| vty_out(vty, " lat %s lon %s%s", |
| osmo_int_to_float_str_c(OTC_SELECT, cell->lat, 6), |
| osmo_int_to_float_str_c(OTC_SELECT, cell->lon, 6), |
| VTY_NEWLINE); |
| } |
| |
| return 0; |
| } |
| |
| DEFUN(ve_show_cells, ve_show_cells_cmd, |
| "show cells", |
| SHOW_STR "Show configured cell locations\n") |
| { |
| if (llist_empty(&g_smlc->cell_locations)) { |
| vty_out(vty, "%% No cell locations are configured%s", VTY_NEWLINE); |
| return CMD_SUCCESS; |
| } |
| config_write_cells(vty); |
| return CMD_SUCCESS; |
| } |
| |
| int cell_locations_vty_init() |
| { |
| install_element(CONFIG_NODE, &cfg_cells_cmd); |
| install_node(&cells_node, config_write_cells); |
| install_element(CELLS_NODE, &cfg_cells_lac_ci_cmd); |
| install_element(CELLS_NODE, &cfg_cells_no_lac_ci_cmd); |
| install_element(CELLS_NODE, &cfg_cells_cgi_cmd); |
| install_element(CELLS_NODE, &cfg_cells_no_cgi_cmd); |
| install_element_ve(&ve_show_cells_cmd); |
| |
| return 0; |
| } |