/*

    OpenPnp-Capture: a video capture subsystem.

    Linux platform code
    Stream class

    Created by Niels Moseley on 7/6/17.
    Copyright (c) 2017 Niels Moseley.

    Permission is hereby granted, free of charge, to any person obtaining a copy
    of this software and associated documentation files (the "Software"), to deal
    in the Software without restriction, including without limitation the rights
    to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
    copies of the Software, and to permit persons to whom the Software is
    furnished to do so, subject to the following conditions:

    The above copyright notice and this permission notice shall be included in all
    copies or substantial portions of the Software.

    THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
    IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
    FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
    AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
    LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
    OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
    SOFTWARE.

*/

#include <stdio.h>
#include <unistd.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <sys/time.h>
#include <sys/mman.h>
#include <memory.h>
#include <string>
#include "scopedptr.h"

#include "platformdeviceinfo.h"
#include "platformstream.h"
#include "platformcontext.h"
#include "yuvconverters.h"

#define CLEAR(x) memset(&(x), 0, sizeof(x))

Stream* createPlatformStream()
{
    return new PlatformStream();
}

int xioctl(int fh, int request, void *arg)
{
    int r;

    do 
    {
        r = ioctl(fh, request, arg);
    } while ((r == -1) && (errno == EINTR));

    return r;
}


// **********************************************************************
//   PlatformStreamHelper functions
// **********************************************************************

bool PlatformStreamHelper::createAndMapBuffers(uint32_t nBuffers)
{
    v4l2_requestbuffers req;

    CLEAR(req);

    req.count  = nBuffers;
    req.type   = V4L2_BUF_TYPE_VIDEO_CAPTURE;
    req.memory = V4L2_MEMORY_MMAP;

    if (xioctl(m_fd, VIDIOC_REQBUFS, &req) == -1) 
    {
        LOG(LOG_ERR, "createAndMapBuffers failed - no memory mapping support.\n");
        return false;
    }

    if (req.count < 2) 
    {
        LOG(LOG_ERR, "createAndMapBuffers: need more than 1 buffer.\n");
        return false;
    }

    LOG(LOG_DEBUG, "Reserving %d mmap buffers\n", req.count);

    m_buffers.resize(req.count);

    for (uint32_t b = 0; b < req.count; ++b) 
    {
        v4l2_buffer buf;

        CLEAR(buf);

        buf.type        = V4L2_BUF_TYPE_VIDEO_CAPTURE;
        buf.memory      = V4L2_MEMORY_MMAP;
        buf.index       = b;

        if (xioctl(m_fd, VIDIOC_QUERYBUF, &buf) == -1)
        {
            LOG(LOG_ERR, "createAndMapBuffers: VIDIOC_QUERYBUF failed.\n");
            return false;
        }

        m_buffers[b].length = buf.length;
        m_buffers[b].start  = mmap(NULL, buf.length, PROT_READ | PROT_WRITE, 
            MAP_SHARED, m_fd, buf.m.offset);

        if (m_buffers[b].start == MAP_FAILED)
        {
            LOG(LOG_ERR, "createAndMapBuffers: mmap failed.\n");
            return false;
        }
        else
        {
            LOG(LOG_DEBUG, "Created mmap buffer of %d bytes\n", buf.length);
        }

    }

    return true;
}

void PlatformStreamHelper::unmapAndDeleteBuffers()
{
    for(uint32_t i=0; i<m_buffers.size(); i++)
    {
        munmap(m_buffers[i].start, m_buffers[i].length);
    }

    m_buffers.clear();
    LOG(LOG_DEBUG, "Mmap buffers deleted\n");
}

