camera/QCamera/stack/mm-camera-interface/src/mm_camera_thread.c - device/lge/hammerhead - Git at Google

 /*
 Copyright (c) 2012, The Linux Foundation. All rights reserved.

 Redistribution and use in source and binary forms, with or without
 modification, are permitted provided that the following conditions are
 met:
     * Redistributions of source code must retain the above copyright
       notice, this list of conditions and the following disclaimer.
     * Redistributions in binary form must reproduce the above
       copyright notice, this list of conditions and the following
       disclaimer in the documentation and/or other materials provided
       with the distribution.
     * Neither the name of The Linux Foundation nor the names of its
       contributors may be used to endorse or promote products derived
       from this software without specific prior written permission.

 THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
 WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
 MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
 ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
 BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
 BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
 WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
 OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
 IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

 #include <pthread.h>
 #include <errno.h>
 #include <stdbool.h>
 #include <sys/ioctl.h>
 #include <sys/types.h>
 #include <sys/stat.h>
 #include <fcntl.h>
 #include <poll.h>
 #include <semaphore.h>

 #include "mm_camera_dbg.h"
 #include "mm_camera_interface.h"
 #include "mm_camera.h"

 typedef enum {
     /* poll entries updated */
     MM_CAMERA_PIPE_CMD_POLL_ENTRIES_UPDATED,
     /* exit */
     MM_CAMERA_PIPE_CMD_EXIT,
     /* max count */
     MM_CAMERA_PIPE_CMD_MAX
 } mm_camera_pipe_cmd_type_t;

 typedef enum {
     MM_CAMERA_POLL_TASK_STATE_STOPPED,
     MM_CAMERA_POLL_TASK_STATE_POLL,     /* polling pid in polling state. */
     MM_CAMERA_POLL_TASK_STATE_MAX
 } mm_camera_poll_task_state_type_t;

 typedef struct {
     uint8_t cmd;
     mm_camera_event_t event;
 } mm_camera_sig_evt_t;

 static int32_t mm_camera_poll_sig(mm_camera_poll_thread_t *poll_cb,
                                   uint32_t cmd)
 {
     /* send through pipe */
     /* get the mutex */
     mm_camera_sig_evt_t cmd_evt;
     int len;

     CDBG("%s: E cmd = %d", __func__,cmd);
     memset(&cmd_evt, 0, sizeof(cmd_evt));
     cmd_evt.cmd = cmd;
     pthread_mutex_lock(&poll_cb->mutex);
     /* reset the statue to false */
     poll_cb->status = false;
     /* send cmd to worker */

     len = write(poll_cb->pfds[1], &cmd_evt, sizeof(cmd_evt));
     if(len < 1) {
         CDBG_ERROR("%s: len = %d, errno = %d", __func__, len, errno);
     }
     CDBG("%s: begin IN mutex write done, len = %d", __func__, len);
     /* wait till worker task gives positive signal */
     if (false == poll_cb->status) {
         CDBG("%s: wait", __func__);
         pthread_cond_wait(&poll_cb->cond_v, &poll_cb->mutex);
     }
     /* done */
     pthread_mutex_unlock(&poll_cb->mutex);
     CDBG("%s: X", __func__);
     return 0;
 }

 static void mm_camera_poll_sig_done(mm_camera_poll_thread_t *poll_cb)
 {
     pthread_mutex_lock(&poll_cb->mutex);
     poll_cb->status = true;
     pthread_cond_signal(&poll_cb->cond_v);
     CDBG("%s: done, in mutex", __func__);
     pthread_mutex_unlock(&poll_cb->mutex);
 }

 static void mm_camera_poll_set_state(mm_camera_poll_thread_t *poll_cb,
                                      mm_camera_poll_task_state_type_t state)
 {
     poll_cb->state = state;
 }

 static void mm_camera_poll_proc_pipe(mm_camera_poll_thread_t *poll_cb)
 {
     ssize_t read_len;
     int i;
     mm_camera_sig_evt_t cmd_evt;
     read_len = read(poll_cb->pfds[0], &cmd_evt, sizeof(cmd_evt));
     CDBG("%s: read_fd = %d, read_len = %d, expect_len = %d cmd = %d",
          __func__, poll_cb->pfds[0], (int)read_len, (int)sizeof(cmd_evt), cmd_evt.cmd);
     switch (cmd_evt.cmd) {
     case MM_CAMERA_PIPE_CMD_POLL_ENTRIES_UPDATED:
         /* we always have index 0 for pipe read */
         poll_cb->num_fds = 0;
         poll_cb->poll_fds[poll_cb->num_fds].fd = poll_cb->pfds[0];
         poll_cb->poll_fds[poll_cb->num_fds].events = POLLIN|POLLRDNORM|POLLPRI;
         poll_cb->num_fds++;

         if (MM_CAMERA_POLL_TYPE_EVT == poll_cb->poll_type) {
             if (poll_cb->poll_entries[0].fd > 0) {
                 /* fd is valid, we update poll_fds */
                 poll_cb->poll_fds[poll_cb->num_fds].fd = poll_cb->poll_entries[0].fd;
                 poll_cb->poll_fds[poll_cb->num_fds].events = POLLIN|POLLRDNORM|POLLPRI;
                 poll_cb->num_fds++;
             }
         } else if (MM_CAMERA_POLL_TYPE_CH == poll_cb->poll_type) {
             for(i = 0; i < MM_CAMEAR_STRAEM_NUM_MAX; i++) {
                 if(poll_cb->poll_entries[i].fd > 0) {
                     /* fd is valid, we update poll_fds to this fd */
                     poll_cb->poll_fds[poll_cb->num_fds].fd = poll_cb->poll_entries[i].fd;
                     poll_cb->poll_fds[poll_cb->num_fds].events = POLLIN|POLLRDNORM|POLLPRI;
                     poll_cb->num_fds++;
                 } else {
                     /* fd is invalid, we set the entry to -1 to prevent polling.
                      * According to spec, polling will not poll on entry with fd=-1.
                      * If this is not the case, we need to skip these invalid fds
                      * when updating this array.
                      * We still keep fd=-1 in this array because this makes easier to
                      * map cb associated with this fd once incoming data avail by directly
                      * using the index-1(0 is reserved for pipe read, so need to reduce index by 1) */
                     poll_cb->poll_fds[poll_cb->num_fds].fd = -1;
                     poll_cb->poll_fds[poll_cb->num_fds].events = 0;
                     poll_cb->num_fds++;
                 }
             }
         }
         mm_camera_poll_sig_done(poll_cb);
         break;

     case MM_CAMERA_PIPE_CMD_EXIT:
     default:
         mm_camera_poll_set_state(poll_cb, MM_CAMERA_POLL_TASK_STATE_STOPPED);
         mm_camera_poll_sig_done(poll_cb);
         break;
     }
 }

 static void *mm_camera_poll_fn(mm_camera_poll_thread_t *poll_cb)
 {
     int rc = 0, i;

     CDBG("%s: poll type = %d, num_fd = %d poll_cb = %p\n",
          __func__, poll_cb->poll_type, poll_cb->num_fds,poll_cb);
     do {
          for(i = 0; i < poll_cb->num_fds; i++) {
             poll_cb->poll_fds[i].events = POLLIN|POLLRDNORM|POLLPRI;
          }

          rc = poll(poll_cb->poll_fds, poll_cb->num_fds, poll_cb->timeoutms);
          if(rc > 0) {
             if ((poll_cb->poll_fds[0].revents & POLLIN) &&
                 (poll_cb->poll_fds[0].revents & POLLRDNORM)) {
                 /* if we have data on pipe, we only process pipe in this iteration */
                 CDBG("%s: cmd received on pipe\n", __func__);
                 mm_camera_poll_proc_pipe(poll_cb);
             } else {
                 for(i=1; i<poll_cb->num_fds; i++) {
                     /* Checking for ctrl events */
                     if ((poll_cb->poll_type == MM_CAMERA_POLL_TYPE_EVT) &&
                         (poll_cb->poll_fds[i].revents & POLLPRI)) {
                         CDBG("%s: mm_camera_evt_notify\n", __func__);
                         if (NULL != poll_cb->poll_entries[i-1].notify_cb) {
                             poll_cb->poll_entries[i-1].notify_cb(poll_cb->poll_entries[i-1].user_data);
                         }
                     }

                     if ((poll_cb->poll_type == MM_CAMERA_POLL_TYPE_CH) &&
                         (poll_cb->poll_fds[i].revents & POLLIN) &&
                         (poll_cb->poll_fds[i].revents & POLLRDNORM)) {
                         CDBG("%s: mm_stream_data_notify\n", __func__);
                         if (NULL != poll_cb->poll_entries[i-1].notify_cb) {
                             poll_cb->poll_entries[i-1].notify_cb(poll_cb->poll_entries[i-1].user_data);
                         }
                     }
                 }
             }
         } else {
             /* in error case sleep 10 us and then continue. hard coded here */
             usleep(10);
             continue;
         }
     } while (poll_cb->state == MM_CAMERA_POLL_TASK_STATE_POLL);
     return NULL;
 }

 static void *mm_camera_poll_thread(void *data)
 {
     int rc = 0;
     int i;
     void *ret = NULL;
     mm_camera_poll_thread_t *poll_cb = (mm_camera_poll_thread_t *)data;

     /* add pipe read fd into poll first */
     poll_cb->poll_fds[poll_cb->num_fds++].fd = poll_cb->pfds[0];

     //poll_cb->poll_fds[poll_cb->num_fds++].fd = (((mm_camera_obj_t *)poll_cb->my_obj)->ctrl_fd);

     mm_camera_poll_sig_done(poll_cb);
     mm_camera_poll_set_state(poll_cb, MM_CAMERA_POLL_TASK_STATE_POLL);
     ret = mm_camera_poll_fn(poll_cb);
     return ret;
 }

 int32_t mm_camera_poll_thread_notify_entries_updated(mm_camera_poll_thread_t * poll_cb)
 {
     /* send poll entries updated signal to poll thread */
     return mm_camera_poll_sig(poll_cb, MM_CAMERA_PIPE_CMD_POLL_ENTRIES_UPDATED);
 }

 int32_t mm_camera_poll_thread_add_poll_fd(mm_camera_poll_thread_t * poll_cb,
                                           uint32_t handler,
                                           int32_t fd,
                                           mm_camera_poll_notify_t notify_cb,
                                           void* userdata)
 {
     int32_t rc = -1;
     uint8_t idx = 0;

     if (MM_CAMERA_POLL_TYPE_CH == poll_cb->poll_type) {
         /* get stream idx from handler if CH type */
         idx = mm_camera_util_get_index_by_handler(handler);
     } else {
         /* for EVT type, only idx=0 is valid */
         idx = 0;
     }

     if (MM_CAMEAR_STRAEM_NUM_MAX > idx) {
         poll_cb->poll_entries[idx].fd = fd;
         poll_cb->poll_entries[idx].handler = handler;
         poll_cb->poll_entries[idx].notify_cb = notify_cb;
         poll_cb->poll_entries[idx].user_data = userdata;
         /* send poll entries updated signal to poll thread */
         rc = mm_camera_poll_sig(poll_cb, MM_CAMERA_PIPE_CMD_POLL_ENTRIES_UPDATED);
     } else {
         CDBG_ERROR("%s: invalid handler %d (%d)",
                    __func__, handler, idx);
     }
     return rc;
 }

 int32_t mm_camera_poll_thread_del_poll_fd(mm_camera_poll_thread_t * poll_cb,
                                           uint32_t handler)
 {
     int32_t rc = -1;
     uint8_t idx = 0;

     if (MM_CAMERA_POLL_TYPE_CH == poll_cb->poll_type) {
         /* get stream idx from handler if CH type */
         idx = mm_camera_util_get_index_by_handler(handler);
     } else {
         /* for EVT type, only idx=0 is valid */
         idx = 0;
     }

     if ((MM_CAMEAR_STRAEM_NUM_MAX > idx) &&
         (handler == poll_cb->poll_entries[idx].handler)) {
         /* reset poll entry */
         poll_cb->poll_entries[idx].fd = -1; /* set fd to invalid */
         poll_cb->poll_entries[idx].handler = 0;
         poll_cb->poll_entries[idx].notify_cb = NULL;

         /* send poll entries updated signal to poll thread */
         rc = mm_camera_poll_sig(poll_cb, MM_CAMERA_PIPE_CMD_POLL_ENTRIES_UPDATED);
     } else {
         CDBG_ERROR("%s: invalid handler %d (%d)",
                    __func__, handler, idx);
     }

     return rc;
 }

 int32_t mm_camera_poll_thread_launch(mm_camera_poll_thread_t * poll_cb,
                                      mm_camera_poll_thread_type_t poll_type)
 {
     int32_t rc = 0;
     poll_cb->poll_type = poll_type;

     poll_cb->pfds[0] = 0;
     poll_cb->pfds[1] = 0;
     rc = pipe(poll_cb->pfds);
     if(rc < 0) {
         CDBG_ERROR("%s: pipe open rc=%d\n", __func__, rc);
         return -1;
     }

     poll_cb->timeoutms = -1;  /* Infinite seconds */

     CDBG("%s: poll_type = %d, read fd = %d, write fd = %d timeout = %d",
         __func__, poll_cb->poll_type,
         poll_cb->pfds[0], poll_cb->pfds[1],poll_cb->timeoutms);

     pthread_mutex_init(&poll_cb->mutex, NULL);
     pthread_cond_init(&poll_cb->cond_v, NULL);

     /* launch the thread */
     pthread_mutex_lock(&poll_cb->mutex);
     poll_cb->status = 0;
     pthread_create(&poll_cb->pid, NULL, mm_camera_poll_thread, (void *)poll_cb);
     if(!poll_cb->status) {
         pthread_cond_wait(&poll_cb->cond_v, &poll_cb->mutex);
     }
     pthread_mutex_unlock(&poll_cb->mutex);
     CDBG("%s: End",__func__);
     return rc;
 }

 int32_t mm_camera_poll_thread_release(mm_camera_poll_thread_t *poll_cb)
 {
     int32_t rc = 0;
     if(MM_CAMERA_POLL_TASK_STATE_STOPPED == poll_cb->state) {
         CDBG_ERROR("%s: err, poll thread is not running.\n", __func__);
         return rc;
     }

     /* send exit signal to poll thread */
     mm_camera_poll_sig(poll_cb, MM_CAMERA_PIPE_CMD_EXIT);
     /* wait until poll thread exits */
     if (pthread_join(poll_cb->pid, NULL) != 0) {
         CDBG_ERROR("%s: pthread dead already\n", __func__);
     }

     /* close pipe */
     if(poll_cb->pfds[0]) {
         close(poll_cb->pfds[0]);
     }
     if(poll_cb->pfds[1]) {
         close(poll_cb->pfds[1]);
     }

     pthread_mutex_destroy(&poll_cb->mutex);
     pthread_cond_destroy(&poll_cb->cond_v);
     memset(poll_cb, 0, sizeof(mm_camera_poll_thread_t));
     return rc;
 }
	/*
	Copyright (c) 2012, The Linux Foundation. All rights reserved.

	Redistribution and use in source and binary forms, with or without
	modification, are permitted provided that the following conditions are
	met:
	* Redistributions of source code must retain the above copyright
	notice, this list of conditions and the following disclaimer.
	* Redistributions in binary form must reproduce the above
	copyright notice, this list of conditions and the following
	disclaimer in the documentation and/or other materials provided
	with the distribution.
	* Neither the name of The Linux Foundation nor the names of its
	contributors may be used to endorse or promote products derived
	from this software without specific prior written permission.

	THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
	WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
	MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
	ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
	BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
	CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
	SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
	BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
	WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
	OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
	IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
	*/

	#include <pthread.h>
	#include <errno.h>
	#include <stdbool.h>
	#include <sys/ioctl.h>
	#include <sys/types.h>
	#include <sys/stat.h>
	#include <fcntl.h>
	#include <poll.h>
	#include <semaphore.h>

	#include "mm_camera_dbg.h"
	#include "mm_camera_interface.h"
	#include "mm_camera.h"

	typedef enum {
	/* poll entries updated */
	MM_CAMERA_PIPE_CMD_POLL_ENTRIES_UPDATED,
	/* exit */
	MM_CAMERA_PIPE_CMD_EXIT,
	/* max count */
	MM_CAMERA_PIPE_CMD_MAX
	} mm_camera_pipe_cmd_type_t;

	typedef enum {
	MM_CAMERA_POLL_TASK_STATE_STOPPED,
	MM_CAMERA_POLL_TASK_STATE_POLL, /* polling pid in polling state. */
	MM_CAMERA_POLL_TASK_STATE_MAX
	} mm_camera_poll_task_state_type_t;

	typedef struct {
	uint8_t cmd;
	mm_camera_event_t event;
	} mm_camera_sig_evt_t;

	static int32_t mm_camera_poll_sig(mm_camera_poll_thread_t *poll_cb,
	uint32_t cmd)
	{
	/* send through pipe */
	/* get the mutex */
	mm_camera_sig_evt_t cmd_evt;
	int len;

	CDBG("%s: E cmd = %d", __func__,cmd);
	memset(&cmd_evt, 0, sizeof(cmd_evt));
	cmd_evt.cmd = cmd;
	pthread_mutex_lock(&poll_cb->mutex);
	/* reset the statue to false */
	poll_cb->status = false;
	/* send cmd to worker */

	len = write(poll_cb->pfds[1], &cmd_evt, sizeof(cmd_evt));
	if(len < 1) {
	CDBG_ERROR("%s: len = %d, errno = %d", __func__, len, errno);
	}
	CDBG("%s: begin IN mutex write done, len = %d", __func__, len);
	/* wait till worker task gives positive signal */
	if (false == poll_cb->status) {
	CDBG("%s: wait", __func__);
	pthread_cond_wait(&poll_cb->cond_v, &poll_cb->mutex);
	}
	/* done */
	pthread_mutex_unlock(&poll_cb->mutex);
	CDBG("%s: X", __func__);
	return 0;
	}

	static void mm_camera_poll_sig_done(mm_camera_poll_thread_t *poll_cb)
	{
	pthread_mutex_lock(&poll_cb->mutex);
	poll_cb->status = true;
	pthread_cond_signal(&poll_cb->cond_v);
	CDBG("%s: done, in mutex", __func__);
	pthread_mutex_unlock(&poll_cb->mutex);
	}

	static void mm_camera_poll_set_state(mm_camera_poll_thread_t *poll_cb,
	mm_camera_poll_task_state_type_t state)
	{
	poll_cb->state = state;
	}

	static void mm_camera_poll_proc_pipe(mm_camera_poll_thread_t *poll_cb)
	{
	ssize_t read_len;
	int i;
	mm_camera_sig_evt_t cmd_evt;
	read_len = read(poll_cb->pfds[0], &cmd_evt, sizeof(cmd_evt));
	CDBG("%s: read_fd = %d, read_len = %d, expect_len = %d cmd = %d",
	__func__, poll_cb->pfds[0], (int)read_len, (int)sizeof(cmd_evt), cmd_evt.cmd);
	switch (cmd_evt.cmd) {
	case MM_CAMERA_PIPE_CMD_POLL_ENTRIES_UPDATED:
	/* we always have index 0 for pipe read */
	poll_cb->num_fds = 0;
	poll_cb->poll_fds[poll_cb->num_fds].fd = poll_cb->pfds[0];
	poll_cb->poll_fds[poll_cb->num_fds].events = POLLIN\|POLLRDNORM\|POLLPRI;
	poll_cb->num_fds++;

	if (MM_CAMERA_POLL_TYPE_EVT == poll_cb->poll_type) {
	if (poll_cb->poll_entries[0].fd > 0) {
	/* fd is valid, we update poll_fds */
	poll_cb->poll_fds[poll_cb->num_fds].fd = poll_cb->poll_entries[0].fd;
	poll_cb->poll_fds[poll_cb->num_fds].events = POLLIN\|POLLRDNORM\|POLLPRI;
	poll_cb->num_fds++;
	}
	} else if (MM_CAMERA_POLL_TYPE_CH == poll_cb->poll_type) {
	for(i = 0; i < MM_CAMEAR_STRAEM_NUM_MAX; i++) {
	if(poll_cb->poll_entries[i].fd > 0) {
	/* fd is valid, we update poll_fds to this fd */
	poll_cb->poll_fds[poll_cb->num_fds].fd = poll_cb->poll_entries[i].fd;
	poll_cb->poll_fds[poll_cb->num_fds].events = POLLIN\|POLLRDNORM\|POLLPRI;
	poll_cb->num_fds++;
	} else {
	/* fd is invalid, we set the entry to -1 to prevent polling.
	* According to spec, polling will not poll on entry with fd=-1.
	* If this is not the case, we need to skip these invalid fds
	* when updating this array.
	* We still keep fd=-1 in this array because this makes easier to
	* map cb associated with this fd once incoming data avail by directly
	* using the index-1(0 is reserved for pipe read, so need to reduce index by 1) */
	poll_cb->poll_fds[poll_cb->num_fds].fd = -1;
	poll_cb->poll_fds[poll_cb->num_fds].events = 0;
	poll_cb->num_fds++;
	}
	}
	}
	mm_camera_poll_sig_done(poll_cb);
	break;

	case MM_CAMERA_PIPE_CMD_EXIT:
	default:
	mm_camera_poll_set_state(poll_cb, MM_CAMERA_POLL_TASK_STATE_STOPPED);
	mm_camera_poll_sig_done(poll_cb);
	break;
	}
	}

	static void mm_camera_poll_fn(mm_camera_poll_thread_t poll_cb)
	{
	int rc = 0, i;

	CDBG("%s: poll type = %d, num_fd = %d poll_cb = %p\n",
	__func__, poll_cb->poll_type, poll_cb->num_fds,poll_cb);
	do {
	for(i = 0; i < poll_cb->num_fds; i++) {
	poll_cb->poll_fds[i].events = POLLIN\|POLLRDNORM\|POLLPRI;
	}

	rc = poll(poll_cb->poll_fds, poll_cb->num_fds, poll_cb->timeoutms);
	if(rc > 0) {
	if ((poll_cb->poll_fds[0].revents & POLLIN) &&
	(poll_cb->poll_fds[0].revents & POLLRDNORM)) {
	/* if we have data on pipe, we only process pipe in this iteration */
	CDBG("%s: cmd received on pipe\n", __func__);
	mm_camera_poll_proc_pipe(poll_cb);
	} else {
	for(i=1; i<poll_cb->num_fds; i++) {
	/* Checking for ctrl events */
	if ((poll_cb->poll_type == MM_CAMERA_POLL_TYPE_EVT) &&
	(poll_cb->poll_fds[i].revents & POLLPRI)) {
	CDBG("%s: mm_camera_evt_notify\n", __func__);
	if (NULL != poll_cb->poll_entries[i-1].notify_cb) {
	poll_cb->poll_entries[i-1].notify_cb(poll_cb->poll_entries[i-1].user_data);
	}
	}

	if ((poll_cb->poll_type == MM_CAMERA_POLL_TYPE_CH) &&
	(poll_cb->poll_fds[i].revents & POLLIN) &&
	(poll_cb->poll_fds[i].revents & POLLRDNORM)) {
	CDBG("%s: mm_stream_data_notify\n", __func__);
	if (NULL != poll_cb->poll_entries[i-1].notify_cb) {
	poll_cb->poll_entries[i-1].notify_cb(poll_cb->poll_entries[i-1].user_data);
	}
	}
	}
	}
	} else {
	/* in error case sleep 10 us and then continue. hard coded here */
	usleep(10);
	continue;
	}
	} while (poll_cb->state == MM_CAMERA_POLL_TASK_STATE_POLL);
	return NULL;
	}

	static void mm_camera_poll_thread(void data)
	{
	int rc = 0;
	int i;
	void *ret = NULL;
	mm_camera_poll_thread_t poll_cb = (mm_camera_poll_thread_t )data;

	/* add pipe read fd into poll first */
	poll_cb->poll_fds[poll_cb->num_fds++].fd = poll_cb->pfds[0];

	//poll_cb->poll_fds[poll_cb->num_fds++].fd = (((mm_camera_obj_t *)poll_cb->my_obj)->ctrl_fd);

	mm_camera_poll_sig_done(poll_cb);
	mm_camera_poll_set_state(poll_cb, MM_CAMERA_POLL_TASK_STATE_POLL);
	ret = mm_camera_poll_fn(poll_cb);
	return ret;
	}

	int32_t mm_camera_poll_thread_notify_entries_updated(mm_camera_poll_thread_t * poll_cb)
	{
	/* send poll entries updated signal to poll thread */
	return mm_camera_poll_sig(poll_cb, MM_CAMERA_PIPE_CMD_POLL_ENTRIES_UPDATED);
	}

	int32_t mm_camera_poll_thread_add_poll_fd(mm_camera_poll_thread_t * poll_cb,
	uint32_t handler,
	int32_t fd,
	mm_camera_poll_notify_t notify_cb,
	void* userdata)
	{
	int32_t rc = -1;
	uint8_t idx = 0;

	if (MM_CAMERA_POLL_TYPE_CH == poll_cb->poll_type) {
	/* get stream idx from handler if CH type */
	idx = mm_camera_util_get_index_by_handler(handler);
	} else {
	/* for EVT type, only idx=0 is valid */
	idx = 0;
	}

	if (MM_CAMEAR_STRAEM_NUM_MAX > idx) {
	poll_cb->poll_entries[idx].fd = fd;
	poll_cb->poll_entries[idx].handler = handler;
	poll_cb->poll_entries[idx].notify_cb = notify_cb;
	poll_cb->poll_entries[idx].user_data = userdata;
	/* send poll entries updated signal to poll thread */
	rc = mm_camera_poll_sig(poll_cb, MM_CAMERA_PIPE_CMD_POLL_ENTRIES_UPDATED);
	} else {
	CDBG_ERROR("%s: invalid handler %d (%d)",
	__func__, handler, idx);
	}
	return rc;
	}

	int32_t mm_camera_poll_thread_del_poll_fd(mm_camera_poll_thread_t * poll_cb,
	uint32_t handler)
	{
	int32_t rc = -1;
	uint8_t idx = 0;

	if (MM_CAMERA_POLL_TYPE_CH == poll_cb->poll_type) {
	/* get stream idx from handler if CH type */
	idx = mm_camera_util_get_index_by_handler(handler);
	} else {
	/* for EVT type, only idx=0 is valid */
	idx = 0;
	}

	if ((MM_CAMEAR_STRAEM_NUM_MAX > idx) &&
	(handler == poll_cb->poll_entries[idx].handler)) {
	/* reset poll entry */
	poll_cb->poll_entries[idx].fd = -1; /* set fd to invalid */
	poll_cb->poll_entries[idx].handler = 0;
	poll_cb->poll_entries[idx].notify_cb = NULL;

	/* send poll entries updated signal to poll thread */
	rc = mm_camera_poll_sig(poll_cb, MM_CAMERA_PIPE_CMD_POLL_ENTRIES_UPDATED);
	} else {
	CDBG_ERROR("%s: invalid handler %d (%d)",
	__func__, handler, idx);
	}

	return rc;
	}

	int32_t mm_camera_poll_thread_launch(mm_camera_poll_thread_t * poll_cb,
	mm_camera_poll_thread_type_t poll_type)
	{
	int32_t rc = 0;
	poll_cb->poll_type = poll_type;

	poll_cb->pfds[0] = 0;
	poll_cb->pfds[1] = 0;
	rc = pipe(poll_cb->pfds);
	if(rc < 0) {
	CDBG_ERROR("%s: pipe open rc=%d\n", __func__, rc);
	return -1;
	}

	poll_cb->timeoutms = -1; /* Infinite seconds */

	CDBG("%s: poll_type = %d, read fd = %d, write fd = %d timeout = %d",
	__func__, poll_cb->poll_type,
	poll_cb->pfds[0], poll_cb->pfds[1],poll_cb->timeoutms);

	pthread_mutex_init(&poll_cb->mutex, NULL);
	pthread_cond_init(&poll_cb->cond_v, NULL);

	/* launch the thread */
	pthread_mutex_lock(&poll_cb->mutex);
	poll_cb->status = 0;
	pthread_create(&poll_cb->pid, NULL, mm_camera_poll_thread, (void *)poll_cb);
	if(!poll_cb->status) {
	pthread_cond_wait(&poll_cb->cond_v, &poll_cb->mutex);
	}
	pthread_mutex_unlock(&poll_cb->mutex);
	CDBG("%s: End",__func__);
	return rc;
	}

	int32_t mm_camera_poll_thread_release(mm_camera_poll_thread_t *poll_cb)
	{
	int32_t rc = 0;
	if(MM_CAMERA_POLL_TASK_STATE_STOPPED == poll_cb->state) {
	CDBG_ERROR("%s: err, poll thread is not running.\n", __func__);
	return rc;
	}

	/* send exit signal to poll thread */
	mm_camera_poll_sig(poll_cb, MM_CAMERA_PIPE_CMD_EXIT);
	/* wait until poll thread exits */
	if (pthread_join(poll_cb->pid, NULL) != 0) {
	CDBG_ERROR("%s: pthread dead already\n", __func__);
	}

	/* close pipe */
	if(poll_cb->pfds[0]) {
	close(poll_cb->pfds[0]);
	}
	if(poll_cb->pfds[1]) {
	close(poll_cb->pfds[1]);
	}

	pthread_mutex_destroy(&poll_cb->mutex);
	pthread_cond_destroy(&poll_cb->cond_v);
	memset(poll_cb, 0, sizeof(mm_camera_poll_thread_t));
	return rc;
	}