From 909f17e6cac6b1b876169ade5755c1ef9fdc5efb Mon Sep 17 00:00:00 2001
From: markster <markster@f38db490-d61c-443f-a65b-d21fe96a405b>
Date: Fri, 29 Nov 2002 16:43:28 +0000
Subject: Version 0.3.0 from FTP

git-svn-id: http://svn.digium.com/svn/asterisk/trunk@558 f38db490-d61c-443f-a65b-d21fe96a405b
---
 callerid.c | 185 +++++++++++++++++++++++++++++++++++++++++++++++--------------
 1 file changed, 143 insertions(+), 42 deletions(-)

(limited to 'callerid.c')

diff --git a/callerid.c b/callerid.c
index 898396d86..f1827b76b 100755
--- a/callerid.c
+++ b/callerid.c
@@ -21,12 +21,11 @@
 #include <unistd.h>
 #include <math.h>
 #include <asterisk/ulaw.h>
+#include <asterisk/alaw.h>
+#include <asterisk/frame.h>
 #include <asterisk/callerid.h>
 #include <asterisk/logger.h>
 #include <asterisk/fskmodem.h>
-#include "sas.h"
-#include "cas.h"
-
 
 struct callerid_state {
 	fsk_data fskd;
@@ -46,9 +45,51 @@ struct callerid_state {
 
 float cid_dr[4], cid_di[4];
 float clidsb = 8000.0 / 1200.0;
+float sasdr, sasdi;
+float casdr1, casdi1, casdr2, casdi2;
 
 #define CALLERID_SPACE	2200.0		/* 2200 hz for "0" */
 #define CALLERID_MARK	1200.0		/* 1200 hz for "1" */
+#define SAS_FREQ		 440.0
+#define CAS_FREQ1		2130.0
+#define CAS_FREQ2		2750.0
+
+static inline void gen_tones(unsigned char *buf, int len, int codec, float ddr1, float ddi1, float ddr2, float ddi2, float *cr1, float *ci1, float *cr2, float *ci2)
+{
+	int x;
+	float t;
+	for (x=0;x<len;x++) {
+		t = *cr1 * ddr1 - *ci1 * ddi1;
+		*ci1 = *cr1 * ddi1 + *ci1 * ddr1;
+		*cr1 = t;
+		t = 2.0 - (*cr1 * *cr1 + *ci1 * *ci1);
+		*cr1 *= t;
+		*ci1 *= t; 	
+
+		t = *cr2 * ddr2 - *ci2 * ddi2;
+		*ci2 = *cr2 * ddi2 + *ci2 * ddr2;
+		*cr2 = t;
+		t = 2.0 - (*cr2 * *cr2 + *ci2 * *ci2);
+		*cr2 *= t;
+		*ci2 *= t; 	
+		buf[x] = AST_LIN2X((*cr1 + *cr2) * 8192.0);
+	}
+}
+
+static inline void gen_tone(unsigned char *buf, int len, int codec, float ddr1, float ddi1, float *cr1, float *ci1)
+{
+	int x;
+	float t;
+	for (x=0;x<len;x++) {
+		t = *cr1 * ddr1 - *ci1 * ddi1;
+		*ci1 = *cr1 * ddi1 + *ci1 * ddr1;
+		*cr1 = t;
+		t = 2.0 - (*cr1 * *cr1 + *ci1 * *ci1);
+		*cr1 *= t;
+		*ci1 *= t; 	
+		buf[x] = AST_LIN2X(*cr1 * 8192.0);
+	}
+}
 
 void callerid_init(void)
 {
@@ -57,6 +98,12 @@ void callerid_init(void)
 	cid_di[0] = sin(CALLERID_SPACE * 2.0 * M_PI / 8000.0);
 	cid_dr[1] = cos(CALLERID_MARK * 2.0 * M_PI / 8000.0);
 	cid_di[1] = sin(CALLERID_MARK * 2.0 * M_PI / 8000.0);
+	sasdr = cos(SAS_FREQ * 2.0 * M_PI / 8000.0);
+	sasdi = sin(SAS_FREQ * 2.0 * M_PI / 8000.0);
+	casdr1 = cos(CAS_FREQ1 * 2.0 * M_PI / 8000.0);
+	casdi1 = sin(CAS_FREQ1 * 2.0 * M_PI / 8000.0);
+	casdr2 = cos(CAS_FREQ2 * 2.0 * M_PI / 8000.0);
+	casdi2 = sin(CAS_FREQ2 * 2.0 * M_PI / 8000.0);
 }
 
 struct callerid_state *callerid_new(void)
@@ -99,36 +146,28 @@ void callerid_get(struct callerid_state *cid, char **name, char **number, int *f
 		*number = cid->number;
 }
 
-int ast_gen_cas(unsigned char *outbuf, int sendsas, int len)
+int ast_gen_cas(unsigned char *outbuf, int sendsas, int len, int codec)
 {
 	int pos = 0;
-	int cnt;
 	int saslen=2400;
+	float cr1 = 1.0;
+	float ci1 = 0.0;
+	float cr2 = 1.0;
+	float ci2 = 0.0;
 	if (sendsas) {
 		if (len < saslen)
 			return -1;
-		while(saslen) {
-			cnt = saslen;
-			if (cnt > sizeof(sas))
-				cnt = sizeof(sas);
-			memcpy(outbuf + pos, sas, cnt);
-			pos += cnt;
-			len -= cnt;
-			saslen -= cnt;
-		}
-	}
-	while(len) {
-		cnt = len;
-		if (cnt > sizeof(cas))
-			cnt = sizeof(cas);
-		memcpy(outbuf + pos, cas, cnt);
-		pos += cnt;
-		len -= cnt;
+		gen_tone(outbuf, saslen, codec, sasdr, sasdi, &cr1, &ci1);
+		len -= saslen;
+		pos += saslen;
+		cr2 = cr1;
+		ci2 = ci1;
 	}
+	gen_tones(outbuf + pos, len, codec, casdr1, casdi1, casdr2, casdi2, &cr1, &ci1, &cr2, &ci2);
 	return 0;
 }
 
-int callerid_feed(struct callerid_state *cid, unsigned char *ubuf, int len)
+int callerid_feed(struct callerid_state *cid, unsigned char *ubuf, int len, int codec)
 {
 	int mylen = len;
 	int olen;
@@ -145,7 +184,7 @@ int callerid_feed(struct callerid_state *cid, unsigned char *ubuf, int len)
 	memcpy(buf, cid->oldstuff, cid->oldlen);
 	mylen += cid->oldlen/2;
 	for (x=0;x<len;x++) 
-		buf[x+cid->oldlen/2] = AST_MULAW(ubuf[x]);
+		buf[x+cid->oldlen/2] = AST_XLAW(ubuf[x]);
 	while(mylen >= 80) {
 		olen = mylen;
 		res = fsk_serie(&cid->fskd, buf, &mylen, &b);
@@ -282,7 +321,7 @@ void callerid_free(struct callerid_state *cid)
 	free(cid);
 }
 
-static void callerid_genmsg(char *msg, int size, char *number, char *name, int flags)
+static int callerid_genmsg(char *msg, int size, char *number, char *name, int flags)
 {
 	time_t t;
 	struct tm *tm;
@@ -311,9 +350,9 @@ static void callerid_genmsg(char *msg, int size, char *number, char *name, int f
 		size -= res;
 		ptr += res;
 	} else {
-		/* Send up to 10 digits of number MAX */
+		/* Send up to 16 digits of number MAX */
 		i = strlen(number);
-		if (i > 10) i = 10;
+		if (i > 16) i = 16;
 		res = snprintf(ptr, size, "\002%c", i);
 		size -= res;
 		ptr += res;
@@ -335,7 +374,7 @@ static void callerid_genmsg(char *msg, int size, char *number, char *name, int f
 		size -= res;
 		ptr += res;
 	} else {
-		/* Send up to 10 digits of number MAX */
+		/* Send up to 16 digits of name MAX */
 		i = strlen(name);
 		if (i > 16) i = 16;
 		res = snprintf(ptr, size, "\007%c", i);
@@ -347,19 +386,80 @@ static void callerid_genmsg(char *msg, int size, char *number, char *name, int f
 		ptr += i;
 		size -= i;
 	}
+	return (ptr - msg);
 	
 }
 
-int callerid_generate(unsigned char *buf, char *number, char *name, int flags, int callwaiting)
+int vmwi_generate(unsigned char *buf, int active, int mdmf, int codec)
+{
+	unsigned char msg[256];
+	int len=0;
+	int sum;
+	int x;
+	int bytes = 0;
+	float cr = 1.0;
+	float ci = 0.0;
+	float scont = 0.0;
+	if (mdmf) {
+		/* MDMF Message waiting */
+		msg[len++] = 0x82;
+		/* Length is 3 */
+		msg[len++] = 3;
+		/* IE is "Message Waiting Parameter" */
+		msg[len++] = 0xb;
+		/* Length of IE is one */
+		msg[len++] = 1;
+		/* Active or not */
+		if (active)
+			msg[len++] = 0xff;
+		else
+			msg[len++] = 0x00;
+	} else {
+		/* SDMF Message waiting */
+		msg[len++] = 0x6;
+		/* Length is 3 */
+		msg[len++] = 3;
+		if (active) {
+			msg[len++] = 0x42;
+			msg[len++] = 0x42;
+			msg[len++] = 0x42;
+		} else {
+			msg[len++] = 0x6f;
+			msg[len++] = 0x6f;
+			msg[len++] = 0x6f;
+		}
+	}
+	sum = 0;
+	for (x=0;x<len;x++)
+		sum += msg[x];
+	sum = (256 - (sum & 255));
+	msg[len++] = sum;
+	/* Transmit 30 0x55's (looks like a square wave) for channel seizure */
+	for (x=0;x<30;x++)
+		PUT_CLID(0x55);
+	/* Send 170ms of callerid marks */
+	for (x=0;x<170;x++)
+		PUT_CLID_MARKMS;
+	for (x=0;x<len;x++) {
+		PUT_CLID(msg[x]);
+	}
+	/* Send 50 more ms of marks */
+	for (x=0;x<50;x++)
+		PUT_CLID_MARKMS;
+	return bytes;
+}
+
+int callerid_generate(unsigned char *buf, char *number, char *name, int flags, int callwaiting, int codec)
 {
 	int bytes=0;
 	int x, sum;
+	int len;
 	/* Initial carriers (real/imaginary) */
 	float cr = 1.0;
 	float ci = 0.0;
 	float scont = 0.0;
-	char msg[256];
-	callerid_genmsg(msg, sizeof(msg), number, name, flags);
+	unsigned char msg[256];
+	len = callerid_genmsg(msg, sizeof(msg), number, name, flags);
 	if (!callwaiting) {
 		/* Wait a half a second */
 		for (x=0;x<4000;x++)
@@ -374,15 +474,16 @@ int callerid_generate(unsigned char *buf, char *number, char *name, int flags, i
 	/* Send 0x80 indicating MDMF format */
 	PUT_CLID(0x80);
 	/* Put length of whole message */
-	PUT_CLID(strlen(msg));
+	PUT_CLID(len);
 	sum = 0x80 + strlen(msg);
 	/* Put each character of message and update checksum */
-	for (x=0;x<strlen(msg); x++) {
+	for (x=0;x<len; x++) {
 		PUT_CLID(msg[x]);
 		sum += msg[x];
 	}
 	/* Send 2's compliment of sum */
 	PUT_CLID(256 - (sum & 255));
+
 	/* Send 50 more ms of marks */
 	for (x=0;x<50;x++)
 		PUT_CLID_MARKMS;
@@ -455,30 +556,30 @@ int ast_callerid_parse(char *instr, char **name, char **location)
 	return -1;
 }
 
-static int __ast_callerid_generate(unsigned char *buf, char *callerid, int callwaiting)
+static int __ast_callerid_generate(unsigned char *buf, char *callerid, int callwaiting, int codec)
 {
 	char tmp[256];
 	char *n, *l;
 	if (!callerid)
-		return callerid_generate(buf, NULL, NULL, 0, callwaiting);
+		return callerid_generate(buf, NULL, NULL, 0, callwaiting, codec);
 	strncpy(tmp, callerid, sizeof(tmp)-1);
 	if (ast_callerid_parse(tmp, &n, &l)) {
 		ast_log(LOG_WARNING, "Unable to parse '%s' into CallerID name & number\n", callerid);
-		return callerid_generate(buf, NULL, NULL, 0, callwaiting);
+		return callerid_generate(buf, NULL, NULL, 0, callwaiting, codec);
 	}
 	if (l)
 		ast_shrink_phone_number(l);
 	if (!ast_isphonenumber(l))
-		return callerid_generate(buf, NULL, n, 0, callwaiting);
-	return callerid_generate(buf, l, n, 0, callwaiting);
+		return callerid_generate(buf, NULL, n, 0, callwaiting, codec);
+	return callerid_generate(buf, l, n, 0, callwaiting, codec);
 }
 
-int ast_callerid_generate(unsigned char *buf, char *callerid)
+int ast_callerid_generate(unsigned char *buf, char *callerid, int codec)
 {
-	return __ast_callerid_generate(buf, callerid, 0);
+	return __ast_callerid_generate(buf, callerid, 0, codec);
 }
 
-int ast_callerid_callwaiting_generate(unsigned char *buf, char *callerid)
+int ast_callerid_callwaiting_generate(unsigned char *buf, char *callerid, int codec)
 {
-	return __ast_callerid_generate(buf, callerid, 1);
+	return __ast_callerid_generate(buf, callerid, 1, codec);
 }
-- 
cgit v1.2.3