LCR now runs as a user.
[lcr.git] / ie.cpp
diff --git a/ie.cpp b/ie.cpp
index 1c70514..c44c166 100644 (file)
--- a/ie.cpp
+++ b/ie.cpp
@@ -26,10 +26,8 @@ static void strnncpy(unsigned char *dest, unsigned char *src, int len, int dst_l
 
 
 /* IE_COMPLETE */
-void Pdss1::enc_ie_complete(unsigned char **ntmode, msg_t *msg, int complete)
+void Pdss1::enc_ie_complete(struct l3_msg *l3m, int complete)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
 
        if (complete<0 || complete>1)
        {
@@ -40,24 +38,15 @@ void Pdss1::enc_ie_complete(unsigned char **ntmode, msg_t *msg, int complete)
        if (complete)
        {
                add_trace("complete", NULL, NULL);
-               p = msg_put(msg, 1);
-               if (p_m_d_ntmode)
-               {
-                       *ntmode = p;
-               } else
-                       qi->sending_complete.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
-               p[0] = IE_COMPLETE;
+               l3m->sending_complete++;
        }
 }
 
-void Pdss1::dec_ie_complete(unsigned char *p, Q931_info_t *qi, int *complete)
+void Pdss1::dec_ie_complete(struct l3_msg *l3m, int *complete)
 {
        *complete = 0;
-       if (!p_m_d_ntmode)
-       {
-               if (qi->sending_complete.off)
-                       *complete = 1;
-       } else
+       // special case: p is not a pointer, it's a value
+       unsigned char p = l3m->sending_complete;
        if (p)
                *complete = 1;
 
@@ -67,10 +56,9 @@ void Pdss1::dec_ie_complete(unsigned char *p, Q931_info_t *qi, int *complete)
 
 
 /* IE_BEARER */
-void Pdss1::enc_ie_bearer(unsigned char **ntmode, msg_t *msg, int coding, int capability, int mode, int rate, int multi, int user)
+void Pdss1::enc_ie_bearer(struct l3_msg *l3m, int coding, int capability, int mode, int rate, int multi, int user)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        if (coding<0 || coding>3)
@@ -117,11 +105,6 @@ void Pdss1::enc_ie_bearer(unsigned char **ntmode, msg_t *msg, int coding, int ca
        add_trace("bearer", "user", "%d", user);
 
        l = 2 + (multi>=0) + (user>=0);
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->bearer_capability.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_BEARER;
        p[1] = l;
        p[2] = 0x80 + (coding<<5) + capability;
@@ -130,9 +113,10 @@ void Pdss1::enc_ie_bearer(unsigned char **ntmode, msg_t *msg, int coding, int ca
                p[4] = 0x80 + multi;
        if (user >= 0)
                p[4+(multi>=0)] = 0xa0 + user;
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_bearer(unsigned char *p, Q931_info_t *qi, int *coding, int *capability, int *mode, int *rate, int *multi, int *user)
+void Pdss1::dec_ie_bearer(struct l3_msg *l3m, int *coding, int *capability, int *mode, int *rate, int *multi, int *user)
 {
        *coding = -1;
        *capability = -1;
@@ -141,12 +125,7 @@ void Pdss1::dec_ie_bearer(unsigned char *p, Q931_info_t *qi, int *coding, int *c
        *multi = -1;
        *user = -1;
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->bearer_capability.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->bearer_capability.off + 1;
-       }
+       unsigned char *p = l3m->bearer_capability;
        if (!p)
                return;
        if (p[0] < 2)
@@ -183,10 +162,9 @@ void Pdss1::dec_ie_bearer(unsigned char *p, Q931_info_t *qi, int *coding, int *c
 
 
 /* IE_HLC */
-void Pdss1::enc_ie_hlc(unsigned char **ntmode, msg_t *msg, int coding, int interpretation, int presentation, int hlc, int exthlc)
+void Pdss1::enc_ie_hlc(struct l3_msg *l3m, int coding, int interpretation, int presentation, int hlc, int exthlc)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        if (coding<0 || coding>3)
@@ -223,11 +201,6 @@ void Pdss1::enc_ie_hlc(unsigned char **ntmode, msg_t *msg, int coding, int inter
                add_trace("hlc", "exthlc", "%d", exthlc);
 
        l = 2 + (exthlc>=0);
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->hlc.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_HLC;
        p[1] = l;
        p[2] = 0x80 + (coding<<5) + (interpretation<<2) + presentation;
@@ -237,9 +210,10 @@ void Pdss1::enc_ie_hlc(unsigned char **ntmode, msg_t *msg, int coding, int inter
                p[4] = 0x80 + exthlc;
        } else
                p[3] = 0x80 + hlc;
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_hlc(unsigned char *p, Q931_info_t *qi, int *coding, int *interpretation, int *presentation, int *hlc, int *exthlc)
+void Pdss1::dec_ie_hlc(struct l3_msg *l3m, int *coding, int *interpretation, int *presentation, int *hlc, int *exthlc)
 {
        *coding = -1;
        *interpretation = -1;
@@ -247,12 +221,7 @@ void Pdss1::dec_ie_hlc(unsigned char *p, Q931_info_t *qi, int *coding, int *inte
        *hlc = -1;
        *exthlc = -1;
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->hlc.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->hlc.off + 1;
-       }
+       unsigned char *p = l3m->hlc;
        if (!p)
                return;
        if (p[0] < 2)
@@ -280,10 +249,9 @@ void Pdss1::dec_ie_hlc(unsigned char *p, Q931_info_t *qi, int *coding, int *inte
 
 
 /* IE_CALL_ID */
-void Pdss1::enc_ie_call_id(unsigned char **ntmode, msg_t *msg, unsigned char *callid, int callid_len)
+void Pdss1::enc_ie_call_id(struct l3_msg *l3m, unsigned char *callid, int callid_len)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        char buffer[25];
@@ -309,29 +277,20 @@ void Pdss1::enc_ie_call_id(unsigned char **ntmode, msg_t *msg, unsigned char *ca
        add_trace("callid", NULL, "%s", buffer[0]?buffer+1:"<none>");
 
        l = callid_len;
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->call_id.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_CALL_ID;
        p[1] = l;
        memcpy(p+2, callid, callid_len);
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_call_id(unsigned char *p, Q931_info_t *qi, unsigned char *callid, int *callid_len)
+void Pdss1::dec_ie_call_id(struct l3_msg *l3m, unsigned char *callid, int *callid_len)
 {
        char buffer[25];
        int i;
 
        *callid_len = -1;
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->call_id.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->call_id.off + 1;
-       }
+       unsigned char *p = l3m->call_id;
        if (!p)
                return;
        if (p[0] > 8)
@@ -355,10 +314,9 @@ void Pdss1::dec_ie_call_id(unsigned char *p, Q931_info_t *qi, unsigned char *cal
 
 
 /* IE_CALLED_PN */
-void Pdss1::enc_ie_called_pn(unsigned char **ntmode, msg_t *msg, int type, int plan, unsigned char *number)
+void Pdss1::enc_ie_called_pn(struct l3_msg *l3m, int type, int plan, unsigned char *number)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        if (type<0 || type>7)
@@ -382,29 +340,20 @@ void Pdss1::enc_ie_called_pn(unsigned char **ntmode, msg_t *msg, int type, int p
        add_trace("called_pn", "number", "%s", number);
 
        l = 1+strlen((char *)number);
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->called_nr.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_CALLED_PN;
        p[1] = l;
        p[2] = 0x80 + (type<<4) + plan;
        UNCPY((char *)p+3, (char *)number, strlen((char *)number));
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_called_pn(unsigned char *p, Q931_info_t *qi, int *type, int *plan, unsigned char *number, int number_len)
+void Pdss1::dec_ie_called_pn(struct l3_msg *l3m, int *type, int *plan, unsigned char *number, int number_len)
 {
        *type = -1;
        *plan = -1;
        *number = '\0';
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->called_nr.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->called_nr.off + 1;
-       }
+       unsigned char *p = l3m->called_nr;
        if (!p)
                return;
        if (p[0] < 2)
@@ -424,10 +373,9 @@ void Pdss1::dec_ie_called_pn(unsigned char *p, Q931_info_t *qi, int *type, int *
 
 
 /* IE_CALLING_PN */
-void Pdss1::enc_ie_calling_pn(unsigned char **ntmode, msg_t *msg, int type, int plan, int present, int screen, unsigned char *number)
+void Pdss1::enc_ie_calling_pn(struct l3_msg *l3m, int type, int plan, int present, int screen, unsigned char *number)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        if (type<0 || type>7)
@@ -462,11 +410,6 @@ void Pdss1::enc_ie_calling_pn(unsigned char **ntmode, msg_t *msg, int type, int
                l += strlen((char *)number);
        if (present >= 0)
                l += 1;
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->calling_nr.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_CALLING_PN;
        p[1] = l;
        if (present >= 0)
@@ -481,9 +424,10 @@ void Pdss1::enc_ie_calling_pn(unsigned char **ntmode, msg_t *msg, int type, int
                if (number) if (number[0])
                        UNCPY((char *)p+3, (char *)number, strlen((char *)number));
        }
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_calling_pn(unsigned char *p, Q931_info_t *qi, int *type, int *plan, int *present, int *screen, unsigned char *number, int number_len)
+void Pdss1::dec_ie_calling_pn(struct l3_msg *l3m, int *type, int *plan, int *present, int *screen, unsigned char *number, int number_len)
 {
        *type = -1;
        *plan = -1;
@@ -491,12 +435,7 @@ void Pdss1::dec_ie_calling_pn(unsigned char *p, Q931_info_t *qi, int *type, int
        *screen = -1;
        *number = '\0';
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->calling_nr.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->calling_nr.off + 1;
-       }
+       unsigned char *p = l3m->calling_nr;
        if (!p)
                return;
        if (p[0] < 1)
@@ -531,10 +470,9 @@ void Pdss1::dec_ie_calling_pn(unsigned char *p, Q931_info_t *qi, int *type, int
 
 
 /* IE_CONNECTED_PN */
-void Pdss1::enc_ie_connected_pn(unsigned char **ntmode, msg_t *msg, int type, int plan, int present, int screen, unsigned char *number)
+void Pdss1::enc_ie_connected_pn(struct l3_msg *l3m, int type, int plan, int present, int screen, unsigned char *number)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        if (type<0 || type>7)
@@ -569,11 +507,6 @@ void Pdss1::enc_ie_connected_pn(unsigned char **ntmode, msg_t *msg, int type, in
                l += strlen((char *)number);
        if (present >= 0)
                l += 1;
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->connected_nr.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_CONNECT_PN;
        p[1] = l;
        if (present >= 0)
@@ -588,9 +521,10 @@ void Pdss1::enc_ie_connected_pn(unsigned char **ntmode, msg_t *msg, int type, in
                if (number) if (number[0])
                        UNCPY((char *)p+3, (char *)number, strlen((char *)number));
        }
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_connected_pn(unsigned char *p, Q931_info_t *qi, int *type, int *plan, int *present, int *screen, unsigned char *number, int number_len)
+void Pdss1::dec_ie_connected_pn(struct l3_msg *l3m, int *type, int *plan, int *present, int *screen, unsigned char *number, int number_len)
 {
        *type = -1;
        *plan = -1;
@@ -598,12 +532,7 @@ void Pdss1::dec_ie_connected_pn(unsigned char *p, Q931_info_t *qi, int *type, in
        *screen = -1;
        *number = '\0';
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->connected_nr.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->connected_nr.off + 1;
-       }
+       unsigned char *p = l3m->connected_nr;
        if (!p)
                return;
        if (p[0] < 1)
@@ -638,10 +567,9 @@ void Pdss1::dec_ie_connected_pn(unsigned char *p, Q931_info_t *qi, int *type, in
 
 
 /* IE_CAUSE */
-void Pdss1::enc_ie_cause(unsigned char **ntmode, msg_t *msg, int location, int cause)
+void Pdss1::enc_ie_cause(struct l3_msg *l3m, int location, int cause)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        if (location<0 || location>7)
@@ -659,42 +587,29 @@ void Pdss1::enc_ie_cause(unsigned char **ntmode, msg_t *msg, int location, int c
        add_trace("cause", "value", "%d", cause);
 
        l = 2;
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->cause.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_CAUSE;
        p[1] = l;
        p[2] = 0x80 + location;
        p[3] = 0x80 + cause;
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
-void enc_ie_cause_standalone(unsigned char **ntmode, msg_t *msg, int location, int cause)
+void enc_ie_cause_standalone(struct l3_msg *l3m, int location, int cause)
 {
-       unsigned char *p = msg_put(msg, 4);
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
-       if (ntmode)
-               *ntmode = p+1;
-       else
-               qi->cause.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
+       unsigned char p[256];
        p[0] = IE_CAUSE;
        p[1] = 2;
        p[2] = 0x80 + location;
        p[3] = 0x80 + cause;
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
 
-void Pdss1::dec_ie_cause(unsigned char *p, Q931_info_t *qi, int *location, int *cause)
+void Pdss1::dec_ie_cause(struct l3_msg *l3m, int *location, int *cause)
 {
        *location = -1;
        *cause = -1;
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->cause.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->cause.off + 1;
-       }
+       unsigned char *p = l3m->cause;
        if (!p)
                return;
        if (p[0] < 2)
@@ -712,10 +627,9 @@ void Pdss1::dec_ie_cause(unsigned char *p, Q931_info_t *qi, int *location, int *
 
 
 /* IE_CHANNEL_ID */
-void Pdss1::enc_ie_channel_id(unsigned char **ntmode, msg_t *msg, int exclusive, int channel)
+void Pdss1::enc_ie_channel_id(struct l3_msg *l3m, int exclusive, int channel)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
        int pri = p_m_mISDNport->pri;
 
@@ -750,11 +664,6 @@ void Pdss1::enc_ie_channel_id(unsigned char **ntmode, msg_t *msg, int exclusive,
        {
                /* BRI */
                l = 1;
-               p = msg_put(msg, l+2);
-               if (p_m_d_ntmode)
-                       *ntmode = p+1;
-               else
-                       qi->channel_id.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
                p[0] = IE_CHANNEL_ID;
                p[1] = l;
                if (channel == CHANNEL_NO)
@@ -762,6 +671,7 @@ void Pdss1::enc_ie_channel_id(unsigned char **ntmode, msg_t *msg, int exclusive,
                else if (channel == CHANNEL_ANY)
                        channel = 3;
                p[2] = 0x80 + (exclusive<<3) + channel;
+               add_layer3_ie(l3m, p[0], p[1], p+2);
        } else
        {
                /* PRI */
@@ -770,43 +680,30 @@ void Pdss1::enc_ie_channel_id(unsigned char **ntmode, msg_t *msg, int exclusive,
                if (channel == CHANNEL_ANY) /* any channel */
                {
                        l = 1;
-                       p = msg_put(msg, l+2);
-                       if (p_m_d_ntmode)
-                               *ntmode = p+1;
-                       else
-                               qi->channel_id.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
                        p[0] = IE_CHANNEL_ID;
                        p[1] = l;
                        p[2] = 0x80 + 0x20 + 0x03;
+                       add_layer3_ie(l3m, p[0], p[1], p+2);
                        return; /* end */
                }
                l = 3;
-               p = msg_put(msg, l+2);
-               if (p_m_d_ntmode)
-                       *ntmode = p+1;
-               else
-                       qi->channel_id.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
                p[0] = IE_CHANNEL_ID;
                p[1] = l;
                p[2] = 0x80 + 0x20 + (exclusive<<3) + 0x01;
                p[3] = 0x80 + 3; /* CCITT, Number, B-type */
                p[4] = 0x80 + channel;
+               add_layer3_ie(l3m, p[0], p[1], p+2);
        }
 }
 
-void Pdss1::dec_ie_channel_id(unsigned char *p, Q931_info_t *qi, int *exclusive, int *channel)
+void Pdss1::dec_ie_channel_id(struct l3_msg *l3m, int *exclusive, int *channel)
 {
        int pri = p_m_mISDNport->pri;
 
        *exclusive = -1;
        *channel = -1;
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->channel_id.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->channel_id.off + 1;
-       }
+       unsigned char *p = l3m->channel_id;
        if (!p)
                return;
        if (p[0] < 1)
@@ -900,10 +797,9 @@ void Pdss1::dec_ie_channel_id(unsigned char *p, Q931_info_t *qi, int *exclusive,
 
 
 /* IE_DATE */
-void Pdss1::enc_ie_date(unsigned char **ntmode, msg_t *msg, time_t ti, int no_seconds)
+void Pdss1::enc_ie_date(struct l3_msg *l3m, time_t ti, int no_seconds)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        struct tm *tm;
@@ -919,11 +815,6 @@ void Pdss1::enc_ie_date(unsigned char **ntmode, msg_t *msg, time_t ti, int no_se
        add_trace("date", "time", "%d:%d:%d", tm->tm_hour, tm->tm_min, tm->tm_sec);
 
        l = 5 + (!no_seconds);
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->date.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_DATE;
        p[1] = l;
        p[2] = tm->tm_year % 100;
@@ -933,14 +824,14 @@ void Pdss1::enc_ie_date(unsigned char **ntmode, msg_t *msg, time_t ti, int no_se
        p[6] = tm->tm_min;
        if (!no_seconds)
                p[7] = tm->tm_sec;
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
 
 /* IE_DISPLAY */
-void Pdss1::enc_ie_display(unsigned char **ntmode, msg_t *msg, unsigned char *display)
+void Pdss1::enc_ie_display(struct l3_msg *l3m, unsigned char *display)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        if (!display[0])
@@ -958,26 +849,17 @@ void Pdss1::enc_ie_display(unsigned char **ntmode, msg_t *msg, unsigned char *di
        add_trace("display", NULL, "%s", display);
 
        l = strlen((char *)display);
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->display.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_DISPLAY;
        p[1] = l;
        UNCPY((char *)p+2, (char *)display, strlen((char *)display));
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_display(unsigned char *p, Q931_info_t *qi, unsigned char *display, int display_len)
+void Pdss1::dec_ie_display(struct l3_msg *l3m, unsigned char *display, int display_len)
 {
        *display = '\0';
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->display.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->display.off + 1;
-       }
+       unsigned char *p = l3m->display;
        if (!p)
                return;
        if (p[0] < 1)
@@ -993,10 +875,9 @@ void Pdss1::dec_ie_display(unsigned char *p, Q931_info_t *qi, unsigned char *dis
 
 
 /* IE_KEYPAD */
-void Pdss1::enc_ie_keypad(unsigned char **ntmode, msg_t *msg, unsigned char *keypad)
+void Pdss1::enc_ie_keypad(struct l3_msg *l3m, unsigned char *keypad)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        if (!keypad[0])
@@ -1008,26 +889,17 @@ void Pdss1::enc_ie_keypad(unsigned char **ntmode, msg_t *msg, unsigned char *key
        add_trace("keypad", NULL, "%s", keypad);
 
        l = strlen((char *)keypad);
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->keypad.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_KEYPAD;
        p[1] = l;
        UNCPY((char *)p+2, (char *)keypad, strlen((char *)keypad));
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_keypad(unsigned char *p, Q931_info_t *qi, unsigned char *keypad, int keypad_len)
+void Pdss1::dec_ie_keypad(struct l3_msg *l3m, unsigned char *keypad, int keypad_len)
 {
        *keypad = '\0';
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->keypad.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->keypad.off + 1;
-       }
+       unsigned char *p = l3m->keypad;
        if (!p)
                return;
        if (p[0] < 1)
@@ -1043,10 +915,9 @@ void Pdss1::dec_ie_keypad(unsigned char *p, Q931_info_t *qi, unsigned char *keyp
 
 
 /* IE_NOTIFY */
-void Pdss1::enc_ie_notify(unsigned char **ntmode, msg_t *msg, int notify)
+void Pdss1::enc_ie_notify(struct l3_msg *l3m, int notify)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        if (notify<0 || notify>0x7f)
@@ -1058,26 +929,17 @@ void Pdss1::enc_ie_notify(unsigned char **ntmode, msg_t *msg, int notify)
        add_trace("notify", NULL, "%d", notify);
 
        l = 1;
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->notify.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_NOTIFY;
        p[1] = l;
        p[2] = 0x80 + notify;
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_notify(unsigned char *p, Q931_info_t *qi, int *notify)
+void Pdss1::dec_ie_notify(struct l3_msg *l3m, int *notify)
 {
        *notify = -1;
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->notify.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->notify.off + 1;
-       }
+       unsigned char *p = l3m->notify;
        if (!p)
                return;
        if (p[0] < 1)
@@ -1093,10 +955,9 @@ void Pdss1::dec_ie_notify(unsigned char *p, Q931_info_t *qi, int *notify)
 
 
 /* IE_PROGRESS */
-void Pdss1::enc_ie_progress(unsigned char **ntmode, msg_t *msg, int coding, int location, int progress)
+void Pdss1::enc_ie_progress(struct l3_msg *l3m, int coding, int location, int progress)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        if (coding<0 || coding>0x03)
@@ -1120,29 +981,20 @@ void Pdss1::enc_ie_progress(unsigned char **ntmode, msg_t *msg, int coding, int
        add_trace("progress", "indicator", "%d", progress);
 
        l = 2;
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->progress.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_PROGRESS;
        p[1] = l;
        p[2] = 0x80 + (coding<<5) + location;
        p[3] = 0x80 + progress;
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_progress(unsigned char *p, Q931_info_t *qi, int *coding, int *location, int *progress)
+void Pdss1::dec_ie_progress(struct l3_msg *l3m, int *coding, int *location, int *progress)
 {
        *coding = -1;
        *location = -1;
        *progress = -1;
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->progress.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->progress.off + 1;
-       }
+       unsigned char *p = l3m->progress;
        if (!p)
                return;
        if (p[0] < 1)
@@ -1162,10 +1014,9 @@ void Pdss1::dec_ie_progress(unsigned char *p, Q931_info_t *qi, int *coding, int
 
 
 /* IE_REDIR_NR (redirecting = during MT_SETUP) */
-void Pdss1::enc_ie_redir_nr(unsigned char **ntmode, msg_t *msg, int type, int plan, int present, int screen, int reason, unsigned char *number)
+void Pdss1::enc_ie_redir_nr(struct l3_msg *l3m, int type, int plan, int present, int screen, int reason, unsigned char *number)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        if (type<0 || type>7)
@@ -1210,11 +1061,6 @@ void Pdss1::enc_ie_redir_nr(unsigned char **ntmode, msg_t *msg, int type, int pl
                if (reason >= 0)
                        l += 1;
        }
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->redirect_nr.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_REDIR_NR;
        p[1] = l;
        if (present >= 0)
@@ -1239,9 +1085,10 @@ void Pdss1::enc_ie_redir_nr(unsigned char **ntmode, msg_t *msg, int type, int pl
                if (number) if (number[0])
                        UNCPY((char *)p+3, (char *)number, strlen((char *)number));
        }
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_redir_nr(unsigned char *p, Q931_info_t *qi, int *type, int *plan, int *present, int *screen, int *reason, unsigned char *number, int number_len)
+void Pdss1::dec_ie_redir_nr(struct l3_msg *l3m, int *type, int *plan, int *present, int *screen, int *reason, unsigned char *number, int number_len)
 {
        *type = -1;
        *plan = -1;
@@ -1250,12 +1097,7 @@ void Pdss1::dec_ie_redir_nr(unsigned char *p, Q931_info_t *qi, int *type, int *p
        *reason = -1;
        *number = '\0';
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->redirect_nr.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->redirect_nr.off + 1;
-       }
+       unsigned char *p = l3m->redirect_nr;
        if (!p)
                return;
        if (p[0] < 1)
@@ -1293,10 +1135,9 @@ void Pdss1::dec_ie_redir_nr(unsigned char *p, Q931_info_t *qi, int *type, int *p
 
 
 /* IE_REDIR_DN (redirection = during MT_NOTIFY) */
-void Pdss1::enc_ie_redir_dn(unsigned char **ntmode, msg_t *msg, int type, int plan, int present, unsigned char *number)
+void Pdss1::enc_ie_redir_dn(struct l3_msg *l3m, int type, int plan, int present, unsigned char *number)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        if (type<0 || type>7)
@@ -1325,11 +1166,6 @@ void Pdss1::enc_ie_redir_dn(unsigned char **ntmode, msg_t *msg, int type, int pl
                l += strlen((char *)number);
        if (present >= 0)
                l += 1;
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->redirect_dn.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_REDIR_DN;
        p[1] = l;
        if (present >= 0)
@@ -1344,21 +1180,17 @@ void Pdss1::enc_ie_redir_dn(unsigned char **ntmode, msg_t *msg, int type, int pl
                if (number)
                        UNCPY((char *)p+3, (char *)number, strlen((char *)number));
        }
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_redir_dn(unsigned char *p, Q931_info_t *qi, int *type, int *plan, int *present, unsigned char *number, int number_len)
+void Pdss1::dec_ie_redir_dn(struct l3_msg *l3m, int *type, int *plan, int *present, unsigned char *number, int number_len)
 {
        *type = -1;
        *plan = -1;
        *present = -1;
        *number = '\0';
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->redirect_dn.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->redirect_dn.off + 1;
-       }
+       unsigned char *p = l3m->redirect_dn;
        if (!p)
                return;
        if (p[0] < 1)
@@ -1386,10 +1218,9 @@ void Pdss1::dec_ie_redir_dn(unsigned char *p, Q931_info_t *qi, int *type, int *p
 
 
 /* IE_FACILITY */
-void Pdss1::enc_ie_facility(unsigned char **ntmode, msg_t *msg, unsigned char *facility, int facility_len)
+void Pdss1::enc_ie_facility(struct l3_msg *l3m, unsigned char *facility, int facility_len)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        char buffer[768];
@@ -1410,29 +1241,20 @@ void Pdss1::enc_ie_facility(unsigned char **ntmode, msg_t *msg, unsigned char *f
        add_trace("facility", NULL, "%s", buffer+1);
 
        l = facility_len;
-       p = msg_put(msg, l+2);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->facility.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_FACILITY;
        p[1] = l;
        memcpy(p+2, facility, facility_len);
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_facility(unsigned char *p, Q931_info_t *qi, unsigned char *facility, int *facility_len)
+void Pdss1::dec_ie_facility(struct l3_msg *l3m, unsigned char *facility, int *facility_len)
 {
        char debug[768];
        int i;
 
        *facility_len = 0;
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->facility.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->facility.off + 1;
-       }
+       unsigned char *p = l3m->facility;
        if (!p)
                return;
 
@@ -1451,7 +1273,7 @@ void Pdss1::dec_ie_facility(unsigned char *p, Q931_info_t *qi, unsigned char *fa
 }
 
 
-void Pdss1::dec_facility_centrex(unsigned char *p, Q931_info_t *qi, unsigned char *cnip, int cnip_len)
+void Pdss1::dec_facility_centrex(struct l3_msg *l3m, unsigned char *cnip, int cnip_len)
 {
        unsigned char centrex[256];
        char debug[768];
@@ -1459,7 +1281,7 @@ void Pdss1::dec_facility_centrex(unsigned char *p, Q931_info_t *qi, unsigned cha
        int i = 0, j;
        *cnip = '\0';
 
-       dec_ie_facility(p, qi, centrex, &facility_len);
+       dec_ie_facility(l3m, centrex, &facility_len);
        if (facility_len >= 2)
        {
                if (centrex[i++] != CENTREX_FAC)
@@ -1498,10 +1320,9 @@ void Pdss1::dec_facility_centrex(unsigned char *p, Q931_info_t *qi, unsigned cha
 
 
 /* IE_USERUSER */
-void Pdss1::enc_ie_useruser(unsigned char **ntmode, msg_t *msg, int protocol, unsigned char *user, int user_len)
+void Pdss1::enc_ie_useruser(struct l3_msg *l3m, int protocol, unsigned char *user, int user_len)
 {
-       unsigned char *p;
-       Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
+       unsigned char p[256];
        int l;
 
        char buffer[768];
@@ -1528,18 +1349,14 @@ void Pdss1::enc_ie_useruser(unsigned char **ntmode, msg_t *msg, int protocol, un
        add_trace("useruser", "value", "%s", buffer);
 
        l = user_len;
-       p = msg_put(msg, l+3);
-       if (p_m_d_ntmode)
-               *ntmode = p+1;
-       else
-               qi->useruser.off = p - (unsigned char *)qi - sizeof(Q931_info_t);
        p[0] = IE_USER_USER;
        p[1] = l;
        p[2] = 0x80 + protocol;
        memcpy(p+3, user, user_len);
+       add_layer3_ie(l3m, p[0], p[1], p+2);
 }
 
-void Pdss1::dec_ie_useruser(unsigned char *p, Q931_info_t *qi, int *protocol, unsigned char *user, int *user_len)
+void Pdss1::dec_ie_useruser(struct l3_msg *l3m, int *protocol, unsigned char *user, int *user_len)
 {
        char buffer[768];
        int i;
@@ -1547,12 +1364,7 @@ void Pdss1::dec_ie_useruser(unsigned char *p, Q931_info_t *qi, int *protocol, un
        *user_len = 0;
        *protocol = -1;
 
-       if (!p_m_d_ntmode)
-       {
-               p = NULL;
-               if (qi->useruser.off)
-                       p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->useruser.off + 1;
-       }
+       unsigned char *p = l3m->useruser;
        if (!p)
                return;