* use select loop based rx/tx processing in bs11_config
* improve parsing/generation of fake lapd header
This commit is contained in:
parent
3b8ba215b9
commit
14f0934f0b
|
@ -9,4 +9,4 @@ bsc_hack_SOURCES = bsc_hack.c misdn.c abis_rsl.c abis_nm.c gsm_04_08.c gsm_data.
|
||||||
trau_frame.c paging.c
|
trau_frame.c paging.c
|
||||||
bsc_hack_LDADD = -ldl -ldbi
|
bsc_hack_LDADD = -ldl -ldbi
|
||||||
|
|
||||||
bs11_config_SOURCES = bs11_config.c abis_nm.c gsm_data.c msgb.c debug.c
|
bs11_config_SOURCES = bs11_config.c abis_nm.c gsm_data.c msgb.c debug.c select.c timer.c
|
||||||
|
|
|
@ -30,6 +30,7 @@
|
||||||
#include <getopt.h>
|
#include <getopt.h>
|
||||||
#include <fcntl.h>
|
#include <fcntl.h>
|
||||||
#include <termios.h>
|
#include <termios.h>
|
||||||
|
#include <signal.h>
|
||||||
|
|
||||||
#include <sys/types.h>
|
#include <sys/types.h>
|
||||||
#include <sys/stat.h>
|
#include <sys/stat.h>
|
||||||
|
@ -39,6 +40,7 @@
|
||||||
#include <openbsc/msgb.h>
|
#include <openbsc/msgb.h>
|
||||||
#include <openbsc/tlv.h>
|
#include <openbsc/tlv.h>
|
||||||
#include <openbsc/debug.h>
|
#include <openbsc/debug.h>
|
||||||
|
#include <openbsc/select.h>
|
||||||
|
|
||||||
/* state of our bs11_config application */
|
/* state of our bs11_config application */
|
||||||
enum bs11cfg_state {
|
enum bs11cfg_state {
|
||||||
|
@ -66,6 +68,19 @@ static const char *trx1_password = "1111111111";
|
||||||
|
|
||||||
static const u_int8_t too_fast[] = { 0x12, 0x80, 0x00, 0x00, 0x02, 0x02 };
|
static const u_int8_t too_fast[] = { 0x12, 0x80, 0x00, 0x00, 0x02, 0x02 };
|
||||||
|
|
||||||
|
struct serial_handle {
|
||||||
|
struct bsc_fd fd;
|
||||||
|
struct llist_head tx_queue;
|
||||||
|
|
||||||
|
struct msgb *rx_msg;
|
||||||
|
unsigned int rxmsg_bytes_missing;
|
||||||
|
};
|
||||||
|
|
||||||
|
/* FIXME: this needs to go */
|
||||||
|
static struct serial_handle _ser_handle, *ser_handle = &_ser_handle;
|
||||||
|
|
||||||
|
static int handle_serial_msg(struct msgb *rx_msg);
|
||||||
|
|
||||||
/* create all objects for an initial configuration */
|
/* create all objects for an initial configuration */
|
||||||
static int create_objects(struct gsm_bts *bts, int trx1)
|
static int create_objects(struct gsm_bts *bts, int trx1)
|
||||||
{
|
{
|
||||||
|
@ -127,16 +142,19 @@ static struct gsm_bts *g_bts;
|
||||||
/* callback from abis_nm */
|
/* callback from abis_nm */
|
||||||
int _abis_nm_sendmsg(struct msgb *msg)
|
int _abis_nm_sendmsg(struct msgb *msg)
|
||||||
{
|
{
|
||||||
int written;
|
struct serial_handle *sh = ser_handle;
|
||||||
u_int8_t *lapd;
|
u_int8_t *lapd;
|
||||||
|
unsigned int len;
|
||||||
|
|
||||||
msg->l2h = msg->data;
|
msg->l2h = msg->data;
|
||||||
|
|
||||||
/* prepend LAPD header */
|
/* prepend LAPD header */
|
||||||
lapd = msgb_push(msg, LAPD_HDR_LEN);
|
lapd = msgb_push(msg, LAPD_HDR_LEN);
|
||||||
|
|
||||||
lapd[0] = 0x00;
|
len = msg->len - 2;
|
||||||
lapd[1] = msg->len - 2; /* length of bytes startign at lapd[2] */
|
|
||||||
|
lapd[0] = (len >> 8) & 0xff;
|
||||||
|
lapd[1] = len & 0xff; /* length of bytes startign at lapd[2] */
|
||||||
lapd[2] = 0x00;
|
lapd[2] = 0x00;
|
||||||
lapd[3] = 0x07;
|
lapd[3] = 0x07;
|
||||||
lapd[4] = 0x01;
|
lapd[4] = 0x01;
|
||||||
|
@ -146,6 +164,24 @@ int _abis_nm_sendmsg(struct msgb *msg)
|
||||||
lapd[8] = msg->len - 10; /* length of bytes starting at lapd[10] */
|
lapd[8] = msg->len - 10; /* length of bytes starting at lapd[10] */
|
||||||
lapd[9] = lapd[8] ^ 0x38;
|
lapd[9] = lapd[8] ^ 0x38;
|
||||||
|
|
||||||
|
msgb_enqueue(&sh->tx_queue, msg);
|
||||||
|
sh->fd.when |= BSC_FD_WRITE;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int handle_ser_write(struct bsc_fd *bfd)
|
||||||
|
{
|
||||||
|
struct serial_handle *sh = bfd->data;
|
||||||
|
struct msgb *msg;
|
||||||
|
int written;
|
||||||
|
|
||||||
|
msg = msgb_dequeue(&sh->tx_queue);
|
||||||
|
if (!msg) {
|
||||||
|
bfd->when &= ~BSC_FD_WRITE;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
fprintf(stdout, "TX: ");
|
fprintf(stdout, "TX: ");
|
||||||
hexdump(msg->data, msg->len);
|
hexdump(msg->data, msg->len);
|
||||||
|
|
||||||
|
@ -165,53 +201,82 @@ int _abis_nm_sendmsg(struct msgb *msg)
|
||||||
|
|
||||||
#define SERIAL_ALLOC_SIZE 300
|
#define SERIAL_ALLOC_SIZE 300
|
||||||
|
|
||||||
/* receive an entire message from the serial port */
|
static int handle_ser_read(struct bsc_fd *bfd)
|
||||||
static struct msgb *serial_read_msg(void)
|
|
||||||
{
|
{
|
||||||
struct msgb *msg = msgb_alloc(SERIAL_ALLOC_SIZE);
|
struct serial_handle *sh = bfd->data;
|
||||||
int rc;
|
struct msgb *msg;
|
||||||
|
int rc = 0;
|
||||||
|
|
||||||
if (!msg)
|
if (!sh->rx_msg) {
|
||||||
return NULL;
|
sh->rx_msg = msgb_alloc(SERIAL_ALLOC_SIZE);
|
||||||
|
sh->rx_msg->l2h = NULL;
|
||||||
msg->l2h = NULL;
|
}
|
||||||
|
msg = sh->rx_msg;
|
||||||
|
|
||||||
/* first read two byes to obtain length */
|
/* first read two byes to obtain length */
|
||||||
while (msg->len < 2) {
|
if (msg->len < 2) {
|
||||||
rc = read(serial_fd, msg->tail, 2 - msg->len);
|
rc = read(sh->fd.fd, msg->tail, 2 - msg->len);
|
||||||
if (rc < 0) {
|
if (rc < 0) {
|
||||||
perror("reading from serial port");
|
perror("ERROR reading from serial port");
|
||||||
msgb_free(msg);
|
msgb_free(msg);
|
||||||
return NULL;
|
return rc;
|
||||||
}
|
}
|
||||||
msgb_put(msg, rc);
|
msgb_put(msg, rc);
|
||||||
}
|
|
||||||
if (msg->data[0] != 0)
|
|
||||||
fprintf(stderr, "Invalid header byte 0: 0x%02x\n",
|
|
||||||
msg->data[0]);
|
|
||||||
|
|
||||||
/* second byte is LAPD payload length */
|
if (msg->len >= 2) {
|
||||||
if (msg->data[1] + 2 < LAPD_HDR_LEN)
|
/* parse LAPD payload length */
|
||||||
fprintf(stderr, "Invalid header byte 1(len): %u\n",
|
if (msg->data[0] != 0)
|
||||||
msg->data[1]);
|
fprintf(stderr, "Suspicious header byte 0: 0x%02x\n",
|
||||||
|
msg->data[0]);
|
||||||
|
|
||||||
while (msg->len < 2 + msg->data[1]) {
|
sh->rxmsg_bytes_missing = msg->data[0] << 8;
|
||||||
rc = read(serial_fd, msg->tail, 2 + msg->data[1] - msg->len);
|
sh->rxmsg_bytes_missing += msg->data[1];
|
||||||
|
|
||||||
|
if (sh->rxmsg_bytes_missing < LAPD_HDR_LEN -2)
|
||||||
|
fprintf(stderr, "Invalid length in hdr: %u\n",
|
||||||
|
sh->rxmsg_bytes_missing);
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
/* try to read as many of the missing bytes as are available */
|
||||||
|
rc = read(sh->fd.fd, msg->tail, sh->rxmsg_bytes_missing);
|
||||||
if (rc < 0) {
|
if (rc < 0) {
|
||||||
perror("reading from serial port");
|
perror("ERROR reading from serial port");
|
||||||
msgb_free(msg);
|
msgb_free(msg);
|
||||||
return NULL;
|
return rc;
|
||||||
}
|
}
|
||||||
msgb_put(msg, rc);
|
msgb_put(msg, rc);
|
||||||
|
sh->rxmsg_bytes_missing -= rc;
|
||||||
|
|
||||||
|
if (sh->rxmsg_bytes_missing == 0) {
|
||||||
|
/* we have one complete message now */
|
||||||
|
sh->rx_msg = NULL;
|
||||||
|
|
||||||
|
if (msg->len > LAPD_HDR_LEN)
|
||||||
|
msg->l2h = msg->data + LAPD_HDR_LEN;
|
||||||
|
|
||||||
|
fprintf(stdout, "RX: ");
|
||||||
|
hexdump(msg->data, msg->len);
|
||||||
|
rc = handle_serial_msg(msg);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
if (msg->len > LAPD_HDR_LEN)
|
return rc;
|
||||||
msg->l2h = msg->data + LAPD_HDR_LEN;
|
}
|
||||||
|
|
||||||
fprintf(stdout, "RX: ");
|
static int serial_fd_cb(struct bsc_fd *bfd, unsigned int what)
|
||||||
hexdump(msg->data, msg->len);
|
{
|
||||||
|
int rc = 0;
|
||||||
|
|
||||||
return msg;
|
if (what & BSC_FD_READ)
|
||||||
|
rc = handle_ser_read(bfd);
|
||||||
|
|
||||||
|
if (rc < 0)
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
if (what & BSC_FD_WRITE)
|
||||||
|
rc = handle_ser_write(bfd);
|
||||||
|
|
||||||
|
return rc;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int file_is_readable(const char *fname)
|
static int file_is_readable(const char *fname)
|
||||||
|
@ -282,6 +347,61 @@ static int handle_state_resp(u_int8_t state)
|
||||||
return rc;
|
return rc;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int handle_serial_msg(struct msgb *rx_msg)
|
||||||
|
{
|
||||||
|
struct abis_om_hdr *oh;
|
||||||
|
struct abis_om_fom_hdr *foh;
|
||||||
|
int rc = -1;
|
||||||
|
|
||||||
|
if (rx_msg->len < LAPD_HDR_LEN
|
||||||
|
+ sizeof(struct abis_om_fom_hdr)
|
||||||
|
+ sizeof(struct abis_om_hdr)) {
|
||||||
|
if (!memcmp(rx_msg->data + 2, too_fast,
|
||||||
|
sizeof(too_fast))) {
|
||||||
|
fprintf(stderr, "BS11 tells us we're too "
|
||||||
|
"fast, try --delay bigger than %u\n",
|
||||||
|
delay_ms);
|
||||||
|
return -E2BIG;
|
||||||
|
} else
|
||||||
|
fprintf(stderr, "unknown BS11 message\n");
|
||||||
|
}
|
||||||
|
|
||||||
|
oh = (struct abis_om_hdr *) msgb_l2(rx_msg);
|
||||||
|
foh = (struct abis_om_fom_hdr *) oh->data;
|
||||||
|
switch (foh->msg_type) {
|
||||||
|
case NM_MT_BS11_FACTORY_LOGON_ACK:
|
||||||
|
printf("FACTORY LOGON: ACK\n");
|
||||||
|
if (bs11cfg_state == STATE_NONE)
|
||||||
|
bs11cfg_state = STATE_LOGON_ACK;
|
||||||
|
rc = 0;
|
||||||
|
break;
|
||||||
|
case NM_MT_BS11_GET_STATE_ACK:
|
||||||
|
rc = handle_state_resp(foh->data[2]);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
rc = abis_nm_rcvmsg(rx_msg);
|
||||||
|
}
|
||||||
|
if (rc < 0) {
|
||||||
|
perror("ERROR in main loop");
|
||||||
|
//break;
|
||||||
|
}
|
||||||
|
if (rc == 1)
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
switch (bs11cfg_state) {
|
||||||
|
case STATE_NONE:
|
||||||
|
abis_nm_bs11_factory_logon(g_bts, 1);
|
||||||
|
break;
|
||||||
|
case STATE_LOGON_ACK:
|
||||||
|
abis_nm_bs11_get_state(g_bts);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
static void print_banner(void)
|
static void print_banner(void)
|
||||||
{
|
{
|
||||||
printf("bs11_config (C) 2009 by Harald Welte and Dieter Spaar\n");
|
printf("bs11_config (C) 2009 by Harald Welte and Dieter Spaar\n");
|
||||||
|
@ -344,6 +464,17 @@ static void handle_options(int argc, char **argv)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void signal_handler(int signal)
|
||||||
|
{
|
||||||
|
fprintf(stdout, "signal %u received\n", signal);
|
||||||
|
|
||||||
|
switch (signal) {
|
||||||
|
case SIGABRT:
|
||||||
|
abis_nm_bs11_factory_logon(g_bts, 0);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
int main(int argc, char **argv)
|
int main(int argc, char **argv)
|
||||||
{
|
{
|
||||||
struct gsm_network *gsmnet;
|
struct gsm_network *gsmnet;
|
||||||
|
@ -384,63 +515,24 @@ int main(int argc, char **argv)
|
||||||
}
|
}
|
||||||
g_bts = &gsmnet->bts[0];
|
g_bts = &gsmnet->bts[0];
|
||||||
|
|
||||||
|
INIT_LLIST_HEAD(&ser_handle->tx_queue);
|
||||||
|
ser_handle->fd.fd = serial_fd;
|
||||||
|
ser_handle->fd.when = BSC_FD_READ;
|
||||||
|
ser_handle->fd.cb = serial_fd_cb;
|
||||||
|
ser_handle->fd.data = ser_handle;
|
||||||
|
rc = bsc_register_fd(&ser_handle->fd);
|
||||||
|
if (rc < 0) {
|
||||||
|
fprintf(stderr, "could not register FD: %s\n",
|
||||||
|
strerror(rc));
|
||||||
|
exit(1);
|
||||||
|
}
|
||||||
|
|
||||||
|
signal(SIGABRT, &signal_handler);
|
||||||
|
|
||||||
abis_nm_bs11_factory_logon(g_bts, 1);
|
abis_nm_bs11_factory_logon(g_bts, 1);
|
||||||
|
|
||||||
while (1) {
|
while (1) {
|
||||||
struct msgb *rx_msg;
|
bsc_select_main();
|
||||||
struct abis_om_hdr *oh;
|
|
||||||
struct abis_om_fom_hdr *foh;
|
|
||||||
rc = -1;
|
|
||||||
|
|
||||||
rx_msg = serial_read_msg();
|
|
||||||
|
|
||||||
if (rx_msg->len < LAPD_HDR_LEN
|
|
||||||
+ sizeof(struct abis_om_fom_hdr)
|
|
||||||
+ sizeof(struct abis_om_hdr)) {
|
|
||||||
if (!memcmp(rx_msg->data + 2, too_fast,
|
|
||||||
sizeof(too_fast))) {
|
|
||||||
fprintf(stderr, "BS11 tells us we're too "
|
|
||||||
"fast, try --delay bigger than %u\n",
|
|
||||||
delay_ms);
|
|
||||||
break;
|
|
||||||
} else
|
|
||||||
fprintf(stderr, "unknown BS11 message\n");
|
|
||||||
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
oh = (struct abis_om_hdr *) msgb_l2(rx_msg);
|
|
||||||
foh = (struct abis_om_fom_hdr *) oh->data;
|
|
||||||
switch (foh->msg_type) {
|
|
||||||
case NM_MT_BS11_FACTORY_LOGON_ACK:
|
|
||||||
printf("FACTORY LOGON: ACK\n");
|
|
||||||
if (bs11cfg_state == STATE_NONE)
|
|
||||||
bs11cfg_state = STATE_LOGON_ACK;
|
|
||||||
rc = 0;
|
|
||||||
break;
|
|
||||||
case NM_MT_BS11_GET_STATE_ACK:
|
|
||||||
rc = handle_state_resp(foh->data[2]);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
rc = abis_nm_rcvmsg(rx_msg);
|
|
||||||
}
|
|
||||||
if (rc < 0) {
|
|
||||||
perror("in main loop");
|
|
||||||
//break;
|
|
||||||
}
|
|
||||||
if (rc == 1)
|
|
||||||
break;
|
|
||||||
|
|
||||||
switch (bs11cfg_state) {
|
|
||||||
case STATE_NONE:
|
|
||||||
abis_nm_bs11_factory_logon(g_bts, 1);
|
|
||||||
break;
|
|
||||||
case STATE_LOGON_ACK:
|
|
||||||
abis_nm_bs11_get_state(g_bts);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
abis_nm_bs11_factory_logon(g_bts, 0);
|
abis_nm_bs11_factory_logon(g_bts, 0);
|
||||||
|
|
Loading…
Reference in New Issue