# HG changeset patch
# User Mychaela Falconia <falcon@freecalypso.org>
# Date 1679102562 28800
# Node ID a3d71489672fefb4896e1730ac8098d8b049066e
# Parent  05d01e810217af6159ebaccb06c184132f8f1150
sip-manual-out: implement tfo-req command

diff -r 05d01e810217 -r a3d71489672f sip-manual-out/rtp_tx.c
--- a/sip-manual-out/rtp_tx.c	Fri Mar 17 16:52:21 2023 -0800
+++ b/sip-manual-out/rtp_tx.c	Fri Mar 17 17:22:42 2023 -0800
@@ -14,6 +14,7 @@
 #include <unistd.h>
 #include "../include/tmgw_const.h"
 #include "../include/rtp_defs.h"
+#include "../libutil/osmo_bits.h"
 
 extern struct sockaddr_in rtp_local_addr, rtp_remote_addr;
 extern int rtp_udp_fd, rtcp_udp_fd, pcma_selected;
@@ -23,12 +24,32 @@
 static uint32_t rtp_out_ts;
 static uint16_t rtp_out_seq;
 
+static uint16_t is_out_buf[7], *is_out_ptr;
+static unsigned is_out_count;
+
 void
 assign_rtpout_ssrc()
 {
 	rtp_ssrc = cur_event_time.tv_sec ^ cur_event_time.tv_usec ^ getpid();
 }
 
+static void
+insert_is_msg(payload, word)
+	uint8_t *payload;
+	uint16_t word;
+{
+	ubit_t is_bits[10];
+	uint8_t *bytep;
+	unsigned n;
+
+	uint16_to_bits(word, is_bits, 10);
+	for (n = 0; n < 10; n++) {
+		bytep = payload + n * 16;
+		*bytep &= 0xFE;
+		*bytep |= is_bits[n];
+	}
+}
+
 void
 generate_rtp_packet()
 {
@@ -42,7 +63,25 @@
 	rtp_out_ts += 160;
 	pkt.ssrc = rtp_ssrc;
 	memset(pkt.payload, pcma_selected ? 0xD5 : 0xFF, RTP_MAX_PAYLOAD);
+	if (is_out_count) {
+		insert_is_msg(pkt.payload, *is_out_ptr++);
+		is_out_count--;
+	}
 	addrlen = sizeof(struct sockaddr_in);
 	sendto(rtp_udp_fd, &pkt, RTP_PACKET_SIZE_PSTN, 0,
 		(struct sockaddr *) &rtp_remote_addr, addrlen);
 }
+
+void
+send_tfo_req(sig, codec)
+	unsigned sig, codec;
+{
+	is_out_buf[0] = 0x15A;
+	is_out_buf[1] = 0x1A9;
+	is_out_buf[2] = 0x05D;
+	is_out_buf[3] = 0x14E;
+	is_out_buf[4] = 0x14B;
+	encode_tfo_ext_words(sig, codec, 0, is_out_buf + 5);
+	is_out_ptr = is_out_buf;
+	is_out_count = 7;
+}
diff -r 05d01e810217 -r a3d71489672f sip-manual-out/user_cmd.c
--- a/sip-manual-out/user_cmd.c	Fri Mar 17 16:52:21 2023 -0800
+++ b/sip-manual-out/user_cmd.c	Fri Mar 17 17:22:42 2023 -0800
@@ -9,6 +9,44 @@
 #include <string.h>
 #include <strings.h>
 
+static void
+tfo_req_cmd(args)
+	char *args;
+{
+	char *cp;
+	unsigned sig, codec;
+
+	for (cp = args; isspace(*cp); cp++)
+		;
+	if (!isdigit(*cp)) {
+inv_syntax:	fprintf(stderr, "error: tfo-req command invalid syntax\n");
+		return;
+	}
+	sig = strtoul(cp, &cp, 0);
+	if (!isspace(*cp))
+		goto inv_syntax;
+	if (sig > 0xFF) {
+		fprintf(stderr, "error: Sig argument out of range\n");
+		return;
+	}
+	while (isspace(*cp))
+		cp++;
+	if (!isdigit(*cp))
+		goto inv_syntax;
+	codec = strtoul(cp, &cp, 0);
+	if (*cp && !isspace(*cp))
+		goto inv_syntax;
+	if (codec > 14) {
+		fprintf(stderr, "error: Codec_Type argument out of range\n");
+		return;
+	}
+	while (isspace(*cp))
+		cp++;
+	if (*cp)
+		goto inv_syntax;
+	send_tfo_req(sig, codec);
+}
+
 void
 select_stdin()
 {
@@ -29,6 +67,8 @@
 		send_bye_req();
 	else if (!strcmp(cp, "c") || !strcasecmp(cp, "cancel"))
 		send_cancel_req();
+	else if (!strncmp(cp, "tfo-req", 7) && isspace(cp[7]))
+		tfo_req_cmd(cp + 8);
 	else
 		fprintf(stderr, "error: non-understood stdin command\n");
 }