2013-05-31 07:51:53 +00:00
|
|
|
|
|
|
|
#include <stdlib.h>
|
2016-01-13 21:29:10 +00:00
|
|
|
#include <inttypes.h>
|
2013-05-31 07:52:26 +00:00
|
|
|
#include <stddef.h>
|
2013-05-31 07:51:53 +00:00
|
|
|
#include <stdio.h>
|
|
|
|
#include <string.h>
|
2013-05-31 07:52:26 +00:00
|
|
|
#include <time.h>
|
2013-05-31 07:51:53 +00:00
|
|
|
|
|
|
|
#include <sys/stat.h>
|
|
|
|
#include <fcntl.h>
|
|
|
|
#include <unistd.h>
|
|
|
|
#include <errno.h>
|
|
|
|
|
2016-01-12 23:18:49 +00:00
|
|
|
#include <osmocom/core/msgb.h>
|
2016-12-23 22:44:19 +00:00
|
|
|
#include <osmocom/core/serial.h>
|
2016-01-12 23:18:49 +00:00
|
|
|
|
2016-12-23 22:41:14 +00:00
|
|
|
#include "diag_io.h"
|
2016-01-12 23:18:49 +00:00
|
|
|
#include "protocol.h"
|
2016-12-24 00:21:03 +00:00
|
|
|
#include "diag_log.h"
|
2016-12-24 00:32:10 +00:00
|
|
|
#include "diag_msg.h"
|
2016-01-13 21:29:10 +00:00
|
|
|
#include "diagcmd.h"
|
2016-01-12 23:18:49 +00:00
|
|
|
|
2016-01-13 21:29:10 +00:00
|
|
|
/*********/
|
|
|
|
|
2016-12-23 22:41:14 +00:00
|
|
|
static void diag_process_msg(struct diag_instance *di, struct msgb *msg)
|
2016-01-13 21:29:10 +00:00
|
|
|
{
|
2016-12-23 22:41:14 +00:00
|
|
|
switch (msg->l2h[0]) {
|
|
|
|
case DIAG_LOG_F:
|
2016-12-24 00:21:03 +00:00
|
|
|
diag_log_handle(di, msg);
|
2016-12-23 22:41:14 +00:00
|
|
|
break;
|
|
|
|
case DIAG_EXT_MSG_F:
|
2016-12-24 00:32:10 +00:00
|
|
|
diag_rx_ext_msg_f(di, msg);
|
2016-12-23 22:41:14 +00:00
|
|
|
break;
|
|
|
|
default:
|
2016-12-23 23:19:55 +00:00
|
|
|
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)));
|
2016-12-23 22:41:14 +00:00
|
|
|
break;
|
2016-12-23 22:28:28 +00:00
|
|
|
}
|
2016-12-23 22:41:14 +00:00
|
|
|
msgb_free(msg);
|
|
|
|
}
|
2016-12-23 22:28:28 +00:00
|
|
|
|
|
|
|
static void do_configure(struct diag_instance *di)
|
2013-05-31 07:51:53 +00:00
|
|
|
{
|
2016-01-13 21:29:10 +00:00
|
|
|
static uint8_t timestamp[] = { DIAG_TS_F };
|
2013-05-31 07:51:53 +00:00
|
|
|
static const uint8_t enable_evt_report[] = {
|
2016-01-13 21:29:10 +00:00
|
|
|
DIAG_EVENT_REPORT_F, 0x01
|
2013-05-31 07:51:53 +00:00
|
|
|
};
|
|
|
|
static const uint8_t disable_evt_report[] = {
|
2016-01-13 21:29:10 +00:00
|
|
|
DIAG_EVENT_REPORT_F, 0x00
|
2013-05-31 07:51:53 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
/* TODO: introduce a wait for response kind of method */
|
2016-12-23 22:28:28 +00:00
|
|
|
diag_transmit_buf(di, timestamp, sizeof(timestamp));
|
2016-12-23 22:41:14 +00:00
|
|
|
diag_read(di);
|
2013-05-31 07:51:53 +00:00
|
|
|
|
2013-05-31 07:52:26 +00:00
|
|
|
/* enable|disable the event report */
|
|
|
|
#if 0
|
2016-12-23 22:28:28 +00:00
|
|
|
diag_transmit_buf(di, enable_evt_report, sizeof(enable_evt_report));
|
2016-12-23 22:41:14 +00:00
|
|
|
diag_read(di);
|
2016-01-13 21:29:10 +00:00
|
|
|
#else
|
2016-12-23 22:28:28 +00:00
|
|
|
diag_transmit_buf(di, disable_evt_report, sizeof(disable_evt_report));
|
2016-12-23 22:41:14 +00:00
|
|
|
diag_read(di);
|
2016-01-13 21:29:10 +00:00
|
|
|
#endif
|
2016-12-24 09:01:28 +00:00
|
|
|
diag_msg_config_set_rt_mask(di, MSG_SSID_LINUX_DATA, 0xffffffff);
|
2016-01-13 21:29:10 +00:00
|
|
|
|
2016-12-24 00:21:03 +00:00
|
|
|
#if 0
|
2016-01-13 21:29:10 +00:00
|
|
|
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
|
2013-05-31 07:51:53 +00:00
|
|
|
|
2016-01-13 21:29:10 +00:00
|
|
|
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);
|
2016-01-12 23:18:49 +00:00
|
|
|
log_config_set_mask_bit(msg, 546);
|
|
|
|
log_config_set_mask_bit(msg, 547);
|
2016-01-13 21:29:10 +00:00
|
|
|
log_config_set_mask_bit(msg, LOG_EGPRS_MAC_UL_ACKNACK_C);
|
|
|
|
log_config_set_mask_bit(msg, LOG_EGPRS_MAC_DL_ACKNACK_C);
|
|
|
|
|
2016-12-23 22:28:28 +00:00
|
|
|
diag_transmit_msgb(di, msg);
|
2016-12-23 22:41:14 +00:00
|
|
|
diag_read(di);
|
2016-01-13 21:29:10 +00:00
|
|
|
|
|
|
|
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);
|
2016-12-22 10:16:33 +00:00
|
|
|
|
2016-12-23 22:28:28 +00:00
|
|
|
diag_transmit_msgb(di, msg);
|
2016-12-23 22:41:14 +00:00
|
|
|
diag_read(di);
|
2016-12-24 00:21:03 +00:00
|
|
|
#else
|
|
|
|
diag_log_enable_all_supported(di);
|
|
|
|
#endif
|
2013-05-31 07:51:53 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
int main(int argc, char **argv)
|
|
|
|
{
|
2016-12-23 22:28:28 +00:00
|
|
|
struct diag_instance di;
|
2016-12-23 21:56:06 +00:00
|
|
|
int i;
|
2016-12-23 22:28:28 +00:00
|
|
|
int rc;
|
2013-05-31 07:51:53 +00:00
|
|
|
|
|
|
|
if (argc < 2) {
|
|
|
|
printf("Invoke with %s PATH_TO_SERIAL\n",
|
|
|
|
argv[0]);
|
|
|
|
return EXIT_FAILURE;
|
|
|
|
}
|
|
|
|
|
2016-12-23 22:28:28 +00:00
|
|
|
memset(&di, 0, sizeof(di));
|
2016-12-23 22:41:14 +00:00
|
|
|
di.rx.rcvmsg = &diag_process_msg;
|
|
|
|
di.fd = osmo_serial_init(argv[1], 921600);
|
2016-12-23 22:28:28 +00:00
|
|
|
if (di.fd < 0)
|
2013-05-31 07:51:53 +00:00
|
|
|
return EXIT_FAILURE;
|
|
|
|
|
2016-12-23 22:28:28 +00:00
|
|
|
do_configure(&di);
|
2013-05-31 07:51:53 +00:00
|
|
|
|
2016-01-13 21:29:10 +00:00
|
|
|
while (1) {
|
|
|
|
i++;
|
2016-12-23 22:41:14 +00:00
|
|
|
rc = diag_read(&di);
|
2016-12-23 22:28:28 +00:00
|
|
|
if (rc == -EIO)
|
|
|
|
break;
|
2016-01-13 21:29:10 +00:00
|
|
|
#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)));
|
2016-12-23 22:28:28 +00:00
|
|
|
diag_transmit_msgb(&di, msg);
|
2016-01-13 21:29:10 +00:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
}
|
2013-05-31 07:51:53 +00:00
|
|
|
}
|