Harald Welte | ccea8dd | 2016-12-24 10:27:55 +0100 | [diff] [blame] | 1 | /* |
| 2 | * (C) 2013-2016 by Harald Welte <laforge@gnumonks.org> |
| 3 | * |
| 4 | * oriiginally based on ealier code from Dieter Spaar and Holger |
| 5 | * Freyther, though by now almost entirely rewritten. Nevertheless, |
| 6 | * thanks to Dieter and Holger! |
| 7 | * |
| 8 | * This program is free software; you can redistribute it and/or modify |
| 9 | * it under the terms of the GNU General Public License as published by |
| 10 | * the Free Software Foundation; either version 2 of the License, or |
| 11 | * (at your option) any later version. |
| 12 | * |
| 13 | * This program is distributed in the hope that it will be useful, |
| 14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 16 | * GNU General Public License for more details. |
| 17 | * |
| 18 | * You should have received a copy of the GNU General Public License along |
| 19 | * with this program; if not, write to the Free Software Foundation, Inc., |
| 20 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. |
| 21 | */ |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 22 | |
| 23 | #include <stdlib.h> |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 24 | #include <inttypes.h> |
Holger Hans Peter Freyther | 93b625b | 2013-05-31 09:52:26 +0200 | [diff] [blame] | 25 | #include <stddef.h> |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 26 | #include <stdio.h> |
| 27 | #include <string.h> |
Holger Hans Peter Freyther | 93b625b | 2013-05-31 09:52:26 +0200 | [diff] [blame] | 28 | #include <time.h> |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 29 | |
| 30 | #include <sys/stat.h> |
| 31 | #include <fcntl.h> |
| 32 | #include <unistd.h> |
| 33 | #include <errno.h> |
| 34 | |
Harald Welte | 211dd6c | 2016-01-13 00:18:49 +0100 | [diff] [blame] | 35 | #include <osmocom/core/msgb.h> |
Harald Welte | 234b56b | 2016-12-23 23:44:19 +0100 | [diff] [blame] | 36 | #include <osmocom/core/serial.h> |
Harald Welte | 211dd6c | 2016-01-13 00:18:49 +0100 | [diff] [blame] | 37 | |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 38 | #include "diag_io.h" |
Harald Welte | faea754 | 2016-12-24 01:21:03 +0100 | [diff] [blame] | 39 | #include "diag_log.h" |
Harald Welte | 0e50916 | 2016-12-24 01:32:10 +0100 | [diff] [blame] | 40 | #include "diag_msg.h" |
Harald Welte | 84ec50f | 2016-12-24 10:16:00 +0100 | [diff] [blame] | 41 | #include "protocol/protocol.h" |
| 42 | #include "protocol/diagcmd.h" |
Harald Welte | 211dd6c | 2016-01-13 00:18:49 +0100 | [diff] [blame] | 43 | |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 44 | /*********/ |
| 45 | |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 46 | static void diag_process_msg(struct diag_instance *di, struct msgb *msg) |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 47 | { |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 48 | switch (msg->l2h[0]) { |
| 49 | case DIAG_LOG_F: |
Harald Welte | faea754 | 2016-12-24 01:21:03 +0100 | [diff] [blame] | 50 | diag_log_handle(di, msg); |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 51 | break; |
| 52 | case DIAG_EXT_MSG_F: |
Harald Welte | 0e50916 | 2016-12-24 01:32:10 +0100 | [diff] [blame] | 53 | diag_rx_ext_msg_f(di, msg); |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 54 | break; |
| 55 | default: |
Harald Welte | 2c36375 | 2016-12-24 00:19:55 +0100 | [diff] [blame] | 56 | printf("Got %d bytes data of unknown payload type 0x%02x: %s\n", |
| 57 | msgb_length(msg), msg->l2h[0], |
| 58 | osmo_hexdump(msgb_data(msg), msgb_length(msg))); |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 59 | break; |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 60 | } |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 61 | msgb_free(msg); |
| 62 | } |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 63 | |
Harald Welte | 272b4ae | 2016-12-23 23:28:28 +0100 | [diff] [blame] | 64 | static void do_configure(struct diag_instance *di) |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 65 | { |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 66 | static uint8_t timestamp[] = { DIAG_TS_F }; |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 67 | static const uint8_t enable_evt_report[] = { |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 68 | DIAG_EVENT_REPORT_F, 0x01 |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 69 | }; |
| 70 | static const uint8_t disable_evt_report[] = { |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 71 | DIAG_EVENT_REPORT_F, 0x00 |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 72 | }; |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 73 | |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 74 | /* TODO: introduce a wait for response kind of method */ |
Harald Welte | 272b4ae | 2016-12-23 23:28:28 +0100 | [diff] [blame] | 75 | diag_transmit_buf(di, timestamp, sizeof(timestamp)); |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 76 | diag_read(di); |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 77 | |
Holger Hans Peter Freyther | 93b625b | 2013-05-31 09:52:26 +0200 | [diff] [blame] | 78 | /* enable|disable the event report */ |
| 79 | #if 0 |
Harald Welte | 272b4ae | 2016-12-23 23:28:28 +0100 | [diff] [blame] | 80 | diag_transmit_buf(di, enable_evt_report, sizeof(enable_evt_report)); |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 81 | diag_read(di); |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 82 | #else |
Harald Welte | 272b4ae | 2016-12-23 23:28:28 +0100 | [diff] [blame] | 83 | diag_transmit_buf(di, disable_evt_report, sizeof(disable_evt_report)); |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 84 | diag_read(di); |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 85 | #endif |
Harald Welte | 6fc7f68 | 2016-12-24 10:01:28 +0100 | [diff] [blame] | 86 | diag_msg_config_set_rt_mask(di, MSG_SSID_LINUX_DATA, 0xffffffff); |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 87 | |
Harald Welte | faea754 | 2016-12-24 01:21:03 +0100 | [diff] [blame] | 88 | #if 0 |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 89 | printf("GSM\n"); |
| 90 | struct msgb *msg = gen_log_config_set_mask(5, 1064); |
| 91 | #if 0 |
| 92 | for (int i = 0; i < 1064; i++) |
| 93 | log_config_set_mask_bit(msg, i); |
| 94 | #endif |
| 95 | |
| 96 | log_config_set_mask_bit(msg, LOG_GSM_RR_CONTROL_CHANNEL_PARAMS_C); |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 97 | |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 98 | log_config_set_mask_bit(msg, LOG_GPRS_RLC_UL_ACKNACK_PARAMS_VER2_C); |
| 99 | log_config_set_mask_bit(msg, LOG_GPRS_RLC_DL_ACKNACK_PARAMS_VER2_C); |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 100 | log_config_set_mask_bit(msg, LOG_EGPRS_RLC_DL_HEADER_C); |
| 101 | log_config_set_mask_bit(msg, LOG_EGPRS_RLC_UL_HEADER_C); |
| 102 | |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 103 | log_config_set_mask_bit(msg, LOG_GPRS_LLC_PERIODIC_STATS_C); |
| 104 | |
| 105 | log_config_set_mask_bit(msg, LOG_GPRS_SNDCP_UL_TCP_HDR_C); |
| 106 | log_config_set_mask_bit(msg, LOG_GPRS_SNDCP_DL_TCP_HDR_C); |
Harald Welte | 211dd6c | 2016-01-13 00:18:49 +0100 | [diff] [blame] | 107 | log_config_set_mask_bit(msg, 546); |
| 108 | log_config_set_mask_bit(msg, 547); |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 109 | log_config_set_mask_bit(msg, LOG_EGPRS_MAC_UL_ACKNACK_C); |
| 110 | log_config_set_mask_bit(msg, LOG_EGPRS_MAC_DL_ACKNACK_C); |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 111 | |
Harald Welte | 272b4ae | 2016-12-23 23:28:28 +0100 | [diff] [blame] | 112 | diag_transmit_msgb(di, msg); |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 113 | diag_read(di); |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 114 | |
| 115 | printf("WCDMA\n"); |
| 116 | msg = gen_log_config_set_mask(4, 1064); |
| 117 | #if 0 |
| 118 | for (int i = 0; i < 1064; i++) |
| 119 | log_config_set_mask_bit(msg, i); |
| 120 | #endif |
| 121 | log_config_set_mask_bit(msg, 0x125); |
| 122 | log_config_set_mask_bit(msg, 0x126); |
| 123 | log_config_set_mask_bit(msg, 0x127); |
| 124 | log_config_set_mask_bit(msg, 0x128); |
| 125 | log_config_set_mask_bit(msg, 0x129); |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 126 | |
Harald Welte | 272b4ae | 2016-12-23 23:28:28 +0100 | [diff] [blame] | 127 | diag_transmit_msgb(di, msg); |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 128 | diag_read(di); |
Harald Welte | faea754 | 2016-12-24 01:21:03 +0100 | [diff] [blame] | 129 | #else |
| 130 | diag_log_enable_all_supported(di); |
| 131 | #endif |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 132 | } |
| 133 | |
| 134 | int main(int argc, char **argv) |
| 135 | { |
Harald Welte | 272b4ae | 2016-12-23 23:28:28 +0100 | [diff] [blame] | 136 | struct diag_instance di; |
Harald Welte | 4e06b5c | 2016-12-23 22:56:06 +0100 | [diff] [blame] | 137 | int i; |
Harald Welte | 272b4ae | 2016-12-23 23:28:28 +0100 | [diff] [blame] | 138 | int rc; |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 139 | |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 140 | if (argc < 2) { |
| 141 | printf("Invoke with %s PATH_TO_SERIAL\n", |
| 142 | argv[0]); |
| 143 | return EXIT_FAILURE; |
| 144 | } |
| 145 | |
Harald Welte | 272b4ae | 2016-12-23 23:28:28 +0100 | [diff] [blame] | 146 | memset(&di, 0, sizeof(di)); |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 147 | di.rx.rcvmsg = &diag_process_msg; |
| 148 | di.fd = osmo_serial_init(argv[1], 921600); |
Harald Welte | 272b4ae | 2016-12-23 23:28:28 +0100 | [diff] [blame] | 149 | if (di.fd < 0) |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 150 | return EXIT_FAILURE; |
| 151 | |
Harald Welte | 272b4ae | 2016-12-23 23:28:28 +0100 | [diff] [blame] | 152 | do_configure(&di); |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 153 | |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 154 | while (1) { |
| 155 | i++; |
Harald Welte | bd44858 | 2016-12-23 23:41:14 +0100 | [diff] [blame] | 156 | rc = diag_read(&di); |
Harald Welte | 272b4ae | 2016-12-23 23:28:28 +0100 | [diff] [blame] | 157 | if (rc == -EIO) |
| 158 | break; |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 159 | #if 0 |
| 160 | /* some packets need to be explicitly requested and |
| 161 | * don't appear automatically */ |
| 162 | if (i % 10 == 0) { |
| 163 | struct msgb *msg = diag_gsm_make_log_pack_req(LOG_GPRS_LLC_PDU_STATS_C , 0, 0); |
| 164 | printf("Requesting LLC stats...(%s)\n", osmo_hexdump(msgb_data(msg), msgb_length(msg))); |
Harald Welte | 272b4ae | 2016-12-23 23:28:28 +0100 | [diff] [blame] | 165 | diag_transmit_msgb(&di, msg); |
Harald Welte | f5d6fee | 2016-01-13 22:29:10 +0100 | [diff] [blame] | 166 | } |
| 167 | #endif |
| 168 | |
| 169 | } |
Martin Hauke | b236aa7 | 2016-12-28 15:10:37 +0100 | [diff] [blame^] | 170 | |
| 171 | return EXIT_SUCCESS; |
Holger Hans Peter Freyther | ae73a05 | 2013-05-31 09:51:53 +0200 | [diff] [blame] | 172 | } |