channels/chan_usbradio.c

   1 /*
   2  * Asterisk -- An open source telephony toolkit.
   3  *
   4  * Copyright (C) 1999 - 2005, Digium, Inc.
   5  * Copyright (C) 2007, Jim Dixon
   6  *
   7  * Jim Dixon, WB6NIL <jim@lambdatel.com>
   8  * Steve Henke, W9SH  <w9sh@arrl.net>
   9  * Based upon work by Mark Spencer <markster@digium.com> and Luigi Rizzo
  10  *
  11  * See http://www.asterisk.org for more information about
  12  * the Asterisk project. Please do not directly contact
  13  * any of the maintainers of this project for assistance;
  14  * the project provides a web site, mailing lists and IRC
  15  * channels for your use.
  16  *
  17  * This program is free software, distributed under the terms of
  18  * the GNU General Public License Version 2. See the LICENSE file
  19   * at the top of the source tree.
  20  */
  21
  22 /*! \file
  23  *
  24  * \brief Channel driver for CM108 USB Cards with Radio Interface
  25  *
  26  * \author Jim Dixon  <jim@lambdatel.com>
  27  * \author Steve Henke  <w9sh@arrl.net>
  28  *
  29  * \par See also
  30  * \arg \ref Config_usbradio
  31  *
  32  * \ingroup channel_drivers
  33  */
  34
  35 /*** MODULEINFO
  36         <depend>asound</depend>
  37         <depend>usb</depend>
  38         <defaultenabled>no</defaultenabled>
  39  ***/
  40
  41 #include "asterisk.h"
  42
  43 ASTERISK_FILE_VERSION(__FILE__, "$Revision$")
  44
  45 #include <ctype.h>
  46 #include <math.h>
  47 #include <sys/ioctl.h>
  48 #include <fcntl.h>
  49 #include <sys/time.h>
  50 #include <usb.h>
  51 #include <alsa/asoundlib.h>
  52
  53 #define CHAN_USBRADIO           1
  54
  55 #define DEBUG_USBRADIO          0
  56 #define DEBUG_CAPTURES                  1
  57
  58 #define DEBUG_CAP_RX_OUT                0
  59 #define DEBUG_CAP_TX_OUT            0
  60
  61 #define DEBUG_FILETEST                  0
  62
  63 #define RX_CAP_RAW_FILE                 "/tmp/rx_cap_in.pcm"
  64 #define RX_CAP_TRACE_FILE               "/tmp/rx_trace.pcm"
  65 #define RX_CAP_OUT_FILE                 "/tmp/rx_cap_out.pcm"
  66
  67 #define TX_CAP_RAW_FILE                 "/tmp/tx_cap_in.pcm"
  68 #define TX_CAP_TRACE_FILE               "/tmp/tx_trace.pcm"
  69 #define TX_CAP_OUT_FILE                 "/tmp/tx_cap_out.pcm"
  70
  71 #define MIXER_PARAM_MIC_PLAYBACK_SW "Mic Playback Switch"
  72 #define MIXER_PARAM_MIC_PLAYBACK_VOL "Mic Playback Volume"
  73 #define MIXER_PARAM_MIC_CAPTURE_SW "Mic Capture Switch"
  74 #define MIXER_PARAM_MIC_CAPTURE_VOL "Mic Capture Volume"
  75 #define MIXER_PARAM_MIC_BOOST "Auto Gain Control"
  76 #define MIXER_PARAM_SPKR_PLAYBACK_SW "Speaker Playback Switch"
  77 #define MIXER_PARAM_SPKR_PLAYBACK_VOL "Speaker Playback Volume"
  78
  79 #include "./xpmr/xpmr.h"
  80
  81 #if 0
  82 #define traceusb1(a, ...) ast_debug(4, a __VA_ARGS__)
  83 #else
  84 #define traceusb1(a, ...)
  85 #endif
  86
  87 #if 0
  88 #define traceusb2(a, ...) ast_debug(4, a __VA_ARGS__)
  89 #else
  90 #define traceusb2(a, ...)
  91 #endif
  92
  93 #ifdef __linux
  94 #include <linux/soundcard.h>
  95 #elif defined(__FreeBSD__)
  96 #include <sys/soundcard.h>
  97 #else
  98 #include <soundcard.h>
  99 #endif
 100
 101 #include "asterisk/lock.h"
 102 #include "asterisk/frame.h"
 103 #include "asterisk/callerid.h"
 104 #include "asterisk/channel.h"
 105 #include "asterisk/module.h"
 106 #include "asterisk/pbx.h"
 107 #include "asterisk/config.h"
 108 #include "asterisk/cli.h"
 109 #include "asterisk/utils.h"
 110 #include "asterisk/causes.h"
 111 #include "asterisk/endian.h"
 112 #include "asterisk/stringfields.h"
 113 #include "asterisk/abstract_jb.h"
 114 #include "asterisk/musiconhold.h"
 115 #include "asterisk/dsp.h"
 116
 117 /* ringtones we use */
 118 #include "busy.h"
 119 #include "ringtone.h"
 120 #include "ring10.h"
 121 #include "answer.h"
 122
 123 #define C108_VENDOR_ID          0x0d8c
 124 #define C108_PRODUCT_ID         0x000c
 125 #define C108_HID_INTERFACE      3
 126
 127 #define HID_REPORT_GET          0x01
 128 #define HID_REPORT_SET          0x09
 129
 130 #define HID_RT_INPUT            0x01
 131 #define HID_RT_OUTPUT           0x02
 132
 133 /*! Global jitterbuffer configuration - by default, jb is disabled */
 134 static struct ast_jb_conf default_jbconf =
 135 {
 136         .flags = 0,
 137         .max_size = -1,
 138         .resync_threshold = -1,
 139         .impl = "",
 140 };
 141 static struct ast_jb_conf global_jbconf;
 142
 143 /*!
 144  * usbradio.conf parameters are
 145 START_CONFIG
 146
 147 [general]
 148     ; General config options, with default values shown.
 149     ; You should use one section per device, with [general] being used
 150     ; for the device.
 151     ;
 152     ;
 153     ; debug = 0x0               ; misc debug flags, default is 0
 154
 155         ; Set the device to use for I/O
 156         ; devicenum = 0
 157         ; Set hardware type here
 158         ; hdwtype=0               ; 0=limey, 1=sph
 159
 160         ; rxboostset=0          ; no rx gain boost
 161         ; rxctcssrelax=1        ; reduce talkoff from radios w/o CTCSS Tx HPF
 162         ; rxctcssfreq=100.0      ; rx ctcss freq in floating point. must be in table
 163         ; txctcssfreq=100.0      ; tx ctcss freq, any frequency permitted
 164
 165         ; carrierfrom=dsp     ;no,usb,usbinvert,dsp,vox
 166         ; ctcssfrom=dsp       ;no,usb,dsp
 167
 168         ; rxdemod=flat            ; input type from radio: no,speaker,flat
 169         ; txprelim=yes            ; output is pre-emphasised and limited
 170         ; txtoctype=no            ; no,phase,notone
 171
 172         ; txmixa=composite        ;no,voice,tone,composite,auxvoice
 173         ; txmixb=no               ;no,voice,tone,composite,auxvoice
 174
 175         ; invertptt=0
 176
 177     ;------------------------------ JITTER BUFFER CONFIGURATION --------------------------
 178     ; jbenable = yes              ; Enables the use of a jitterbuffer on the receiving side of an
 179                                   ; USBRADIO channel. Defaults to "no". An enabled jitterbuffer will
 180                                   ; be used only if the sending side can create and the receiving
 181                                   ; side can not accept jitter. The USBRADIO channel can't accept jitter,
 182                                   ; thus an enabled jitterbuffer on the receive USBRADIO side will always
 183                                   ; be used if the sending side can create jitter.
 184
 185     ; jbmaxsize = 200             ; Max length of the jitterbuffer in milliseconds.
 186
 187     ; jbresyncthreshold = 1000    ; Jump in the frame timestamps over which the jitterbuffer is
 188                                   ; resynchronized. Useful to improve the quality of the voice, with
 189                                   ; big jumps in/broken timestamps, usualy sent from exotic devices
 190                                   ; and programs. Defaults to 1000.
 191
 192     ; jbimpl = fixed              ; Jitterbuffer implementation, used on the receiving side of an USBRADIO
 193                                   ; channel. Two implementations are currenlty available - "fixed"
 194                                   ; (with size always equals to jbmax-size) and "adaptive" (with
 195                                   ; variable size, actually the new jb of IAX2). Defaults to fixed.
 196
 197     ; jblog = no                  ; Enables jitterbuffer frame logging. Defaults to "no".
 198     ;-----------------------------------------------------------------------------------
 199
 200
 201 END_CONFIG
 202
 203  */
 204
 205 /*! \brief
 206  * Helper macros to parse config arguments. They will go in a common
 207  * header file if their usage is globally accepted. In the meantime,
 208  * we define them here. Typical usage is as below.
 209  * Remember to open a block right before M_START (as it declares
 210  * some variables) and use the M_* macros WITHOUT A SEMICOLON:
 211  *
 212  *      {
 213  *              M_START(v->name, v->value)
 214  *
 215  *              M_BOOL("dothis", x->flag1)
 216  *              M_STR("name", x->somestring)
 217  *              M_F("bar", some_c_code)
 218  *              M_END(some_final_statement)
 219  *              ... other code in the block
 220  *      }
 221  *
 222  * XXX NOTE these macros should NOT be replicated in other parts of asterisk.
 223  * Likely we will come up with a better way of doing config file parsing.
 224  */
 225 #define M_START(var, val) \
 226         const char *__s = var; const char *__val = val;
 227 #define M_END(x)   x;
 228 #define M_F(tag, f)                     if (!strcasecmp((__s), tag)) { f; } else
 229 #define M_BOOL(tag, dst)        M_F(tag, (dst) = ast_true(__val) )
 230 #define M_UINT(tag, dst)        M_F(tag, (dst) = strtoul(__val, NULL, 0) )
 231 #define M_STR(tag, dst)         M_F(tag, ast_copy_string(dst, __val, sizeof(dst)))
 232
 233 /*!
 234  * The following parameters are used in the driver:
 235  *
 236  *  FRAME_SIZE  the size of an audio frame, in samples.
 237  *              160 is used almost universally, so you should not change it.
 238  *
 239  *  FRAGS       the argument for the SETFRAGMENT ioctl.
 240  *              Overridden by the 'frags' parameter in usbradio.conf
 241  *
 242  *              Bits 0-7 are the base-2 log of the device's block size,
 243  *              bits 16-31 are the number of blocks in the driver's queue.
 244  *              There are a lot of differences in the way this parameter
 245  *              is supported by different drivers, so you may need to
 246  *              experiment a bit with the value.
 247  *              A good default for linux is 30 blocks of 64 bytes, which
 248  *              results in 6 frames of 320 bytes (160 samples).
 249  *              FreeBSD works decently with blocks of 256 or 512 bytes,
 250  *              leaving the number unspecified.
 251  *              Note that this only refers to the device buffer size,
 252  *              this module will then try to keep the lenght of audio
 253  *              buffered within small constraints.
 254  *
 255  *  QUEUE_SIZE  The max number of blocks actually allowed in the device
 256  *              driver's buffer, irrespective of the available number.
 257  *              Overridden by the 'queuesize' parameter in usbradio.conf
 258  *
 259  *              Should be >=2, and at most as large as the hw queue above
 260  *              (otherwise it will never be full).
 261  */
 262
 263 #define FRAME_SIZE      160
 264 #define QUEUE_SIZE      20
 265
 266 #if defined(__FreeBSD__)
 267 #define FRAGS   0x8
 268 #else
 269 #define FRAGS   ( ( (6 * 5) << 16 ) | 0xc )
 270 #endif
 271
 272 /*
 273  * XXX text message sizes are probably 256 chars, but i am
 274  * not sure if there is a suitable definition anywhere.
 275  */
 276 #define TEXT_SIZE       256
 277
 278 #if 0
 279 #define TRYOPEN 1                               /* try to open on startup */
 280 #endif
 281 #define O_CLOSE 0x444                   /* special 'close' mode for device */
 282 /* Which device to use */
 283 #if defined( __OpenBSD__ ) || defined( __NetBSD__ )
 284 #define DEV_DSP "/dev/audio"
 285 #else
 286 #define DEV_DSP "/dev/dsp"
 287 #endif
 288
 289 #ifndef MIN
 290 #define MIN(a,b) ((a) < (b) ? (a) : (b))
 291 #endif
 292 #ifndef MAX
 293 #define MAX(a,b) ((a) > (b) ? (a) : (b))
 294 #endif
 295
 296 static char *config = "usbradio.conf";  /* default config file */
 297 static char *config1 = "usbradio_tune.conf";    /* tune config file */
 298
 299 static FILE *frxcapraw = NULL, *frxcaptrace = NULL, *frxoutraw = NULL;
 300 static FILE *ftxcapraw = NULL, *ftxcaptrace = NULL, *ftxoutraw = NULL;
 301
 302 static int usbradio_debug;
 303 #if 0 /* maw asdf sph */
 304 static int usbradio_debug_level = 0;
 305 #endif
 306
 307 enum {RX_AUDIO_NONE,RX_AUDIO_SPEAKER,RX_AUDIO_FLAT};
 308 enum {CD_IGNORE,CD_XPMR_NOISE,CD_XPMR_VOX,CD_HID,CD_HID_INVERT};
 309 enum {SD_IGNORE,SD_HID,SD_HID_INVERT,SD_XPMR};                                   /* no,external,externalinvert,software */
 310 enum {RX_KEY_CARRIER,RX_KEY_CARRIER_CODE};
 311 enum {TX_OUT_OFF,TX_OUT_VOICE,TX_OUT_LSD,TX_OUT_COMPOSITE,TX_OUT_AUX};
 312 enum {TOC_NONE,TOC_PHASE,TOC_NOTONE};
 313
 314 /*      DECLARE STRUCTURES */
 315
 316 /*
 317  * Each sound is made of 'datalen' samples of sound, repeated as needed to
 318  * generate 'samplen' samples of data, then followed by 'silencelen' samples
 319  * of silence. The loop is repeated if 'repeat' is set.
 320  */
 321 struct sound {
 322         int ind;
 323         char *desc;
 324         short *data;
 325         int datalen;
 326         int samplen;
 327         int silencelen;
 328         int repeat;
 329 };
 330
 331 static struct sound sounds[] = {
 332         { AST_CONTROL_RINGING, "RINGING", ringtone, sizeof(ringtone)/2, 16000, 32000, 1 },
 333         { AST_CONTROL_BUSY, "BUSY", busy, sizeof(busy)/2, 4000, 4000, 1 },
 334         { AST_CONTROL_CONGESTION, "CONGESTION", busy, sizeof(busy)/2, 2000, 2000, 1 },
 335         { AST_CONTROL_RING, "RING10", ring10, sizeof(ring10)/2, 16000, 32000, 1 },
 336         { AST_CONTROL_ANSWER, "ANSWER", answer, sizeof(answer)/2, 2200, 0, 0 },
 337         { -1, NULL, 0, 0, 0, 0 },       /* end marker */
 338 };
 339
 340
 341 /*
 342  * descriptor for one of our channels.
 343  * There is one used for 'default' values (from the [general] entry in
 344  * the configuration file), and then one instance for each device
 345  * (the default is cloned from [general], others are only created
 346  * if the relevant section exists).
 347  */
 348 struct chan_usbradio_pvt {
 349         struct chan_usbradio_pvt *next;
 350
 351         char *name;
 352         /*
 353          * cursound indicates which in struct sound we play. -1 means nothing,
 354          * any other value is a valid sound, in which case sampsent indicates
 355          * the next sample to send in [0..samplen + silencelen]
 356          * nosound is set to disable the audio data from the channel
 357          * (so we can play the tones etc.).
 358          */
 359         int sndcmd[2];              /* Sound command pipe */
 360         int cursound;               /* index of sound to send */
 361         int sampsent;               /* # of sound samples sent  */
 362         int nosound;                /* set to block audio from the PBX */
 363
 364         int total_blocks;           /* total blocks in the output device */
 365         int sounddev;
 366         enum { M_UNSET, M_FULL, M_READ, M_WRITE } duplex;
 367         i16 cdMethod;
 368         int autoanswer;
 369         int autohangup;
 370         int hookstate;
 371         unsigned int queuesize;         /* max fragments in queue */
 372         unsigned int frags;                     /* parameter for SETFRAGMENT */
 373
 374         int warned;                 /* various flags used for warnings */
 375 #define WARN_used_blocks        1
 376 #define WARN_speed              2
 377 #define WARN_frag               4
 378         int w_errors;               /* overfull in the write path */
 379         struct timeval lastopen;
 380
 381         int overridecontext;
 382         int mute;
 383
 384         /* boost support. BOOST_SCALE * 10 ^(BOOST_MAX/20) must
 385          * be representable in 16 bits to avoid overflows.
 386          */
 387 #define BOOST_SCALE     (1<<9)
 388 #define BOOST_MAX       40          /* slightly less than 7 bits */
 389         int boost;                  /* input boost, scaled by BOOST_SCALE */
 390         char devicenum;
 391         int spkrmax;
 392         int micmax;
 393
 394         pthread_t sthread;
 395         pthread_t hidthread;
 396
 397         int     stophid;
 398         struct ast_channel *owner;
 399         char    ext[AST_MAX_EXTENSION];
 400         char    ctx[AST_MAX_CONTEXT];
 401         char    language[MAX_LANGUAGE];
 402         char    cid_name[256];          /* XXX */
 403         char    cid_num[256];           /* XXX */
 404         char    mohinterpret[MAX_MUSICCLASS];
 405
 406         /* buffers used in usbradio_write, 2 per int by 2 channels by 6 times oversampling (48KS/s) */
 407         char    usbradio_write_buf[FRAME_SIZE * 2 * 2 * 6];
 408         char    usbradio_write_buf_1[FRAME_SIZE * 2 * 2 * 6];
 409
 410         int     usbradio_write_dst;
 411         /* buffers used in usbradio_read - AST_FRIENDLY_OFFSET space for headers
 412          * plus enough room for a full frame
 413          */
 414         char    usbradio_read_buf[FRAME_SIZE * (2 * 12) + AST_FRIENDLY_OFFSET];
 415         char    usbradio_read_buf_8k[FRAME_SIZE * 2 + AST_FRIENDLY_OFFSET];
 416         int     readpos;         /* read position above */
 417         struct ast_frame read_f; /* returned by usbradio_read */
 418
 419
 420         char    debuglevel;
 421         char    radioduplex;
 422
 423         char    lastrx;
 424         char    rxhidsq;
 425         char    rxcarrierdetect; /*!< status from pmr channel */
 426         char    rxctcssdecode;   /*!< status from pmr channel */
 427
 428         char    rxkeytype;
 429         char    rxkeyed;         /*!< indicates rx signal present */
 430
 431         char    lasttx;
 432         char    txkeyed;         /*! tx key request from upper layers  */
 433         char    txchankey;
 434         char    txtestkey;
 435
 436         time_t  lasthidtime;
 437     struct ast_dsp *dsp;
 438
 439         t_pmr_chan *pmrChan;
 440
 441         char    rxcpusaver;
 442         char    txcpusaver;
 443
 444         char    rxdemod;
 445         float   rxgain;
 446         char    rxcdtype;
 447         char    rxsdtype;
 448         int     rxsquelchadj;    /*!< this copy needs to be here for initialization */
 449         char    txtoctype;
 450
 451         char    txprelim;
 452         float   txctcssgain;
 453         char    txmixa;
 454         char    txmixb;
 455
 456         char    invertptt;
 457
 458         char    rxctcssrelax;
 459         float   rxctcssgain;
 460         float   rxctcssfreq;
 461         float   txctcssfreq;
 462
 463         int     rxmixerset;
 464         int     rxboostset;
 465         float   rxvoiceadj;
 466         float   rxctcssadj;
 467         int     txmixaset;
 468         int     txmixbset;
 469         int     txctcssadj;
 470
 471         int     hdwtype;
 472         int     hid_gpio_ctl;
 473         int     hid_gpio_ctl_loc;
 474         int     hid_io_cor;
 475         int     hid_io_cor_loc;
 476         int     hid_io_ctcss;
 477         int     hid_io_ctcss_loc;
 478         int     hid_io_ptt;
 479         int     hid_gpio_loc;
 480
 481         struct {
 482                 unsigned rxcapraw:1;
 483                 unsigned txcapraw:1;
 484                 unsigned txcap2:1;
 485                 unsigned rxcap2:1;
 486         } b;
 487 };
 488
 489 /* maw add additional defaults !!! */
 490 static struct chan_usbradio_pvt usbradio_default = {
 491         .cursound = -1,
 492         .sounddev = -1,
 493         .duplex = M_UNSET,                      /* XXX check this */
 494         .autoanswer = 1,
 495         .autohangup = 1,
 496         .queuesize = QUEUE_SIZE,
 497         .frags = FRAGS,
 498         .ext = "s",
 499         .ctx = "default",
 500         .readpos = AST_FRIENDLY_OFFSET, /* start here on reads */
 501         .lastopen = { 0, 0 },
 502         .boost = BOOST_SCALE,
 503 };
 504
 505 /*      DECLARE FUNCTION PROTOTYPES     */
 506
 507 static void store_txtoctype(struct chan_usbradio_pvt *o, const char *s);
 508 static int  hidhdwconfig(struct chan_usbradio_pvt *o);
 509 static int  set_txctcss_level(struct chan_usbradio_pvt *o);
 510 static void pmrdump(struct chan_usbradio_pvt *o);
 511 static void mult_set(struct chan_usbradio_pvt *o);
 512 static int  mult_calc(int value);
 513 static void mixer_write(struct chan_usbradio_pvt *o);
 514 static void tune_rxinput(struct chan_usbradio_pvt *o);
 515 static void tune_rxvoice(struct chan_usbradio_pvt *o);
 516 static void tune_rxctcss(struct chan_usbradio_pvt *o);
 517 static void tune_txoutput(struct chan_usbradio_pvt *o, int value);
 518 static void tune_write(struct chan_usbradio_pvt *o);
 519
 520 static char *usbradio_active;    /* the active device */
 521
 522 static int  setformat(struct chan_usbradio_pvt *o, int mode);
 523
 524 static struct ast_channel *usbradio_request(const char *type, int format, void *data
 525 , int *cause);
 526 static int usbradio_digit_begin(struct ast_channel *c, char digit);
 527 static int usbradio_digit_end(struct ast_channel *c, char digit, unsigned int duration);
 528 static int usbradio_text(struct ast_channel *c, const char *text);
 529 static int usbradio_hangup(struct ast_channel *c);
 530 static int usbradio_answer(struct ast_channel *c);
 531 static struct ast_frame *usbradio_read(struct ast_channel *chan);
 532 static int usbradio_call(struct ast_channel *c, char *dest, int timeout);
 533 static int usbradio_write(struct ast_channel *chan, struct ast_frame *f);
 534 static int usbradio_indicate(struct ast_channel *chan, int cond, const void *data, size_t datalen);
 535 static int usbradio_fixup(struct ast_channel *oldchan, struct ast_channel *newchan);
 536
 537 #if     DEBUG_FILETEST == 1
 538 static int RxTestIt(struct chan_usbradio_pvt *o);
 539 #endif
 540
 541 static char tdesc[] = "USB (CM108) Radio Channel Driver";
 542
 543 static const struct ast_channel_tech usbradio_tech = {
 544         .type = "Radio",
 545         .description = tdesc,
 546         .capabilities = AST_FORMAT_SLINEAR,
 547         .requester = usbradio_request,
 548         .send_digit_begin = usbradio_digit_begin,
 549         .send_digit_end = usbradio_digit_end,
 550         .send_text = usbradio_text,
 551         .hangup = usbradio_hangup,
 552         .answer = usbradio_answer,
 553         .read = usbradio_read,
 554         .call = usbradio_call,
 555         .write = usbradio_write,
 556         .indicate = usbradio_indicate,
 557         .fixup = usbradio_fixup,
 558 };
 559
 560 /* Call with:  devnum: alsa major device number, param: ascii Formal
 561 Parameter Name, val1, first or only value, val2 second value, or 0
 562 if only 1 value. Values: 0-99 (percent) or 0-1 for baboon.
 563
 564 Note: must add -lasound to end of linkage */
 565
 566 static int amixer_max(int devnum,char *param)
 567 {
 568         int     rv,type;
 569         char str[15];
 570         snd_hctl_t *hctl;
 571         snd_ctl_elem_id_t *id;
 572         snd_hctl_elem_t *elem;
 573         snd_ctl_elem_info_t *info;
 574
 575         snprintf(str, sizeof(str), "hw:%d", devnum);
 576         if (snd_hctl_open(&hctl, str, 0))
 577                 return -1;
 578         snd_hctl_load(hctl);
 579         id = alloca(snd_ctl_elem_id_sizeof());
 580         memset(id, 0, snd_ctl_elem_id_sizeof());
 581         snd_ctl_elem_id_set_interface(id, SND_CTL_ELEM_IFACE_MIXER);
 582         snd_ctl_elem_id_set_name(id, param);
 583         elem = snd_hctl_find_elem(hctl, id);
 584         if (!elem) {
 585                 snd_hctl_close(hctl);
 586                 return -1;
 587         }
 588         info = alloca(snd_ctl_elem_info_sizeof());
 589         memset(info, 0, snd_ctl_elem_info_sizeof());
 590         snd_hctl_elem_info(elem,info);
 591         type = snd_ctl_elem_info_get_type(info);
 592         rv = 0;
 593         switch (type) {
 594         case SND_CTL_ELEM_TYPE_INTEGER:
 595                 rv = snd_ctl_elem_info_get_max(info);
 596                 break;
 597         case SND_CTL_ELEM_TYPE_BOOLEAN:
 598                 rv = 1;
 599                 break;
 600         }
 601         snd_hctl_close(hctl);
 602         return(rv);
 603 }
 604
 605 /*! \brief Call with:  devnum: alsa major device number, param: ascii Formal
 606 Parameter Name, val1, first or only value, val2 second value, or 0
 607 if only 1 value. Values: 0-99 (percent) or 0-1 for baboon.
 608
 609 Note: must add -lasound to end of linkage */
 610
 611 static int setamixer(int devnum, char *param, int v1, int v2)
 612 {
 613         int     type;
 614         char str[15];
 615         snd_hctl_t *hctl;
 616         snd_ctl_elem_id_t *id;
 617         snd_ctl_elem_value_t *control;
 618         snd_hctl_elem_t *elem;
 619         snd_ctl_elem_info_t *info;
 620
 621         snprintf(str, sizeof(str), "hw:%d", devnum);
 622         if (snd_hctl_open(&hctl, str, 0))
 623                 return -1;
 624         snd_hctl_load(hctl);
 625         id = alloca(snd_ctl_elem_id_sizeof());
 626         memset(id, 0, snd_ctl_elem_id_sizeof());
 627         snd_ctl_elem_id_set_interface(id, SND_CTL_ELEM_IFACE_MIXER);
 628         snd_ctl_elem_id_set_name(id, param);
 629         elem = snd_hctl_find_elem(hctl, id);
 630         if (!elem) {
 631                 snd_hctl_close(hctl);
 632                 return -1;
 633         }
 634         info = alloca(snd_ctl_elem_info_sizeof());
 635         memset(info, 0, snd_ctl_elem_info_sizeof());
 636         snd_hctl_elem_info(elem,info);
 637         type = snd_ctl_elem_info_get_type(info);
 638         control = alloca(snd_ctl_elem_value_sizeof());
 639         memset(control, 0, snd_ctl_elem_value_sizeof());
 640         snd_ctl_elem_value_set_id(control, id);
 641         switch (type) {
 642         case SND_CTL_ELEM_TYPE_INTEGER:
 643                 snd_ctl_elem_value_set_integer(control, 0, v1);
 644                 if (v2 > 0) snd_ctl_elem_value_set_integer(control, 1, v2);
 645                 break;
 646         case SND_CTL_ELEM_TYPE_BOOLEAN:
 647                 snd_ctl_elem_value_set_integer(control, 0, (v1 != 0));
 648                 break;
 649         }
 650         if (snd_hctl_elem_write(elem, control)) {
 651                 snd_hctl_close(hctl);
 652                 return(-1);
 653         }
 654         snd_hctl_close(hctl);
 655         return 0;
 656 }
 657
 658 static void hid_set_outputs(struct usb_dev_handle *handle,
 659          unsigned char *outputs)
 660 {
 661         usb_control_msg(handle,
 662                 USB_ENDPOINT_OUT + USB_TYPE_CLASS + USB_RECIP_INTERFACE,
 663                 HID_REPORT_SET,
 664                 0 + (HID_RT_OUTPUT << 8),
 665                 C108_HID_INTERFACE,
 666                 (char *)outputs, 4, 5000);
 667 }
 668
 669 static void hid_get_inputs(struct usb_dev_handle *handle,
 670          unsigned char *inputs)
 671 {
 672         usb_control_msg(handle,
 673                 USB_ENDPOINT_IN + USB_TYPE_CLASS + USB_RECIP_INTERFACE,
 674                 HID_REPORT_GET,
 675                 0 + (HID_RT_INPUT << 8),
 676                 C108_HID_INTERFACE,
 677                 (char *)inputs, 4, 5000);
 678 }
 679
 680 static struct usb_device *hid_device_init(void)
 681 {
 682         struct usb_bus *usb_bus;
 683         struct usb_device *dev;
 684
 685         usb_init();
 686         usb_find_busses();
 687         usb_find_devices();
 688         for (usb_bus = usb_busses; usb_bus; usb_bus = usb_bus->next) {
 689                 for (dev = usb_bus->devices; dev; dev = dev->next) {
 690                         if ((dev->descriptor.idVendor == C108_VENDOR_ID) && (dev->descriptor.idProduct == C108_PRODUCT_ID))
 691                                 return dev;
 692                 }
 693         }
 694         return NULL;
 695 }
 696
 697 static int hidhdwconfig(struct chan_usbradio_pvt *o)
 698 {
 699         if (o->hdwtype == 1) {         /*sphusb */
 700                 o->hid_gpio_ctl     =  0x08; /* set GPIO4 to output mode */
 701                 o->hid_gpio_ctl_loc =  2;    /* For CTL of GPIO */
 702                 o->hid_io_cor       =  4;    /* GPIO3 is COR */
 703                 o->hid_io_cor_loc   =  1;    /* GPIO3 is COR */
 704                 o->hid_io_ctcss     =  2;    /* GPIO 2 is External CTCSS */
 705                 o->hid_io_ctcss_loc =  1;    /* is GPIO 2 */
 706                 o->hid_io_ptt       =  8;    /* GPIO 4 is PTT */
 707                 o->hid_gpio_loc     =  1;    /* For ALL GPIO */
 708         } else if (o->hdwtype == 0) {  /* dudeusb */
 709                 o->hid_gpio_ctl     =  0x0c;/* set GPIO 3 & 4 to output mode */
 710                 o->hid_gpio_ctl_loc =  2;    /* For CTL of GPIO */
 711                 o->hid_io_cor       =  2;    /* VOLD DN is COR */
 712                 o->hid_io_cor_loc   =  0;    /* VOL DN COR */
 713                 o->hid_io_ctcss     =  2;    /* GPIO 2 is External CTCSS */
 714                 o->hid_io_ctcss_loc =  1;    /* is GPIO 2 */
 715                 o->hid_io_ptt       =  4;    /* GPIO 3 is PTT */
 716                 o->hid_gpio_loc     =  1;    /* For ALL GPIO */
 717         } else if (o->hdwtype == 3) {  /* custom version */
 718                 o->hid_gpio_ctl     =  0x0c; /* set GPIO 3 & 4 to output mode */
 719                 o->hid_gpio_ctl_loc =  2;    /* For CTL of GPIO */
 720                 o->hid_io_cor       =  2;    /* VOLD DN is COR */
 721                 o->hid_io_cor_loc   =  0;    /* VOL DN COR */
 722                 o->hid_io_ctcss     =  2;    /* GPIO 2 is External CTCSS */
 723                 o->hid_io_ctcss_loc =  1;    /* is GPIO 2 */
 724                 o->hid_io_ptt       =  4;    /* GPIO 3 is PTT */
 725                 o->hid_gpio_loc     =  1;    /* For ALL GPIO */
 726         }
 727
 728         return 0;
 729 }
 730
 731
 732 static void *hidthread(void *arg)
 733 {
 734         unsigned char buf[4], keyed;
 735         char lastrx, txtmp;
 736         struct usb_device *usb_dev;
 737         struct usb_dev_handle *usb_handle;
 738         struct chan_usbradio_pvt *o = arg;
 739
 740         usb_dev = hid_device_init();
 741         if (usb_dev == NULL) {
 742                 ast_log(LOG_ERROR, "USB HID device not found\n");
 743                 pthread_exit(NULL);
 744         }
 745         usb_handle = usb_open(usb_dev);
 746         if (usb_handle == NULL) {
 747                 ast_log(LOG_ERROR, "Not able to open USB device\n");
 748                 pthread_exit(NULL);
 749         }
 750         if (usb_claim_interface(usb_handle, C108_HID_INTERFACE) < 0) {
 751                 if (usb_detach_kernel_driver_np(usb_handle, C108_HID_INTERFACE) < 0) {
 752                         ast_log(LOG_ERROR, "Not able to detach the USB device\n");
 753                         pthread_exit(NULL);
 754                 }
 755                 if (usb_claim_interface(usb_handle, C108_HID_INTERFACE) < 0) {
 756                         ast_log(LOG_ERROR, "Not able to claim the USB device\n");
 757                         pthread_exit(NULL);
 758                 }
 759         }
 760         memset(buf, 0, sizeof(buf));
 761         buf[2] = o->hid_gpio_ctl;
 762         buf[1] = 0;
 763         hid_set_outputs(usb_handle, buf);
 764         traceusb1("hidthread: Starting normally!!\n");
 765         lastrx = 0;
 766         while (!o->stophid) {
 767                 buf[o->hid_gpio_ctl_loc] = o->hid_gpio_ctl;
 768                 hid_get_inputs(usb_handle, buf);
 769                 keyed = !(buf[o->hid_io_cor_loc] & o->hid_io_cor);
 770                 if (keyed != o->rxhidsq) {
 771                         if (o->debuglevel)
 772                                 ast_log(LOG_NOTICE, "chan_usbradio() hidthread: update rxhidsq = %d\n", keyed);
 773                         o->rxhidsq = keyed;
 774                 }
 775
 776                 /* if change in tx stuff */
 777                 txtmp = 0;
 778                 if (o->txkeyed || o->txchankey || o->txtestkey || o->pmrChan->txPttOut)
 779                         txtmp = 1;
 780
 781                 if (o->lasttx != txtmp) {
 782                         o->lasttx = txtmp;
 783                         if (o->debuglevel)
 784                                 ast_log(LOG_NOTICE, "hidthread: tx set to %d\n", txtmp);
 785                         buf[o->hid_gpio_loc] = 0;
 786                         if (txtmp)
 787                                 buf[o->hid_gpio_loc] = o->hid_io_ptt;
 788                         buf[o->hid_gpio_ctl_loc] = o->hid_gpio_ctl;
 789                         hid_set_outputs(usb_handle, buf);
 790                 }
 791
 792                 time(&o->lasthidtime);
 793                 usleep(50000);
 794         }
 795         buf[o->hid_gpio_loc] = 0;
 796         if (o->invertptt)
 797                 buf[o->hid_gpio_loc] = o->hid_io_ptt;
 798         buf[o->hid_gpio_ctl_loc] = o->hid_gpio_ctl;
 799         hid_set_outputs(usb_handle, buf);
 800         pthread_exit(0);
 801 }
 802
 803 /*! \brief
 804  * returns a pointer to the descriptor with the given name
 805  */
 806 static struct chan_usbradio_pvt *find_desc(char *dev)
 807 {
 808         struct chan_usbradio_pvt *o = NULL;
 809
 810         if (!dev)
 811                 ast_log(LOG_WARNING, "null dev\n");
 812
 813         for (o = usbradio_default.next; o && o->name && dev && strcmp(o->name, dev) != 0; o = o->next);
 814
 815         if (!o)
 816                 ast_log(LOG_WARNING, "could not find <%s>\n", dev ? dev : "--no-device--");
 817
 818         return o;
 819 }
 820
 821 /*! \brief
 822  * split a string in extension-context, returns pointers to malloc'ed
 823  * strings.
 824  * If we do not have 'overridecontext' then the last @ is considered as
 825  * a context separator, and the context is overridden.
 826  * This is usually not very necessary as you can play with the dialplan,
 827  * and it is nice not to need it because you have '@' in SIP addresses.
 828  * Return value is the buffer address.
 829  */
 830 #if     0
 831 static char *ast_ext_ctx(const char *src, char **ext, char **ctx)
 832 {
 833         struct chan_usbradio_pvt *o = find_desc(usbradio_active);
 834
 835         if (ext == NULL || ctx == NULL)
 836                 return NULL;                    /* error */
 837
 838         *ext = *ctx = NULL;
 839
 840         if (src && *src != '\0')
 841                 *ext = ast_strdup(src);
 842
 843         if (*ext == NULL)
 844                 return NULL;
 845
 846         if (!o->overridecontext) {
 847                 /* parse from the right */
 848                 *ctx = strrchr(*ext, '@');
 849                 if (*ctx)
 850                         *(*ctx)++ = '\0';
 851         }
 852
 853         return *ext;
 854 }
 855 #endif
 856
 857 /*! \brief
 858  * Returns the number of blocks used in the audio output channel
 859  */
 860 static int used_blocks(struct chan_usbradio_pvt *o)
 861 {
 862         struct audio_buf_info info;
 863
 864         if (ioctl(o->sounddev, SNDCTL_DSP_GETOSPACE, &info)) {
 865                 if (!(o->warned & WARN_used_blocks)) {
 866                         ast_log(LOG_WARNING, "Error reading output space\n");
 867                         o->warned |= WARN_used_blocks;
 868                 }
 869                 return 1;
 870         }
 871
 872         if (o->total_blocks == 0) {
 873                 ast_debug(4, "fragtotal %d size %d avail %d\n", info.fragstotal, info.fragsize, info.fragments);
 874                 o->total_blocks = info.fragments;
 875         }
 876
 877         return o->total_blocks - info.fragments;
 878 }
 879
 880 /*! \brief Write an exactly FRAME_SIZE sized frame */
 881 static int soundcard_writeframe(struct chan_usbradio_pvt *o, short *data)
 882 {
 883         int res;
 884
 885         if (o->sounddev < 0)
 886                 setformat(o, O_RDWR);
 887         if (o->sounddev < 0)
 888                 return 0;                               /* not fatal */
 889         /*
 890          * Nothing complex to manage the audio device queue.
 891          * If the buffer is full just drop the extra, otherwise write.
 892          * XXX in some cases it might be useful to write anyways after
 893          * a number of failures, to restart the output chain.
 894          */
 895         res = used_blocks(o);
 896         if (res > o->queuesize) {       /* no room to write a block */
 897                 if (o->w_errors++ == 0 && (usbradio_debug & 0x4))
 898                         ast_log(LOG_WARNING, "write: used %d blocks (%d)\n", res, o->w_errors);
 899                 return 0;
 900         }
 901         o->w_errors = 0;
 902
 903         return write(o->sounddev, ((void *) data), FRAME_SIZE * 2 * 12);
 904 }
 905
 906 /*! \brief
 907  * Handler for 'sound writable' events from the sound thread.
 908  * Builds a frame from the high level description of the sounds,
 909  * and passes it to the audio device.
 910  * The actual sound is made of 1 or more sequences of sound samples
 911  * (s->datalen, repeated to make s->samplen samples) followed by
 912  * s->silencelen samples of silence. The position in the sequence is stored
 913  * in o->sampsent, which goes between 0 .. s->samplen+s->silencelen.
 914  * In case we fail to write a frame, don't update o->sampsent.
 915  */
 916 static void send_sound(struct chan_usbradio_pvt *o)
 917 {
 918         short myframe[FRAME_SIZE];
 919         int ofs, l, start;
 920         int l_sampsent = o->sampsent;
 921         struct sound *s;
 922
 923         if (o->cursound < 0)            /* no sound to send */
 924                 return;
 925
 926         s = &sounds[o->cursound];
 927
 928         for (ofs = 0; ofs < FRAME_SIZE; ofs += l) {
 929                 l = s->samplen - l_sampsent;    /* # of available samples */
 930                 if (l > 0) {
 931                         start = l_sampsent % s->datalen;        /* source offset */
 932                         if (l > FRAME_SIZE - ofs)       /* don't overflow the frame */
 933                                 l = FRAME_SIZE - ofs;
 934                         if (l > s->datalen - start)     /* don't overflow the source */
 935                                 l = s->datalen - start;
 936                         memcpy(myframe + ofs, s->data + start, l * 2);
 937                         ast_debug(4, "send_sound sound %d/%d of %d into %d\n", l_sampsent, l, s->samplen, ofs);
 938                         l_sampsent += l;
 939                 } else {                                /* end of samples, maybe some silence */
 940                         static const short silence[FRAME_SIZE] = { 0, };
 941
 942                         l += s->silencelen;
 943                         if (l > 0) {
 944                                 if (l > FRAME_SIZE - ofs)
 945                                         l = FRAME_SIZE - ofs;
 946                                 memcpy(myframe + ofs, silence, l * 2);
 947                                 l_sampsent += l;
 948                         } else {                        /* silence is over, restart sound if loop */
 949                                 if (s->repeat == 0) {   /* last block */
 950                                         o->cursound = -1;
 951                                         o->nosound = 0; /* allow audio data */
 952                                         if (ofs < FRAME_SIZE)   /* pad with silence */
 953                                                 memcpy(myframe + ofs, silence, (FRAME_SIZE - ofs) * 2);
 954                                 }
 955                                 l_sampsent = 0;
 956                         }
 957                 }
 958         }
 959         l = soundcard_writeframe(o, myframe);
 960         if (l > 0)
 961                 o->sampsent = l_sampsent;       /* update status */
 962 }
 963
 964 static void *sound_thread(void *arg)
 965 {
 966         char ign[4096];
 967         struct chan_usbradio_pvt *o = arg;
 968
 969         /*
 970          * Just in case, kick the driver by trying to read from it.
 971          * Ignore errors - this read is almost guaranteed to fail.
 972          */
 973         read(o->sounddev, ign, sizeof(ign));
 974         for (;;) {
 975                 fd_set rfds, wfds;
 976                 int maxfd, res;
 977
 978                 FD_ZERO(&rfds);
 979                 FD_ZERO(&wfds);
 980                 FD_SET(o->sndcmd[0], &rfds);
 981                 maxfd = o->sndcmd[0];   /* pipe from the main process */
 982                 if (o->cursound > -1 && o->sounddev < 0)
 983                         setformat(o, O_RDWR);   /* need the channel, try to reopen */
 984                 else if (o->cursound == -1 && o->owner == NULL)
 985                         setformat(o, O_CLOSE);  /* can close */
 986                 if (o->sounddev > -1) {
 987                         if (!o->owner) {        /* no one owns the audio, so we must drain it */
 988                                 FD_SET(o->sounddev, &rfds);
 989                                 maxfd = MAX(o->sounddev, maxfd);
 990                         }
 991                         if (o->cursound > -1) {
 992                                 FD_SET(o->sounddev, &wfds);
 993                                 maxfd = MAX(o->sounddev, maxfd);
 994                         }
 995                 }
 996                 /* ast_select emulates linux behaviour in terms of timeout handling */
 997                 res = ast_select(maxfd + 1, &rfds, &wfds, NULL, NULL);
 998                 if (res < 1) {
 999                         ast_log(LOG_WARNING, "select failed: %s\n", strerror(errno));
1000                         sleep(1);
1001                         continue;
1002                 }
1003                 if (FD_ISSET(o->sndcmd[0], &rfds)) {
1004                         /* read which sound to play from the pipe */
1005                         int i, what = -1;
1006
1007                         read(o->sndcmd[0], &what, sizeof(what));
1008                         for (i = 0; sounds[i].ind != -1; i++) {
1009                                 if (sounds[i].ind == what) {
1010                                         o->cursound = i;
1011                                         o->sampsent = 0;
1012                                         o->nosound = 1; /* block audio from pbx */
1013                                         break;
1014                                 }
1015                         }
1016                         if (sounds[i].ind == -1)
1017                                 ast_log(LOG_WARNING, "invalid sound index: %d\n", what);
1018                 }
1019                 if (o->sounddev > -1) {
1020                         if (FD_ISSET(o->sounddev, &rfds))       /* read and ignore errors */
1021                                 read(o->sounddev, ign, sizeof(ign));
1022                         if (FD_ISSET(o->sounddev, &wfds))
1023                                 send_sound(o);
1024                 }
1025         }
1026         return NULL;                            /* Never reached */
1027 }
1028
1029 /*
1030  * reset and close the device if opened,
1031  * then open and initialize it in the desired mode,
1032  * trigger reads and writes so we can start using it.
1033  */
1034 static int setformat(struct chan_usbradio_pvt *o, int mode)
1035 {
1036         int fmt, desired, res, fd;
1037         char device[20];
1038
1039         if (o->sounddev >= 0) {
1040                 ioctl(o->sounddev, SNDCTL_DSP_RESET, 0);
1041                 close(o->sounddev);
1042                 o->duplex = M_UNSET;
1043                 o->sounddev = -1;
1044         }
1045         if (mode == O_CLOSE)            /* we are done */
1046                 return 0;
1047         if (ast_tvdiff_ms(ast_tvnow(), o->lastopen) < 1000)
1048                 return -1;                              /* don't open too often */
1049         o->lastopen = ast_tvnow();
1050         strcpy(device, "/dev/dsp");
1051         if (o->devicenum)
1052                 snprintf(device + strlen("/dev/dsp"), sizeof(device) - strlen("/dev/dsp"), "%d", o->devicenum);
1053         fd = o->sounddev = open(device, mode | O_NONBLOCK);
1054         if (fd < 0) {
1055                 ast_log(LOG_WARNING, "Unable to re-open DSP device %d: %s\n", o->devicenum, strerror(errno));
1056                 return -1;
1057         }
1058         if (o->owner)
1059                 o->owner->fds[0] = fd;
1060
1061 #if __BYTE_ORDER == __LITTLE_ENDIAN
1062         fmt = AFMT_S16_LE;
1063 #else
1064         fmt = AFMT_S16_BE;
1065 #endif
1066         res = ioctl(fd, SNDCTL_DSP_SETFMT, &fmt);
1067         if (res < 0) {
1068                 ast_log(LOG_WARNING, "Unable to set format to 16-bit signed\n");
1069                 return -1;
1070         }
1071         switch (mode) {
1072                 case O_RDWR:
1073                         res = ioctl(fd, SNDCTL_DSP_SETDUPLEX, 0);
1074                         /* Check to see if duplex set (FreeBSD Bug) */
1075                         res = ioctl(fd, SNDCTL_DSP_GETCAPS, &fmt);
1076                         if (res == 0 && (fmt & DSP_CAP_DUPLEX)) {
1077                                 if (option_verbose > 1)
1078                                         ast_verbose(VERBOSE_PREFIX_2 "Console is full duplex\n");
1079                                 o->duplex = M_FULL;
1080                         };
1081                         break;
1082                 case O_WRONLY:
1083                         o->duplex = M_WRITE;
1084                         break;
1085                 case O_RDONLY:
1086                         o->duplex = M_READ;
1087                         break;
1088         }
1089
1090         fmt = 1;
1091         res = ioctl(fd, SNDCTL_DSP_STEREO, &fmt);
1092         if (res < 0) {
1093                 ast_log(LOG_WARNING, "Failed to set audio device to mono\n");
1094                 return -1;
1095         }
1096         fmt = desired = 48000;                                                  /* 8000 Hz desired */
1097         res = ioctl(fd, SNDCTL_DSP_SPEED, &fmt);
1098
1099         if (res < 0) {
1100                 ast_log(LOG_WARNING, "Failed to set audio device to mono\n");
1101                 return -1;
1102         }
1103         if (fmt != desired) {
1104                 if (!(o->warned & WARN_speed)) {
1105                         ast_log(LOG_WARNING,
1106                             "Requested %d Hz, got %d Hz -- sound may be choppy\n",
1107                             desired, fmt);
1108                         o->warned |= WARN_speed;
1109                 }
1110         }
1111         /*
1112          * on Freebsd, SETFRAGMENT does not work very well on some cards.
1113          * Default to use 256 bytes, let the user override
1114          */
1115         if (o->frags) {
1116                 fmt = o->frags;
1117                 res = ioctl(fd, SNDCTL_DSP_SETFRAGMENT, &fmt);
1118                 if (res < 0) {
1119                         if (!(o->warned & WARN_frag)) {
1120                                 ast_log(LOG_WARNING,
1121                                         "Unable to set fragment size -- sound may be choppy\n");
1122                                 o->warned |= WARN_frag;
1123                         }
1124                 }
1125         }
1126         /* on some cards, we need SNDCTL_DSP_SETTRIGGER to start outputting */
1127         res = PCM_ENABLE_INPUT | PCM_ENABLE_OUTPUT;
1128         res = ioctl(fd, SNDCTL_DSP_SETTRIGGER, &res);
1129         /* it may fail if we are in half duplex, never mind */
1130         return 0;
1131 }
1132
1133 /*
1134  * some of the standard methods supported by channels.
1135  */
1136 static int usbradio_digit_begin(struct ast_channel *c, char digit)
1137 {
1138         return 0;
1139 }
1140
1141 static int usbradio_digit_end(struct ast_channel *c, char digit, unsigned int duration)
1142 {
1143         /* no better use for received digits than print them */
1144         ast_verbose(" << Console Received digit %c of duration %u ms >> \n",
1145                 digit, duration);
1146         return 0;
1147 }
1148
1149 static int usbradio_text(struct ast_channel *c, const char *text)
1150 {
1151         /* print received messages */
1152         ast_verbose(" << Console Received text %s >> \n", text);
1153         return 0;
1154 }
1155
1156 /* Play ringtone 'x' on device 'o' */
1157 static void ring(struct chan_usbradio_pvt *o, int x)
1158 {
1159         write(o->sndcmd[1], &x, sizeof(x));
1160 }
1161
1162 /*
1163  * handler for incoming calls. Either autoanswer, or start ringing
1164  */
1165 static int usbradio_call(struct ast_channel *c, char *dest, int timeout)
1166 {
1167         struct chan_usbradio_pvt *o = c->tech_pvt;
1168
1169         time(&o->lasthidtime);
1170         ast_pthread_create_background(&o->hidthread, NULL, hidthread, o);
1171         ast_setstate(c, AST_STATE_UP);
1172         return 0;
1173 }
1174
1175 /*
1176  * remote side answered the phone
1177  */
1178 static int usbradio_answer(struct ast_channel *c)
1179 {
1180         struct chan_usbradio_pvt *o = c->tech_pvt;
1181
1182         ast_setstate(c, AST_STATE_UP);
1183         o->cursound = -1;
1184         o->nosound = 0;
1185         return 0;
1186 }
1187
1188 static int usbradio_hangup(struct ast_channel *c)
1189 {
1190         struct chan_usbradio_pvt *o = c->tech_pvt;
1191
1192         o->cursound = -1;
1193         o->nosound = 0;
1194         c->tech_pvt = NULL;
1195         o->owner = NULL;
1196         ast_module_unref(ast_module_info->self);
1197         if (o->hookstate) {
1198                 if (o->autoanswer || o->autohangup) {
1199                         /* Assume auto-hangup too */
1200                         o->hookstate = 0;
1201                         setformat(o, O_CLOSE);
1202                 } else {
1203                         /* Make congestion noise */
1204                         ring(o, AST_CONTROL_CONGESTION);
1205                 }
1206         }
1207         o->stophid = 1;
1208         pthread_join(o->hidthread, NULL);
1209         return 0;
1210 }
1211
1212
1213 /* used for data coming from the network */
1214 static int usbradio_write(struct ast_channel *c, struct ast_frame *f)
1215 {
1216         int src,datalen;
1217         struct chan_usbradio_pvt *o = c->tech_pvt;
1218
1219         traceusb2("usbradio_write() o->nosound=%d\n", o->nosound);      /*sph maw asdf */
1220
1221         /* Immediately return if no sound is enabled */
1222         if (o->nosound)
1223                 return 0;
1224         /* Stop any currently playing sound */
1225         o->cursound = -1;
1226         /*
1227          * we could receive a block which is not a multiple of our
1228          * FRAME_SIZE, so buffer it locally and write to the device
1229          * in FRAME_SIZE chunks.
1230          * Keep the residue stored for future use.
1231          */
1232
1233         if (o->txkeyed || o->txtestkey)
1234                 o->pmrChan->txPttIn = 1;
1235         else
1236                 o->pmrChan->txPttIn = 0;
1237
1238         #if DEBUG_CAPTURES == 1 /* to write input data to a file   datalen=320 */
1239         if (ftxcapraw && o->b.txcapraw) {
1240                 i16 i, tbuff[f->datalen];
1241                 for (i = 0; i < f->datalen; i += 2) {
1242                         tbuff[i] = ((i16 *)(f->data))[i / 2];
1243                         tbuff[i + 1] = o->txkeyed * M_Q13;
1244                 }
1245                 fwrite(tbuff, 2, f->datalen, ftxcapraw);
1246                 /*fwrite(f->data,1,f->datalen,ftxcapraw); */
1247         }
1248         #endif
1249
1250         PmrTx(o->pmrChan,(i16*)f->data,(i16*)o->usbradio_write_buf_1);
1251
1252         #if 0   /* to write 48KS/s stereo data to a file */
1253         if (!ftxoutraw) ftxoutraw = fopen(TX_CAP_OUT_FILE,"w");
1254         if (ftxoutraw) fwrite(o->usbradio_write_buf_1,1,f->datalen * 2 * 6,ftxoutraw);
1255         #endif
1256
1257         #if DEBUG_CAPTURES == 1
1258     if (o->b.txcap2 && ftxcaptrace)
1259                 fwrite((o->pmrChan->ptxDebug), 1, FRAME_SIZE * 2 * 16, ftxcaptrace);
1260         #endif
1261
1262         src = 0;                                        /* read position into f->data */
1263         datalen = f->datalen * 12;
1264         while (src < datalen) {
1265                 /* Compute spare room in the buffer */
1266                 int l = sizeof(o->usbradio_write_buf) - o->usbradio_write_dst;
1267
1268                 if (datalen - src >= l) {       /* enough to fill a frame */
1269                         memcpy(o->usbradio_write_buf + o->usbradio_write_dst, o->usbradio_write_buf_1 + src, l);
1270                         soundcard_writeframe(o, (short *) o->usbradio_write_buf);
1271                         src += l;
1272                         o->usbradio_write_dst = 0;
1273                 } else {                                /* copy residue */
1274                         l = datalen - src;
1275                         memcpy(o->usbradio_write_buf + o->usbradio_write_dst, o->usbradio_write_buf_1 + src, l);
1276                         src += l;                       /* but really, we are done */
1277                         o->usbradio_write_dst += l;
1278                 }
1279         }
1280         return 0;
1281 }
1282
1283 static struct ast_frame *usbradio_read(struct ast_channel *c)
1284 {
1285         int res;
1286         struct chan_usbradio_pvt *o = c->tech_pvt;
1287         struct ast_frame *f = &o->read_f, *f1;
1288         struct ast_frame wf = { AST_FRAME_CONTROL };
1289         time_t now;
1290
1291         traceusb2("usbradio_read()\n"); /* sph maw asdf */
1292
1293         if (o->lasthidtime) {
1294                 time(&now);
1295                 if ((now - o->lasthidtime) > 3) {
1296                         ast_log(LOG_ERROR, "HID process has died or something!!\n");
1297                         return NULL;
1298                 }
1299         }
1300         if (o->lastrx && (!o->rxkeyed)) {
1301                 o->lastrx = 0;
1302                 wf.subclass = AST_CONTROL_RADIO_UNKEY;
1303                 ast_queue_frame(o->owner, &wf);
1304         } else if ((!o->lastrx) && (o->rxkeyed)) {
1305                 o->lastrx = 1;
1306                 wf.subclass = AST_CONTROL_RADIO_KEY;
1307                 ast_queue_frame(o->owner, &wf);
1308         }
1309         /* XXX can be simplified returning &ast_null_frame */
1310         /* prepare a NULL frame in case we don't have enough data to return */
1311         memset(f, 0, sizeof(struct ast_frame));
1312         f->frametype = AST_FRAME_NULL;
1313         f->src = usbradio_tech.type;
1314
1315         res = read(o->sounddev, o->usbradio_read_buf + o->readpos,
1316                 sizeof(o->usbradio_read_buf) - o->readpos);
1317         if (res < 0)                            /* audio data not ready, return a NULL frame */
1318                 return f;
1319
1320         o->readpos += res;
1321         if (o->readpos < sizeof(o->usbradio_read_buf))  /* not enough samples */
1322                 return f;
1323
1324         if (o->mute)
1325                 return f;
1326
1327         #if DEBUG_CAPTURES == 1
1328         if (o->b.rxcapraw && frxcapraw)
1329                 fwrite((o->usbradio_read_buf + AST_FRIENDLY_OFFSET), 1, FRAME_SIZE * 2 * 2 * 6, frxcapraw);
1330         #endif
1331
1332         #if 1
1333         PmrRx(         o->pmrChan,
1334                    (i16 *)(o->usbradio_read_buf + AST_FRIENDLY_OFFSET),
1335                    (i16 *)(o->usbradio_read_buf_8k + AST_FRIENDLY_OFFSET));
1336
1337         #else
1338         static FILE *hInput;
1339         i16 iBuff[FRAME_SIZE * 2 * 6];
1340
1341         o->pmrChan->b.rxCapture = 1;
1342
1343         if(!hInput) {
1344                 hInput = fopen("/usr/src/xpmr/testdata/rx_in.pcm", "r");
1345                 if(!hInput) {
1346                         ast_log(LOG_ERROR, " Input Data File Not Found.\n");
1347                         return 0;
1348                 }
1349         }
1350
1351         if (0 == fread((void *)iBuff, 2, FRAME_SIZE * 2 * 6, hInput))
1352                 exit;
1353
1354         PmrRx(         o->pmrChan,
1355                    (i16 *)iBuff,
1356                    (i16 *)(o->usbradio_read_buf_8k + AST_FRIENDLY_OFFSET));
1357
1358         #endif
1359
1360         #if 0
1361         if (!frxoutraw) frxoutraw = fopen(RX_CAP_OUT_FILE, "w");
1362     if (frxoutraw) fwrite((o->usbradio_read_buf_8k + AST_FRIENDLY_OFFSET), 1, FRAME_SIZE * 2, frxoutraw);
1363         #endif
1364
1365         #if DEBUG_CAPTURES == 1
1366     if (frxcaptrace && o->b.rxcap2) fwrite((o->pmrChan->prxDebug), 1, FRAME_SIZE * 2 * 16, frxcaptrace);
1367         #endif
1368
1369         if (o->rxcdtype == CD_HID && (o->pmrChan->rxExtCarrierDetect != o->rxhidsq))
1370                 o->pmrChan->rxExtCarrierDetect = o->rxhidsq;
1371         if (o->rxcdtype == CD_HID_INVERT && (o->pmrChan->rxExtCarrierDetect == o->rxhidsq))
1372                 o->pmrChan->rxExtCarrierDetect = !o->rxhidsq;
1373
1374         if ( (o->rxcdtype == CD_HID && o->rxhidsq) ||
1375                  (o->rxcdtype == CD_HID_INVERT && !o->rxhidsq) ||
1376                  (o->rxcdtype == CD_XPMR_NOISE && o->pmrChan->rxCarrierDetect) ||
1377                  (o->rxcdtype == CD_XPMR_VOX && o->pmrChan->rxCarrierDetect) )
1378                 res = 1;
1379         else
1380                 res = 0;
1381
1382         if (res != o->rxcarrierdetect) {
1383                 o->rxcarrierdetect = res;
1384                 if (o->debuglevel)
1385                         ast_debug(4, "rxcarrierdetect = %d\n", res);
1386         }
1387
1388         if (o->pmrChan->rxCtcss->decode != o->rxctcssdecode) {
1389                 if (o->debuglevel)
1390                         ast_debug(4, "rxctcssdecode = %d\n", o->pmrChan->rxCtcss->decode);
1391                 o->rxctcssdecode = o->pmrChan->rxCtcss->decode;
1392         }
1393
1394         if ( (  o->rxctcssfreq && (o->rxctcssdecode == o->pmrChan->rxCtcssIndex)) ||
1395                  ( !o->rxctcssfreq && o->rxcarrierdetect) )
1396                 o->rxkeyed = 1;
1397         else
1398                 o->rxkeyed = 0;
1399
1400
1401         o->readpos = AST_FRIENDLY_OFFSET;       /* reset read pointer for next frame */
1402         if (c->_state != AST_STATE_UP)  /* drop data if frame is not up */
1403                 return f;
1404         /* ok we can build and deliver the frame to the caller */
1405         f->frametype = AST_FRAME_VOICE;
1406         f->subclass = AST_FORMAT_SLINEAR;
1407         f->samples = FRAME_SIZE;
1408         f->datalen = FRAME_SIZE * 2;
1409         f->data = o->usbradio_read_buf_8k + AST_FRIENDLY_OFFSET;
1410         if (o->boost != BOOST_SCALE) {  /* scale and clip values */
1411                 int i, x;
1412                 int16_t *p = (int16_t *) f->data;
1413                 for (i = 0; i < f->samples; i++) {
1414                         x = (p[i] * o->boost) / BOOST_SCALE;
1415                         if (x > 32767)
1416                                 x = 32767;
1417                         else if (x < -32768)
1418                                 x = -32768;
1419                         p[i] = x;
1420                 }
1421         }
1422
1423         f->offset = AST_FRIENDLY_OFFSET;
1424         if (o->dsp) {
1425                 f1 = ast_dsp_process(c, o->dsp, f);
1426                 if ((f1->frametype == AST_FRAME_DTMF_END) || (f1->frametype == AST_FRAME_DTMF_BEGIN)) {
1427                         if ((f1->subclass == 'm') || (f1->subclass == 'u'))
1428                             f1->frametype = AST_FRAME_DTMF_BEGIN;
1429                         if (f1->frametype == AST_FRAME_DTMF_END)
1430                             ast_log(LOG_NOTICE,"Got DTMF char %c\n",f1->subclass);
1431                         return f1;
1432                 }
1433         }
1434         return f;
1435 }
1436
1437 static int usbradio_fixup(struct ast_channel *oldchan, struct ast_channel *newchan)
1438 {
1439         struct chan_usbradio_pvt *o = newchan->tech_pvt;
1440         ast_log(LOG_WARNING,"usbradio_fixup()\n");
1441         o->owner = newchan;
1442         return 0;
1443 }
1444
1445 static int usbradio_indicate(struct ast_channel *c, int cond, const void *data, size_t datalen)
1446 {
1447         struct chan_usbradio_pvt *o = c->tech_pvt;
1448         int res = -1;
1449
1450         switch (cond) {
1451                 case AST_CONTROL_BUSY:
1452                 case AST_CONTROL_CONGESTION:
1453                 case AST_CONTROL_RINGING:
1454                         res = cond;
1455                         break;
1456
1457                 case -1:
1458                         o->cursound = -1;
1459                         o->nosound = 0;         /* when cursound is -1 nosound must be 0 */
1460                         return 0;
1461
1462                 case AST_CONTROL_VIDUPDATE:
1463                         res = -1;
1464                         break;
1465                 case AST_CONTROL_HOLD:
1466                         ast_verbose(" << Console Has Been Placed on Hold >> \n");
1467                         ast_moh_start(c, data, o->mohinterpret);
1468                         break;
1469                 case AST_CONTROL_UNHOLD:
1470                         ast_verbose(" << Console Has Been Retrieved from Hold >> \n");
1471                         ast_moh_stop(c);
1472                         break;
1473                 case AST_CONTROL_PROCEEDING:
1474                         ast_verbose(" << Call Proceeding... >> \n");
1475                         ast_moh_stop(c);
1476                         break;
1477                 case AST_CONTROL_PROGRESS:
1478                         ast_verbose(" << Call Progress... >> \n");
1479                         ast_moh_stop(c);
1480                         break;
1481                 case AST_CONTROL_RADIO_KEY:
1482                         o->txkeyed = 1;
1483                         if(o->debuglevel)ast_verbose(" << Radio Transmit On. >> \n");
1484                         break;
1485                 case AST_CONTROL_RADIO_UNKEY:
1486                         o->txkeyed = 0;
1487                         if(o->debuglevel)ast_verbose(" << Radio Transmit Off. >> \n");
1488                         break;
1489                 default:
1490                         ast_log(LOG_WARNING, "Don't know how to display condition %d on %s\n", cond, c->name);
1491                         return -1;
1492         }
1493
1494         if (res > -1)
1495                 ring(o, res);
1496
1497         return 0;
1498 }
1499
1500 /*
1501  * allocate a new channel.
1502  */
1503 static struct ast_channel *usbradio_new(struct chan_usbradio_pvt *o, char *ext, char *ctx, int state)
1504 {
1505         struct ast_channel *c;
1506         char device[15] = "dsp";
1507
1508         if (o->devicenum)
1509                 snprintf(device + 3, sizeof(device) - 3, "%d", o->devicenum);
1510         c = ast_channel_alloc(1, state, o->cid_num, o->cid_name, "", ext, ctx, 0, "usbRadio/%s", device);
1511         if (c == NULL)
1512                 return NULL;
1513         c->tech = &usbradio_tech;
1514         if (o->sounddev < 0)
1515                 setformat(o, O_RDWR);
1516         c->fds[0] = o->sounddev;        /* -1 if device closed, override later */
1517         c->nativeformats = AST_FORMAT_SLINEAR;
1518         c->readformat = AST_FORMAT_SLINEAR;
1519         c->writeformat = AST_FORMAT_SLINEAR;
1520         c->tech_pvt = o;
1521
1522         if (!ast_strlen_zero(o->language))
1523                 ast_string_field_set(c, language, o->language);
1524         /* Don't use ast_set_callerid() here because it will
1525          * generate a needless NewCallerID event */
1526         c->cid.cid_num = ast_strdup(o->cid_num);
1527         c->cid.cid_ani = ast_strdup(o->cid_num);
1528         c->cid.cid_name = ast_strdup(o->cid_name);
1529         if (!ast_strlen_zero(ext))
1530                 c->cid.cid_dnid = ast_strdup(ext);
1531
1532         o->owner = c;
1533         ast_module_ref(ast_module_info->self);
1534         ast_jb_configure(c, &global_jbconf);
1535         if (state != AST_STATE_DOWN) {
1536                 if (ast_pbx_start(c)) {
1537                         ast_log(LOG_WARNING, "Unable to start PBX on %s\n", c->name);
1538                         ast_hangup(c);
1539                         o->owner = c = NULL;
1540                         /* XXX what about the channel itself ? */
1541                         /* XXX what about usecnt ? */
1542                 }
1543         }
1544
1545         return c;
1546 }
1547
1548 static struct ast_channel *usbradio_request(const char *type, int format, void *data, int *cause)
1549 {
1550         struct ast_channel *c;
1551         struct chan_usbradio_pvt *o = find_desc(data);
1552
1553         ast_debug(4, "usbradio_request ty <%s> data 0x%p <%s>\n", type, data, (char *) data);
1554         if (o == NULL) {
1555                 ast_log(LOG_NOTICE, "Device %s not found\n", (char *) data);
1556                 /* XXX we could default to 'dsp' perhaps ? */
1557                 return NULL;
1558         }
1559         if ((format & AST_FORMAT_SLINEAR) == 0) {
1560                 ast_log(LOG_NOTICE, "Format 0x%x unsupported\n", format);
1561                 return NULL;
1562         }
1563         if (o->owner) {
1564                 ast_log(LOG_NOTICE, "Already have a call (chan %p) on the usb channel\n", o->owner);
1565                 *cause = AST_CAUSE_BUSY;
1566                 return NULL;
1567         }
1568         c = usbradio_new(o, NULL, NULL, AST_STATE_DOWN);
1569         if (c == NULL) {
1570                 ast_log(LOG_WARNING, "Unable to create new usb channel\n");
1571                 return NULL;
1572         }
1573         return c;
1574 }
1575
1576 static char *handle_cli_radio_key(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
1577 {
1578         struct chan_usbradio_pvt *o = NULL;
1579
1580         switch (cmd) {
1581         case CLI_INIT:
1582                 e->command = "radio key";
1583                 e->usage =
1584                         "Usage: radio key\n"
1585                         "       Simulates COR active.\n";
1586                 return NULL;
1587         case CLI_GENERATE:
1588                 return NULL;
1589         }
1590
1591         if (a->argc != 2)
1592                 return CLI_SHOWUSAGE;
1593
1594         o = find_desc(usbradio_active);
1595         o->txtestkey = 1;
1596
1597         return CLI_SUCCESS;
1598 }
1599
1600 static char *handle_cli_radio_unkey(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
1601 {
1602         struct chan_usbradio_pvt *o = NULL;
1603
1604         switch (cmd) {
1605         case CLI_INIT:
1606                 e->command = "radio unkey";
1607                 e->usage =
1608                         "Usage: radio unkey\n"
1609                         "       Simulates COR un-active.\n";
1610                 return NULL;
1611         case CLI_GENERATE:
1612                 return NULL;
1613         }
1614
1615         if (a->argc != 2)
1616                 return CLI_SHOWUSAGE;
1617
1618         o = find_desc(usbradio_active);
1619         o->txtestkey = 0;
1620
1621         return CLI_SUCCESS;
1622 }
1623
1624 static char *handle_cli_radio_tune(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
1625 {
1626         struct chan_usbradio_pvt *o = NULL;
1627         int i = 0;
1628
1629         switch (cmd) {
1630         case CLI_INIT:
1631                 e->command = "radio tune [rxnoise|rxvoice|rxtone|rxsquelch|rxcap|rxtracecap|"
1632                         "txvoice|txtone|txcap|txtracecap|auxvoice|nocap|dump|save]";
1633                 /* radio tune 6 3000        measured tx value */
1634                 e->usage =
1635                         "Usage: radio tune <function>\n"
1636                         "       rxnoise\n"
1637                         "       rxvoice\n"
1638                         "       rxtone\n"
1639                         "       rxsquelch [newsetting]\n"
1640                         "       rxcap\n"
1641                         "       rxtracecap\n"
1642                         "       txvoice [newsetting]\n"
1643                         "       txtone [newsetting]\n"
1644                         "       txcap\n"
1645                         "       txtracecap\n"
1646                         "       auxvoice [newsetting]\n"
1647                         "       nocap\n"
1648                         "       dump\n"
1649                         "       save (settings to tuning file)\n"
1650                         "\n"
1651                         "       All [newsetting]s are values 0-999\n";
1652                 return NULL;
1653         case CLI_GENERATE:
1654                 return NULL;
1655         }
1656
1657         if ((a->argc < 2) || (a->argc > 4))
1658                 return CLI_SHOWUSAGE;
1659
1660         if (a->argc == 2) { /* just show stuff */
1661                 ast_cli(a->fd, "Output A is currently set to %s.\n",
1662                         o->txmixa == TX_OUT_COMPOSITE ? "composite" :
1663                         o->txmixa == TX_OUT_VOICE ? "voice" :
1664                         o->txmixa == TX_OUT_LSD ? "tone" :
1665                         o->txmixa == TX_OUT_AUX ? "auxvoice" :
1666                         "off");
1667
1668                 ast_cli(a->fd, "Output B is currently set to %s.\n",
1669                         o->txmixb == TX_OUT_COMPOSITE ? "composite" :
1670                         o->txmixb == TX_OUT_VOICE ? "voice" :
1671                         o->txmixb == TX_OUT_LSD ? "tone" :
1672                         o->txmixb == TX_OUT_AUX ? "auxvoice" :
1673                         "off");
1674
1675                 ast_cli(a->fd, "Tx Voice Level currently set to %d\n", o->txmixaset);
1676                 ast_cli(a->fd, "Tx Tone Level currently set to %d\n", o->txctcssadj);
1677                 ast_cli(a->fd, "Rx Squelch currently set to %d\n", o->rxsquelchadj);
1678                 return CLI_SHOWUSAGE;
1679         }
1680
1681         o = find_desc(usbradio_active);
1682
1683         if (!strcasecmp(a->argv[2], "rxnoise"))
1684                 tune_rxinput(o);
1685         else if (!strcasecmp(a->argv[2], "rxvoice"))
1686                 tune_rxvoice(o);
1687         else if (!strcasecmp(a->argv[2], "rxtone"))
1688                 tune_rxctcss(o);
1689         else if (!strcasecmp(a->argv[2], "rxsquelch")) {
1690                 if (a->argc == 3) {
1691                     ast_cli(a->fd, "Current Signal Strength is %d\n", ((32767 - o->pmrChan->rxRssi) * 1000 / 32767));
1692                     ast_cli(a->fd, "Current Squelch setting is %d\n", o->rxsquelchadj);
1693 #if 0
1694                         ast_cli(a->fd,"Current Raw RSSI        is %d\n",o->pmrChan->rxRssi);
1695                     ast_cli(a->fd,"Current (real) Squelch setting is %d\n",*(o->pmrChan->prxSquelchAdjust));
1696 #endif
1697                 } else {
1698                         i = atoi(a->argv[3]);
1699                         if ((i < 0) || (i > 999))
1700                                 return CLI_SHOWUSAGE;
1701                         ast_cli(a->fd, "Changed Squelch setting to %d\n", i);
1702                         o->rxsquelchadj = i;
1703                         *(o->pmrChan->prxSquelchAdjust) = ((999 - i) * 32767) / 1000;
1704                 }
1705         } else if (!strcasecmp(a->argv[2], "txvoice")) {
1706                 i = 0;
1707
1708                 if ((o->txmixa != TX_OUT_VOICE) && (o->txmixb != TX_OUT_VOICE) &&
1709                         (o->txmixa != TX_OUT_COMPOSITE) && (o->txmixb != TX_OUT_COMPOSITE)) {
1710                         ast_log(LOG_ERROR, "No txvoice output configured.\n");
1711                 } else if (a->argc == 3) {
1712                         if ((o->txmixa == TX_OUT_VOICE) || (o->txmixa == TX_OUT_COMPOSITE))
1713                                 ast_cli(a->fd, "Current txvoice setting on Channel A is %d\n", o->txmixaset);
1714                         else
1715                                 ast_cli(a->fd, "Current txvoice setting on Channel B is %d\n", o->txmixbset);
1716                 } else {
1717                         i = atoi(a->argv[3]);
1718                         if ((i < 0) || (i > 999))
1719                                 return CLI_SHOWUSAGE;
1720
1721                         if ((o->txmixa == TX_OUT_VOICE) || (o->txmixa == TX_OUT_COMPOSITE)) {
1722                                 o->txmixaset = i;
1723                                 ast_cli(a->fd, "Changed txvoice setting on Channel A to %d\n", o->txmixaset);
1724                         } else {
1725                                 o->txmixbset = i;
1726                                 ast_cli(a->fd, "Changed txvoice setting on Channel B to %d\n", o->txmixbset);
1727                         }
1728                         mixer_write(o);
1729                         mult_set(o);
1730                         ast_cli(a->fd, "Changed Tx Voice Output setting to %d\n", i);
1731                 }
1732                 tune_txoutput(o,i);
1733         } else if (!strcasecmp(a->argv[2], "auxvoice")) {
1734                 i = 0;
1735                 if ( (o->txmixa != TX_OUT_AUX) && (o->txmixb != TX_OUT_AUX))
1736                         ast_log(LOG_WARNING, "No auxvoice output configured.\n");
1737                 else if (a->argc == 3) {
1738                         if (o->txmixa == TX_OUT_AUX)
1739                                 ast_cli(a->fd, "Current auxvoice setting on Channel A is %d\n", o->txmixaset);
1740                         else
1741                                 ast_cli(a->fd, "Current auxvoice setting on Channel B is %d\n", o->txmixbset);
1742                 } else {
1743                         i = atoi(a->argv[3]);
1744                         if ((i < 0) || (i > 999))
1745                                 return CLI_SHOWUSAGE;
1746                         if (o->txmixa == TX_OUT_AUX) {
1747                                 o->txmixbset = i;
1748                                 ast_cli(a->fd, "Changed auxvoice setting on Channel A to %d\n", o->txmixaset);
1749                         } else {
1750                                 o->txmixbset = i;
1751                                 ast_cli(a->fd, "Changed auxvoice setting on Channel B to %d\n", o->txmixbset);
1752                         }
1753                         mixer_write(o);
1754                         mult_set(o);
1755                 }
1756                 /* tune_auxoutput(o,i); */
1757         } else if (!strcasecmp(a->argv[2], "txtone")) {
1758                 if (a->argc == 3)
1759                         ast_cli(a->fd, "Current Tx CTCSS modulation setting = %d\n", o->txctcssadj);
1760                 else {
1761                         i = atoi(a->argv[3]);
1762                         if ((i < 0) || (i > 999))
1763                                 return CLI_SHOWUSAGE;
1764                         o->txctcssadj = i;
1765                         set_txctcss_level(o);
1766                         ast_cli(a->fd, "Changed Tx CTCSS modulation setting to %i\n", i);
1767                 }
1768                 o->txtestkey = 1;
1769                 usleep(5000000);
1770                 o->txtestkey = 0;
1771         } else if (!strcasecmp(a->argv[2],"dump"))
1772                 pmrdump(o);
1773         else if (!strcasecmp(a->argv[2],"nocap")) {
1774                 ast_cli(a->fd, "File capture (trace) was rx=%d tx=%d and now off.\n", o->b.rxcap2, o->b.txcap2);
1775                 ast_cli(a->fd, "File capture (raw)   was rx=%d tx=%d and now off.\n", o->b.rxcapraw, o->b.txcapraw);
1776                 o->b.rxcapraw = o->b.txcapraw = o->b.rxcap2 = o->b.txcap2 = o->pmrChan->b.rxCapture = o->pmrChan->b.txCapture = 0;
1777                 if (frxcapraw) {
1778                         fclose(frxcapraw);
1779                         frxcapraw = NULL;
1780                 }
1781                 if (frxcaptrace) {
1782                         fclose(frxcaptrace);
1783                         frxcaptrace = NULL;
1784                 }
1785                 if (frxoutraw) {
1786                         fclose(frxoutraw);
1787                         frxoutraw = NULL;
1788                 }
1789                 if (ftxcapraw) {
1790                         fclose(ftxcapraw);
1791                         ftxcapraw = NULL;
1792                 }
1793                 if (ftxcaptrace) {
1794                         fclose(ftxcaptrace);
1795                         ftxcaptrace = NULL;
1796                 }
1797                 if (ftxoutraw) {
1798                         fclose(ftxoutraw);
1799                         ftxoutraw = NULL;
1800                 }
1801         } else if (!strcasecmp(a->argv[2], "rxtracecap")) {
1802                 if (!frxcaptrace)
1803                         frxcaptrace = fopen(RX_CAP_TRACE_FILE, "w");
1804                 ast_cli(a->fd, "Trace rx on.\n");
1805                 o->b.rxcap2 = o->pmrChan->b.rxCapture = 1;
1806         } else if (!strcasecmp(a->argv[2], "txtracecap")) {
1807                 if (!ftxcaptrace)
1808                         ftxcaptrace = fopen(TX_CAP_TRACE_FILE, "w");
1809                 ast_cli(a->fd, "Trace tx on.\n");
1810                 o->b.txcap2 = o->pmrChan->b.txCapture = 1;
1811         } else if (!strcasecmp(a->argv[2], "rxcap")) {
1812                 if (!frxcapraw)
1813                         frxcapraw = fopen(RX_CAP_RAW_FILE, "w");
1814                 ast_cli(a->fd, "cap rx raw on.\n");
1815                 o->b.rxcapraw = 1;
1816         } else if (!strcasecmp(a->argv[2], "txcap")) {
1817                 if (!ftxcapraw)
1818                         ftxcapraw = fopen(TX_CAP_RAW_FILE, "w");
1819                 ast_cli(a->fd, "cap tx raw on.\n");
1820                 o->b.txcapraw = 1;
1821         } else if (!strcasecmp(a->argv[2], "save")) {
1822                 tune_write(o);
1823                 ast_cli(a->fd, "Saved radio tuning settings to usbradio_tune.conf\n");
1824         } else
1825                 return CLI_SHOWUSAGE;
1826         return CLI_SUCCESS;
1827 }
1828
1829 /*
1830         set transmit ctcss modulation level
1831         adjust mixer output or internal gain depending on output type
1832         setting range is 0.0 to 0.9
1833 */
1834 static int set_txctcss_level(struct chan_usbradio_pvt *o)
1835 {
1836         if (o->txmixa == TX_OUT_LSD) {
1837                 o->txmixaset = (151 * o->txctcssadj) / 1000;
1838                 mixer_write(o);
1839                 mult_set(o);
1840         } else if (o->txmixb == TX_OUT_LSD) {
1841                 o->txmixbset = (151 * o->txctcssadj) / 1000;
1842                 mixer_write(o);
1843                 mult_set(o);
1844         } else {
1845                 *o->pmrChan->ptxCtcssAdjust = (o->txctcssadj * M_Q8) / 1000;
1846         }
1847         return 0;
1848 }
1849 /*
1850         CLI debugging on and off
1851 */
1852 static char *handle_cli_radio_set_debug(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
1853 {
1854         struct chan_usbradio_pvt *o = NULL;
1855
1856         switch (cmd) {
1857         case CLI_INIT:
1858                 e->command = "radio set debug [off]";
1859                 e->usage =
1860                         "Usage: radio set debug [off]\n"
1861                         "       Enable/Disable radio debugging.\n";
1862         case CLI_GENERATE:
1863                 return NULL;
1864         }
1865         if (a->argc < 3 || a->argc > 4)
1866                 return CLI_SHOWUSAGE;
1867         if (a->argc == 4 && strncasecmp(a->argv[3], "off", 3))
1868                 return CLI_SHOWUSAGE;
1869
1870         o = find_desc(usbradio_active);
1871
1872         if (a->argc == 3)
1873                 o->debuglevel = 1;
1874         else
1875                 o->debuglevel = 0;
1876
1877         ast_cli(a->fd, "USB Radio debugging %s.\n", o->debuglevel ? "enabled" : "disabled");
1878
1879         return CLI_SUCCESS;
1880 }
1881
1882 static struct ast_cli_entry cli_usbradio[] = {
1883         AST_CLI_DEFINE(handle_cli_radio_key,       "Simulate Rx Signal Present"),
1884         AST_CLI_DEFINE(handle_cli_radio_unkey,     "Simulate Rx Signal Lusb"),
1885         AST_CLI_DEFINE(handle_cli_radio_tune,      "Radio Tune"),
1886         AST_CLI_DEFINE(handle_cli_radio_set_debug, "Enable/Disable Radio Debugging"),
1887 };
1888
1889 /*
1890  * store the callerid components
1891  */
1892 #if 0
1893 static void store_callerid(struct chan_usbradio_pvt *o, const char *s)
1894 {
1895         ast_callerid_split(s, o->cid_name, sizeof(o->cid_name), o->cid_num, sizeof(o->cid_num));
1896 }
1897 #endif
1898
1899 static void store_rxdemod(struct chan_usbradio_pvt *o, const char *s)
1900 {
1901         if (!strcasecmp(s, "no")) {
1902                 o->rxdemod = RX_AUDIO_NONE;
1903         } else if (!strcasecmp(s, "speaker")) {
1904                 o->rxdemod = RX_AUDIO_SPEAKER;
1905         } else if (!strcasecmp(s, "flat")) {
1906                         o->rxdemod = RX_AUDIO_FLAT;
1907         } else {
1908                 ast_log(LOG_WARNING, "Unrecognized rxdemod parameter: %s\n", s);
1909         }
1910
1911         ast_debug(4, "set rxdemod = %s\n", s);
1912 }
1913
1914
1915 static void store_txmixa(struct chan_usbradio_pvt *o, const char *s)
1916 {
1917         if (!strcasecmp(s, "no"))
1918                 o->txmixa = TX_OUT_OFF;
1919
1920         else if (!strcasecmp(s, "voice"))
1921                 o->txmixa = TX_OUT_VOICE;
1922         else if (!strcasecmp(s, "tone"))
1923                         o->txmixa = TX_OUT_LSD;
1924         else if (!strcasecmp(s, "composite"))
1925                 o->txmixa = TX_OUT_COMPOSITE;
1926         else if (!strcasecmp(s, "auxvoice"))
1927                 o->txmixb = TX_OUT_AUX;
1928         else
1929                 ast_log(LOG_WARNING, "Unrecognized txmixa parameter: %s\n", s);
1930
1931         ast_debug(4, "set txmixa = %s\n", s);
1932 }
1933
1934 static void store_txmixb(struct chan_usbradio_pvt *o, const char *s)
1935 {
1936         if (!strcasecmp(s, "no"))
1937                 o->txmixb = TX_OUT_OFF;
1938         else if (!strcasecmp(s, "voice"))
1939                 o->txmixb = TX_OUT_VOICE;
1940         else if (!strcasecmp(s, "tone"))
1941                         o->txmixb = TX_OUT_LSD;
1942         else if (!strcasecmp(s, "composite"))
1943                 o->txmixb = TX_OUT_COMPOSITE;
1944         else if (!strcasecmp(s, "auxvoice"))
1945                 o->txmixb = TX_OUT_AUX;
1946         else
1947                 ast_log(LOG_WARNING, "Unrecognized txmixb parameter: %s\n", s);
1948
1949         ast_debug(4, "set txmixb = %s\n", s);
1950 }
1951
1952 static void store_rxcdtype(struct chan_usbradio_pvt *o, const char *s)
1953 {
1954         if (!strcasecmp(s, "no"))
1955                 o->rxcdtype = CD_IGNORE;
1956         else if (!strcasecmp(s, "usb"))
1957                 o->rxcdtype = CD_HID;
1958         else if (!strcasecmp(s, "dsp"))
1959                 o->rxcdtype = CD_XPMR_NOISE;
1960         else if (!strcasecmp(s, "vox"))
1961                 o->rxcdtype = CD_XPMR_VOX;
1962         else if (!strcasecmp(s, "usbinvert"))
1963                 o->rxcdtype = CD_HID_INVERT;
1964         else
1965                 ast_log(LOG_WARNING, "Unrecognized rxcdtype parameter: %s\n", s);
1966
1967         ast_debug(4, "set rxcdtype = %s\n", s);
1968 }
1969
1970 static void store_rxsdtype(struct chan_usbradio_pvt *o, const char *s)
1971 {
1972         if (!strcasecmp(s, "no") || !strcasecmp(s, "SD_IGNORE"))
1973                 o->rxsdtype = SD_IGNORE;
1974         else if (!strcasecmp(s, "usb") || !strcasecmp(s, "SD_HID"))
1975                 o->rxsdtype = SD_HID;
1976         else if (!strcasecmp(s, "usbinvert") || !strcasecmp(s, "SD_HID_INVERT"))
1977                 o->rxsdtype = SD_HID_INVERT;
1978         else if (!strcasecmp(s, "software") || !strcasecmp(s, "SD_XPMR"))
1979                 o->rxsdtype = SD_XPMR;
1980         else
1981                 ast_log(LOG_WARNING, "Unrecognized rxsdtype parameter: %s\n", s);
1982
1983         ast_debug(4, "set rxsdtype = %s\n", s);
1984 }
1985
1986 static void store_rxgain(struct chan_usbradio_pvt *o, const char *s)
1987 {
1988         float f;
1989         if (sscanf(s, "%f", &f) == 1)
1990                 o->rxgain = f;
1991         ast_debug(4, "set rxgain = %f\n", f);
1992 }
1993
1994 static void store_rxvoiceadj(struct chan_usbradio_pvt *o, const char *s)
1995 {
1996         float f;
1997         if (sscanf(s, "%f", &f) == 1)
1998                 o->rxvoiceadj = f;
1999         ast_debug(4, "set rxvoiceadj = %f\n", f);
2000 }
2001
2002 static void store_rxctcssadj(struct chan_usbradio_pvt *o, const char *s)
2003 {
2004         float f;
2005         if (sscanf(s, "%f", &f) == 1)
2006                 o->rxctcssadj = f;
2007         ast_debug(4, "set rxctcssadj = %f\n", f);
2008 }
2009
2010 static void store_txtoctype(struct chan_usbradio_pvt *o, const char *s)
2011 {
2012         if (!strcasecmp(s, "no") || !strcasecmp(s, "TOC_NONE"))
2013                 o->txtoctype = TOC_NONE;
2014         else if (!strcasecmp(s, "phase") || !strcasecmp(s, "TOC_PHASE"))
2015                 o->txtoctype = TOC_PHASE;
2016         else if (!strcasecmp(s, "notone") || !strcasecmp(s, "TOC_NOTONE"))
2017                 o->txtoctype = TOC_NOTONE;
2018         else
2019                 ast_log(LOG_WARNING, "Unrecognized txtoctype parameter: %s\n", s);
2020
2021         ast_debug(4, "set txtoctype = %s\n", s);
2022 }
2023
2024 static void store_rxctcssfreq(struct chan_usbradio_pvt *o, const char *s)
2025 {
2026         float f;
2027         if (sscanf(s, "%f", &f) == 1)
2028                 o->rxctcssfreq = f;
2029         ast_debug(4, "set rxctcss = %f\n", f);
2030 }
2031
2032 static void store_txctcssfreq(struct chan_usbradio_pvt *o, const char *s)
2033 {
2034         float f;
2035         if (sscanf(s, "%f", &f) == 1)
2036                 o->txctcssfreq = f;
2037         ast_debug(4, "set txctcss = %f\n", f);
2038 }
2039
2040 static void tune_txoutput(struct chan_usbradio_pvt *o, int value)
2041 {
2042         o->txtestkey = 1;
2043         o->pmrChan->txPttIn = 1;
2044
2045 #if 0
2046         /* generate 1KHz tone at 7200 peak */
2047         o->pmrChan->spsSigGen1->freq = 10000;
2048         o->pmrChan->spsSigGen1->outputGain = (float)(0.22 * M_Q8);
2049         o->pmrChan->b.startSpecialTone = 1;
2050 #endif
2051
2052         TxTestTone(o->pmrChan, 1);
2053
2054         usleep(5000000);
2055         /* o->pmrChan->b.stopSpecialTone = 1; */
2056         usleep(100000);
2057
2058         TxTestTone(o->pmrChan, 0);
2059
2060         o->pmrChan->txPttIn = 0;
2061         o->txtestkey = 0;
2062 }
2063
2064 static void tune_rxinput(struct chan_usbradio_pvt *o)
2065 {
2066         const int target = 23000;
2067         const int tolerance = 2000;
2068         const int settingmin = 1;
2069         const int settingstart = 2;
2070         const int maxtries = 12;
2071
2072         float settingmax;
2073
2074         int setting = 0, tries = 0, tmpdiscfactor, meas;
2075         int tunetype = 0;
2076
2077         settingmax = o->micmax;
2078
2079         if (o->pmrChan->rxDemod)
2080                 tunetype = 1;
2081
2082         setting = settingstart;
2083
2084         while (tries < maxtries) {
2085                 setamixer(o->devicenum, MIXER_PARAM_MIC_CAPTURE_VOL, setting, 0);
2086                 setamixer(o->devicenum, MIXER_PARAM_MIC_BOOST, o->rxboostset, 0);
2087                 usleep(100000);
2088                 if (o->rxcdtype == CD_XPMR_VOX || o->rxdemod == RX_AUDIO_SPEAKER) {
2089                         ast_debug(4, "Measure Direct Input\n");
2090                         o->pmrChan->spsMeasure->source = o->pmrChan->spsRx->source;
2091                         o->pmrChan->spsMeasure->discfactor = 1000;
2092                         o->pmrChan->spsMeasure->enabled = 1;
2093                         o->pmrChan->spsMeasure->amax = o->pmrChan->spsMeasure->amin = 0;
2094                         usleep(400000);
2095                         meas = o->pmrChan->spsMeasure->apeak;
2096                         o->pmrChan->spsMeasure->enabled = 0;
2097                 } else {
2098                         ast_debug(4, "Measure HF Noise\n");
2099                         tmpdiscfactor = o->pmrChan->spsRx->discfactor;
2100                         o->pmrChan->spsRx->discfactor = (i16)1000;
2101                         o->pmrChan->spsRx->discounteru = o->pmrChan->spsRx->discounterl = 0;
2102                         o->pmrChan->spsRx->amax = o->pmrChan->spsRx->amin = 0;
2103                         usleep(200000);
2104                         meas = o->pmrChan->rxRssi;
2105                         o->pmrChan->spsRx->discfactor = tmpdiscfactor;
2106                         o->pmrChan->spsRx->discounteru = o->pmrChan->spsRx->discounterl = 0;
2107                         o->pmrChan->spsRx->amax = o->pmrChan->spsRx->amin = 0;
2108                 }
2109         if (!meas)
2110                         meas++;
2111                 ast_log(LOG_NOTICE, "tries=%d, setting=%d, meas=%i\n", tries, setting, meas);
2112
2113                 if ( meas < (target - tolerance) || meas > (target + tolerance) || tries < 3)
2114                         setting = setting * target / meas;
2115                 else if (tries > 4 && meas > (target - tolerance) && meas < (target + tolerance) )
2116                         break;
2117
2118                 if (setting < settingmin)
2119                         setting = settingmin;
2120                 else if (setting > settingmax)
2121                         setting = settingmax;
2122
2123                 tries++;
2124         }
2125         ast_log(LOG_NOTICE, "DONE tries=%d, setting=%d, meas=%i\n", tries,
2126                 (setting * 1000) / o->micmax, meas);
2127         if (meas < (target - tolerance) || meas > (target + tolerance))
2128                 ast_log(LOG_NOTICE, "ERROR: RX INPUT ADJUST FAILED.\n");
2129         else {
2130                 ast_log(LOG_NOTICE, "INFO: RX INPUT ADJUST SUCCESS.\n");
2131                 o->rxmixerset = (setting * 1000) / o->micmax;
2132         }
2133 }
2134 /*
2135 */
2136 static void tune_rxvoice(struct chan_usbradio_pvt *o)
2137 {
2138         const int target = 7200;        /* peak */
2139         const int tolerance = 360;      /* peak to peak */
2140         const float settingmin = 0.1;
2141         const float settingmax = 4;
2142         const float settingstart = 1;
2143         const int maxtries = 12;
2144
2145         float setting;
2146
2147         int tries = 0, meas;
2148
2149         ast_log(LOG_NOTICE, "INFO: RX VOICE ADJUST START.\n");
2150         ast_log(LOG_NOTICE, "target=%d tolerance=%d\n", target, tolerance);
2151
2152         if (!o->pmrChan->spsMeasure)
2153                 ast_log(LOG_ERROR, "NO MEASURE BLOCK.\n");
2154
2155         if (!o->pmrChan->spsMeasure->source || !o->pmrChan->prxVoiceAdjust )
2156                 ast_log(LOG_ERROR, "NO SOURCE OR MEASURE SETTING.\n");
2157
2158         o->pmrChan->spsMeasure->source = o->pmrChan->spsRxOut->sink;
2159         o->pmrChan->spsMeasure->enabled = 1;
2160         o->pmrChan->spsMeasure->discfactor = 1000;
2161
2162         setting=settingstart;
2163
2164         ast_debug(4, "ERROR: NO MEASURE BLOCK.\n");
2165
2166         while (tries < maxtries) {
2167                 *(o->pmrChan->prxVoiceAdjust) = setting * M_Q8;
2168                 usleep(10000);
2169         o->pmrChan->spsMeasure->amax = o->pmrChan->spsMeasure->amin = 0;
2170                 usleep(1000000);
2171                 meas = o->pmrChan->spsMeasure->apeak;
2172                 ast_log(LOG_NOTICE, "tries=%d, setting=%f, meas=%i\n", tries, setting, meas);
2173
2174                 if (meas < (target - tolerance) || meas > (target + tolerance) || tries < 3)
2175                         setting = setting * target / meas;
2176                 else if (tries > 4 && meas > (target - tolerance) && meas < (target + tolerance))
2177                         break;
2178                 if (setting < settingmin)
2179                         setting = settingmin;
2180                 else if (setting > settingmax)
2181                         setting = settingmax;
2182
2183                 tries++;
2184         }
2185
2186         o->pmrChan->spsMeasure->enabled = 0;
2187
2188         ast_log(LOG_NOTICE, "DONE tries=%d, setting=%f, meas=%f\n", tries, setting, (float)meas);
2189         if (meas < (target - tolerance) || meas > (target + tolerance))
2190                 ast_log(LOG_ERROR, "RX VOICE GAIN ADJUST FAILED.\n");
2191         else {
2192                 ast_log(LOG_NOTICE, "RX VOICE GAIN ADJUST SUCCESS.\n");
2193                 o->rxvoiceadj = setting;
2194         }
2195 }
2196
2197 static void tune_rxctcss(struct chan_usbradio_pvt *o)
2198 {
2199         const int target = 4096;
2200         const int tolerance = 100;
2201         const float settingmin = 0.1;
2202         const float settingmax = 4;
2203         const float settingstart = 1;
2204         const int maxtries = 12;
2205
2206         float setting;
2207         int tries = 0, meas;
2208
2209         ast_log(LOG_NOTICE, "RX CTCSS ADJUST START.\n");
2210         ast_log(LOG_NOTICE, "target=%d tolerance=%d \n", target, tolerance);
2211
2212         o->pmrChan->spsMeasure->source = o->pmrChan->prxCtcssMeasure;
2213         o->pmrChan->spsMeasure->discfactor = 400;
2214         o->pmrChan->spsMeasure->enabled = 1;
2215
2216         setting = settingstart;
2217
2218         while (tries < maxtries) {
2219                 *(o->pmrChan->prxCtcssAdjust) = setting * M_Q8;
2220                 usleep(10000);
2221         o->pmrChan->spsMeasure->amax = o->pmrChan->spsMeasure->amin = 0;
2222                 usleep(500000);
2223                 meas = o->pmrChan->spsMeasure->apeak;
2224                 ast_debug(4, "tries=%d, setting=%f, meas=%i\n", tries, setting, meas);
2225
2226                 if (meas < (target - tolerance) || meas > (target + tolerance) || tries < 3)
2227                         setting = setting * target / meas;
2228                 else if (tries > 4 && meas > (target - tolerance) && meas < (target + tolerance))
2229                         break;
2230                 if (setting < settingmin)
2231                         setting = settingmin;
2232                 else if (setting > settingmax)
2233                         setting = settingmax;
2234
2235                 tries++;
2236         }
2237         o->pmrChan->spsMeasure->enabled = 0;
2238         ast_debug(4, "DONE tries=%d, setting=%f, meas=%f\n", tries, setting, (float)meas);
2239         if (meas < (target - tolerance) || meas > (target + tolerance))
2240                 ast_log(LOG_ERROR, "RX CTCSS GAIN ADJUST FAILED.\n");
2241         else {
2242                 ast_log(LOG_NOTICE, "RX CTCSS GAIN ADJUST SUCCESS.\n");
2243                 o->rxctcssadj = setting;
2244         }
2245 }
2246 /*
2247         this file then is included in chan_usbradio.conf
2248         #include /etc/asterisk/usbradio_tune.conf
2249 */
2250 static void tune_write(struct chan_usbradio_pvt *o)
2251 {
2252         FILE *fp;
2253
2254         fp = fopen("/etc/asterisk/usbradio_tune.conf", "w");
2255
2256         if (!strcmp(o->name, "dsp"))
2257                 fprintf(fp, "[general]\n");
2258         else
2259                 fprintf(fp, "[%s]\n", o->name);
2260
2261         fprintf(fp, "; name=%s\n", o->name);
2262         fprintf(fp, "; devicenum=%d\n", o->devicenum);
2263
2264         fprintf(fp, "rxmixerset=%d\n", o->rxmixerset);
2265         fprintf(fp, "rxboostset=%d\n", o->rxboostset);
2266         fprintf(fp, "txmixaset=%d\n", o->txmixaset);
2267         fprintf(fp, "txmixbset=%d\n", o->txmixbset);
2268
2269         fprintf(fp, "rxvoiceadj=%f\n", o->rxvoiceadj);
2270         fprintf(fp, "rxctcssadj=%f\n", o->rxctcssadj);
2271         fprintf(fp, "txctcssadj=%d\n", o->txctcssadj);
2272
2273         fprintf(fp, "rxsquelchadj=%d\n", o->rxsquelchadj);
2274         fclose(fp);
2275 }
2276
2277 static void mixer_write(struct chan_usbradio_pvt *o)
2278 {
2279         setamixer(o->devicenum, MIXER_PARAM_MIC_PLAYBACK_SW, 0, 0);
2280         setamixer(o->devicenum, MIXER_PARAM_MIC_PLAYBACK_VOL, 0, 0);
2281         setamixer(o->devicenum, MIXER_PARAM_SPKR_PLAYBACK_SW, 1, 0);
2282         setamixer(o->devicenum, MIXER_PARAM_SPKR_PLAYBACK_VOL,
2283                 o->txmixaset * o->spkrmax / 1000,
2284                 o->txmixbset * o->spkrmax / 1000);
2285         setamixer(o->devicenum, MIXER_PARAM_MIC_CAPTURE_VOL,
2286                 o->rxmixerset * o->micmax / 1000, 0);
2287         setamixer(o->devicenum, MIXER_PARAM_MIC_BOOST, o->rxboostset, 0);
2288         setamixer(o->devicenum, MIXER_PARAM_MIC_CAPTURE_SW, 1, 0);
2289 }
2290 /*
2291         adjust dsp multiplier to add resolution to tx level adjustment
2292 */
2293 static void mult_set(struct chan_usbradio_pvt *o)
2294 {
2295
2296         if (o->pmrChan->spsTxOutA) {
2297                 o->pmrChan->spsTxOutA->outputGain =
2298                         mult_calc((o->txmixaset * 152) / 1000);
2299         }
2300         if (o->pmrChan->spsTxOutB) {
2301                 o->pmrChan->spsTxOutB->outputGain =
2302                         mult_calc((o->txmixbset * 152) / 1000);
2303         }
2304 }
2305 /*
2306  * input 0 - 151 outputs are pot and multiplier
2307  */
2308 static int mult_calc(int value)
2309 {
2310         const int multx = M_Q8;
2311         int pot, mult;
2312
2313         pot= ((int)(value / 4) * 4) + 2;
2314         mult = multx - ((multx * (3 - (value % 4))) / (pot + 2));
2315         return mult;
2316 }
2317
2318 #define pd(x) ast_debug(4, #x" = %d\n", x)
2319 #define pp(x) ast_debug(4, #x" = %p\n", x)
2320 #define ps(x) ast_debug(4, #x" = %s\n", x)
2321 #define pf(x) ast_debug(4, #x" = %f\n", x)
2322 /*
2323 */
2324 static void pmrdump(struct chan_usbradio_pvt *o)
2325 {
2326         t_pmr_chan *p;
2327
2328         p = o->pmrChan;
2329
2330         ast_debug(4, "odump()\n");
2331
2332         pd(o->devicenum);
2333
2334         pd(o->rxdemod);
2335         pd(o->rxcdtype);
2336         pd(o->rxsdtype);
2337         pd(o->txtoctype);
2338
2339         pd(o->rxmixerset);
2340         pf(o->rxvoiceadj);
2341         pf(o->rxctcssadj);
2342         pd(o->rxsquelchadj);
2343
2344         pd(o->txprelim);
2345         pd(o->txmixa);
2346         pd(o->txmixb);
2347
2348         pd(o->txmixaset);
2349         pd(o->txmixbset);
2350
2351         ast_debug(4, "pmrdump()\n");
2352
2353         ast_debug(4, "prxSquelchAdjust=%d\n", *(o->pmrChan->prxSquelchAdjust));
2354
2355         pd(p->rxCarrierPoint);
2356         pd(p->rxCarrierHyst);
2357
2358         pd(p->rxCtcss->relax);
2359         pf(p->rxCtcssFreq);
2360         pd(p->rxCtcssIndex);
2361         pf(p->txCtcssFreq);
2362
2363         pd(p->txMixA);
2364         pd(p->txMixB);
2365
2366         pd(p->rxDeEmpEnable);
2367         pd(p->rxCenterSlicerEnable);
2368         pd(p->rxCtcssDecodeEnable);
2369         pd(p->rxDcsDecodeEnable);
2370
2371         pd(p->txHpfEnable);
2372         pd(p->txLimiterEnable);
2373         pd(p->txPreEmpEnable);
2374         pd(p->txLpfEnable);
2375
2376         if (p->spsTxOutA)
2377                 pd(p->spsTxOutA->outputGain);
2378         if (p->spsTxOutB)
2379                 pd(p->spsTxOutB->outputGain);
2380
2381         return;
2382 }
2383
2384
2385 /*
2386  * grab fields from the config file, init the descriptor and open the device.
2387  */
2388 static struct chan_usbradio_pvt *store_config(struct ast_config *cfg, char *ctg)
2389 {
2390         struct ast_variable *v;
2391         struct chan_usbradio_pvt *o;
2392         struct ast_config *cfg1;
2393         struct ast_flags config_flags = { 0 };
2394
2395         if (ctg == NULL) {
2396                 traceusb1(" store_config() ctg == NULL\n");
2397                 o = &usbradio_default;
2398                 ctg = "general";
2399         } else {
2400                 if (!(o = ast_calloc(1, sizeof(*o)))){
2401                         return NULL;
2402                 }
2403                 *o = usbradio_default;
2404                 /* "general" is also the default thing */
2405                 if (strcmp(ctg, "general") == 0) {
2406                         o->name = ast_strdup("dsp");
2407                         usbradio_active = o->name;
2408                 } else
2409                         o->name = ast_strdup(ctg);
2410         }
2411
2412         strcpy(o->mohinterpret, "default");
2413         o->micmax = amixer_max(o->devicenum, MIXER_PARAM_MIC_CAPTURE_VOL);
2414         o->spkrmax = amixer_max(o->devicenum, MIXER_PARAM_SPKR_PLAYBACK_VOL);
2415         /* fill other fields from configuration */
2416         for (v = ast_variable_browse(cfg, ctg); v; v = v->next) {
2417                 M_START(v->name, v->value);
2418
2419                 /* handle jb conf */
2420                 if (!ast_jb_read_conf(&global_jbconf, v->name, v->value))
2421                         continue;
2422
2423 #if     0
2424                         M_BOOL("autoanswer", o->autoanswer)
2425                         M_BOOL("autohangup", o->autohangup)
2426                         M_BOOL("overridecontext", o->overridecontext)
2427                         M_STR("context", o->ctx)
2428                         M_STR("language", o->language)
2429                         M_STR("mohinterpret", o->mohinterpret)
2430                         M_STR("extension", o->ext)
2431                         M_F("callerid", store_callerid(o, v->value))
2432 #endif
2433                         M_UINT("frags", o->frags)
2434                         M_UINT("queuesize", o->queuesize)
2435                         M_UINT("devicenum", o->devicenum)
2436                         M_UINT("debug", usbradio_debug)
2437                         M_BOOL("rxcpusaver", o->rxcpusaver)
2438                         M_BOOL("txcpusaver", o->txcpusaver)
2439                         M_BOOL("invertptt", o->invertptt)
2440                         M_F("rxdemod", store_rxdemod(o, v->value))
2441                         M_BOOL("txprelim", o->txprelim);
2442                         M_F("txmixa", store_txmixa(o, v->value))
2443                         M_F("txmixb", store_txmixb(o, v->value))
2444                         M_F("carrierfrom", store_rxcdtype(o, v->value))
2445                         M_F("rxsdtype", store_rxsdtype(o, v->value))
2446                         M_F("rxctcssfreq", store_rxctcssfreq(o, v->value))
2447                         M_F("txctcssfreq", store_txctcssfreq(o, v->value))
2448                         M_F("rxgain", store_rxgain(o, v->value))
2449                         M_BOOL("rxboostset", o->rxboostset)
2450                         M_UINT("rxctcssrelax", o->rxctcssrelax)
2451                         M_F("txtoctype", store_txtoctype(o, v->value))
2452                         M_UINT("hdwtype", o->hdwtype)
2453                         M_UINT("duplex", o->radioduplex)
2454                         M_END(;
2455                         );
2456         }
2457
2458         cfg1 = ast_config_load(config1, config_flags);
2459         if (!cfg1) {
2460                 o->rxmixerset = 500;
2461                 o->txmixaset = 500;
2462                 o->txmixbset = 500;
2463                 o->rxvoiceadj = 0.5;
2464                 o->rxctcssadj = 0.5;
2465                 o->txctcssadj = 200;
2466                 o->rxsquelchadj = 500;
2467                 ast_log(LOG_WARNING, "File %s not found, using default parameters.\n", config1);
2468         } else  {
2469                 for (v = ast_variable_browse(cfg1, ctg); v; v = v->next) {
2470
2471                         M_START(v->name, v->value);
2472                         M_UINT("rxmixerset", o->rxmixerset)
2473                         M_UINT("txmixaset", o->txmixaset)
2474                         M_UINT("txmixbset", o->txmixbset)
2475                         M_F("rxvoiceadj", store_rxvoiceadj(o, v->value))
2476                         M_F("rxctcssadj", store_rxctcssadj(o, v->value))
2477                         M_UINT("txctcssadj", o->txctcssadj);
2478                         M_UINT("rxsquelchadj", o->rxsquelchadj)
2479                         M_END(;
2480                         );
2481                 }
2482                 ast_config_destroy(cfg1);
2483         }
2484
2485         o->debuglevel = 0;
2486
2487         if (o == &usbradio_default)             /* we are done with the default */
2488                 return NULL;
2489
2490         o->lastopen = ast_tvnow();      /* don't leave it 0 or tvdiff may wrap */
2491         o->dsp = ast_dsp_new();
2492         if (o->dsp) {
2493                 ast_dsp_set_features(o->dsp, DSP_FEATURE_DTMF_DETECT);
2494                 ast_dsp_digitmode(o->dsp, DSP_DIGITMODE_DTMF | DSP_DIGITMODE_MUTECONF | DSP_DIGITMODE_RELAXDTMF);
2495         }
2496
2497         if (o->rxctcssfreq != 0 && o->rxdemod == RX_AUDIO_SPEAKER)
2498                 ast_log(LOG_ERROR, "Incompatable Options  o->rxctcssfreq=%f and o->rxdemod=speaker\n", o->rxctcssfreq);
2499
2500         if (o->pmrChan == NULL) {
2501                 t_pmr_chan tChan;
2502
2503                 memset(&tChan, 0, sizeof(tChan));
2504
2505                 tChan.rxDemod = o->rxdemod;
2506                 tChan.rxCdType = o->rxcdtype;
2507
2508                 tChan.txMod = o->txprelim;
2509
2510                 tChan.txMixA = o->txmixa;
2511                 tChan.txMixB = o->txmixb;
2512
2513                 tChan.rxCpuSaver = o->rxcpusaver;
2514                 tChan.txCpuSaver = o->txcpusaver;
2515
2516                 tChan.rxCtcssFreq = o->rxctcssfreq;
2517                 tChan.txCtcssFreq = o->txctcssfreq;
2518
2519                 o->pmrChan = createPmrChannel(&tChan, FRAME_SIZE);
2520
2521                 o->pmrChan->radioDuplex = o->radioduplex;
2522
2523                 o->pmrChan->rxCpuSaver = o->rxcpusaver;
2524                 o->pmrChan->txCpuSaver = o->txcpusaver;
2525
2526                 *(o->pmrChan->prxSquelchAdjust) =
2527                         ((999 - o->rxsquelchadj) * 32767) / 1000;
2528
2529                 o->pmrChan->spsRx->outputGain = o->rxvoiceadj*M_Q8;
2530
2531                 o->pmrChan->txTocType = o->txtoctype;
2532
2533                 if ((o->txmixa == TX_OUT_LSD) ||
2534                         (o->txmixa == TX_OUT_COMPOSITE) ||
2535                         (o->txmixb == TX_OUT_LSD) ||
2536                         (o->txmixb == TX_OUT_COMPOSITE)) {
2537                         *(o->pmrChan->prxCtcssAdjust) = o->rxctcssadj * M_Q8;
2538                         set_txctcss_level(o);
2539                 }
2540
2541                 o->pmrChan->rxCtcss->relax = o->rxctcssrelax;
2542
2543         }
2544
2545         if ((o->txmixa != TX_OUT_VOICE) && (o->txmixb != TX_OUT_VOICE) &&
2546                 (o->txmixa != TX_OUT_COMPOSITE) && (o->txmixb != TX_OUT_COMPOSITE))
2547                 ast_log(LOG_ERROR, "No txvoice output configured.\n");
2548
2549         if (o->txctcssfreq &&
2550             o->txmixa != TX_OUT_LSD && o->txmixa != TX_OUT_COMPOSITE  &&
2551                 o->txmixb != TX_OUT_LSD && o->txmixb != TX_OUT_COMPOSITE)
2552                 ast_log(LOG_ERROR, "No txtone output configured.\n");
2553
2554         if (o->rxctcssfreq && o->pmrChan->rxCtcssIndex < 0)
2555                 ast_log(LOG_ERROR, "Invalid CTCSS Frequency.\n");
2556
2557         /* RxTestIt(o); */
2558
2559         mixer_write(o);
2560         mult_set(o);
2561         hidhdwconfig(o);
2562
2563         /* pmrdump(o); */
2564
2565         if (pipe(o->sndcmd) != 0) {
2566                 ast_log(LOG_ERROR, "Unable to create pipe\n");
2567                 goto error;
2568         }
2569
2570         ast_debug(4, "creating sound thread\n");
2571         ast_pthread_create_background(&o->sthread, NULL, sound_thread, o);
2572
2573         /* link into list of devices */
2574         if (o != &usbradio_default) {
2575                 o->next = usbradio_default.next;
2576                 usbradio_default.next = o;
2577         }
2578         return o;
2579
2580 error:
2581         if (o != &usbradio_default)
2582                 ast_free(o);
2583         return NULL;
2584 }
2585
2586 #if     DEBUG_FILETEST == 1
2587 /*
2588         Test It on a File
2589 */
2590 int RxTestIt(struct chan_usbradio_pvt *o)
2591 {
2592         const int numSamples = SAMPLES_PER_BLOCK;
2593         const int numChannels = 16;
2594
2595         i16 sample, i, ii;
2596
2597         i32 txHangTime;
2598
2599         i16 txEnable;
2600
2601         t_pmr_chan tChan;
2602         t_pmr_chan *pChan;
2603
2604         FILE *hInput = NULL, *hOutput = NULL, *hOutputTx = NULL;
2605
2606         i16 iBuff[numSamples * 2 * 6], oBuff[numSamples];
2607
2608         ast_debug(4, "RxTestIt()\n");
2609
2610         pChan = o->pmrChan;
2611         pChan->b.txCapture = 1;
2612         pChan->b.rxCapture = 1;
2613
2614         txEnable = 0;
2615
2616         hInput = fopen("/usr/src/xpmr/testdata/rx_in.pcm", "r");
2617         if (!hInput){
2618                 ast_debug(4, " RxTestIt() File Not Found.\n");
2619                 return 0;
2620         }
2621         hOutput = fopen("/usr/src/xpmr/testdata/rx_debug.pcm", "w");
2622
2623         ast_debug(4, " RxTestIt() Working...\n");
2624
2625         while (!feof(hInput)) {
2626                 fread((void *)iBuff, 2, numSamples * 2 * 6, hInput);
2627
2628                 if (txHangTime)
2629                         txHangTime -= numSamples;
2630                 if (txHangTime < 0)
2631                         txHangTime = 0;
2632
2633                 if (pChan->rxCtcss->decode)
2634                         txHangTime = (8000 / 1000 * 2000);
2635
2636                 if (pChan->rxCtcss->decode && !txEnable) {
2637                         txEnable = 1;
2638                         /* pChan->inputBlanking = (8000 / 1000 * 200); */
2639                 } else if (!pChan->rxCtcss->decode && txEnable) {
2640                         txEnable = 0;
2641                 }
2642
2643                 PmrRx(pChan, iBuff, oBuff);
2644
2645                 fwrite((void *)pChan->prxDebug, 2, numSamples * numChannels, hOutput);
2646         }
2647         pChan->b.txCapture = 0;
2648         pChan->b.rxCapture = 0;
2649
2650         if (hInput)
2651                 fclose(hInput);
2652         if (hOutput)
2653                 fclose(hOutput);
2654
2655         ast_debug(4, " RxTestIt() Complete.\n");
2656
2657         return 0;
2658 }
2659 #endif
2660
2661 #include "./xpmr/xpmr.c"
2662 /*
2663 */
2664 static int load_module(void)
2665 {
2666         struct ast_config *cfg = NULL;
2667         char *ctg = NULL;
2668         struct ast_flags config_flags = { 0 };
2669
2670         /* Copy the default jb config over global_jbconf */
2671         memcpy(&global_jbconf, &default_jbconf, sizeof(struct ast_jb_conf));
2672
2673         /* load config file */
2674         if (!(cfg = ast_config_load(config, config_flags))) {
2675                 ast_log(LOG_NOTICE, "Unable to load config %s\n", config);
2676                 return AST_MODULE_LOAD_DECLINE;
2677         }
2678
2679         do {
2680                 store_config(cfg, ctg);
2681         } while ( (ctg = ast_category_browse(cfg, ctg)) != NULL);
2682
2683         ast_config_destroy(cfg);
2684
2685         if (find_desc(usbradio_active) == NULL) {
2686                 ast_log(LOG_NOTICE, "Device %s not found\n", usbradio_active);
2687                 /* XXX we could default to 'dsp' perhaps ? */
2688                 /* XXX should cleanup allocated memory etc. */
2689                 return AST_MODULE_LOAD_FAILURE;
2690         }
2691
2692         if (ast_channel_register(&usbradio_tech)) {
2693                 ast_log(LOG_ERROR, "Unable to register channel type 'usb'\n");
2694                 return AST_MODULE_LOAD_FAILURE;
2695         }
2696
2697         ast_cli_register_multiple(cli_usbradio, sizeof(cli_usbradio) / sizeof(struct ast_cli_entry));
2698
2699         return AST_MODULE_LOAD_SUCCESS;
2700 }
2701 /*
2702 */
2703 static int unload_module(void)
2704 {
2705         struct chan_usbradio_pvt *o;
2706
2707         ast_log(LOG_WARNING, "unload_module() called\n");
2708
2709         ast_channel_unregister(&usbradio_tech);
2710         ast_cli_unregister_multiple(cli_usbradio, sizeof(cli_usbradio) / sizeof(struct ast_cli_entry));
2711
2712         for (o = usbradio_default.next; o; o = o->next) {
2713
2714                 ast_log(LOG_WARNING, "destroyPmrChannel() called\n");
2715                 if (o->pmrChan)
2716                         destroyPmrChannel(o->pmrChan);
2717
2718                 #if DEBUG_CAPTURES == 1
2719                 if (frxcapraw) { fclose(frxcapraw); frxcapraw = NULL; }
2720                 if (frxcaptrace) { fclose(frxcaptrace); frxcaptrace = NULL; }
2721                 if (frxoutraw) { fclose(frxoutraw); frxoutraw = NULL; }
2722                 if (ftxcapraw) { fclose(ftxcapraw); ftxcapraw = NULL; }
2723                 if (ftxcaptrace) { fclose(ftxcaptrace); ftxcaptrace = NULL; }
2724                 if (ftxoutraw) { fclose(ftxoutraw); ftxoutraw = NULL; }
2725                 #endif
2726
2727                 close(o->sounddev);
2728                 if (o->sndcmd[0] > 0) {
2729                         close(o->sndcmd[0]);
2730                         close(o->sndcmd[1]);
2731                 }
2732                 if (o->dsp)
2733                         ast_dsp_free(o->dsp);
2734                 if (o->owner)
2735                         ast_softhangup(o->owner, AST_SOFTHANGUP_APPUNLOAD);
2736                 if (o->owner)                   /* XXX how ??? */
2737                         return -1;
2738                 /* XXX what about the thread ? */
2739                 /* XXX what about the memory allocated ? */
2740         }
2741         return 0;
2742 }
2743
2744 AST_MODULE_INFO_STANDARD(ASTERISK_GPL_KEY, "usb Console Channel Driver");
2745
2746 /*      end of file */
2747
2748