bool PlatformStreamHelper::queueAllBuffers()
{
    // ****************************************
    // create queue buffers
    // ****************************************

    v4l2_buf_type bufferType;
    for (uint32_t i = 0; i < m_buffers.size(); ++i)
    {        
        v4l2_buffer   buf;

        CLEAR(buf);
        buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
        buf.memory = V4L2_MEMORY_MMAP;
        buf.index = i;

        if (xioctl(m_fd, VIDIOC_QBUF, &buf) == -1)
        {
            LOG(LOG_ERR,"VIDIOC_QBUF failed (errno=%d)\n", errno);
            return false;
        }
    }
    return true;
}

bool PlatformStreamHelper::streamOn()
{
    v4l2_buf_type bufferType = V4L2_BUF_TYPE_VIDEO_CAPTURE;

    if (xioctl(m_fd, VIDIOC_STREAMON, &bufferType) == -1)
    {
        LOG(LOG_ERR,"VIDIOC_STREAMON failed (errno=%d)\n", errno);
        return false;
    }

    LOG(LOG_DEBUG, "stream is On\n");

    return true;
}

bool PlatformStreamHelper::streamOff()
{
    v4l2_buf_type bufferType = V4L2_BUF_TYPE_VIDEO_CAPTURE;
    if (xioctl(m_fd, VIDIOC_STREAMOFF, &bufferType) == -1)
    {
        LOG(LOG_ERR,"VIDIOC_STREAMOFF failed (errno=%d)\n", errno);
        return false;
    }

    LOG(LOG_DEBUG, "stream is Off\n");

    return true;
}

// **********************************************************************
//   Capture thread/function
// **********************************************************************

void captureThreadFunction(PlatformStream *stream, int fd, size_t bufferSizeBytes)
{
    if (stream == nullptr)
    {
        return;
    }

    LOG(LOG_DEBUG, "capture thread running (deviceHandle = %08X) ...\n", fd);

    // create local frame buffer
    std::vector<uint8_t> buffer(bufferSizeBytes);

    // FIXME: For now, weĺl just rely on the read to fail
    // when the PlatformStream closes the file
    // descriptor. This doesn't feel very professional,
    // but it should work :)
    while(!stream->getThreadQuitState())
    {
        ssize_t actualBytesRead = ::read(fd, &buffer[0], bufferSizeBytes);
        if (actualBytesRead < 0)
        {
            LOG(LOG_DEBUG, "capture thread exited (errno %d).\n", errno);
            return; //exit thread
        }

        // read will only return complete buffers
        stream->threadSubmitBuffer(&buffer[0], actualBytesRead);
        LOG(LOG_INFO, "yay\n");
    }
}



void captureThreadFunctionAsync(PlatformStream *stream, int fd, size_t bufferSizeBytes)
{
    //https://linuxtv.org/downloads/v4l-dvb-apis/uapi/v4l/capture.c.html
    const uint32_t nBuffers = 8;
    
    if (stream == nullptr)
    {
        return;
    }

    LOG(LOG_DEBUG, "captureThreadFunctionAsync started\n");

    PlatformStreamHelper *pHelper = new PlatformStreamHelper(fd);
    ScopedPtr<PlatformStreamHelper> helper(pHelper);

    if (!helper->createAndMapBuffers(nBuffers))
    {
        return;
    }
    
    if (!helper->queueAllBuffers())
    {
        return;
    }
    
    if (!helper->streamOn())
    {
        return;
    }

    while(!stream->getThreadQuitState())
    {
        fd_set fds;
        struct timeval tv;
        int result;

        FD_ZERO(&fds);
        FD_SET(fd, &fds);

        /* Timeout. */
        tv.tv_sec = 5;
        tv.tv_usec = 0;

        result = select(fd + 1, &fds, NULL, NULL, &tv);
        if (result == -1)
        {
            if (errno == EINTR)
            {
                continue;
            }
            LOG(LOG_ERR,"Select failed (errno=%d)\n", errno);
            return;
        }
        else if (result == 0)
        {
            LOG(LOG_ERR,"Select timeout\n");
            return;
        }

        // ****************************************
        // read the frame
        // ****************************************
        v4l2_buffer buf;
        CLEAR(buf);
        buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
        buf.memory = V4L2_MEMORY_MMAP;

        if (xioctl(fd, VIDIOC_DQBUF, &buf) == -1)
        {
            switch (errno) 
            {
            case EAGAIN:
                LOG(LOG_DEBUG, "VIDIOC_DQBUF returned EAGAIN\n");
                //FIXME: what to do here?!?
                continue;

            case EIO:
                /* Could ignore EIO, see spec. */

                /* fall through */

            default:
                LOG(LOG_ERR, "VIDIOC_DQBUF error\n");
                return;
            }
        }

        //assert(buf.index < nBuffers);
        stream->threadSubmitBuffer(helper->getBufferPointer(buf.index), buf.bytesused);

        // re-queue the buffer
        if (xioctl(fd, VIDIOC_QBUF, &buf) == -1)
        {
            LOG(LOG_ERR, "VIDIOC_DQBUF error\n");
            return;    
        }
    } // while  

    // Note: the destruction of the PlatformHelper 
    // by the scoped pointer will automatically
    // turn off streaming and remove the
    // memory mapped buffers from the system.
    LOG(LOG_DEBUG, "captureThreadFunctionAsync exited\n");
}

