551 lines · c
1/*2 * Audio support data for ISDN4Linux.3 *4 * Copyright Andreas Eversberg (jolly@eversberg.eu)5 *6 * This software may be used and distributed according to the terms7 * of the GNU General Public License, incorporated herein by reference.8 *9 */10 11#include <linux/gfp.h>12#include <linux/mISDNif.h>13#include <linux/mISDNdsp.h>14#include "core.h"15#include "dsp.h"16 17 18#define DATA_S sample_silence19#define SIZE_S (&sizeof_silence)20#define DATA_GA sample_german_all21#define SIZE_GA (&sizeof_german_all)22#define DATA_GO sample_german_old23#define SIZE_GO (&sizeof_german_old)24#define DATA_DT sample_american_dialtone25#define SIZE_DT (&sizeof_american_dialtone)26#define DATA_RI sample_american_ringing27#define SIZE_RI (&sizeof_american_ringing)28#define DATA_BU sample_american_busy29#define SIZE_BU (&sizeof_american_busy)30#define DATA_S1 sample_special131#define SIZE_S1 (&sizeof_special1)32#define DATA_S2 sample_special233#define SIZE_S2 (&sizeof_special2)34#define DATA_S3 sample_special335#define SIZE_S3 (&sizeof_special3)36 37/***************/38/* tones loops */39/***************/40 41/* all tones are alaw encoded */42/* the last sample+1 is in phase with the first sample. the error is low */43 44static u8 sample_german_all[] = {45 0x80, 0xab, 0x81, 0x6d, 0xfd, 0xdd, 0x5d, 0x9d,46 0x4d, 0xd1, 0x89, 0x88, 0xd0, 0x4c, 0x9c, 0x5c,47 0xdc, 0xfc, 0x6c,48 0x80, 0xab, 0x81, 0x6d, 0xfd, 0xdd, 0x5d, 0x9d,49 0x4d, 0xd1, 0x89, 0x88, 0xd0, 0x4c, 0x9c, 0x5c,50 0xdc, 0xfc, 0x6c,51 0x80, 0xab, 0x81, 0x6d, 0xfd, 0xdd, 0x5d, 0x9d,52 0x4d, 0xd1, 0x89, 0x88, 0xd0, 0x4c, 0x9c, 0x5c,53 0xdc, 0xfc, 0x6c,54 0x80, 0xab, 0x81, 0x6d, 0xfd, 0xdd, 0x5d, 0x9d,55 0x4d, 0xd1, 0x89, 0x88, 0xd0, 0x4c, 0x9c, 0x5c,56 0xdc, 0xfc, 0x6c,57};58static u32 sizeof_german_all = sizeof(sample_german_all);59 60static u8 sample_german_old[] = {61 0xec, 0x68, 0xe1, 0x6d, 0x6d, 0x91, 0x51, 0xed,62 0x6d, 0x01, 0x1e, 0x10, 0x0c, 0x90, 0x60, 0x70,63 0x8c,64 0xec, 0x68, 0xe1, 0x6d, 0x6d, 0x91, 0x51, 0xed,65 0x6d, 0x01, 0x1e, 0x10, 0x0c, 0x90, 0x60, 0x70,66 0x8c,67 0xec, 0x68, 0xe1, 0x6d, 0x6d, 0x91, 0x51, 0xed,68 0x6d, 0x01, 0x1e, 0x10, 0x0c, 0x90, 0x60, 0x70,69 0x8c,70 0xec, 0x68, 0xe1, 0x6d, 0x6d, 0x91, 0x51, 0xed,71 0x6d, 0x01, 0x1e, 0x10, 0x0c, 0x90, 0x60, 0x70,72 0x8c,73};74static u32 sizeof_german_old = sizeof(sample_german_old);75 76static u8 sample_american_dialtone[] = {77 0x2a, 0x18, 0x90, 0x6c, 0x4c, 0xbc, 0x4c, 0x6c,78 0x10, 0x58, 0x32, 0xb9, 0x31, 0x2d, 0x8d, 0x0d,79 0x8d, 0x2d, 0x31, 0x99, 0x0f, 0x28, 0x60, 0xf0,80 0xd0, 0x50, 0xd0, 0x30, 0x60, 0x08, 0x8e, 0x67,81 0x09, 0x19, 0x21, 0xe1, 0xd9, 0xb9, 0x29, 0x67,82 0x83, 0x02, 0xce, 0xbe, 0xee, 0x1a, 0x1b, 0xef,83 0xbf, 0xcf, 0x03, 0x82, 0x66, 0x28, 0xb8, 0xd8,84 0xe0, 0x20, 0x18, 0x08, 0x66, 0x8f, 0x09, 0x61,85 0x31, 0xd1, 0x51, 0xd1, 0xf1, 0x61, 0x29, 0x0e,86 0x98, 0x30, 0x2c, 0x8c, 0x0c, 0x8c, 0x2c, 0x30,87 0xb8, 0x33, 0x59, 0x11, 0x6d, 0x4d, 0xbd, 0x4d,88 0x6d, 0x91, 0x19,89};90static u32 sizeof_american_dialtone = sizeof(sample_american_dialtone);91 92static u8 sample_american_ringing[] = {93 0x2a, 0xe0, 0xac, 0x0c, 0xbc, 0x4c, 0x8c, 0x90,94 0x48, 0xc7, 0xc1, 0xed, 0xcd, 0x4d, 0xcd, 0xed,95 0xc1, 0xb7, 0x08, 0x30, 0xec, 0xcc, 0xcc, 0x8c,96 0x10, 0x58, 0x1a, 0x99, 0x71, 0xed, 0x8d, 0x8d,97 0x2d, 0x41, 0x89, 0x9e, 0x20, 0x70, 0x2c, 0xec,98 0x2c, 0x70, 0x20, 0x86, 0x77, 0xe1, 0x31, 0x11,99 0xd1, 0xf1, 0x81, 0x09, 0xa3, 0x56, 0x58, 0x00,100 0x40, 0xc0, 0x60, 0x38, 0x46, 0x43, 0x57, 0x39,101 0xd9, 0x59, 0x99, 0xc9, 0x77, 0x2f, 0x2e, 0xc6,102 0xd6, 0x28, 0xd6, 0x36, 0x26, 0x2e, 0x8a, 0xa3,103 0x43, 0x63, 0x4b, 0x4a, 0x62, 0x42, 0xa2, 0x8b,104 0x2f, 0x27, 0x37, 0xd7, 0x29, 0xd7, 0xc7, 0x2f,105 0x2e, 0x76, 0xc8, 0x98, 0x58, 0xd8, 0x38, 0x56,106 0x42, 0x47, 0x39, 0x61, 0xc1, 0x41, 0x01, 0x59,107 0x57, 0xa2, 0x08, 0x80, 0xf0, 0xd0, 0x10, 0x30,108 0xe0, 0x76, 0x87, 0x21, 0x71, 0x2d, 0xed, 0x2d,109 0x71, 0x21, 0x9f, 0x88, 0x40, 0x2c, 0x8c, 0x8c,110 0xec, 0x70, 0x98, 0x1b, 0x59, 0x11, 0x8d, 0xcd,111 0xcd, 0xed, 0x31, 0x09, 0xb6, 0xc0, 0xec, 0xcc,112 0x4c, 0xcc, 0xec, 0xc0, 0xc6, 0x49, 0x91, 0x8d,113 0x4d, 0xbd, 0x0d, 0xad, 0xe1,114};115static u32 sizeof_american_ringing = sizeof(sample_american_ringing);116 117static u8 sample_american_busy[] = {118 0x2a, 0x00, 0x6c, 0x4c, 0x4c, 0x6c, 0xb0, 0x66,119 0x99, 0x11, 0x6d, 0x8d, 0x2d, 0x41, 0xd7, 0x96,120 0x60, 0xf0, 0x70, 0x40, 0x58, 0xf6, 0x53, 0x57,121 0x09, 0x89, 0xd7, 0x5f, 0xe3, 0x2a, 0xe3, 0x5f,122 0xd7, 0x89, 0x09, 0x57, 0x53, 0xf6, 0x58, 0x40,123 0x70, 0xf0, 0x60, 0x96, 0xd7, 0x41, 0x2d, 0x8d,124 0x6d, 0x11, 0x99, 0x66, 0xb0, 0x6c, 0x4c, 0x4c,125 0x6c, 0x00, 0x2a, 0x01, 0x6d, 0x4d, 0x4d, 0x6d,126 0xb1, 0x67, 0x98, 0x10, 0x6c, 0x8c, 0x2c, 0x40,127 0xd6, 0x97, 0x61, 0xf1, 0x71, 0x41, 0x59, 0xf7,128 0x52, 0x56, 0x08, 0x88, 0xd6, 0x5e, 0xe2, 0x2a,129 0xe2, 0x5e, 0xd6, 0x88, 0x08, 0x56, 0x52, 0xf7,130 0x59, 0x41, 0x71, 0xf1, 0x61, 0x97, 0xd6, 0x40,131 0x2c, 0x8c, 0x6c, 0x10, 0x98, 0x67, 0xb1, 0x6d,132 0x4d, 0x4d, 0x6d, 0x01,133};134static u32 sizeof_american_busy = sizeof(sample_american_busy);135 136static u8 sample_special1[] = {137 0x2a, 0x2c, 0xbc, 0x6c, 0xd6, 0x71, 0xbd, 0x0d,138 0xd9, 0x80, 0xcc, 0x4c, 0x40, 0x39, 0x0d, 0xbd,139 0x11, 0x86, 0xec, 0xbc, 0xec, 0x0e, 0x51, 0xbd,140 0x8d, 0x89, 0x30, 0x4c, 0xcc, 0xe0, 0xe1, 0xcd,141 0x4d, 0x31, 0x88, 0x8c, 0xbc, 0x50, 0x0f, 0xed,142 0xbd, 0xed, 0x87, 0x10, 0xbc, 0x0c, 0x38, 0x41,143 0x4d, 0xcd, 0x81, 0xd8, 0x0c, 0xbc, 0x70, 0xd7,144 0x6d, 0xbd, 0x2d,145};146static u32 sizeof_special1 = sizeof(sample_special1);147 148static u8 sample_special2[] = {149 0x2a, 0xcc, 0x8c, 0xd7, 0x4d, 0x2d, 0x18, 0xbc,150 0x10, 0xc1, 0xbd, 0xc1, 0x10, 0xbc, 0x18, 0x2d,151 0x4d, 0xd7, 0x8c, 0xcc, 0x2a, 0xcd, 0x8d, 0xd6,152 0x4c, 0x2c, 0x19, 0xbd, 0x11, 0xc0, 0xbc, 0xc0,153 0x11, 0xbd, 0x19, 0x2c, 0x4c, 0xd6, 0x8d, 0xcd,154 0x2a, 0xcc, 0x8c, 0xd7, 0x4d, 0x2d, 0x18, 0xbc,155 0x10, 0xc1, 0xbd, 0xc1, 0x10, 0xbc, 0x18, 0x2d,156 0x4d, 0xd7, 0x8c, 0xcc, 0x2a, 0xcd, 0x8d, 0xd6,157 0x4c, 0x2c, 0x19, 0xbd, 0x11, 0xc0, 0xbc, 0xc0,158 0x11, 0xbd, 0x19, 0x2c, 0x4c, 0xd6, 0x8d, 0xcd,159};160static u32 sizeof_special2 = sizeof(sample_special2);161 162static u8 sample_special3[] = {163 0x2a, 0xbc, 0x18, 0xcd, 0x11, 0x2c, 0x8c, 0xc1,164 0x4d, 0xd6, 0xbc, 0xd6, 0x4d, 0xc1, 0x8c, 0x2c,165 0x11, 0xcd, 0x18, 0xbc, 0x2a, 0xbd, 0x19, 0xcc,166 0x10, 0x2d, 0x8d, 0xc0, 0x4c, 0xd7, 0xbd, 0xd7,167 0x4c, 0xc0, 0x8d, 0x2d, 0x10, 0xcc, 0x19, 0xbd,168 0x2a, 0xbc, 0x18, 0xcd, 0x11, 0x2c, 0x8c, 0xc1,169 0x4d, 0xd6, 0xbc, 0xd6, 0x4d, 0xc1, 0x8c, 0x2c,170 0x11, 0xcd, 0x18, 0xbc, 0x2a, 0xbd, 0x19, 0xcc,171 0x10, 0x2d, 0x8d, 0xc0, 0x4c, 0xd7, 0xbd, 0xd7,172 0x4c, 0xc0, 0x8d, 0x2d, 0x10, 0xcc, 0x19, 0xbd,173};174static u32 sizeof_special3 = sizeof(sample_special3);175 176static u8 sample_silence[] = {177 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a,178 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a,179 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a,180 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a,181 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a,182 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a,183 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a,184 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a,185 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a,186 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a,187 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a,188 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a,189};190static u32 sizeof_silence = sizeof(sample_silence);191 192struct tones_samples {193 u32 *len;194 u8 *data;195};196static struct197tones_samples samples[] = {198 {&sizeof_german_all, sample_german_all},199 {&sizeof_german_old, sample_german_old},200 {&sizeof_american_dialtone, sample_american_dialtone},201 {&sizeof_american_ringing, sample_american_ringing},202 {&sizeof_american_busy, sample_american_busy},203 {&sizeof_special1, sample_special1},204 {&sizeof_special2, sample_special2},205 {&sizeof_special3, sample_special3},206 {NULL, NULL},207};208 209/***********************************210 * generate ulaw from alaw samples *211 ***********************************/212 213void214dsp_audio_generate_ulaw_samples(void)215{216 int i, j;217 218 i = 0;219 while (samples[i].len) {220 j = 0;221 while (j < (*samples[i].len)) {222 samples[i].data[j] =223 dsp_audio_alaw_to_ulaw[samples[i].data[j]];224 j++;225 }226 i++;227 }228}229 230 231/****************************232 * tone sequence definition *233 ****************************/234 235static struct pattern {236 int tone;237 u8 *data[10];238 u32 *siz[10];239 u32 seq[10];240} pattern[] = {241 {TONE_GERMAN_DIALTONE,242 {DATA_GA, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},243 {SIZE_GA, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},244 {1900, 0, 0, 0, 0, 0, 0, 0, 0, 0} },245 246 {TONE_GERMAN_OLDDIALTONE,247 {DATA_GO, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},248 {SIZE_GO, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},249 {1998, 0, 0, 0, 0, 0, 0, 0, 0, 0} },250 251 {TONE_AMERICAN_DIALTONE,252 {DATA_DT, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},253 {SIZE_DT, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},254 {8000, 0, 0, 0, 0, 0, 0, 0, 0, 0} },255 256 {TONE_GERMAN_DIALPBX,257 {DATA_GA, DATA_S, DATA_GA, DATA_S, DATA_GA, DATA_S, NULL, NULL, NULL,258 NULL},259 {SIZE_GA, SIZE_S, SIZE_GA, SIZE_S, SIZE_GA, SIZE_S, NULL, NULL, NULL,260 NULL},261 {2000, 2000, 2000, 2000, 2000, 12000, 0, 0, 0, 0} },262 263 {TONE_GERMAN_OLDDIALPBX,264 {DATA_GO, DATA_S, DATA_GO, DATA_S, DATA_GO, DATA_S, NULL, NULL, NULL,265 NULL},266 {SIZE_GO, SIZE_S, SIZE_GO, SIZE_S, SIZE_GO, SIZE_S, NULL, NULL, NULL,267 NULL},268 {2000, 2000, 2000, 2000, 2000, 12000, 0, 0, 0, 0} },269 270 {TONE_AMERICAN_DIALPBX,271 {DATA_DT, DATA_S, DATA_DT, DATA_S, DATA_DT, DATA_S, NULL, NULL, NULL,272 NULL},273 {SIZE_DT, SIZE_S, SIZE_DT, SIZE_S, SIZE_DT, SIZE_S, NULL, NULL, NULL,274 NULL},275 {2000, 2000, 2000, 2000, 2000, 12000, 0, 0, 0, 0} },276 277 {TONE_GERMAN_RINGING,278 {DATA_GA, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},279 {SIZE_GA, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},280 {8000, 32000, 0, 0, 0, 0, 0, 0, 0, 0} },281 282 {TONE_GERMAN_OLDRINGING,283 {DATA_GO, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},284 {SIZE_GO, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},285 {8000, 40000, 0, 0, 0, 0, 0, 0, 0, 0} },286 287 {TONE_AMERICAN_RINGING,288 {DATA_RI, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},289 {SIZE_RI, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},290 {8000, 32000, 0, 0, 0, 0, 0, 0, 0, 0} },291 292 {TONE_GERMAN_RINGPBX,293 {DATA_GA, DATA_S, DATA_GA, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL},294 {SIZE_GA, SIZE_S, SIZE_GA, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL},295 {4000, 4000, 4000, 28000, 0, 0, 0, 0, 0, 0} },296 297 {TONE_GERMAN_OLDRINGPBX,298 {DATA_GO, DATA_S, DATA_GO, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL},299 {SIZE_GO, SIZE_S, SIZE_GO, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL},300 {4000, 4000, 4000, 28000, 0, 0, 0, 0, 0, 0} },301 302 {TONE_AMERICAN_RINGPBX,303 {DATA_RI, DATA_S, DATA_RI, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL},304 {SIZE_RI, SIZE_S, SIZE_RI, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL},305 {4000, 4000, 4000, 28000, 0, 0, 0, 0, 0, 0} },306 307 {TONE_GERMAN_BUSY,308 {DATA_GA, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},309 {SIZE_GA, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},310 {4000, 4000, 0, 0, 0, 0, 0, 0, 0, 0} },311 312 {TONE_GERMAN_OLDBUSY,313 {DATA_GO, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},314 {SIZE_GO, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},315 {1000, 5000, 0, 0, 0, 0, 0, 0, 0, 0} },316 317 {TONE_AMERICAN_BUSY,318 {DATA_BU, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},319 {SIZE_BU, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},320 {4000, 4000, 0, 0, 0, 0, 0, 0, 0, 0} },321 322 {TONE_GERMAN_HANGUP,323 {DATA_GA, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},324 {SIZE_GA, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},325 {4000, 4000, 0, 0, 0, 0, 0, 0, 0, 0} },326 327 {TONE_GERMAN_OLDHANGUP,328 {DATA_GO, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},329 {SIZE_GO, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},330 {1000, 5000, 0, 0, 0, 0, 0, 0, 0, 0} },331 332 {TONE_AMERICAN_HANGUP,333 {DATA_DT, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},334 {SIZE_DT, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},335 {8000, 0, 0, 0, 0, 0, 0, 0, 0, 0} },336 337 {TONE_SPECIAL_INFO,338 {DATA_S1, DATA_S2, DATA_S3, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL},339 {SIZE_S1, SIZE_S2, SIZE_S3, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL},340 {2666, 2666, 2666, 8002, 0, 0, 0, 0, 0, 0} },341 342 {TONE_GERMAN_GASSENBESETZT,343 {DATA_GA, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},344 {SIZE_GA, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},345 {2000, 2000, 0, 0, 0, 0, 0, 0, 0, 0} },346 347 {TONE_GERMAN_AUFSCHALTTON,348 {DATA_GO, DATA_S, DATA_GO, DATA_S, NULL, NULL, NULL, NULL, NULL, NULL},349 {SIZE_GO, SIZE_S, SIZE_GO, SIZE_S, NULL, NULL, NULL, NULL, NULL, NULL},350 {1000, 5000, 1000, 17000, 0, 0, 0, 0, 0, 0} },351 352 {0,353 {NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},354 {NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL},355 {0, 0, 0, 0, 0, 0, 0, 0, 0, 0} },356};357 358/******************359 * copy tone data *360 ******************/361 362/* an sk_buff is generated from the number of samples needed.363 * the count will be changed and may begin from 0 each pattern period.364 * the clue is to precalculate the pointers and legths to use only one365 * memcpy per function call, or two memcpy if the tone sequence changes.366 *367 * pattern - the type of the pattern368 * count - the sample from the beginning of the pattern (phase)369 * len - the number of bytes370 *371 * return - the sk_buff with the sample372 *373 * if tones has finished (e.g. knocking tone), dsp->tones is turned off374 */375void dsp_tone_copy(struct dsp *dsp, u8 *data, int len)376{377 int index, count, start, num;378 struct pattern *pat;379 struct dsp_tone *tone = &dsp->tone;380 381 /* if we have no tone, we copy silence */382 if (!tone->tone) {383 memset(data, dsp_silence, len);384 return;385 }386 387 /* process pattern */388 pat = (struct pattern *)tone->pattern;389 /* points to the current pattern */390 index = tone->index; /* gives current sequence index */391 count = tone->count; /* gives current sample */392 393 /* copy sample */394 while (len) {395 /* find sample to start with */396 while (42) {397 /* wrap around */398 if (!pat->seq[index]) {399 count = 0;400 index = 0;401 }402 /* check if we are currently playing this tone */403 if (count < pat->seq[index])404 break;405 if (dsp_debug & DEBUG_DSP_TONE)406 printk(KERN_DEBUG "%s: reaching next sequence "407 "(index=%d)\n", __func__, index);408 count -= pat->seq[index];409 index++;410 }411 /* calculate start and number of samples */412 start = count % (*(pat->siz[index]));413 num = len;414 if (num + count > pat->seq[index])415 num = pat->seq[index] - count;416 if (num + start > (*(pat->siz[index])))417 num = (*(pat->siz[index])) - start;418 /* copy memory */419 memcpy(data, pat->data[index] + start, num);420 /* reduce length */421 data += num;422 count += num;423 len -= num;424 }425 tone->index = index;426 tone->count = count;427 428 /* return sk_buff */429 return;430}431 432 433/*******************************434 * send HW message to hfc card *435 *******************************/436 437static void438dsp_tone_hw_message(struct dsp *dsp, u8 *sample, int len)439{440 struct sk_buff *nskb;441 442 /* unlocking is not required, because we don't expect a response */443 nskb = _alloc_mISDN_skb(PH_CONTROL_REQ,444 (len) ? HFC_SPL_LOOP_ON : HFC_SPL_LOOP_OFF, len, sample,445 GFP_ATOMIC);446 if (nskb) {447 if (dsp->ch.peer) {448 if (dsp->ch.recv(dsp->ch.peer, nskb))449 dev_kfree_skb(nskb);450 } else451 dev_kfree_skb(nskb);452 }453}454 455 456/*****************457 * timer expires *458 *****************/459void460dsp_tone_timeout(struct timer_list *t)461{462 struct dsp *dsp = from_timer(dsp, t, tone.tl);463 struct dsp_tone *tone = &dsp->tone;464 struct pattern *pat = (struct pattern *)tone->pattern;465 int index = tone->index;466 467 if (!tone->tone)468 return;469 470 index++;471 if (!pat->seq[index])472 index = 0;473 tone->index = index;474 475 /* set next tone */476 if (pat->data[index] == DATA_S)477 dsp_tone_hw_message(dsp, NULL, 0);478 else479 dsp_tone_hw_message(dsp, pat->data[index], *(pat->siz[index]));480 /* set timer */481 tone->tl.expires = jiffies + (pat->seq[index] * HZ) / 8000;482 add_timer(&tone->tl);483}484 485 486/********************487 * set/release tone *488 ********************/489 490/*491 * tones are relaized by streaming or by special loop commands if supported492 * by hardware. when hardware is used, the patterns will be controlled by493 * timers.494 */495int496dsp_tone(struct dsp *dsp, int tone)497{498 struct pattern *pat;499 int i;500 struct dsp_tone *tonet = &dsp->tone;501 502 tonet->software = 0;503 tonet->hardware = 0;504 505 /* we turn off the tone */506 if (!tone) {507 if (dsp->features.hfc_loops && timer_pending(&tonet->tl))508 del_timer(&tonet->tl);509 if (dsp->features.hfc_loops)510 dsp_tone_hw_message(dsp, NULL, 0);511 tonet->tone = 0;512 return 0;513 }514 515 pat = NULL;516 i = 0;517 while (pattern[i].tone) {518 if (pattern[i].tone == tone) {519 pat = &pattern[i];520 break;521 }522 i++;523 }524 if (!pat) {525 printk(KERN_WARNING "dsp: given tone 0x%x is invalid\n", tone);526 return -EINVAL;527 }528 if (dsp_debug & DEBUG_DSP_TONE)529 printk(KERN_DEBUG "%s: now starting tone %d (index=%d)\n",530 __func__, tone, 0);531 tonet->tone = tone;532 tonet->pattern = pat;533 tonet->index = 0;534 tonet->count = 0;535 536 if (dsp->features.hfc_loops) {537 tonet->hardware = 1;538 /* set first tone */539 dsp_tone_hw_message(dsp, pat->data[0], *(pat->siz[0]));540 /* set timer */541 if (timer_pending(&tonet->tl))542 del_timer(&tonet->tl);543 tonet->tl.expires = jiffies + (pat->seq[0] * HZ) / 8000;544 add_timer(&tonet->tl);545 } else {546 tonet->software = 1;547 }548 549 return 0;550}551