improve linked-list macros in two ways:
[asterisk/asterisk.git] / main / indications.c
1 /*
2  * Asterisk -- An open source telephony toolkit.
3  *
4  * Copyright (C) 2002, Pauline Middelink
5  *
6  *
7  * See http://www.asterisk.org for more information about
8  * the Asterisk project. Please do not directly contact
9  * any of the maintainers of this project for assistance;
10  * the project provides a web site, mailing lists and IRC
11  * channels for your use.
12  *
13  * This program is free software, distributed under the terms of
14  * the GNU General Public License Version 2. See the LICENSE file
15  * at the top of the source tree.
16  */
17
18 /*! \file
19  *
20  * \brief Tone Management
21  * 
22  * \author Pauline Middelink <middelink@polyware.nl>
23  *
24  * This set of function allow us to play a list of tones on a channel.
25  * Each element has two frequencies, which are mixed together and a
26  * duration. For silence both frequencies can be set to 0.
27  * The playtones can be given as a comma separated string.
28  *
29  */
30
31 #include "asterisk.h"
32
33 ASTERISK_FILE_VERSION(__FILE__, "$Revision$")
34
35 #include <stdio.h>
36 #include <stdlib.h>
37 #include <string.h>
38 #include <math.h>
39
40 #include "asterisk/lock.h"
41 #include "asterisk/linkedlists.h"
42 #include "asterisk/indications.h"
43 #include "asterisk/frame.h"
44 #include "asterisk/options.h"
45 #include "asterisk/channel.h"
46 #include "asterisk/logger.h"
47 #include "asterisk/utils.h"
48
49 static int midi_tohz[128] = {
50                         8,8,9,9,10,10,11,12,12,13,14,
51                         15,16,17,18,19,20,21,23,24,25,
52                         27,29,30,32,34,36,38,41,43,46,
53                         48,51,55,58,61,65,69,73,77,82,
54                         87,92,97,103,110,116,123,130,138,146,
55                         155,164,174,184,195,207,220,233,246,261,
56                         277,293,311,329,349,369,391,415,440,466,
57                         493,523,554,587,622,659,698,739,783,830,
58                         880,932,987,1046,1108,1174,1244,1318,1396,1479,
59                         1567,1661,1760,1864,1975,2093,2217,2349,2489,2637,
60                         2793,2959,3135,3322,3520,3729,3951,4186,4434,4698,
61                         4978,5274,5587,5919,6271,6644,7040,7458,7902,8372,
62                         8869,9397,9956,10548,11175,11839,12543
63                         };
64
65 struct playtones_item {
66         int fac1;
67         int init_v2_1;
68         int init_v3_1;
69         int fac2;
70         int init_v2_2;
71         int init_v3_2;
72         int modulate;
73         int duration;
74 };
75
76 struct playtones_def {
77         int vol;
78         int reppos;
79         int nitems;
80         int interruptible;
81         struct playtones_item *items;
82 };
83
84 struct playtones_state {
85         int vol;
86         int v1_1;
87         int v2_1;
88         int v3_1;
89         int v1_2;
90         int v2_2;
91         int v3_2;
92         int reppos;
93         int nitems;
94         struct playtones_item *items;
95         int npos;
96         int oldnpos;
97         int pos;
98         int origwfmt;
99         struct ast_frame f;
100         unsigned char offset[AST_FRIENDLY_OFFSET];
101         short data[4000];
102 };
103
104 static void playtones_release(struct ast_channel *chan, void *params)
105 {
106         struct playtones_state *ps = params;
107
108         if (chan)
109                 ast_set_write_format(chan, ps->origwfmt);
110         if (ps->items)
111                 ast_free(ps->items);
112
113         ast_free(ps);
114 }
115
116 static void * playtones_alloc(struct ast_channel *chan, void *params)
117 {
118         struct playtones_def *pd = params;
119         struct playtones_state *ps = NULL;
120
121         if (!(ps = ast_calloc(1, sizeof(*ps))))
122                 return NULL;
123
124         ps->origwfmt = chan->writeformat;
125
126         if (ast_set_write_format(chan, AST_FORMAT_SLINEAR)) {
127                 ast_log(LOG_WARNING, "Unable to set '%s' to signed linear format (write)\n", chan->name);
128                 playtones_release(NULL, ps);
129                 ps = NULL;
130         } else {
131                 ps->vol = pd->vol;
132                 ps->reppos = pd->reppos;
133                 ps->nitems = pd->nitems;
134                 ps->items = pd->items;
135                 ps->oldnpos = -1;
136         }
137
138         /* Let interrupts interrupt :) */
139         if (pd->interruptible)
140                 ast_set_flag(chan, AST_FLAG_WRITE_INT);
141         else
142                 ast_clear_flag(chan, AST_FLAG_WRITE_INT);
143
144         return ps;
145 }
146
147 static int playtones_generator(struct ast_channel *chan, void *data, int len, int samples)
148 {
149         struct playtones_state *ps = data;
150         struct playtones_item *pi;
151         int x;
152         /* we need to prepare a frame with 16 * timelen samples as we're 
153          * generating SLIN audio
154          */
155         len = samples * 2;
156         if (len > sizeof(ps->data) / 2 - 1) {
157                 ast_log(LOG_WARNING, "Can't generate that much data!\n");
158                 return -1;
159         }
160         memset(&ps->f, 0, sizeof(ps->f));
161
162         pi = &ps->items[ps->npos];
163         if (ps->oldnpos != ps->npos) {
164                 /* Load new parameters */
165                 ps->v1_1 = 0;
166                 ps->v2_1 = pi->init_v2_1;
167                 ps->v3_1 = pi->init_v3_1;
168                 ps->v1_2 = 0;
169                 ps->v2_2 = pi->init_v2_2;
170                 ps->v3_2 = pi->init_v3_2;
171                 ps->oldnpos = ps->npos;
172         }
173         for (x=0;x<len/2;x++) {
174                 ps->v1_1 = ps->v2_1;
175                 ps->v2_1 = ps->v3_1;
176                 ps->v3_1 = (pi->fac1 * ps->v2_1 >> 15) - ps->v1_1;
177                 
178                 ps->v1_2 = ps->v2_2;
179                 ps->v2_2 = ps->v3_2;
180                 ps->v3_2 = (pi->fac2 * ps->v2_2 >> 15) - ps->v1_2;
181                 if (pi->modulate) {
182                         int p;
183                         p = ps->v3_2 - 32768;
184                         if (p < 0) p = -p;
185                         p = ((p * 9) / 10) + 1;
186                         ps->data[x] = (ps->v3_1 * p) >> 15;
187                 } else
188                         ps->data[x] = ps->v3_1 + ps->v3_2; 
189         }
190         
191         ps->f.frametype = AST_FRAME_VOICE;
192         ps->f.subclass = AST_FORMAT_SLINEAR;
193         ps->f.datalen = len;
194         ps->f.samples = samples;
195         ps->f.offset = AST_FRIENDLY_OFFSET;
196         ps->f.data = ps->data;
197         ps->f.delivery.tv_sec = 0;
198         ps->f.delivery.tv_usec = 0;
199         ast_write(chan, &ps->f);
200
201         ps->pos += x;
202         if (pi->duration && ps->pos >= pi->duration * 8) {      /* item finished? */
203                 ps->pos = 0;                                    /* start new item */
204                 ps->npos++;
205                 if (ps->npos >= ps->nitems) {                   /* last item? */
206                         if (ps->reppos == -1)                   /* repeat set? */
207                                 return -1;
208                         ps->npos = ps->reppos;                  /* redo from top */
209                 }
210         }
211         return 0;
212 }
213
214 static struct ast_generator playtones = {
215         alloc: playtones_alloc,
216         release: playtones_release,
217         generate: playtones_generator,
218 };
219
220 int ast_playtones_start(struct ast_channel *chan, int vol, const char *playlst, int interruptible)
221 {
222         char *s, *data = ast_strdupa(playlst); /* cute */
223         struct playtones_def d = { vol, -1, 0, 1, NULL};
224         char *stringp;
225         char *separator;
226         
227         if (vol < 1)
228                 d.vol = 7219; /* Default to -8db */
229
230         d.interruptible = interruptible;
231         
232         stringp=data;
233         /* the stringp/data is not null here */
234         /* check if the data is separated with '|' or with ',' by default */
235         if (strchr(stringp,'|'))
236                 separator = "|";
237         else
238                 separator = ",";
239         s = strsep(&stringp,separator);
240         while (s && *s) {
241                 int freq1, freq2, time, modulate=0, midinote=0;
242
243                 if (s[0]=='!')
244                         s++;
245                 else if (d.reppos == -1)
246                         d.reppos = d.nitems;
247                 if (sscanf(s, "%d+%d/%d", &freq1, &freq2, &time) == 3) {
248                         /* f1+f2/time format */
249                 } else if (sscanf(s, "%d+%d", &freq1, &freq2) == 2) {
250                         /* f1+f2 format */
251                         time = 0;
252                 } else if (sscanf(s, "%d*%d/%d", &freq1, &freq2, &time) == 3) {
253                         /* f1*f2/time format */
254                         modulate = 1;
255                 } else if (sscanf(s, "%d*%d", &freq1, &freq2) == 2) {
256                         /* f1*f2 format */
257                         time = 0;
258                         modulate = 1;
259                 } else if (sscanf(s, "%d/%d", &freq1, &time) == 2) {
260                         /* f1/time format */
261                         freq2 = 0;
262                 } else if (sscanf(s, "%d", &freq1) == 1) {
263                         /* f1 format */
264                         freq2 = 0;
265                         time = 0;
266                 } else if (sscanf(s, "M%d+M%d/%d", &freq1, &freq2, &time) == 3) {
267                         /* Mf1+Mf2/time format */
268                         midinote = 1;
269                 } else if (sscanf(s, "M%d+M%d", &freq1, &freq2) == 2) {
270                         /* Mf1+Mf2 format */
271                         time = 0;
272                         midinote = 1;
273                 } else if (sscanf(s, "M%d*M%d/%d", &freq1, &freq2, &time) == 3) {
274                         /* Mf1*Mf2/time format */
275                         modulate = 1;
276                         midinote = 1;
277                 } else if (sscanf(s, "M%d*M%d", &freq1, &freq2) == 2) {
278                         /* Mf1*Mf2 format */
279                         time = 0;
280                         modulate = 1;
281                         midinote = 1;
282                 } else if (sscanf(s, "M%d/%d", &freq1, &time) == 2) {
283                         /* Mf1/time format */
284                         freq2 = -1;
285                         midinote = 1;
286                 } else if (sscanf(s, "M%d", &freq1) == 1) {
287                         /* Mf1 format */
288                         freq2 = -1;
289                         time = 0;
290                         midinote = 1;
291                 } else {
292                         ast_log(LOG_WARNING,"%s: tone component '%s' of '%s' is no good\n",chan->name,s,playlst);
293                         return -1;
294                 }
295
296                 if (midinote) {
297                         /* midi notes must be between 0 and 127 */
298                         if ((freq1 >= 0) && (freq1 <= 127))
299                                 freq1 = midi_tohz[freq1];
300                         else
301                                 freq1 = 0;
302
303                         if ((freq2 >= 0) && (freq2 <= 127))
304                                 freq2 = midi_tohz[freq2];
305                         else
306                                 freq2 = 0;
307                 }
308
309                 if (!(d.items = ast_realloc(d.items, (d.nitems + 1) * sizeof(*d.items)))) {
310                         return -1;
311                 }
312                 d.items[d.nitems].fac1 = 2.0 * cos(2.0 * M_PI * (freq1 / 8000.0)) * 32768.0;
313                 d.items[d.nitems].init_v2_1 = sin(-4.0 * M_PI * (freq1 / 8000.0)) * d.vol;
314                 d.items[d.nitems].init_v3_1 = sin(-2.0 * M_PI * (freq1 / 8000.0)) * d.vol;
315
316                 d.items[d.nitems].fac2 = 2.0 * cos(2.0 * M_PI * (freq2 / 8000.0)) * 32768.0;
317                 d.items[d.nitems].init_v2_2 = sin(-4.0 * M_PI * (freq2 / 8000.0)) * d.vol;
318                 d.items[d.nitems].init_v3_2 = sin(-2.0 * M_PI * (freq2 / 8000.0)) * d.vol;
319                 d.items[d.nitems].duration = time;
320                 d.items[d.nitems].modulate = modulate;
321                 d.nitems++;
322
323                 s = strsep(&stringp,separator);
324         }
325
326         if (ast_activate_generator(chan, &playtones, &d)) {
327                 ast_free(d.items);
328                 return -1;
329         }
330         return 0;
331 }
332
333 void ast_playtones_stop(struct ast_channel *chan)
334 {
335         ast_deactivate_generator(chan);
336 }
337
338 /*--------------------------------------------*/
339
340 static AST_RWLIST_HEAD_STATIC(tone_zones, ind_tone_zone);
341 static struct ind_tone_zone *current_tonezone;
342
343 struct ind_tone_zone *ast_walk_indications(const struct ind_tone_zone *cur)
344 {
345         struct ind_tone_zone *tz = NULL;
346
347         AST_RWLIST_RDLOCK(&tone_zones);
348         /* If cur is not NULL, then we have to iterate through - otherwise just return the first entry */
349         if (cur) {
350                 AST_RWLIST_TRAVERSE(&tone_zones, tz, list) {
351                         if (tz == cur)
352                                 break;
353                 }
354                 tz = AST_RWLIST_NEXT(tz, list);
355         } else {
356                 tz = AST_RWLIST_FIRST(&tone_zones);
357         }
358         AST_RWLIST_UNLOCK(&tone_zones);
359
360         return tz;
361 }
362
363 /* Set global indication country */
364 int ast_set_indication_country(const char *country)
365 {
366         struct ind_tone_zone *zone = NULL;
367
368         /* If no country is specified or we are unable to find the zone, then return not found */
369         if (!country || !(zone = ast_get_indication_zone(country)))
370                 return 1;
371         
372         ast_verb(3, "Setting default indication country to '%s'\n", country);
373
374         /* Protect the current tonezone using the tone_zones lock as well */
375         AST_RWLIST_WRLOCK(&tone_zones);
376         current_tonezone = zone;
377         AST_RWLIST_UNLOCK(&tone_zones);
378
379         /* Zone was found */
380         return 0;
381 }
382
383 /* locate tone_zone, given the country. if country == NULL, use the default country */
384 struct ind_tone_zone *ast_get_indication_zone(const char *country)
385 {
386         struct ind_tone_zone *tz = NULL;
387         int alias_loop = 0;
388
389         AST_RWLIST_RDLOCK(&tone_zones);
390
391         if (!country) {
392                 if (current_tonezone)
393                         tz = current_tonezone;
394                 else
395                         tz = AST_LIST_FIRST(&tone_zones);
396         } else {
397                 do {
398                         AST_RWLIST_TRAVERSE(&tone_zones, tz, list) {
399                                 if (!strcasecmp(tz->country, country))
400                                         break;
401                         }
402                         if (!tz)
403                                 break;
404                         /* If this is an alias then we have to search yet again otherwise we have found the zonezone */
405                         if (tz->alias && tz->alias[0])
406                                 country = tz->alias;
407                         else
408                                 break;
409                 } while ((++alias_loop < 20) && tz);
410         }
411
412         AST_RWLIST_UNLOCK(&tone_zones);
413
414         /* If we reached the maximum loops to find the proper country via alias, print out a notice */
415         if (alias_loop == 20)
416                 ast_log(LOG_NOTICE, "Alias loop for '%s' is bonkers\n", country);
417
418         return tz;
419 }
420
421 /* locate a tone_zone_sound, given the tone_zone. if tone_zone == NULL, use the default tone_zone */
422 struct ind_tone_zone_sound *ast_get_indication_tone(const struct ind_tone_zone *zone, const char *indication)
423 {
424         struct ind_tone_zone_sound *ts = NULL;
425
426         AST_RWLIST_RDLOCK(&tone_zones);
427
428         /* If no zone is already specified we need to try to pick one */
429         if (!zone) {
430                 if (current_tonezone) {
431                         zone = current_tonezone;
432                 } else if (!(zone = AST_LIST_FIRST(&tone_zones))) {
433                         /* No zone has been found ;( */
434                         AST_RWLIST_UNLOCK(&tone_zones);
435                         return NULL;
436                 }
437         }
438
439         /* Look through list of tones in the zone searching for the right one */
440         for (ts = zone->tones; ts; ts = ts->next) {
441                 if (!strcasecmp(ts->name, indication))
442                         break;
443         }
444
445         AST_RWLIST_UNLOCK(&tone_zones);
446
447         return ts;
448 }
449
450 /* helper function to delete a tone_zone in its entirety */
451 static inline void free_zone(struct ind_tone_zone* zone)
452 {
453         while (zone->tones) {
454                 struct ind_tone_zone_sound *tmp = zone->tones->next;
455                 ast_free((void *)zone->tones->name);
456                 ast_free((void *)zone->tones->data);
457                 ast_free(zone->tones);
458                 zone->tones = tmp;
459         }
460
461         if (zone->ringcadence)
462                 ast_free(zone->ringcadence);
463
464         ast_free(zone);
465 }
466
467 /*--------------------------------------------*/
468
469 /* add a new country, if country exists, it will be replaced. */
470 int ast_register_indication_country(struct ind_tone_zone *zone)
471 {
472         struct ind_tone_zone *tz = NULL;
473
474         AST_RWLIST_WRLOCK(&tone_zones);
475         AST_RWLIST_TRAVERSE_SAFE_BEGIN(&tone_zones, tz, list) {
476                 /* If this is not the same zone, then just continue to the next entry */
477                 if (strcasecmp(zone->country, tz->country))
478                         continue;
479                 /* If this zone we are going to remove is the current default then make the new zone the default */
480                 if (tz == current_tonezone)
481                         current_tonezone = zone;
482                 /* Remove from the linked list */
483                 AST_RWLIST_REMOVE_CURRENT(list);
484                 /* Finally free the zone itself */
485                 free_zone(tz);
486                 break;
487         }
488         AST_RWLIST_TRAVERSE_SAFE_END;
489
490         /* Add zone to the list */
491         AST_RWLIST_INSERT_TAIL(&tone_zones, zone, list);
492
493         /* It's all over. */
494         AST_RWLIST_UNLOCK(&tone_zones);
495
496         ast_verb(3, "Registered indication country '%s'\n", zone->country);
497
498         return 0;
499 }
500
501 /* remove an existing country and all its indications, country must exist.
502  * Also, all countries which are an alias for the specified country are removed. */
503 int ast_unregister_indication_country(const char *country)
504 {
505         struct ind_tone_zone *tz = NULL;
506         int res = -1;
507
508         AST_RWLIST_WRLOCK(&tone_zones);
509         AST_RWLIST_TRAVERSE_SAFE_BEGIN(&tone_zones, tz, list) {
510                 if (country && (strcasecmp(country, tz->country) && strcasecmp(country, tz->alias)))
511                         continue;
512                 /* If this tonezone is the current default then unset it */
513                 if (tz == current_tonezone) {
514                         ast_log(LOG_NOTICE,"Removed default indication country '%s'\n", tz->country);
515                         current_tonezone = NULL;
516                 }
517                 /* Remove from the list */
518                 AST_RWLIST_REMOVE_CURRENT(list);
519                 ast_verb(3, "Unregistered indication country '%s'\n", tz->country);
520                 free_zone(tz);
521                 res = 0;
522         }
523         AST_RWLIST_TRAVERSE_SAFE_END;
524         AST_RWLIST_UNLOCK(&tone_zones);
525
526         return res;
527 }
528
529 /* add a new indication to a tone_zone. tone_zone must exist. if the indication already
530  * exists, it will be replaced. */
531 int ast_register_indication(struct ind_tone_zone *zone, const char *indication, const char *tonelist)
532 {
533         struct ind_tone_zone_sound *ts, *ps;
534
535         /* is it an alias? stop */
536         if (zone->alias[0])
537                 return -1;
538
539         AST_RWLIST_WRLOCK(&tone_zones);
540         for (ps=NULL,ts=zone->tones; ts; ps=ts,ts=ts->next) {
541                 if (strcasecmp(indication,ts->name)==0) {
542                         /* indication already there, replace */
543                         ast_free((void*)ts->name);
544                         ast_free((void*)ts->data);
545                         break;
546                 }
547         }
548         if (!ts) {
549                 /* not there, we have to add */
550                 if (!(ts = ast_malloc(sizeof(*ts)))) {
551                         AST_RWLIST_UNLOCK(&tone_zones);
552                         return -2;
553                 }
554                 ts->next = NULL;
555         }
556         if (!(ts->name = ast_strdup(indication)) || !(ts->data = ast_strdup(tonelist))) {
557                 AST_RWLIST_UNLOCK(&tone_zones);
558                 return -2;
559         }
560         if (ps)
561                 ps->next = ts;
562         else
563                 zone->tones = ts;
564         AST_RWLIST_UNLOCK(&tone_zones);
565         return 0;
566 }
567
568 /* remove an existing country's indication. Both country and indication must exist */
569 int ast_unregister_indication(struct ind_tone_zone *zone, const char *indication)
570 {
571         struct ind_tone_zone_sound *ts,*ps = NULL, *tmp;
572         int res = -1;
573
574         /* is it an alias? stop */
575         if (zone->alias[0])
576                 return -1;
577
578         AST_RWLIST_WRLOCK(&tone_zones);
579         ts = zone->tones;
580         while (ts) {
581                 if (strcasecmp(indication,ts->name)==0) {
582                         /* indication found */
583                         tmp = ts->next;
584                         if (ps)
585                                 ps->next = tmp;
586                         else
587                                 zone->tones = tmp;
588                         ast_free((void*)ts->name);
589                         ast_free((void*)ts->data);
590                         ast_free(ts);
591                         ts = tmp;
592                         res = 0;
593                 }
594                 else {
595                         /* next zone please */
596                         ps = ts;
597                         ts = ts->next;
598                 }
599         }
600         /* indication not found, goodbye */
601         AST_RWLIST_UNLOCK(&tone_zones);
602         return res;
603 }