// **********************************************************************
//   PlatformStream
// **********************************************************************

PlatformStream::PlatformStream() : 
    Stream(),
    m_quitThread(false),
    m_helperThread(nullptr)
{
    CLEAR(m_fmt);
}

PlatformStream::~PlatformStream()
{
    close();
}

void PlatformStream::close()
{
    LOG(LOG_INFO, "closing stream\n");

    m_owner = nullptr;
    m_width = 0;
    m_height = 0;
    m_isOpen = false; 
    m_quitThread = true;

    if (m_helperThread != nullptr)
    {
        m_helperThread->join();
        
        delete m_helperThread;           
        
        m_helperThread = nullptr;
    }

    m_frameBuffer.resize(0);
    ::close(m_deviceHandle);

    m_deviceHandle = -1;    
}

void test(size_t bufferSizeBytes)
{

}

bool PlatformStream::open(Context *owner, deviceInfo *device, uint32_t width, uint32_t height, uint32_t fourCC, uint32_t fps)
{
    if (m_isOpen)
    {
        LOG(LOG_INFO,"open() was called on an active stream.\n");
        close();
    }

    if (owner == nullptr)
    {
        LOG(LOG_ERR,"open() was with owner=NULL!\n");        
        return false;
    }

    if (device == nullptr)
    {
        LOG(LOG_ERR,"open() was with device=NULL!\n");
        return false;
    }

    platformDeviceInfo *dinfo = dynamic_cast<platformDeviceInfo*>(device);
    if (dinfo == NULL)
    {
        LOG(LOG_CRIT, "Could not cast deviceInfo* to platfromDeviceInfo*!");
        return false;
    }

    m_owner = owner;
    m_frames = 0;
    m_width = 0;
    m_height = 0;    

    m_deviceHandle = ::open(dinfo->m_devicePath.c_str(), O_RDWR /* required */ | O_NONBLOCK);
    if (m_deviceHandle < 0)
    {
        LOG(LOG_CRIT, "Could not open device %s (errno = %d)\n", dinfo->m_devicePath.c_str(), errno);
        close();
        return false;
    }

    // request a format
    m_fmt.type       = V4L2_BUF_TYPE_VIDEO_CAPTURE;
    m_fmt.fmt.pix.width  = width;
    m_fmt.fmt.pix.height = height;
    m_fmt.fmt.pix.pixelformat = fourCC;
    m_fmt.fmt.pix.field  = V4L2_FIELD_NONE; // we want regular frames, not interlaced ones.
    
    //FIXME: this is needed for compressed formats
    //       but can we get away with this in uncompressed
    //       formats?
    m_fmt.fmt.pix.bytesperline = 0;
    m_fmt.fmt.pix.sizeimage = 0;        // only set be the driver
    m_fmt.fmt.pix.priv = 0; 

    if (xioctl(m_deviceHandle, VIDIOC_S_FMT, &m_fmt) == -1)
    {
        LOG(LOG_CRIT, "Could set the frame buffer format (errno = %d)\n", errno);
        close();
        return false;
    }

    // now get the actual format information set by the
    // driver

    if (xioctl(m_deviceHandle, VIDIOC_G_FMT, &m_fmt) == -1)
    {
        LOG(LOG_CRIT, "Could not query default format (errno = %d)\n", errno);
        close();
        return false;
    }

    LOG(LOG_INFO, "Format buffer type: %d\n", m_fmt.type);
    if (m_fmt.type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
    {
        LOG(LOG_ERR, "Buffer type (%d) not supported!\n", m_fmt.type);
        close();
        return false;
    }

    m_width = m_fmt.fmt.pix.width;
    m_height = m_fmt.fmt.pix.height;

    LOG(LOG_INFO, "Width  = %d pixels\n", m_fmt.fmt.pix.width);
    LOG(LOG_INFO, "Height = %d pixels\n", m_fmt.fmt.pix.height);
    LOG(LOG_INFO, "FOURCC = %s\n", fourCCToString(m_fmt.fmt.pix.pixelformat).c_str());
    LOG(LOG_INFO, "FPS    = %d\n", fps);

    // set the desired frame rate
    v4l2_streamparm sparam;
    CLEAR(sparam);
    sparam.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
    sparam.parm.capture.timeperframe.numerator   = 1;
    sparam.parm.capture.timeperframe.denominator = fps;
    if (xioctl(m_deviceHandle, VIDIOC_S_PARM, &sparam) == -1)
    {
        LOG(LOG_CRIT, "Could not set the frame rate (errno = %d)\n", errno);
        close();
        return false;
    }    

    // set the (max) size of the frame buffer in Stream class
    //
    // Note: we only support 24-bit per pixel RGB
    // buffers for now!
    m_frameBuffer.resize(m_width*m_height*3);

    m_isOpen = true;

    // create the helper thread to read from the device
    m_quitThread = false;

    // for now, assume we always have streaming driver support
#ifdef __V4L2_NO_STREAMNING_SUPPORT
    m_helperThread = new std::thread(&captureThreadFunction, this,
        m_deviceHandle, m_width*m_height*4);
#else
    m_helperThread = new std::thread(&captureThreadFunctionAsync, this,
        m_deviceHandle, m_width*m_height*4);
#endif

    return true;
}

/*

RGB formats .. https://lwn.net/Articles/218798/

 -- V4L2 DEFINE --   FOURCC
V4L2_PIX_FMT_RGB332  RGB1
V4L2_PIX_FMT_RGB444  R444
V4L2_PIX_FMT_RGB555  RGB0
V4L2_PIX_FMT_RGB565  RGBP
V4L2_PIX_FMT_RGB555X RGBQ
V4L2_PIX_FMT_RGB565X RGBR
V4L2_PIX_FMT_BGR24   BGR3
V4L2_PIX_FMT_RGB24   RGB3
V4L2_PIX_FMT_BGR32   BGR4
V4L2_PIX_FMT_RGB32   RGB4
V4L2_PIX_FMT_SBGGR8  BA81

*/

//#define FRAMEDUMP

void PlatformStream::threadSubmitBuffer(void *ptr, size_t bytes)
{
    if (ptr != nullptr) 
    {
        switch(m_fmt.fmt.pix.pixelformat)
        {
        case V4L2_PIX_FMT_RGB24:
            Stream::submitBuffer((uint8_t*)ptr, bytes);
            break;
        case V4L2_PIX_FMT_YUYV:
            // here we implement our own ::submitBuffer replacement
            // so we can decode the 16-bit YUYV frames and copy the 24-bit
            // RGB pixels into m_frameBuffer
            m_bufferMutex.lock();
            YUYV2RGB((const uint8_t*)ptr, &m_frameBuffer[0], bytes);
            m_newFrame = true;
            m_frames++;
            m_bufferMutex.unlock();
            break;            
        case 0x47504A4D:    // MJPG
            #ifdef FRAMEDUMP
            {
                static int32_t fcnt = 0;
                char fname[100];
                if (fcnt < 10)
                {
                    sprintf(fname,"frame_%d.dat", fcnt++);
                    FILE *fout = fopen(fname, "wb");
                    fwrite(ptr, 1, bytes, fout);
                    fclose(fout);
                }
            }
            #endif        

            // here we implement our own ::submitBuffer replacement
            // so we can decode the MJEG frames and copy the 24-bit
            // RGB pixels into m_frameBuffer
            m_bufferMutex.lock();
            if (m_mjpegHelper.decompressFrame((uint8_t*)ptr, bytes, &m_frameBuffer[0], m_width, m_height))
            {
                m_newFrame = true; 
                m_frames++;
            }
            m_bufferMutex.unlock();
            break;
        default:
            LOG(LOG_DEBUG, "ThreadSubmitBuffer: unsupported format %s (%08X)\n", fourCCToString(m_fmt.fmt.pix.pixelformat).c_str(),
                m_fmt.fmt.pix.pixelformat);
            break;
        }        
    }
}

bool PlatformStream::setFrameRate(uint32_t fps)
{    
    struct v4l2_streamparm param;
    CLEAR(param);

    param.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;

    param.parm.capture.timeperframe.numerator = 1;
    param.parm.capture.timeperframe.denominator = fps;

    if (xioctl(m_deviceHandle, VIDIOC_S_PARM, &param) == -1)
    {
        LOG(LOG_ERR,"setFrameRate failed on VIDIOC_S_PARM (errno %d)\n", errno);
        return false;
    }

    return true;
}

uint32_t PlatformStream::getFOURCC()
{
    if (m_isOpen)
    {
        return m_fmt.fmt.pix.pixelformat;
    }
    else
    {
        return 0;
    }
}

bool PlatformStream::setProperty(uint32_t propID, int32_t value)
{
    v4l2_control ctrl;
    CLEAR(ctrl);

    switch(propID)
    {
    case CAPPROPID_EXPOSURE:
        ctrl.id = V4L2_CID_EXPOSURE_ABSOLUTE;
        break;
    case CAPPROPID_FOCUS:
        ctrl.id = V4L2_CID_FOCUS_ABSOLUTE;
        break;
    case CAPPROPID_ZOOM:
        ctrl.id = V4L2_CID_ZOOM_ABSOLUTE;
        break;
    case CAPPROPID_WHITEBALANCE:
        ctrl.id = V4L2_CID_WHITE_BALANCE_TEMPERATURE;
        break;
    case CAPPROPID_BRIGHTNESS:
        ctrl.id = V4L2_CID_BRIGHTNESS;
        break;
    case CAPPROPID_CONTRAST:
        ctrl.id = V4L2_CID_CONTRAST;
        break;
    case CAPPROPID_SATURATION:
        ctrl.id = V4L2_CID_SATURATION;
        break;
    case CAPPROPID_GAMMA:
        ctrl.id = V4L2_CID_GAMMA;
        break;        
    case CAPPROPID_HUE:
        ctrl.id = V4L2_CID_HUE;
        break;
    case CAPPROPID_SHARPNESS:
        ctrl.id = V4L2_CID_SHARPNESS;
        break;
    case CAPPROPID_BACKLIGHTCOMP:
        ctrl.id = V4L2_CID_BACKLIGHT_COMPENSATION;
        break;
    case CAPPROPID_POWERLINEFREQ:
        ctrl.id = V4L2_CID_POWER_LINE_FREQUENCY;
        break;
    default:    
        return false;
    }

    ctrl.value = value;
    if (xioctl(m_deviceHandle, VIDIOC_S_CTRL, &ctrl)==-1)
    {
        LOG(LOG_ERR,"setProperty (ID=%d) failed on VIDIOC_S_CTRL (errno %d)\n", propID, errno);
        return false;        
    }
    return true;
}

bool PlatformStream::setAutoProperty(uint32_t propID, bool enabled)
{
    v4l2_control ctrl;
    CLEAR(ctrl);

    switch(propID)
    {
    case CAPPROPID_EXPOSURE:
        ctrl.id = V4L2_CID_EXPOSURE_AUTO;
        //FIXME: V4L2 has multiple auto settings
        // currently my cameras only have support for 
        // V4L2_EXPOSURE_APERTURE_PRIORITY, so we're
        // using that for now.. 
        ctrl.value = enabled ? V4L2_EXPOSURE_APERTURE_PRIORITY : V4L2_EXPOSURE_MANUAL;
        break;
    case CAPPROPID_FOCUS:
        ctrl.id = V4L2_CID_FOCUS_AUTO;
        ctrl.value = enabled ? 1:0;
        break;
    case CAPPROPID_WHITEBALANCE:
        ctrl.id = V4L2_CID_AUTO_WHITE_BALANCE;
        ctrl.value = enabled ? 1:0;
        break;
    case CAPPROPID_GAIN:
        ctrl.id = V4L2_CID_AUTOGAIN;
        ctrl.value = enabled ? 1:0;
        break;        
    default:
        return false;
    }

    if (xioctl(m_deviceHandle, VIDIOC_S_CTRL, &ctrl)==-1)
    {
        LOG(LOG_ERR,"setAutoProperty (ID=%d) failed on VIDIOC_S_CTRL (errno %d)\n", propID, errno);
        return false;    
    }
    return true;    
}

bool PlatformStream::getPropertyLimits(uint32_t propID, int32_t *emin, int32_t *emax,
        int32_t *dValue)
{
    v4l2_queryctrl ctrl;
    CLEAR(ctrl);

    if ((emin == nullptr) || (emax == nullptr) || (dValue == nullptr))
    {
        return false;
    }

    switch(propID)
    {
    case CAPPROPID_EXPOSURE:
        ctrl.id = V4L2_CID_EXPOSURE_ABSOLUTE;
        break;
    case CAPPROPID_FOCUS:
        ctrl.id = V4L2_CID_FOCUS_ABSOLUTE;
        break;
    case CAPPROPID_ZOOM:
        ctrl.id = V4L2_CID_ZOOM_ABSOLUTE;
        break;
    case CAPPROPID_WHITEBALANCE:
        ctrl.id = V4L2_CID_WHITE_BALANCE_TEMPERATURE;
        break;
    case CAPPROPID_BRIGHTNESS:
        ctrl.id = V4L2_CID_BRIGHTNESS;
        break;
    case CAPPROPID_CONTRAST:
        ctrl.id = V4L2_CID_CONTRAST;
        break;
    case CAPPROPID_SATURATION:
        ctrl.id = V4L2_CID_SATURATION;
        break;
    case CAPPROPID_GAMMA:
        ctrl.id = V4L2_CID_GAMMA;
        break;   
    case CAPPROPID_HUE:
        ctrl.id = V4L2_CID_HUE;
        break;
    case CAPPROPID_SHARPNESS:
        ctrl.id = V4L2_CID_SHARPNESS;
        break;
    case CAPPROPID_BACKLIGHTCOMP:
        ctrl.id = V4L2_CID_BACKLIGHT_COMPENSATION;
        break;                    
    case CAPPROPID_POWERLINEFREQ:
        ctrl.id = V4L2_CID_POWER_LINE_FREQUENCY;
        break;        
    default:
        return false;
    }

    if (xioctl(m_deviceHandle, VIDIOC_QUERYCTRL, &ctrl) == -1)
    {
        LOG(LOG_ERR,"getPropertyLimits (ID=%d) failed on VIDIOC_QUERYCTRL (errno %d)\n", propID, errno);
        return false;
    }
    *emin = ctrl.minimum;
    *emax = ctrl.maximum;
    *dValue= ctrl.default_value;
    return true;
}

bool PlatformStream::getProperty(uint32_t propID, int32_t &value)
{
    v4l2_control ctrl;
    CLEAR(ctrl);

    switch(propID)
    {
    case CAPPROPID_EXPOSURE:
        ctrl.id = V4L2_CID_EXPOSURE_ABSOLUTE;
        break;
    case CAPPROPID_FOCUS:
        ctrl.id = V4L2_CID_FOCUS_ABSOLUTE;
        break;
    case CAPPROPID_ZOOM:
        ctrl.id = V4L2_CID_ZOOM_ABSOLUTE;
        break;
    case CAPPROPID_WHITEBALANCE:
        ctrl.id = V4L2_CID_WHITE_BALANCE_TEMPERATURE;
        break;
    case CAPPROPID_BRIGHTNESS:
        ctrl.id = V4L2_CID_BRIGHTNESS;
        break;
    case CAPPROPID_CONTRAST:
        ctrl.id = V4L2_CID_CONTRAST;
        break;
    case CAPPROPID_SATURATION:
        ctrl.id = V4L2_CID_SATURATION;
        break;
    case CAPPROPID_GAMMA:
        ctrl.id = V4L2_CID_GAMMA;
        break;   
    case CAPPROPID_HUE:
        ctrl.id = V4L2_CID_HUE;
        break;
    case CAPPROPID_SHARPNESS:
        ctrl.id = V4L2_CID_SHARPNESS;
        break;
    case CAPPROPID_BACKLIGHTCOMP:
        ctrl.id = V4L2_CID_BACKLIGHT_COMPENSATION;
        break;      
    case CAPPROPID_POWERLINEFREQ:
        ctrl.id = V4L2_CID_POWER_LINE_FREQUENCY;
        break;                       
    default:
        return false;
    }

    if (xioctl(m_deviceHandle, VIDIOC_G_CTRL, &ctrl)==-1)
    {
        LOG(LOG_ERR,"getProperty (ID=%d) failed on VIDIOC_G_CTRL (errno %d)\n", propID, errno);
        return false;        
    }

    value = ctrl.value;

    return true;
}

bool PlatformStream::getAutoProperty(uint32_t propID, bool &enabled)
{
    v4l2_control ctrl;
    CLEAR(ctrl);

    switch(propID)
    {
    case CAPPROPID_EXPOSURE:
        ctrl.id = V4L2_CID_EXPOSURE_AUTO;        
        break;
    case CAPPROPID_FOCUS:
        ctrl.id = V4L2_CID_FOCUS_AUTO;
        break;
    case CAPPROPID_WHITEBALANCE:
        ctrl.id = V4L2_CID_AUTO_WHITE_BALANCE;
        break;
    case CAPPROPID_GAIN:
        ctrl.id = V4L2_CID_AUTOGAIN;
        break;
    default:
        return false;
    }

    if (xioctl(m_deviceHandle, VIDIOC_G_CTRL, &ctrl)==-1)
    {
        LOG(LOG_ERR,"getAutoProperty (ID=%d) failed on VIDIOC_G_CTRL (errno %d)\n", propID, errno);
        return false;        
    }

    // V4L2_CID_EXPOSURE_AUTO is a menu, not a boolean .. *sigh*
    if (ctrl.id == V4L2_CID_EXPOSURE_AUTO)
    {
        enabled = (ctrl.value == V4L2_EXPOSURE_MANUAL) ? 0 : 1;
    }
    else
    {
        enabled = (ctrl.value != 0);
    }
    return true;   
}