X-Git-Url: http://git.eversberg.eu/gitweb.cgi?p=lcr.git;a=blobdiff_plain;f=ie.cpp;h=c44c166d2ea77a545ca535f61ee5dc2a8f52bdc0;hp=1c705145e137d7b9c973274d0029a3a3acb1ed6d;hb=b1ab2b9ac1cfc15d2a8f5850145dd69043cc3ef7;hpb=d57a2db4c6a9143b8fbee59ff4d151846e8f4303

diff --git a/ie.cpp b/ie.cpp
index 1c70514..c44c166 100644
--- 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;