// read_maps_file(argv[0]);
// need to register general path prefixes to match
// and then have this call register_global_root_section for each prefix match
void read_maps_file(char *executable_path) {
pid_t pid = getpid();
char maps_path[128];
sprintf(maps_path, "/proc/%d/maps", pid);
FILE *maps = fopen(maps_path, "r");
long low, high;
int offset, inode;
char perms[5], dev[6], path[1024];
int count = 0;
while (EOF != count) {
count = fscanf(maps,
"%lx-%lx %s %x %s %x",
&low, &high, &perms, &offset, &dev, &inode);
if (EOF != count) {
//printf("%lx-%lx %s %08x %s %x\n", low, high, perms, offset, dev, inode);
if (0 == inode) {
eat_line(maps);
} else {
count = fscanf(maps, " %s", &path);
if ((0 == strcmp(&(perms[0]), "rw-p")) &&
(0 == strcmp(&(path[0]), executable_path))) {
printf("roots start at %x, length %x\n", low, high - low);
}
}
}
}
}
static inline struct hdr_field* extract_parsed_hdrs( char *buf, int len)
{
char *p;
static struct sip_msg msg;
struct hdr_field *hdr;
/* skip the first line - not interesting */
p = eat_line( buf, len);
if (p>=buf+len)
return 0;
memset( &msg, 0, sizeof(struct sip_msg) );
msg.buf = buf;
msg.len = len;
msg.unparsed = p;
/* as we need all Route headers, we need to parse all headers */
if (parse_headers( &msg, HDR_EOH_F, 0)==-1)
goto error;
hdr = msg.headers;
msg.headers = 0;
free_sip_msg( &msg );
return hdr;
error:
free_sip_msg( &msg );
return 0;
}
static int
extract_mediaport(str *body, str *mediaport)
{
char *cp, *cp1;
int len;
cp1 = NULL;
for (cp = body->s; (len = body->s + body->len - cp) > 0;) {
cp1 = ser_memmem(cp, "m=", len, 2);
if (cp1 == NULL || cp1[-1] == '\n' || cp1[-1] == '\r')
break;
cp = cp1 + 2;
}
if (cp1 == NULL) {
LOG(L_ERR, "ERROR: extract_mediaport: no `m=' in SDP\n");
return -1;
}
mediaport->s = cp1 + 2;
mediaport->len = eat_line(mediaport->s, body->s + body->len -
mediaport->s) - mediaport->s;
trim_len(mediaport->len, mediaport->s, *mediaport);
if (mediaport->len < 7 || memcmp(mediaport->s, "audio", 5) != 0 ||
!isspace((int)mediaport->s[5])) {
LOG(L_ERR, "ERROR: extract_mediaport: can't parse `m=' in SDP\n");
return -1;
}
cp = eat_space_end(mediaport->s + 5, mediaport->s + mediaport->len);
mediaport->len = eat_token_end(cp, mediaport->s + mediaport->len) - cp;
mediaport->s = cp;
return 1;
}
int extract_bwidth(str *body, str *bwtype, str *bwwitdth)
{
char *cp, *cp1;
int len;
cp1 = NULL;
for (cp = body->s; (len = body->s + body->len - cp) > 0;) {
cp1 = (char*)ser_memmem(cp, "b=", len, 2);
if (cp1 == NULL || cp1[-1] == '\n' || cp1[-1] == '\r')
break;
cp = cp1 + 2;
}
if (cp1 == NULL)
return -1;
bwtype->s = cp1 + 2;
bwtype->len = eat_line(bwtype->s, body->s + body->len - bwtype->s) - bwtype->s;
trim_len(bwtype->len, bwtype->s, *bwtype);
cp = bwtype->s;
len = bwtype->len;
cp1 = (char*)ser_memmem(cp, ":", len, 1);
len -= cp1 - cp;
if (len <= 0) {
LM_ERR("invalid encoding in `b=%.*s'\n", bwtype->len, bwtype->s);
return -1;
}
bwtype->len = cp1 - cp;
/* skip ':' */
bwwitdth->s = cp1 + 1;
bwwitdth->len = len - 1;
return 0;
}
void TsvFile::read_file (const std::string &filename) {
std::ifstream is (filename.c_str ());
if (!is)
throw unreadable_file (filename);
// iostreams exceptions just suck.
//is.exceptions (std::ios::badbit);
std::vector <double> line;
for (;;) {
eat_spaces (is);
int pk = is.peek ();
switch (pk) {
case '\n':
is.get ();
if (line.size ()) {
my_data.push_back (line);
line.clear ();
}
continue;
case EOF:
if (line.size ()) {
my_data.push_back (line);
line.clear ();
}
return;
case '#':
eat_line (is);
continue;
default:
double tmp;
is >> tmp;
line.push_back (tmp);
}
}
}
void gates(char **Arr_b, short input_no, short prob)
{
short AND, OR, XOR, NAND, NOR;
char Ch= '\0';
__int8 i, j, k;
puts("Enter (a) for AND gate, (o) for OR gate, (x) for XOR gate, (r) & (d) for NAND gate or (q) to quit");
Ch= getchar();
while (Ch != 'q') {
eat_line();
if (Ch == 'a') {
puts("\n\n\tAND\n");
for (AND= '\0', i= 0; i < prob; ++i)
for (j= 0, AND= *(*(Arr_b+i)+j); j < input_no; ++j, AND *= *(*(Arr_b+i)+j)) {
if ((j+1) % input_no == 0)
printf("\t%d\n", AND);
}
}
else if (Ch == 'o') {
puts("\n\n\tOR\n");
for (OR= '\0', i= 0; i < prob; ++i)
for (j= 0, OR= *(*(Arr_b+i)+j); j < input_no; ++j, OR += *(*(Arr_b+i)+j), OR= !!OR) {
if ((j+1) % input_no == 0)
printf("\t%d\n", OR);
}
}
else if (Ch == 'r') {
puts("\n\n\tNOR\n");
for (NOR= '\0', i= 0; i < prob; ++i)
for (j= 0, NOR= *(*(Arr_b+i)+j); j < input_no; ++j, NOR += *(*(Arr_b+i)+j), NOR= !!NOR) {
if ((j+1) % input_no == 0)
printf("\t%d\n", !NOR);
}
}
else if (Ch == 'x') {
puts("\n\n\tXOR\n");
for (XOR= 0, i= 0; i < prob; ++i) {
for (j= 0; j < input_no; ++j, XOR= XOR + *(*(Arr_b+i)+j));
if (i == 0 || i == prob-1)
puts("\t1");
else
puts("\t0");
}
}
else if (Ch == 'd') {
puts("\n\n\tNAND\n");
for (NAND= '\0', i= 0; i < prob; ++i)
for (j= 0, NAND= *(*(Arr_b+i)+j); j < input_no; ++j, NAND *= *(*(Arr_b+i)+j)) {
if ((j+1) % input_no == 0)
printf("\t%d\n", !NAND);
}
}
puts("\nEnter (a) for AND gate, (o) for OR gate, (x) for XOR gate, (r) & (d) for NAND gate or (q) to quit");
Ch= get_char();
}
free(Arr_b);
}
static int
extract_mediaip(str *body, str *mediaip, int *pf)
{
char *cp, *cp1;
int len, nextisip;
cp1 = NULL;
for (cp = body->s; (len = body->s + body->len - cp) > 0;) {
cp1 = ser_memmem(cp, "c=", len, 2);
if (cp1 == NULL || cp1[-1] == '\n' || cp1[-1] == '\r')
break;
cp = cp1 + 2;
}
if (cp1 == NULL) {
LOG(L_ERR, "ERROR: extract_mediaip: no `c=' in SDP\n");
return -1;
}
mediaip->s = cp1 + 2;
mediaip->len = eat_line(mediaip->s, body->s + body->len - mediaip->s) - mediaip->s;
trim_len(mediaip->len, mediaip->s, *mediaip);
nextisip = 0;
for (cp = mediaip->s; cp < mediaip->s + mediaip->len;) {
len = eat_token_end(cp, mediaip->s + mediaip->len) - cp;
if (nextisip == 1) {
mediaip->s = cp;
mediaip->len = len;
nextisip++;
break;
}
if (len == 3 && memcmp(cp, "IP", 2) == 0) {
switch (cp[2]) {
case '4':
nextisip = 1;
*pf = AF_INET;
break;
case '6':
nextisip = 1;
*pf = AF_INET6;
break;
default:
break;
}
}
cp = eat_space_end(cp + len, mediaip->s + mediaip->len);
}
if (nextisip != 2 || mediaip->len == 0) {
LOG(L_ERR, "ERROR: extract_mediaip: "
"no `IP[4|6]' in `c=' field\n");
return -1;
}
return 1;
}
int extract_mediaip(str *body, str *mediaip, int *pf, char *line)
{
char *cp, *cp1;
int len, nextisip;
cp1 = NULL;
for (cp = body->s; (len = body->s + body->len - cp) > 0;) {
cp1 = (char*)ser_memmem(cp, line, len, 2);
if (cp1 == NULL || cp1[-1] == '\n' || cp1[-1] == '\r')
break;
cp = cp1 + 2;
}
if (cp1 == NULL)
return -1;
mediaip->s = cp1 + 2;
mediaip->len = eat_line(mediaip->s, body->s + body->len - mediaip->s) - mediaip->s;
trim_len(mediaip->len, mediaip->s, *mediaip);
nextisip = 0;
for (cp = mediaip->s; cp < mediaip->s + mediaip->len;) {
len = eat_token_end(cp, mediaip->s + mediaip->len) - cp;
if (nextisip == 1) {
mediaip->s = cp;
mediaip->len = len;
nextisip++;
break;
}
if (len == 3 && memcmp(cp, "IP", 2) == 0) {
switch (cp[2]) {
case '4':
nextisip = 1;
*pf = AF_INET;
break;
case '6':
nextisip = 1;
*pf = AF_INET6;
break;
default:
break;
}
}
/* consume all spaces starting from the second char after the token
First char after the token is the char that stoped the token
parsing, so it is space or \r / \n, so we simply skip it */
cp = eat_space_end(cp + len + 1, mediaip->s + mediaip->len);
}
if (nextisip != 2 || mediaip->len == 0) {
LM_ERR("no `IP[4|6]' in `%s' field\n",line);
return -1;
}
return 1;
}
int extract_fmtp( str *body, str *fmtp_payload, str *fmtp_string )
{
char *cp, *cp1;
int len;
if (strncasecmp(body->s, "a=fmtp:", 7) !=0) {
/*LM_DBG("We are not pointing to an a=fmtp: attribute =>`%.*s'\n", body->len, body->s); */
return -1;
}
cp1 = body->s;
fmtp_payload->s = cp1 + 7; /* skip `a=fmtp:' */
fmtp_payload->len = eat_line(fmtp_payload->s, body->s + body->len -
fmtp_payload->s) - fmtp_payload->s;
trim_len(fmtp_payload->len, fmtp_payload->s, *fmtp_payload);
len = fmtp_payload->len;
/* */
cp = eat_token_end(fmtp_payload->s, fmtp_payload->s + fmtp_payload->len);
fmtp_payload->len = cp - fmtp_payload->s;
if (fmtp_payload->len <= 0 || cp == fmtp_payload->s) {
LM_ERR("no encoding in `a=fmtp:'\n");
return -1;
}
len -= fmtp_payload->len;
fmtp_string->s = cp;
cp = eat_space_end(fmtp_string->s, fmtp_string->s + len);
len -= cp - fmtp_string->s;
if (len <= 0 || cp == fmtp_string->s) {
LM_ERR("no encoding in `a=fmtp:'\n");
return -1;
}
fmtp_string->s = cp;
fmtp_string->len = eat_line(fmtp_string->s, body->s + body->len -
fmtp_string->s) - fmtp_string->s;
trim_len(fmtp_string->len, fmtp_string->s, *fmtp_string);
return 0;
}
/* generic method for attribute extraction
* field must has format "a=attrname:" */
int extract_field(str *body, str *value, str field)
{
if (strncmp(body->s, field.s, field.len < body->len ? field.len : body->len) !=0) {
/*LM_DBG("We are not pointing to an %.* attribute =>`%.*s'\n", field.len, field.s, body->len, body->s); */
return -1;
}
value->s = body->s + field.len; /* skip `a=attrname:' */
value->len = eat_line(value->s, body->s + body->len -
value->s) - value->s;
trim_len(value->len, value->s, *value);
return 0;
}
int main(void)
{
short inputs_no= 0, prob= 1, storage= 0;
__int8 i, j;
puts("Enter Number of inputs");
scanf("%hd", &inputs_no);
eat_line();
for (i= inputs_no; i > 0; prob<<= 1, i--);
itob(inputs_no, prob);
putchar('\n');
system("pause");
return 0;
}
/* returns the pointer to the first VIA header */
char *lw_find_via(char *buf, char *buf_end)
{
char *p;
unsigned int val;
/* skip the first line */
p = eat_line(buf, buf_end - buf);
while (buf_end - p > 4) {
val = LOWER_DWORD(READ(p));
if ((val == _via1_) || (val == _via2_)
|| ((LOWER_BYTE(*p) == 'v') /* compact header */
&& ((*(p+1) == ' ') || (*(p+1) == ':')) )
) return p;
p = lw_next_line(p, buf_end);
}
/* not found */
return 0;
}
/** Skip past FIG comments (lines starting with #) and empty lines.
* Returns TRUE if there is more in the file to read.
*/
static int
skip_comments(FILE *file) {
int ch;
while (!feof(file)) {
if ((ch = fgetc(file)) == EOF) {
return FALSE;
}
if (ch == '\n') continue;
else if (ch == '#') {
eat_line(file);
continue;
} else {
ungetc(ch, file);
return TRUE;
}
}
return FALSE;
}
/* parses the first line, returns pointer to next line & fills fl;
also modifies buffer (to avoid extra copy ops) */
char* parse_first_line(char* buffer, unsigned int len, struct msg_start * fl)
{
char *tmp;
char* second;
char* third;
char* nl;
int offset;
/* int l; */
char* end;
char s1,s2,s3;
char *prn;
unsigned int t;
/* grammar:
request = method SP uri SP version CRLF
response = version SP status SP reason CRLF
(version = "SIP/2.0")
*/
end=buffer+len;
/* see if it's a reply (status) */
/* jku -- parse well-known methods */
/* drop messages which are so short they are for sure useless;
utilize knowledge of minimum size in parsing the first
token
*/
if (len <=16 ) {
LOG(L_INFO, "ERROR: parse_first_line: message too short: %d\n", len);
goto error1;
}
tmp=buffer;
/* is it perhaps a reply, ie does it start with "SIP...." ? */
if ( (*tmp=='S' || *tmp=='s') &&
strncasecmp( tmp+1, SIP_VERSION+1, SIP_VERSION_LEN-1)==0 &&
(*(tmp+SIP_VERSION_LEN)==' ')) {
fl->type=SIP_REPLY;
fl->u.reply.version.len=SIP_VERSION_LEN;
tmp=buffer+SIP_VERSION_LEN;
} else IFISMETHOD( INVITE, 'I' )
else IFISMETHOD( CANCEL, 'C')
else IFISMETHOD( ACK, 'A' )
else IFISMETHOD( BYE, 'B' )
/* if you want to add another method XXX, include METHOD_XXX in
H-file (this is the value which you will take later in
processing and define XXX_LEN as length of method name;
then just call IFISMETHOD( XXX, 'X' ) ... 'X' is the first
latter; everything must be capitals
*/
else {
/* neither reply, nor any of known method requests,
let's believe it is an unknown method request
*/
tmp=eat_token_end(buffer,buffer+len);
if ((tmp==buffer)||(tmp>=end)){
LOG(L_INFO, "ERROR:parse_first_line: empty or bad first line\n");
goto error1;
}
if (*tmp!=' ') {
LOG(L_INFO, "ERROR:parse_first_line: method not followed by SP\n");
goto error1;
}
fl->type=SIP_REQUEST;
fl->u.request.method_value=METHOD_OTHER;
fl->u.request.method.len=tmp-buffer;
}
/* identifying type of message over now;
tmp points at space after; go ahead */
fl->u.request.method.s=buffer; /* store ptr to first token */
second=tmp+1; /* jump to second token */
offset=second-buffer;
/* EoJku */
/* next element */
tmp=eat_token_end(second, second+len-offset);
if (tmp>=end){
goto error;
}
offset+=tmp-second;
third=eat_space_end(tmp, tmp+len-offset);
offset+=third-tmp;
if ((third==tmp)||(tmp>=end)){
goto error;
}
fl->u.request.uri.s=second;
fl->u.request.uri.len=tmp-second;
/* jku: parse status code */
if (fl->type==SIP_REPLY) {
if (fl->u.request.uri.len!=3) {
LOG(L_INFO, "ERROR:parse_first_line: len(status code)!=3: %.*s\n",
fl->u.request.uri.len, ZSW(second) );
goto error;
}
s1=*second; s2=*(second+1);s3=*(second+2);
if (s1>='0' && s1<='9' &&
s2>='0' && s2<='9' &&
s3>='0' && s3<='9' ) {
fl->u.reply.statuscode=(s1-'0')*100+10*(s2-'0')+(s3-'0');
} else {
LOG(L_INFO, "ERROR:parse_first_line: status_code non-numerical: %.*s\n",
fl->u.request.uri.len, ZSW(second) );
goto error;
}
}
/* EoJku */
/* last part: for a request it must be the version, for a reply
* it can contain almost anything, including spaces, so we don't care
* about it*/
if (fl->type==SIP_REQUEST){
tmp=eat_token_end(third,third+len-offset);
offset+=tmp-third;
if ((tmp==third)||(tmp>=end)){
goto error;
}
if (! is_empty_end(tmp, tmp+len-offset)){
goto error;
}
}else{
tmp=eat_token2_end(third,third+len-offset,'\r'); /* find end of line
('\n' or '\r') */
if (tmp>=end){ /* no crlf in packet => invalid */
goto error;
}
offset+=tmp-third;
}
nl=eat_line(tmp,len-offset);
if (nl>=end){ /* no crlf in packet or only 1 line > invalid */
goto error;
}
fl->u.request.version.s=third;
fl->u.request.version.len=tmp-third;
fl->len=nl-buffer;
return nl;
error:
LOG(L_INFO, "ERROR:parse_first_line: bad %s first line\n",
(fl->type==SIP_REPLY)?"reply(status)":"request");
LOG(L_INFO, "ERROR: at line 0 char %d: \n", offset );
prn=pkg_malloc( offset );
if (prn) {
for (t=0; t<offset; t++)
if (*(buffer+t)) *(prn+t)=*(buffer+t);
else *(prn+t)='°';
LOG(L_INFO, "ERROR: parsed so far: %.*s\n", offset, ZSW(prn) );
pkg_free( prn );
};
error1:
fl->type=SIP_INVALID;
LOG(L_INFO, "ERROR:parse_first_line: bad message\n");
/* skip line */
nl=eat_line(buffer,len);
return nl;
}
int extract_media_attr(str *body, str *mediamedia, str *mediaport, str *mediatransport, str *mediapayload, int *is_rtp)
{
char *cp, *cp1;
int len, i;
cp1 = NULL;
for (cp = body->s; (len = body->s + body->len - cp) > 0;) {
cp1 = (char*)ser_memmem(cp, "m=", len, 2);
if (cp1 == NULL || cp1[-1] == '\n' || cp1[-1] == '\r')
break;
cp = cp1 + 2;
}
if (cp1 == NULL) {
LM_ERR("no `m=' in SDP\n");
return -1;
}
mediaport->s = cp1 + 2; /* skip `m=' */
mediaport->len = eat_line(mediaport->s, body->s + body->len -
mediaport->s) - mediaport->s;
trim_len(mediaport->len, mediaport->s, *mediaport);
mediapayload->len = mediaport->len;
mediamedia->s = mediaport->s;
/* Skip media supertype and spaces after it */
cp = eat_token_end(mediaport->s, mediaport->s + mediaport->len);
mediaport->len -= cp - mediaport->s;
mediamedia->len = mediapayload->len - mediaport->len;
if (mediaport->len <= 0 || cp == mediaport->s) {
LM_ERR("no port in `m='\n");
return -1;
}
mediaport->s = cp;
cp = eat_space_end(mediaport->s, mediaport->s + mediaport->len);
mediaport->len -= cp - mediaport->s;
if (mediaport->len <= 0 || cp == mediaport->s) {
LM_ERR("no port in `m='\n");
return -1;
}
/* Extract port */
mediaport->s = cp;
cp = eat_token_end(mediaport->s, mediaport->s + mediaport->len);
mediatransport->len = mediaport->len - (cp - mediaport->s);
if (mediatransport->len <= 0 || cp == mediaport->s) {
LM_ERR("no port in `m='\n");
return -1;
}
mediatransport->s = cp;
mediaport->len = cp - mediaport->s;
/* Skip spaces after port */
cp = eat_space_end(mediatransport->s, mediatransport->s + mediatransport->len);
mediatransport->len -= cp - mediatransport->s;
if (mediatransport->len <= 0 || cp == mediatransport->s) {
LM_ERR("no protocol type in `m='\n");
return -1;
}
/* Extract protocol type */
mediatransport->s = cp;
cp = eat_token_end(mediatransport->s, mediatransport->s + mediatransport->len);
if (cp == mediatransport->s) {
LM_ERR("no protocol type in `m='\n");
return -1;
}
mediatransport->len = cp - mediatransport->s;
mediapayload->s = mediatransport->s + mediatransport->len;
mediapayload->len -= mediapayload->s - mediamedia->s;
cp = eat_space_end(mediapayload->s, mediapayload->s + mediapayload->len);
mediapayload->len -= cp - mediapayload->s;
mediapayload->s = cp;
for (i = 0; sup_ptypes[i].s != NULL; i++)
if (mediatransport->len == sup_ptypes[i].len &&
strncasecmp(mediatransport->s, sup_ptypes[i].s, mediatransport->len) == 0) {
*is_rtp = sup_ptypes[i].is_rtp;
return 0;
}
/* Unproxyable protocol type. Generally it isn't error. */
return 0;
}
int extract_mediaip(str *body, str *mediaip, int *pf, char *line)
{
char *cp, *cp1;
int len;
cp1 = NULL;
for (cp = body->s; (len = body->s + body->len - cp) > 0;) {
cp1 = (char*)ser_memmem(cp, line, len, 2);
if (cp1 == NULL || cp1[-1] == '\n' || cp1[-1] == '\r')
break;
cp = cp1 + 2;
}
if (cp1 == NULL)
return -1;
mediaip->s = cp1 + 2;
mediaip->len = eat_line(mediaip->s, body->s + body->len - mediaip->s) - mediaip->s;
trim_len(mediaip->len, mediaip->s, *mediaip);
if (mediaip->len == 0) {
LM_ERR("no [%s] line in SDP\n",line);
return -1;
}
/* search reverse for IP[4|6] in c=/o= line */
cp = (char*)ser_memrmem(mediaip->s, " IP", mediaip->len, 3);
if (cp == NULL) {
LM_ERR("no `IP[4|6]' in `%s' field\n",line);
return -1;
}
/* safety checks:
* - for length, at least 6: ' IP[4|6] x...'
* - white space after
*/
if(cp + 6 > mediaip->s + mediaip->len && cp[4]!=' ') {
LM_ERR("invalid content for `%s' line\n",line);
return -1;
}
switch(cp[3]) {
case '4':
*pf = AF_INET;
break;
case '6':
*pf = AF_INET6;
break;
default:
LM_ERR("invalid addrtype IPx for `%s' line\n",line);
return -1;
}
cp += 5;
/* next token is the IP address */
cp = eat_space_end(cp, mediaip->s + mediaip->len);
len = eat_token_end(cp, mediaip->s + mediaip->len) - cp;
mediaip->s = cp;
mediaip->len = len;
if (mediaip->len == 0) {
LM_ERR("no `IP[4|6]' address in `%s' field\n",line);
return -1;
}
LM_DBG("located IP address [%.*s] in `%s' field\n",
mediaip->len, mediaip->s, line);
return 1;
}
static int extract_mediaport(str *body, str *mediaport)
{
char *cp, *cp1;
int len, i;
str ptype;
cp1 = NULL;
for (cp = body->s; (len = body->s + body->len - cp) > 0;) {
cp1 = ser_memmem(cp, "m=", len, 2);
if (cp1 == NULL || cp1[-1] == '\n' || cp1[-1] == '\r')
break;
cp = cp1 + 2;
}
if (cp1 == NULL) {
LOG(L_ERR, "ERROR: extract_mediaport: no `m=' in SDP\n");
return -1;
}
mediaport->s = cp1 + 2; /* skip `m=' */
mediaport->len = eat_line(mediaport->s, body->s + body->len -
mediaport->s) - mediaport->s;
trim_len(mediaport->len, mediaport->s, *mediaport);
/* Skip media supertype and spaces after it */
cp = eat_token_end(mediaport->s, mediaport->s + mediaport->len);
mediaport->len -= cp - mediaport->s;
if (mediaport->len <= 0 || cp == mediaport->s) {
LOG(L_ERR, "ERROR: extract_mediaport: no port in `m='\n");
return -1;
}
mediaport->s = cp;
cp = eat_space_end(mediaport->s, mediaport->s + mediaport->len);
mediaport->len -= cp - mediaport->s;
if (mediaport->len <= 0 || cp == mediaport->s) {
LOG(L_ERR, "ERROR: extract_mediaport: no port in `m='\n");
return -1;
}
/* Extract port */
mediaport->s = cp;
cp = eat_token_end(mediaport->s, mediaport->s + mediaport->len);
ptype.len = mediaport->len - (cp - mediaport->s);
if (ptype.len <= 0 || cp == mediaport->s) {
LOG(L_ERR, "ERROR: extract_mediaport: no port in `m='\n");
return -1;
}
ptype.s = cp;
mediaport->len = cp - mediaport->s;
/* Skip spaces after port */
cp = eat_space_end(ptype.s, ptype.s + ptype.len);
ptype.len -= cp - ptype.s;
if (ptype.len <= 0 || cp == ptype.s) {
LOG(L_ERR, "ERROR: extract_mediaport: no protocol type in `m='\n");
return -1;
}
/* Extract protocol type */
ptype.s = cp;
cp = eat_token_end(ptype.s, ptype.s + ptype.len);
if (cp == ptype.s) {
LOG(L_ERR, "ERROR: extract_mediaport: no protocol type in `m='\n");
return -1;
}
ptype.len = cp - ptype.s;
for (i = 0; sup_ptypes[i].s != NULL; i++)
if (ptype.len == sup_ptypes[i].len &&
strncasecmp(ptype.s, sup_ptypes[i].s, ptype.len) == 0)
return 0;
/* Unproxyable protocol type. Generally it isn't error. */
return -1;
}
/**
* rfc4566:
* a=rtpmap:<payload type> <encoding name>/<clock rate> [/<encoding parameters>]
*/
int extract_rtpmap(str *body,
str *rtpmap_payload, str *rtpmap_encoding, str *rtpmap_clockrate, str *rtpmap_parmas)
{
char *cp, *cp1;
int len;
if (strncasecmp(body->s, "a=rtpmap:", 9) !=0) {
/*LM_DBG("We are not pointing to an a=rtpmap: attribute =>`%.*s'\n", body->len, body->s); */
return -1;
}
cp1 = body->s;
rtpmap_payload->s = cp1 + 9; /* skip `a=rtpmap:' */
rtpmap_payload->len = eat_line(rtpmap_payload->s, body->s + body->len -
rtpmap_payload->s) - rtpmap_payload->s;
trim_len(rtpmap_payload->len, rtpmap_payload->s, *rtpmap_payload);
len = rtpmap_payload->len;
/* */
cp = eat_token_end(rtpmap_payload->s, rtpmap_payload->s + rtpmap_payload->len);
rtpmap_payload->len = cp - rtpmap_payload->s;
if (rtpmap_payload->len <= 0 || cp == rtpmap_payload->s) {
LM_ERR("no encoding in `a=rtpmap'\n");
return -1;
}
len -= rtpmap_payload->len;
rtpmap_encoding->s = cp;
cp = eat_space_end(rtpmap_encoding->s, rtpmap_encoding->s + len);
len -= cp - rtpmap_encoding->s;
if (len <= 0 || cp == rtpmap_encoding->s) {
LM_ERR("no encoding in `a=rtpmap:'\n");
return -1;
}
rtpmap_encoding->s = cp;
cp1 = (char*)ser_memmem(cp, "/", len, 1);
if(cp1==NULL) {
LM_ERR("invalid encoding in `a=rtpmap' at [%.*s]\n", len, cp);
return -1;
}
len -= cp1 - cp;
rtpmap_encoding->len = cp1 - cp;
cp = cp1+1; /* skip '/' */
len--;
rtpmap_clockrate->s = cp;
cp1 = (char*)ser_memmem(cp, "/", len, 1);
if(cp1==NULL) {
/* no encoding parameters */
rtpmap_clockrate->len = len;
rtpmap_parmas->s = NULL;
rtpmap_parmas->len = 0;
return 0;
}
rtpmap_clockrate->len = cp1 - cp;
len -= cp1 - cp;
rtpmap_parmas->s = cp1 + 1; /* skip '/' */
rtpmap_parmas->len = len - 1;
return 0;
}
/* Re-parsing version of build_local() function:
* it builds a local CANCEL or ACK (for non-200 response) request based on
* the previous INVITE which was sent out.
*
* Can not be used to build other type of requests!
*/
char *build_local_reparse(struct cell *Trans,unsigned int branch,
unsigned int *len, char *method, int method_len, str *to
#ifdef CANCEL_REASON_SUPPORT
, struct cancel_reason *reason
#endif /* CANCEL_REASON_SUPPORT */
)
{
char *invite_buf, *invite_buf_end;
char *cancel_buf;
char *s, *s1, *d; /* source and destination buffers */
short invite_len;
enum _hdr_types_t hf_type;
int first_via, to_len;
int cancel_buf_len;
#ifdef CANCEL_REASON_SUPPORT
int reason_len, code_len;
struct hdr_field *reas1, *reas_last, *hdr;
#endif /* CANCEL_REASON_SUPPORT */
int hadded = 0;
sr_cfgenv_t *cenv = NULL;
invite_buf = Trans->uac[branch].request.buffer;
invite_len = Trans->uac[branch].request.buffer_len;
if (!invite_buf || !invite_len) {
LM_ERR("INVITE is missing\n");
goto error;
}
if ((*invite_buf != 'I') && (*invite_buf != 'i')) {
LM_ERR("trying to build with local reparse"
" for a non-INVITE request?\n");
goto error;
}
#ifdef CANCEL_REASON_SUPPORT
reason_len = 0;
reas1 = 0;
reas_last = 0;
/* compute reason size (if no reason or disabled => reason_len == 0)*/
if (reason && reason->cause != CANCEL_REAS_UNKNOWN){
if (likely(reason->cause > 0 &&
cfg_get(tm, tm_cfg, local_cancel_reason))){
/* Reason: SIP;cause=<reason->cause>[;text=<reason->u.text.s>] */
reason_len = REASON_PREFIX_LEN + USHORT2SBUF_MAX_LEN +
(reason->u.text.s?
REASON_TEXT_LEN + 1 + reason->u.text.len + 1 : 0) +
CRLF_LEN;
} else if (likely(reason->cause == CANCEL_REAS_PACKED_HDRS &&
!(Trans->flags & T_NO_E2E_CANCEL_REASON))) {
reason_len = reason->u.packed_hdrs.len;
} else if (reason->cause == CANCEL_REAS_RCVD_CANCEL &&
reason->u.e2e_cancel &&
!(Trans->flags & T_NO_E2E_CANCEL_REASON)) {
/* parse the entire cancel, to get all the Reason headers */
if(parse_headers(reason->u.e2e_cancel, HDR_EOH_F, 0)<0) {
LM_WARN("failed to parse headers\n");
}
for(hdr=get_hdr(reason->u.e2e_cancel, HDR_REASON_T), reas1=hdr;
hdr; hdr=next_sibling_hdr(hdr)) {
/* hdr->len includes CRLF */
reason_len += hdr->len;
reas_last=hdr;
}
} else if (unlikely(reason->cause < CANCEL_REAS_MIN))
LM_BUG("unhandled reason cause %d\n", reason->cause);
}
#endif /* CANCEL_REASON_SUPPORT */
invite_buf_end = invite_buf + invite_len;
s = invite_buf;
/* Allocate memory for the new message.
The new request will be smaller than the INVITE, so the same size is enough.
I just extend it with the length of new To HF to be sure.
Ugly, but we avoid lots of checks and memory allocations this way */
to_len = to ? to->len : 0;
#ifdef CANCEL_REASON_SUPPORT
cancel_buf_len = invite_len + to_len + reason_len;
#else
cancel_buf_len = invite_len + to_len;
#endif /* CANCEL_REASON_SUPPORT */
cancel_buf = shm_malloc(sizeof(char)*cancel_buf_len);
if (!cancel_buf)
{
LM_ERR("cannot allocate shared memory\n");
goto error;
}
d = cancel_buf;
/* method name + space */
append_str(d, method, method_len);
*d = ' ';
d++;
/* skip "INVITE " and copy the rest of the line including CRLF */
s += 7;
s1 = s;
s = eat_line(s, invite_buf_end - s);
append_str(d, s1, s - s1);
cenv = sr_cfgenv_get();
/* check every header field name,
we must exclude and modify some of the headers */
first_via = 1;
while (s < invite_buf_end) {
s1 = s;
if ((*s == '\n') || (*s == '\r')) {
/* end of SIP msg */
hf_type = HDR_EOH_T;
} else {
/* parse HF name */
s = lw_get_hf_name(s, invite_buf_end,
&hf_type);
}
switch(hf_type) {
case HDR_CSEQ_T:
/* find the method name and replace it */
while ((s < invite_buf_end)
&& ((*s == ':') || (*s == ' ') || (*s == '\t') ||
((*s >= '0') && (*s <= '9')))
) s++;
append_str(d, s1, s - s1);
append_str(d, method, method_len);
append_str(d, CRLF, CRLF_LEN);
s = lw_next_line(s, invite_buf_end);
break;
case HDR_VIA_T:
s = lw_next_line(s, invite_buf_end);
if (first_via) {
/* copy hf */
append_str(d, s1, s - s1);
first_via = 0;
} /* else skip this line, we need olny the first via */
break;
case HDR_TO_T:
if (to_len == 0) {
/* there is no To tag required, just copy paste
* the header */
s = lw_next_line(s, invite_buf_end);
append_str(d, s1, s - s1);
} else {
/* use the given To HF instead of the original one */
append_str(d, to->s, to->len);
/* move the pointer to the next line */
s = lw_next_line(s, invite_buf_end);
}
break;
case HDR_FROM_T:
case HDR_CALLID_T:
case HDR_ROUTE_T:
case HDR_MAXFORWARDS_T:
/* copy hf */
s = lw_next_line(s, invite_buf_end);
append_str(d, s1, s - s1);
break;
case HDR_REQUIRE_T:
case HDR_PROXYREQUIRE_T:
/* skip this line */
s = lw_next_line(s, invite_buf_end);
break;
case HDR_CONTENTLENGTH_T:
/* copy hf name with 0 value */
append_str(d, s1, s - s1);
append_str(d, ": 0" CRLF, 3 + CRLF_LEN);
/* move the pointer to the next line */
s = lw_next_line(s, invite_buf_end);
break;
case HDR_EOH_T:
/* end of SIP message found */
#ifdef CANCEL_REASON_SUPPORT
/* add reason if needed */
if (reason_len) {
/* if reason_len !=0, no need for any reason enabled
* checks */
if (likely(reason->cause > 0)) {
append_str(d, REASON_PREFIX, REASON_PREFIX_LEN);
code_len=ushort2sbuf(reason->cause, d,
cancel_buf_len-(int)(d-cancel_buf));
if (unlikely(code_len==0))
LM_BUG("not enough space to write reason code");
d+=code_len;
if (reason->u.text.s){
append_str(d, REASON_TEXT, REASON_TEXT_LEN);
*d='"'; d++;
append_str(d, reason->u.text.s,
reason->u.text.len);
*d='"'; d++;
}
append_str(d, CRLF, CRLF_LEN);
} else if (likely(reason->cause ==
CANCEL_REAS_PACKED_HDRS)) {
append_str(d, reason->u.packed_hdrs.s,
reason->u.packed_hdrs.len);
} else if (reason->cause == CANCEL_REAS_RCVD_CANCEL) {
for(hdr=reas1; hdr; hdr=next_sibling_hdr(hdr)) {
/* hdr->len includes CRLF */
append_str(d, hdr->name.s, hdr->len);
if (likely(hdr==reas_last))
break;
}
}
}
#endif /* CANCEL_REASON_SUPPORT */
/* final (end-of-headers) CRLF */
append_str(d, CRLF, CRLF_LEN);
*len = d - cancel_buf;
/* LOG(L_DBG, "DBG: build_local: %.*s\n", *len, cancel_buf); */
return cancel_buf;
default:
s = lw_next_line(s, invite_buf_end);
hadded = 0;
/* uac auth headers */
if(Trans->uas.request &&
(Trans->uas.request->msg_flags & FL_UAC_AUTH)) {
if(s1 + cenv->uac_cseq_auth.len + 2 < invite_buf_end) {
if(s1[cenv->uac_cseq_auth.len]==':'
&& strncmp(s1, cenv->uac_cseq_auth.s,
cenv->uac_cseq_auth.len)==0) {
hadded = 1;
append_str(d, s1, s - s1);
} else if(s1[cenv->uac_cseq_refresh.len]==':'
&& strncmp(s1, cenv->uac_cseq_refresh.s,
cenv->uac_cseq_refresh.len)==0) {
hadded = 1;
append_str(d, s1, s - s1);
}
}
}
if(likely(hadded==0)) {
if (cfg_get(tm, tm_cfg, ac_extra_hdrs).len
&& (s1 + cfg_get(tm, tm_cfg, ac_extra_hdrs).len < invite_buf_end)
&& (strncasecmp(s1,
cfg_get(tm, tm_cfg, ac_extra_hdrs).s,
cfg_get(tm, tm_cfg, ac_extra_hdrs).len) == 0)) {
append_str(d, s1, s - s1);
}
}
break;
}
}
/* HDR_EOH_T was not found in the buffer, the message is corrupt */
LM_ERR("HDR_EOH_T was not found\n");
shm_free(cancel_buf);
error:
LM_ERR("cannot build %.*s request\n", method_len, method);
return NULL;
}
