| |
| #include <stdlib.h> |
| #include <inttypes.h> |
| #include <stddef.h> |
| #include <stdio.h> |
| #include <string.h> |
| #include <time.h> |
| |
| #include <sys/stat.h> |
| #include <fcntl.h> |
| #include <unistd.h> |
| #include <errno.h> |
| |
| #include <osmocom/core/msgb.h> |
| #include <osmocom/core/serial.h> |
| |
| #include "diag_io.h" |
| #include "protocol.h" |
| #include "diag_log.h" |
| #include "diagcmd.h" |
| |
| /* handler for EXT MSG */ |
| static int diag_rx_ext_msg_f(const uint8_t *data, const size_t len) |
| { |
| const struct ext_log_msg *msg; |
| const char *file = NULL, *fmt; |
| unsigned int num_args; |
| |
| if (len < sizeof(struct ext_log_msg)) { |
| printf("too short ext_log_msg.\n"); |
| return -1; |
| } |
| |
| msg = (struct ext_log_msg *) data; |
| num_args = msg->num_args; |
| fmt = (const char *) msg->params + num_args*sizeof(msg->params[0]); |
| file = fmt + strlen(fmt) + 1; |
| |
| printf("MSG(%u|%s:%u): ", diag_ts_to_epoch(msg->timestamp), file, msg->line_nr); |
| switch (num_args) { |
| case 0: |
| fputs(fmt, stdout); |
| break; |
| case 1: |
| printf(fmt, msg->params[0]); |
| break; |
| case 2: |
| printf(fmt, msg->params[0], msg->params[1]); |
| break; |
| case 3: |
| printf(fmt, msg->params[0], msg->params[1], msg->params[2]); |
| break; |
| case 4: |
| printf(fmt, msg->params[0], msg->params[1], msg->params[2], msg->params[3]); |
| break; |
| } |
| fputc('\n', stdout); |
| return 0; |
| } |
| |
| /*********/ |
| |
| static void diag_process_msg(struct diag_instance *di, struct msgb *msg) |
| { |
| switch (msg->l2h[0]) { |
| case DIAG_LOG_F: |
| diag_log_handle(di, msg); |
| break; |
| case DIAG_EXT_MSG_F: |
| diag_rx_ext_msg_f(msgb_data(msg), msgb_length(msg)); |
| break; |
| default: |
| printf("Got %d bytes data of unknown payload type 0x%02x: %s\n", |
| msgb_length(msg), msg->l2h[0], |
| osmo_hexdump(msgb_data(msg), msgb_length(msg))); |
| break; |
| } |
| msgb_free(msg); |
| } |
| |
| static void do_configure(struct diag_instance *di) |
| { |
| static uint8_t timestamp[] = { DIAG_TS_F }; |
| static const uint8_t enable_evt_report[] = { |
| DIAG_EVENT_REPORT_F, 0x01 |
| }; |
| static const uint8_t disable_evt_report[] = { |
| DIAG_EVENT_REPORT_F, 0x00 |
| }; |
| static const uint8_t extended_report_cfg[] = { |
| /* command code */ |
| DIAG_EXT_MSG_CONFIG_F, |
| /* sub command */ |
| 0x04, |
| /* subsystem ID range start */ |
| 0x00, 0x00, |
| /* subsystem ID range end */ |
| 0x00, 0x00, |
| /* pad */ |
| 0x00, 0x00, |
| /* array of runtime masks */ |
| 0x02, 0x00, 0x00, 0x00, |
| }; |
| |
| /* TODO: introduce a wait for response kind of method */ |
| diag_transmit_buf(di, timestamp, sizeof(timestamp)); |
| diag_read(di); |
| |
| /* enable|disable the event report */ |
| #if 0 |
| diag_transmit_buf(di, enable_evt_report, sizeof(enable_evt_report)); |
| diag_read(di); |
| #else |
| diag_transmit_buf(di, disable_evt_report, sizeof(disable_evt_report)); |
| diag_read(di); |
| #endif |
| |
| diag_transmit_buf(di, extended_report_cfg, sizeof(extended_report_cfg)); |
| diag_read(di); |
| |
| #if 0 |
| printf("GSM\n"); |
| struct msgb *msg = gen_log_config_set_mask(5, 1064); |
| #if 0 |
| for (int i = 0; i < 1064; i++) |
| log_config_set_mask_bit(msg, i); |
| #endif |
| |
| log_config_set_mask_bit(msg, LOG_GSM_RR_CONTROL_CHANNEL_PARAMS_C); |
| |
| log_config_set_mask_bit(msg, LOG_GPRS_RLC_UL_ACKNACK_PARAMS_VER2_C); |
| log_config_set_mask_bit(msg, LOG_GPRS_RLC_DL_ACKNACK_PARAMS_VER2_C); |
| log_config_set_mask_bit(msg, LOG_EGPRS_RLC_DL_HEADER_C); |
| log_config_set_mask_bit(msg, LOG_EGPRS_RLC_UL_HEADER_C); |
| |
| log_config_set_mask_bit(msg, LOG_GPRS_LLC_PERIODIC_STATS_C); |
| |
| log_config_set_mask_bit(msg, LOG_GPRS_SNDCP_UL_TCP_HDR_C); |
| log_config_set_mask_bit(msg, LOG_GPRS_SNDCP_DL_TCP_HDR_C); |
| log_config_set_mask_bit(msg, 546); |
| log_config_set_mask_bit(msg, 547); |
| log_config_set_mask_bit(msg, LOG_EGPRS_MAC_UL_ACKNACK_C); |
| log_config_set_mask_bit(msg, LOG_EGPRS_MAC_DL_ACKNACK_C); |
| |
| diag_transmit_msgb(di, msg); |
| diag_read(di); |
| |
| printf("WCDMA\n"); |
| msg = gen_log_config_set_mask(4, 1064); |
| #if 0 |
| for (int i = 0; i < 1064; i++) |
| log_config_set_mask_bit(msg, i); |
| #endif |
| log_config_set_mask_bit(msg, 0x125); |
| log_config_set_mask_bit(msg, 0x126); |
| log_config_set_mask_bit(msg, 0x127); |
| log_config_set_mask_bit(msg, 0x128); |
| log_config_set_mask_bit(msg, 0x129); |
| |
| diag_transmit_msgb(di, msg); |
| diag_read(di); |
| #else |
| diag_log_enable_all_supported(di); |
| #endif |
| } |
| |
| int main(int argc, char **argv) |
| { |
| struct diag_instance di; |
| int i; |
| int rc; |
| |
| if (argc < 2) { |
| printf("Invoke with %s PATH_TO_SERIAL\n", |
| argv[0]); |
| return EXIT_FAILURE; |
| } |
| |
| memset(&di, 0, sizeof(di)); |
| di.rx.rcvmsg = &diag_process_msg; |
| di.fd = osmo_serial_init(argv[1], 921600); |
| if (di.fd < 0) |
| return EXIT_FAILURE; |
| |
| do_configure(&di); |
| |
| while (1) { |
| i++; |
| rc = diag_read(&di); |
| if (rc == -EIO) |
| break; |
| #if 0 |
| /* some packets need to be explicitly requested and |
| * don't appear automatically */ |
| if (i % 10 == 0) { |
| struct msgb *msg = diag_gsm_make_log_pack_req(LOG_GPRS_LLC_PDU_STATS_C , 0, 0); |
| printf("Requesting LLC stats...(%s)\n", osmo_hexdump(msgb_data(msg), msgb_length(msg))); |
| diag_transmit_msgb(&di, msg); |
| } |
| #endif |
| |
| } |
| } |