path: root/package/pjsip/patches/200-pjmedia_tapi_audiodev.patch

--- /dev/null
+++ b/pjmedia/src/pjmedia-audiodev/tapi_dev.c
@@ -0,0 +1,1024 @@
+/******************************************************************************
+
+                               Copyright (c) 2010
+                            Lantiq Deutschland GmbH
+                     Am Campeon 3; 85579 Neubiberg, Germany
+
+  For licensing information, see the file 'LICENSE' in the root folder of
+  this software module.
+
+******************************************************************************/
+#include <pjmedia-audiodev/audiodev_imp.h>
+#include <pjmedia/errno.h>
+#include <pj/assert.h>
+#include <pj/pool.h>
+#include <pj/log.h>
+#include <pj/os.h>
+
+/* Linux includes*/
+#include <stdio.h>
+#include <string.h>
+#include <stdlib.h>
+#include <ctype.h>
+#include <sys/stat.h> 
+#include <fcntl.h>
+#include <sys/types.h>
+#include <sys/ioctl.h>
+#include <sys/select.h>
+#include <sys/time.h>
+#include <unistd.h>
+
+#if PJMEDIA_AUDIO_DEV_HAS_TAPI_DEVICE
+
+/* TAPI includes*/
+#include "drv_tapi_io.h"
+#include "vmmc_io.h"
+
+/* Maximum 2 devices*/
+#define TAPI_AUDIO_DEV_NUM          (1)
+#define TAPI_AUDIO_MAX_DEV_NUM      (2)
+#define TAPI_BASE_NAME              "TAPI"
+#define TAPI_LL_DEV_BASE_PATH       "/dev/vmmc"
+#define TAPI_LL_DEV_FIRMWARE_NAME   "/lib/firmware/danube_firmware.bin" 
+
+#define TAPI_LL_DEV_SELECT_TIMEOUT_MS      (2000)
+#define TAPI_LL_DEV_MAX_PACKET_SIZE        (800)
+#define TAPI_LL_DEV_RTP_HEADER_SIZE_BYTE   (12)
+#define TAPI_LL_DEV_ENC_FRAME_LEN_MS       (20)
+#define TAPI_LL_DEV_ENC_SMPL_PER_SEC       (8000)
+#define TAPI_LL_DEV_ENC_BITS_PER_SMPLS     (16)
+#define TAPI_LL_DEV_ENC_SMPL_PER_FRAME     (160)
+#define TAPI_LL_DEV_ENC_BYTES_PER_FRAME    (TAPI_LL_DEV_ENC_SMPL_PER_FRAME * (TAPI_LL_DEV_ENC_BITS_PER_SMPLS / 8))
+
+
+#define FD_WIDTH_SET(fd, maxfd)   (maxfd) < (fd) ? (fd) : maxfd 
+
+#define THIS_FILE     "tapi_dev.c"
+
+#if 1
+#   define TRACE_(x)    PJ_LOG(1,x)
+#else
+#   define TRACE_(x)
+#endif
+
+typedef struct
+{
+   pj_int32_t dev_fd;
+   pj_int32_t ch_fd[TAPI_AUDIO_DEV_NUM];
+   pj_int8_t  data2phone_map[TAPI_AUDIO_DEV_NUM];
+   
+} tapi_ctx;
+
+
+/* TAPI factory */
+struct tapi_aud_factory
+{
+   pjmedia_aud_dev_factory  base;
+   pj_pool_t         *pool;
+   pj_pool_factory   *pf;
+
+   pj_uint32_t             dev_count;
+   pjmedia_aud_dev_info   *dev_info;
+
+   tapi_ctx   dev_ctx;
+};
+
+typedef struct tapi_aud_factory tapi_aud_factory_t;
+
+/*
+   Sound stream descriptor.
+**/
+struct tapi_aud_stream
+{
+   /* Base*/
+   pjmedia_aud_stream   base;      /**< Base class.  */
+   /* Pool*/
+   pj_pool_t            *pool;     /**< Memory pool.       */
+   /* Common settings.*/
+   pjmedia_aud_param    param;     /**< Stream param.  */
+   pjmedia_aud_rec_cb   rec_cb;    /**< Record callback.   */
+   pjmedia_aud_play_cb  play_cb;   /**< Playback callback. */
+   void                *user_data; /**< Application data.  */
+
+   pj_thread_desc       thread_desc;
+   pj_thread_t         *thread;
+   tapi_ctx            *dev_ctx;
+   pj_uint8_t           run_flag;
+   pj_timestamp         timestamp;
+};
+
+typedef struct tapi_aud_stream tapi_aud_stream_t;
+
+/* Factory prototypes */
+static pj_status_t factory_init(pjmedia_aud_dev_factory *f);
+static pj_status_t factory_destroy(pjmedia_aud_dev_factory *f);
+static unsigned    factory_get_dev_count(pjmedia_aud_dev_factory *f);
+static pj_status_t factory_get_dev_info(pjmedia_aud_dev_factory *f,
+          unsigned index,
+          pjmedia_aud_dev_info *info);
+static pj_status_t factory_default_param(pjmedia_aud_dev_factory *f,
+           unsigned index,
+           pjmedia_aud_param *param);
+static pj_status_t factory_create_stream(pjmedia_aud_dev_factory *f,
+           const pjmedia_aud_param *param,
+           pjmedia_aud_rec_cb rec_cb,
+           pjmedia_aud_play_cb play_cb,
+           void *user_data,
+           pjmedia_aud_stream **p_aud_strm);
+
+/* Stream prototypes */
+static pj_status_t stream_get_param(pjmedia_aud_stream *strm,
+          pjmedia_aud_param *param);
+static pj_status_t stream_get_cap(pjmedia_aud_stream *strm,
+              pjmedia_aud_dev_cap cap,
+              void *value);
+static pj_status_t stream_set_cap(pjmedia_aud_stream *strm,
+              pjmedia_aud_dev_cap cap,
+              const void *value);
+static pj_status_t stream_start(pjmedia_aud_stream *strm);
+static pj_status_t stream_stop(pjmedia_aud_stream *strm);
+static pj_status_t stream_destroy(pjmedia_aud_stream *strm);
+
+static pjmedia_aud_dev_factory_op tapi_fact_op =
+  {
+      &factory_init,
+      &factory_destroy,
+      &factory_get_dev_count,
+      &factory_get_dev_info,
+      &factory_default_param,
+      &factory_create_stream
+  };
+
+static pjmedia_aud_stream_op tapi_strm_op =
+{
+    &stream_get_param,
+    &stream_get_cap,
+    &stream_set_cap,
+    &stream_start,
+    &stream_stop,
+    &stream_destroy
+};
+
+static pj_int32_t tapi_dev_open(char* dev_path, const pj_int32_t ch_num)
+{
+   char devname[128] = {0};
+
+   pj_ansi_sprintf(devname,"%s%u%u", dev_path, 1, ch_num);
+
+   return open((const char*)devname, O_RDWR, 0644);
+}
+
+static pj_status_t tapi_dev_binary_buffer_create(
+                     const char *pPath,
+                     pj_uint8_t **ppBuf,
+                     pj_uint32_t *pBufSz)
+{
+   pj_status_t status = PJ_SUCCESS;
+   FILE *fd;
+   struct stat file_stat;
+
+   /* Open binary file for reading*/
+   fd = fopen(pPath, "rb");
+   if (fd == NULL) {
+      TRACE_((THIS_FILE, "ERROR -  binary file %s open failed!\n", pPath));
+      return PJ_EUNKNOWN;
+   }
+
+   /* Get file statistics*/
+   if (stat(pPath, &file_stat) != 0) {
+      TRACE_((THIS_FILE, "ERROR -  file %s statistics get failed!\n", pPath));
+      return PJ_EUNKNOWN;
+   }
+
+   *ppBuf = malloc(file_stat.st_size);
+   if (*ppBuf == NULL) {
+      TRACE_((THIS_FILE, "ERROR -  binary file %s memory allocation failed!\n", pPath));
+      status = PJ_EUNKNOWN;
+
+      goto on_exit;
+   }
+
+   if (fread (*ppBuf, sizeof(pj_uint8_t), file_stat.st_size, fd) <= 0) {
+      TRACE_((THIS_FILE, "ERROR - file %s read failed!\n", pPath));
+      status = PJ_EUNKNOWN;
+
+      goto on_exit;
+   }
+
+   *pBufSz = file_stat.st_size; 
+
+on_exit:
+   if (fd != NULL) {
+      fclose(fd);
+   }
+
+   if (*ppBuf != NULL && status != PJ_SUCCESS) {
+      free(*ppBuf);
+   }
+
+   return status;
+}
+
+static void tapi_dev_binary_buffer_delete(pj_uint8_t *pBuf)
+{
+   if (pBuf != NULL)
+      free(pBuf);
+}
+
+static pj_status_t tapi_dev_firmware_download(
+                     pj_int32_t fd,
+                     const char *pPath)
+{
+   pj_status_t status = PJ_SUCCESS;
+   pj_uint8_t *pFirmware = NULL;
+   pj_uint32_t binSz = 0;
+   VMMC_IO_INIT vmmc_io_init;
+
+   /* Create binary buffer*/
+   status = tapi_dev_binary_buffer_create(pPath, &pFirmware, &binSz);
+   if (status != PJ_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR - binary buffer create failed!\n"));
+
+      return PJ_EUNKNOWN;
+   }
+
+   /* Download Voice Firmware*/
+   memset(&vmmc_io_init, 0, sizeof(VMMC_IO_INIT));
+   vmmc_io_init.pPRAMfw   = pFirmware;
+   vmmc_io_init.pram_size = binSz;
+
+   status = ioctl(fd, FIO_FW_DOWNLOAD, &vmmc_io_init);
+   if (status != PJ_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR -  FIO_FW_DOWNLOAD ioctl failed!"));
+   }
+
+   /* Delete binary buffer*/
+   tapi_dev_binary_buffer_delete(pFirmware);
+
+   return status;
+}
+
+
+static pj_status_t tapi_dev_start(tapi_aud_factory_t *f)
+{
+   pj_status_t status = PJ_SUCCESS;
+   pj_uint8_t c;
+   IFX_TAPI_DEV_START_CFG_t tapistart;
+   IFX_TAPI_MAP_DATA_t datamap;
+   IFX_TAPI_ENC_CFG_t enc_cfg;
+   IFX_TAPI_LINE_VOLUME_t vol;
+
+   /* Open device*/
+   f->dev_ctx.dev_fd = tapi_dev_open(TAPI_LL_DEV_BASE_PATH, 0);
+
+   if (f->dev_ctx.dev_fd < 0) {
+      TRACE_((THIS_FILE, "ERROR - TAPI device open failed!"));
+      return PJ_EUNKNOWN;
+   }
+
+   for (c = 0; c < TAPI_AUDIO_DEV_NUM; c++) {
+      f->dev_ctx.ch_fd[c] = tapi_dev_open(TAPI_LL_DEV_BASE_PATH, TAPI_AUDIO_MAX_DEV_NUM - c);
+
+      if (f->dev_ctx.dev_fd < 0) {
+         TRACE_((THIS_FILE, "ERROR - TAPI channel%d open failed!", c));
+         return PJ_EUNKNOWN;
+      }
+      
+      f->dev_ctx.data2phone_map[c] = c & 0x1 ? 0 : 1;
+   }
+
+   status = tapi_dev_firmware_download(f->dev_ctx.dev_fd, TAPI_LL_DEV_FIRMWARE_NAME);
+   if (status != PJ_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR - Voice Firmware Download failed!"));
+      return PJ_EUNKNOWN;
+   }
+
+   memset(&tapistart, 0x0, sizeof(IFX_TAPI_DEV_START_CFG_t));
+   tapistart.nMode = IFX_TAPI_INIT_MODE_VOICE_CODER;
+
+   /* Start TAPI*/
+   status = ioctl(f->dev_ctx.dev_fd, IFX_TAPI_DEV_START, &tapistart);
+   if (status != PJ_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR - IFX_TAPI_DEV_START ioctl failed"));
+      return PJ_EUNKNOWN;
+   }
+
+
+   for (c = 0; c < TAPI_AUDIO_DEV_NUM; c++) {
+      /* Perform mapping*/
+      memset(&datamap, 0x0, sizeof(IFX_TAPI_MAP_DATA_t));
+      datamap.nDstCh  = f->dev_ctx.data2phone_map[c];
+      datamap.nChType = IFX_TAPI_MAP_TYPE_PHONE;
+
+      status = ioctl(f->dev_ctx.ch_fd[c], IFX_TAPI_MAP_DATA_ADD, &datamap);
+
+      if (status != PJ_SUCCESS) {
+         TRACE_((THIS_FILE, "ERROR - IFX_TAPI_MAP_DATA_ADD ioctl failed"));
+         return PJ_EUNKNOWN;
+      }
+
+      /* Set Line feed*/
+      status = ioctl(f->dev_ctx.ch_fd[c], IFX_TAPI_LINE_FEED_SET, IFX_TAPI_LINE_FEED_STANDBY);
+
+      if (status != PJ_SUCCESS) {
+         TRACE_((THIS_FILE, "ERROR - IFX_TAPI_LINE_FEED_SET ioctl failed"));
+         return PJ_EUNKNOWN;
+      }
+
+      /* Config encoder for linear stream*/
+      memset(&enc_cfg, 0x0, sizeof(IFX_TAPI_ENC_CFG_t));
+
+      enc_cfg.nFrameLen = IFX_TAPI_COD_LENGTH_20;
+      enc_cfg.nEncType  = IFX_TAPI_COD_TYPE_LIN16_8;
+
+      status = ioctl(f->dev_ctx.ch_fd[c], IFX_TAPI_ENC_CFG_SET, &enc_cfg);
+      if (status != PJ_SUCCESS) {
+         TRACE_((THIS_FILE, "ERROR - IFX_TAPI_ENC_CFG_SET ioctl failed"));
+         return PJ_EUNKNOWN;
+      }
+
+
+      /* Suppress TAPI volume, otherwise PJSIP starts autogeneration!!!*/
+      vol.nGainRx = -8;
+      vol.nGainTx = -8;
+
+      status = ioctl(f->dev_ctx.ch_fd[c], IFX_TAPI_PHONE_VOLUME_SET, &vol);
+      if (status != PJ_SUCCESS) {
+         TRACE_((THIS_FILE, "ERROR - IFX_TAPI_PHONE_VOLUME_SET ioctl failed"));
+         return PJ_EUNKNOWN;
+      }
+   }
+
+
+   return status;
+}
+
+static pj_status_t tapi_dev_stop(tapi_aud_factory_t *f)
+{
+   pj_status_t status = PJ_SUCCESS;
+   pj_uint8_t c;
+   
+   /* Stop TAPI device*/
+   if (ioctl(f->dev_ctx.dev_fd, IFX_TAPI_DEV_STOP, 0) != PJ_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR - IFX_TAPI_DEV_STOP ioctl failed"));
+      status = PJ_EUNKNOWN;
+   }
+
+   /* Close device FD*/
+   close(f->dev_ctx.dev_fd);
+
+   /* Close channel FD*/
+   for (c = TAPI_AUDIO_DEV_NUM; c > 0; c--) {
+      close(f->dev_ctx.ch_fd[TAPI_AUDIO_DEV_NUM-c]);
+   }
+
+
+   return status;
+}
+
+static pj_status_t tapi_dev_codec_control(pj_int32_t fd, pj_uint8_t start)
+{
+   if (ioctl(fd, start ? IFX_TAPI_ENC_START : IFX_TAPI_ENC_STOP, 0) != PJ_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR - IFX_TAPI_ENC_%s ioctl failed!",
+         start ? "START" : "STOP"));
+
+      return PJ_EUNKNOWN;
+   }
+
+   if (ioctl(fd, start ? IFX_TAPI_DEC_START : IFX_TAPI_DEC_STOP, 0) != IFX_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR - IFX_TAPI_DEC_%s ioctl failed!",
+         start ? "START" : "STOP"));
+
+      return PJ_EUNKNOWN;
+   }
+
+   return PJ_SUCCESS;
+}
+
+static pj_status_t tapi_dev_event_ONHOOK(tapi_ctx *dev_ctx, pj_uint32_t dev_idx)
+{
+   PJ_LOG(1,(THIS_FILE, "TAPI: ONHOOK"));
+
+   if (ioctl(dev_ctx->ch_fd[dev_idx], IFX_TAPI_LINE_FEED_SET,
+               IFX_TAPI_LINE_FEED_STANDBY) != PJ_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR - IFX_TAPI_LINE_FEED_SET ioctl failed!"));
+
+      return PJ_EUNKNOWN;
+   }
+
+   /* enc/dec stop*/
+   if (tapi_dev_codec_control(dev_ctx->ch_fd[dev_idx], 0) != PJ_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR - codec start failed!"));
+
+      return PJ_EUNKNOWN;
+   }
+
+   return PJ_SUCCESS;
+}
+
+static pj_status_t tapi_dev_event_OFFHOOK(tapi_ctx *dev_ctx, pj_uint32_t dev_idx)
+{
+   PJ_LOG(1,(THIS_FILE, "TAPI: OFFHOOK"));
+
+   if (ioctl(dev_ctx->ch_fd[dev_idx], IFX_TAPI_LINE_FEED_SET,
+               IFX_TAPI_LINE_FEED_ACTIVE) != PJ_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR - IFX_TAPI_LINE_FEED_SET ioctl failed!"));
+
+      return PJ_EUNKNOWN;
+   }
+
+   /* enc/dec stop*/
+   if (tapi_dev_codec_control(dev_ctx->ch_fd[dev_idx], 1) != PJ_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR - codec start failed!"));
+
+      return PJ_EUNKNOWN;
+   }
+
+   return PJ_SUCCESS;
+}
+
+static pj_status_t tapi_dev_event_handler(
+                     tapi_aud_stream_t *stream)
+{
+   tapi_ctx *dev_ctx = stream->dev_ctx;
+   pj_uint32_t dev_idx = stream->param.rec_id;
+   pj_status_t status = PJ_SUCCESS;
+   IFX_TAPI_EVENT_t tapiEvent;
+
+   memset (&tapiEvent, 0, sizeof(tapiEvent));
+
+   tapiEvent.ch = dev_ctx->data2phone_map[dev_idx];
+
+   /* Get event*/
+   status = ioctl(dev_ctx->dev_fd, IFX_TAPI_EVENT_GET, &tapiEvent);
+
+   if ((status == PJ_SUCCESS) && (tapiEvent.id != IFX_TAPI_EVENT_NONE)) {
+      switch(tapiEvent.id) {
+         case IFX_TAPI_EVENT_FXS_ONHOOK:
+            status = tapi_dev_event_ONHOOK(dev_ctx, dev_idx);
+            break;
+         case IFX_TAPI_EVENT_FXS_OFFHOOK:
+            status = tapi_dev_event_OFFHOOK(dev_ctx, dev_idx);
+            break;
+         default:
+            break;
+      }
+   }
+
+   return status;
+}
+
+static pj_status_t tapi_dev_data_handler(
+                     tapi_aud_stream_t *stream)
+{
+   pj_status_t status = PJ_SUCCESS;
+   tapi_ctx *dev_ctx = stream->dev_ctx;
+   pj_uint32_t dev_idx = stream->param.rec_id;
+   pj_uint8_t buf_rec[TAPI_LL_DEV_ENC_BYTES_PER_FRAME + TAPI_LL_DEV_RTP_HEADER_SIZE_BYTE]={0};
+   pj_uint8_t buf_play[TAPI_LL_DEV_ENC_BYTES_PER_FRAME + TAPI_LL_DEV_RTP_HEADER_SIZE_BYTE]={0};
+   pjmedia_frame frame_rec, frame_play;
+   pj_int32_t ret;
+
+   /* Get data from driver*/
+   ret = read(dev_ctx->ch_fd[dev_idx], buf_rec, sizeof(buf_rec));
+   if (ret < 0) {
+      TRACE_((THIS_FILE, "ERROR - no data available from device!"));
+
+      return PJ_EUNKNOWN;
+   }
+
+   if (ret > 0) {
+      frame_rec.type = PJMEDIA_FRAME_TYPE_AUDIO;
+      frame_rec.buf  = buf_rec + TAPI_LL_DEV_RTP_HEADER_SIZE_BYTE;
+      frame_rec.size = ret - TAPI_LL_DEV_RTP_HEADER_SIZE_BYTE;
+      frame_rec.timestamp.u64 = stream->timestamp.u64;
+
+      status = stream->rec_cb(stream->user_data, &frame_rec);
+      if (status != PJ_SUCCESS)
+      {
+        PJ_LOG(1, (THIS_FILE, "rec_cb() failed %d", status));
+      }
+
+      frame_play.type = PJMEDIA_FRAME_TYPE_AUDIO;
+      frame_play.buf  = buf_play + TAPI_LL_DEV_RTP_HEADER_SIZE_BYTE;
+      frame_play.size = TAPI_LL_DEV_ENC_BYTES_PER_FRAME;
+      frame_play.timestamp.u64 = stream->timestamp.u64;
+
+      status = (*stream->play_cb)(stream->user_data, &frame_play);
+      if (status != PJ_SUCCESS)
+      {
+         PJ_LOG(1, (THIS_FILE, "play_cb() failed %d", status));
+      }
+      else
+      {
+         memcpy(buf_play, buf_rec, TAPI_LL_DEV_RTP_HEADER_SIZE_BYTE);
+
+         ret = write(dev_ctx->ch_fd[dev_idx], buf_play, sizeof(buf_play));
+
+         if (ret < 0) {
+            PJ_LOG(1, (THIS_FILE, "ERROR - device data writing failed!"));
+            return PJ_EUNKNOWN;
+         }
+
+         if (ret == 0) {
+            PJ_LOG(1, (THIS_FILE, "ERROR - no data written to device!"));
+            return PJ_EUNKNOWN;
+         }
+      }
+
+      stream->timestamp.u64 += TAPI_LL_DEV_ENC_SMPL_PER_FRAME;
+   }
+
+   return PJ_SUCCESS;
+}
+
+/* TAPI capture and playback thread. */
+static int PJ_THREAD_FUNC tapi_dev_thread(void *arg)
+{
+   tapi_aud_stream_t *strm = (struct tapi_aud_stream*)arg;
+   tapi_ctx *dev_ctx = strm->dev_ctx;
+   fd_set rfds, trfds;
+   pj_uint32_t width = 0;
+   struct timeval tv;
+   pj_uint32_t sretval;
+   pj_uint32_t dev_idx;
+
+   PJ_LOG(1,(THIS_FILE, "TAPI: thread starting..."));
+
+   if (strm->param.rec_id != strm->param.play_id) {
+      PJ_LOG(1,(THIS_FILE, "TAPI: thread exit - incorrect play/rec IDs"));
+      return 0;
+   }
+
+   dev_idx = strm->param.rec_id;
+
+   FD_ZERO(&rfds);
+
+   FD_SET(dev_ctx->dev_fd, &rfds);
+   width = FD_WIDTH_SET(dev_ctx->dev_fd, width);
+
+   FD_SET(dev_ctx->ch_fd[dev_idx], &rfds);
+   width = FD_WIDTH_SET(dev_ctx->ch_fd[dev_idx], width);
+
+   tv.tv_sec = TAPI_LL_DEV_SELECT_TIMEOUT_MS / 1000;
+   tv.tv_usec = (TAPI_LL_DEV_SELECT_TIMEOUT_MS % 1000) * 1000; 
+
+   strm->run_flag = 1;
+
+   while(1)
+   {
+      /* Update the local file descriptor by the copy in the task parameter */
+      memcpy((void *) &trfds, (void*) &rfds, sizeof(fd_set));
+
+      sretval = select(width + 1, &trfds, NULL, NULL, &tv); 
+
+      if (!strm->run_flag) {
+         break;
+      }
+
+      /* error or timeout on select */
+      if (sretval <= 0) {
+         continue;
+      }
+
+      /* Check device control channel*/
+      if (FD_ISSET(dev_ctx->dev_fd, &trfds)) {
+         if (tapi_dev_event_handler(strm) != PJ_SUCCESS) {
+            PJ_LOG(1,(THIS_FILE, "TAPI: event hanldler failed!"));
+            break;
+         }
+      }
+
+      /* Check device data channel*/
+      if (FD_ISSET(dev_ctx->ch_fd[dev_idx], &trfds)) {
+         if (tapi_dev_data_handler(strm) != PJ_SUCCESS) {
+            PJ_LOG(1,(THIS_FILE, "TAPI: data hanldler failed!"));
+            break;
+         }
+      }
+   }
+
+   PJ_LOG(1,(THIS_FILE, "TAPI: thread stopping..."));
+
+   return 0;
+}
+
+/****************************************************************************
+ Factory operations
+ ****************************************************************************/
+
+/*  Init tapi audio driver. */
+pjmedia_aud_dev_factory* pjmedia_tapi_factory(pj_pool_factory *pf)
+{
+    struct tapi_aud_factory *f;
+    pj_pool_t *pool;
+
+    TRACE_((THIS_FILE, "pjmedia_tapi_factory()"));
+
+    pool = pj_pool_create(pf, "tapi", 512, 512, NULL);
+    f = PJ_POOL_ZALLOC_T(pool, struct tapi_aud_factory);
+    f->pf = pf;
+    f->pool = pool;
+    f->base.op = &tapi_fact_op;
+
+    return &f->base;
+}
+
+/* API: init factory */
+static pj_status_t factory_init(pjmedia_aud_dev_factory *f)
+{
+   struct tapi_aud_factory *af = (struct tapi_aud_factory*)f;
+   pj_uint8_t c;
+
+   TRACE_((THIS_FILE, "factory_init()"));
+
+   /* Enumerate sound devices */
+   af->dev_count = TAPI_AUDIO_DEV_NUM;
+
+   af->dev_info = (pjmedia_aud_dev_info*)
+         pj_pool_calloc(af->pool, af->dev_count, sizeof(pjmedia_aud_dev_info));
+
+   for (c = 0; c < af->dev_count; c++) {
+      pj_ansi_sprintf(af->dev_info[c].name,"%s_%02d", TAPI_BASE_NAME, c);
+
+      af->dev_info[c].input_count = af->dev_info[c].output_count = 1;
+      af->dev_info[c].default_samples_per_sec = TAPI_LL_DEV_ENC_SMPL_PER_SEC;
+      pj_ansi_strcpy(af->dev_info[c].driver, "/dev/vmmc");
+
+      af->dev_info[c].caps = PJMEDIA_AUD_DEV_CAP_OUTPUT_VOLUME_SETTING |
+                             PJMEDIA_AUD_DEV_CAP_OUTPUT_LATENCY |
+                             PJMEDIA_AUD_DEV_CAP_INPUT_LATENCY;
+
+      af->dev_info[c].routes = PJMEDIA_AUD_DEV_ROUTE_DEFAULT ;
+   }
+
+   /* Initialize TAPI device(s)*/
+   if (tapi_dev_start(af) != PJ_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR - TAPI device init failed!"));
+      return PJ_EUNKNOWN;
+   }
+
+   return PJ_SUCCESS;
+}
+
+/* API: destroy factory */
+static pj_status_t factory_destroy(pjmedia_aud_dev_factory *f)
+{
+   struct tapi_aud_factory *af = (struct tapi_aud_factory*)f;
+   pj_pool_t *pool;
+   pj_status_t status = PJ_SUCCESS;
+
+   TRACE_((THIS_FILE, "factory_destroy()"));
+
+   /* Stop TAPI device*/
+   if (tapi_dev_stop(f) != PJ_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR - TAPI device stop failed!"));
+      status = PJ_EUNKNOWN;
+   }
+
+   pool = af->pool;
+   af->pool = NULL;
+   pj_pool_release(pool);
+
+   return status;
+}
+
+/* API: get number of devices */
+static unsigned factory_get_dev_count(pjmedia_aud_dev_factory *f)
+{
+  struct tapi_aud_factory *af = (struct tapi_aud_factory*)f;
+  TRACE_((THIS_FILE, "factory_get_dev_count()"));
+
+  return af->dev_count;
+}
+
+/* API: get device info */
+static pj_status_t factory_get_dev_info(pjmedia_aud_dev_factory *f,
+          unsigned index,
+          pjmedia_aud_dev_info *info)
+{
+  struct tapi_aud_factory *af = (struct tapi_aud_factory*)f;
+
+  TRACE_((THIS_FILE, "factory_get_dev_info()"));
+  PJ_ASSERT_RETURN(index < af->dev_count, PJMEDIA_EAUD_INVDEV);
+
+  pj_memcpy(info, &af->dev_info[index], sizeof(*info));
+
+  return PJ_SUCCESS;
+}
+
+/* API: create default device parameter */
+static pj_status_t factory_default_param(pjmedia_aud_dev_factory *f,
+           unsigned index,
+           pjmedia_aud_param *param)
+{
+  struct tapi_aud_factory *af = (struct tapi_aud_factory*)f;
+  struct pjmedia_aud_dev_info *di = &af->dev_info[index];
+
+  TRACE_((THIS_FILE, "factory_default_param."));
+  PJ_ASSERT_RETURN(index < af->dev_count, PJMEDIA_EAUD_INVDEV);
+
+  pj_bzero(param, sizeof(*param));
+  if (di->input_count && di->output_count) {
+    param->dir = PJMEDIA_DIR_CAPTURE_PLAYBACK;
+    param->rec_id = index;
+    param->play_id = index;
+  } else if (di->input_count) {
+    param->dir = PJMEDIA_DIR_CAPTURE;
+    param->rec_id = index;
+    param->play_id = PJMEDIA_AUD_INVALID_DEV;
+  } else if (di->output_count) {
+    param->dir = PJMEDIA_DIR_PLAYBACK;
+    param->play_id = index;
+    param->rec_id = PJMEDIA_AUD_INVALID_DEV;
+  } else {
+    return PJMEDIA_EAUD_INVDEV;
+  }
+
+  param->clock_rate        = di->default_samples_per_sec;
+  param->channel_count     = 1;
+  param->samples_per_frame = TAPI_LL_DEV_ENC_SMPL_PER_FRAME;
+  param->bits_per_sample   = TAPI_LL_DEV_ENC_BITS_PER_SMPLS;
+  param->flags             = PJMEDIA_AUD_DEV_CAP_OUTPUT_ROUTE | di->caps;
+  param->output_route      = PJMEDIA_AUD_DEV_ROUTE_DEFAULT;
+
+  return PJ_SUCCESS;
+}
+
+/* API: create stream */
+static pj_status_t factory_create_stream(pjmedia_aud_dev_factory *f,
+           const pjmedia_aud_param *param,
+           pjmedia_aud_rec_cb rec_cb,
+           pjmedia_aud_play_cb play_cb,
+           void *user_data,
+           pjmedia_aud_stream **p_aud_strm)
+{
+   struct tapi_aud_factory *af = (struct tapi_aud_factory*)f;
+   pj_pool_t *pool;
+   struct tapi_aud_stream *strm;
+   pj_status_t status;
+
+   TRACE_((THIS_FILE, "factory_create_stream()"));
+
+   /* Can only support 16bits per sample */
+   PJ_ASSERT_RETURN(param->bits_per_sample == TAPI_LL_DEV_ENC_BITS_PER_SMPLS, PJ_EINVAL);
+
+   PJ_ASSERT_RETURN(param->clock_rate == TAPI_LL_DEV_ENC_SMPL_PER_SEC, PJ_EINVAL);
+
+   PJ_ASSERT_RETURN(param->samples_per_frame == TAPI_LL_DEV_ENC_SMPL_PER_FRAME, PJ_EINVAL);
+
+   /* Can only support bidirectional stream */
+   PJ_ASSERT_RETURN(param->dir & PJMEDIA_DIR_CAPTURE_PLAYBACK, PJ_EINVAL);
+
+   /* Initialize our stream data */
+   pool = pj_pool_create(af->pf, "tapi-dev", 1000, 1000, NULL);
+   PJ_ASSERT_RETURN(pool != NULL, PJ_ENOMEM);
+
+   strm = PJ_POOL_ZALLOC_T(pool, struct tapi_aud_stream);
+   strm->pool      = pool;
+   strm->rec_cb    = rec_cb;
+   strm->play_cb   = play_cb;
+   strm->user_data = user_data;
+   pj_memcpy(&strm->param, param, sizeof(*param));
+
+   if ((strm->param.flags & PJMEDIA_AUD_DEV_CAP_EXT_FORMAT) == 0) {
+      strm->param.ext_fmt.id = PJMEDIA_FORMAT_L16;
+   }
+
+   strm->timestamp.u64 = 0;
+   strm->dev_ctx = &(af->dev_ctx);
+
+   /* Create and start the thread */
+   status = pj_thread_create(pool, "tapi", &tapi_dev_thread, strm, 0, 0, 
+			      &strm->thread);
+   if (status != PJ_SUCCESS) {
+      stream_destroy(&strm->base);
+      return status;
+   }
+
+   /* Done */
+   strm->base.op = &tapi_strm_op;
+   *p_aud_strm = &strm->base;
+
+   return PJ_SUCCESS;
+}
+
+/****************************************************************************
+ * Stream operations
+ */
+/* API: Get stream info. */
+static pj_status_t stream_get_param(pjmedia_aud_stream *s,
+                                    pjmedia_aud_param *pi)
+{
+  struct tapi_aud_stream *strm = (struct tapi_aud_stream*)s;
+
+  PJ_ASSERT_RETURN(strm && pi, PJ_EINVAL);
+
+  pj_memcpy(pi, &strm->param, sizeof(*pi));
+  /* Update the volume setting */
+  if (stream_get_cap(s, PJMEDIA_AUD_DEV_CAP_OUTPUT_VOLUME_SETTING,
+        &pi->output_vol) == PJ_SUCCESS)
+  {
+    pi->flags |= PJMEDIA_AUD_DEV_CAP_OUTPUT_VOLUME_SETTING;
+  }
+
+  if (stream_get_cap(s, PJMEDIA_AUD_DEV_CAP_OUTPUT_LATENCY,
+        &pi->output_latency_ms) == PJ_SUCCESS)
+  {
+    pi->flags |= PJMEDIA_AUD_DEV_CAP_OUTPUT_LATENCY;
+  }
+
+  if (stream_get_cap(s, PJMEDIA_AUD_DEV_CAP_INPUT_LATENCY,
+        &pi->input_latency_ms) == PJ_SUCCESS)
+  {
+    pi->flags |= PJMEDIA_AUD_DEV_CAP_INPUT_LATENCY;
+  }
+
+  return PJ_SUCCESS;
+}
+
+/* API: get capability */
+static pj_status_t stream_get_cap(pjmedia_aud_stream *s,
+          pjmedia_aud_dev_cap cap,
+          void *pval)
+{
+  struct tapi_aud_stream *strm = (struct tapi_aud_stream*)s;
+#ifdef OLD_IMPL
+  OSStatus status = 0;
+  PJ_ASSERT_RETURN(strm && pval, PJ_EINVAL);
+
+  if (cap==PJMEDIA_AUD_DEV_CAP_OUTPUT_VOLUME_SETTING && strm->play_strm->queue)
+  {
+    Float32 vol;
+    status = AudioQueueGetParameter(strm->play_strm->queue,
+                                    kAudioQueueParam_Volume, &vol);
+    if (!status)
+    {
+      *(unsigned*)pval = (vol * 100);
+      return PJ_SUCCESS;
+    }
+  }
+  else if (cap==PJMEDIA_AUD_DEV_CAP_OUTPUT_LATENCY && strm->play_strm->queue)
+  {
+    Float32 lat;
+    UInt32 size = sizeof(lat);
+    status = AudioSessionGetProperty(kAudioSessionProperty_CurrentHardwareOutputLatency,
+                                     &size, &lat);
+    if (!status)
+    {
+      *(unsigned*)pval = lat * 1000;
+      return PJ_SUCCESS;
+    }
+  }
+  else if (cap==PJMEDIA_AUD_DEV_CAP_OUTPUT_ROUTE && strm->play_strm->queue)
+  {
+    *(pjmedia_aud_dev_route*)pval = strm->param.output_route;
+    return PJ_SUCCESS;
+  }
+  else if (cap==PJMEDIA_AUD_DEV_CAP_INPUT_LATENCY && strm->rec_strm->queue)
+  {
+    Float32 lat;
+    UInt32 size = sizeof(lat);
+    status = AudioSessionGetProperty(kAudioSessionProperty_CurrentHardwareInputLatency,
+                                     &size, &lat);
+    if (!status)
+    {
+      *(unsigned*)pval = lat * 1000;
+      return PJ_SUCCESS;
+    }
+  }
+
+  if (status)
+    PJ_LOG(1, (THIS_FILE, "AudioQueueGetParameter/AudioSessionGetProperty err %d", status));
+  return PJMEDIA_EAUD_INVCAP;
+#else
+  return PJ_SUCCESS;
+#endif
+}
+
+/* API: set capability */
+static pj_status_t stream_set_cap(pjmedia_aud_stream *s,
+          pjmedia_aud_dev_cap cap,
+          const void *pval)
+{
+  struct tapi_aud_stream *strm = (struct tapi_aud_stream*)s;
+#ifdef OLD_IMPL
+  OSStatus status = 0;
+  PJ_ASSERT_RETURN(strm && pval, PJ_EINVAL);
+
+  if (strm->play_strm->queue)
+    switch (cap)
+    {
+      case PJMEDIA_AUD_DEV_CAP_OUTPUT_VOLUME_SETTING:
+      {
+        /* Output volume setting */
+        unsigned vol = *(unsigned*)pval;
+        Float32 volume;
+
+        if (vol > 100)
+          vol = 100;
+        volume = vol / 100.;
+        status = AudioQueueSetParameter(strm->play_strm->queue, kAudioQueueParam_Volume,
+                                        volume);
+        if (!status)
+        {
+          PJ_LOG(1, (THIS_FILE, "AudioQueueSetParameter err %d", status));
+          return PJMEDIA_EAUD_SYSERR;
+        }
+        strm->param.output_vol = *(unsigned*)pval;
+        return PJ_SUCCESS;
+      }
+      case PJMEDIA_AUD_DEV_CAP_OUTPUT_ROUTE:
+      {
+        pjmedia_aud_dev_route r = *(const pjmedia_aud_dev_route*)pval;
+        UInt32 route = (r == PJMEDIA_AUD_DEV_ROUTE_LOUDSPEAKER ?
+            kAudioSessionOverrideAudioRoute_Speaker :
+            kAudioSessionOverrideAudioRoute_None);
+
+        status = AudioSessionSetProperty (kAudioSessionProperty_OverrideAudioRoute,
+                                          sizeof(route), &route);
+        if (status)
+        {
+          PJ_LOG(1, (THIS_FILE, "AudioSessionSetProperty err %d", status));
+          return PJMEDIA_EAUD_SYSERR;
+        }
+        strm->param.output_route = r;
+        return PJ_SUCCESS;
+      }
+      default:
+        return PJMEDIA_EAUD_INVCAP;
+    }
+
+
+  return PJMEDIA_EAUD_INVCAP;
+#else
+  return PJ_SUCCESS;
+#endif
+}
+
+/* API: Start stream. */
+static pj_status_t stream_start(pjmedia_aud_stream *s)
+{
+   struct tapi_aud_stream *strm = (struct tapi_aud_stream*)s;
+   tapi_ctx *dev_ctx = strm->dev_ctx;
+   pj_uint32_t dev_idx;
+
+   TRACE_((THIS_FILE, "stream_start()"));
+
+   dev_idx = strm->param.rec_id;
+
+   return PJ_SUCCESS;
+}
+
+/* API: Stop stream. */
+static pj_status_t stream_stop(pjmedia_aud_stream *s)
+{
+   struct tapi_aud_stream *strm = (struct tapi_aud_stream*)s;
+   tapi_ctx *dev_ctx = strm->dev_ctx;
+   pj_uint32_t dev_idx;
+
+   TRACE_((THIS_FILE, "stream_stop()"));
+
+   dev_idx = strm->param.rec_id;
+
+   /* enc/dec stop*/
+   if (tapi_dev_codec_control(dev_ctx->ch_fd[dev_idx], 0) != PJ_SUCCESS) {
+      TRACE_((THIS_FILE, "ERROR - codec start failed!"));
+
+      return PJ_EUNKNOWN;
+   }
+
+   return PJ_SUCCESS;
+}
+
+/* API: Destroy stream. */
+static pj_status_t stream_destroy(pjmedia_aud_stream *s)
+{
+   pj_status_t state = PJ_SUCCESS;
+   struct tapi_aud_stream *stream = (struct tapi_aud_stream*)s;
+   pj_pool_t *pool;
+
+   PJ_ASSERT_RETURN(stream != NULL, PJ_EINVAL);
+
+   TRACE_((THIS_FILE, "stream_destroy()"));
+
+   stream_stop(stream);
+
+   stream->run_flag = 0;
+
+   /* Stop the stream thread */
+   if (stream->thread)
+   {
+      pj_thread_join(stream->thread);
+      pj_thread_destroy(stream->thread);
+      stream->thread = NULL;
+   }
+
+   pool = stream->pool;
+   pj_bzero(stream, sizeof(stream));
+   pj_pool_release(pool);
+
+   return state;
+}
+
+#endif /* PJMEDIA_AUDIO_DEV_HAS_TAPI_DEVICE */