Merge branch 'master' of ssh://infradead/~/public_git/wireless into for-davem

[mirror_ubuntu-bionic-kernel.git] / drivers / media / video / timblogiw.c

/*
 * timblogiw.c timberdale FPGA LogiWin Video In driver
 * Copyright (c) 2009-2010 Intel Corporation
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

/* Supports:
 * Timberdale FPGA LogiWin Video In
 */

#include <linux/platform_device.h>
#include <linux/slab.h>
#include <linux/dmaengine.h>
#include <linux/scatterlist.h>
#include <linux/interrupt.h>
#include <linux/list.h>
#include <linux/i2c.h>
#include <media/v4l2-ioctl.h>
#include <media/v4l2-device.h>
#include <media/videobuf-dma-contig.h>
#include <media/timb_video.h>

#define DRIVER_NAME                     "timb-video"

#define TIMBLOGIWIN_NAME                "Timberdale Video-In"
#define TIMBLOGIW_VERSION_CODE          0x04

#define TIMBLOGIW_LINES_PER_DESC        44
#define TIMBLOGIW_MAX_VIDEO_MEM         16

#define TIMBLOGIW_HAS_DECODER(lw)       (lw->pdata.encoder.module_name)


struct timblogiw {
        struct video_device             video_dev;
        struct v4l2_device              v4l2_dev; /* mutual exclusion */
        struct mutex                    lock;
        struct device                   *dev;
        struct timb_video_platform_data pdata;
        struct v4l2_subdev              *sd_enc;        /* encoder */
        bool                            opened;
};

struct timblogiw_tvnorm {
        v4l2_std_id std;
        u16     width;
        u16     height;
        u8      fps;
};

struct timblogiw_fh {
        struct videobuf_queue           vb_vidq;
        struct timblogiw_tvnorm const   *cur_norm;
        struct list_head                capture;
        struct dma_chan                 *chan;
        spinlock_t                      queue_lock; /* mutual exclusion */
        unsigned int                    frame_count;
};

struct timblogiw_buffer {
        /* common v4l buffer stuff -- must be first */
        struct videobuf_buffer  vb;
        struct scatterlist      sg[16];
        dma_cookie_t            cookie;
        struct timblogiw_fh     *fh;
};

const struct timblogiw_tvnorm timblogiw_tvnorms[] = {
        {
                .std                    = V4L2_STD_PAL,
                .width                  = 720,
                .height                 = 576,
                .fps                    = 25
        },
        {
                .std                    = V4L2_STD_NTSC,
                .width                  = 720,
                .height                 = 480,
                .fps                    = 30
        }
};

static int timblogiw_bytes_per_line(const struct timblogiw_tvnorm *norm)
{
        return norm->width * 2;
}


static int timblogiw_frame_size(const struct timblogiw_tvnorm *norm)
{
        return norm->height * timblogiw_bytes_per_line(norm);
}

static const struct timblogiw_tvnorm *timblogiw_get_norm(const v4l2_std_id std)
{
        int i;
        for (i = 0; i < ARRAY_SIZE(timblogiw_tvnorms); i++)
                if (timblogiw_tvnorms[i].std & std)
                        return timblogiw_tvnorms + i;

        /* default to first element */
        return timblogiw_tvnorms;
}

static void timblogiw_dma_cb(void *data)
{
        struct timblogiw_buffer *buf = data;
        struct timblogiw_fh *fh = buf->fh;
        struct videobuf_buffer *vb = &buf->vb;

        spin_lock(&fh->queue_lock);

        /* mark the transfer done */
        buf->cookie = -1;

        fh->frame_count++;

        if (vb->state != VIDEOBUF_ERROR) {
                list_del(&vb->queue);
                do_gettimeofday(&vb->ts);
                vb->field_count = fh->frame_count * 2;
                vb->state = VIDEOBUF_DONE;

                wake_up(&vb->done);
        }

        if (!list_empty(&fh->capture)) {
                vb = list_entry(fh->capture.next, struct videobuf_buffer,
                        queue);
                vb->state = VIDEOBUF_ACTIVE;
        }

        spin_unlock(&fh->queue_lock);
}

static bool timblogiw_dma_filter_fn(struct dma_chan *chan, void *filter_param)
{
        return chan->chan_id == (uintptr_t)filter_param;
}

/* IOCTL functions */

static int timblogiw_g_fmt(struct file *file, void  *priv,
        struct v4l2_format *format)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw *lw = video_get_drvdata(vdev);
        struct timblogiw_fh *fh = priv;

        dev_dbg(&vdev->dev, "%s entry\n", __func__);

        if (format->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
                return -EINVAL;

        mutex_lock(&lw->lock);

        format->fmt.pix.width = fh->cur_norm->width;
        format->fmt.pix.height = fh->cur_norm->height;
        format->fmt.pix.pixelformat = V4L2_PIX_FMT_UYVY;
        format->fmt.pix.bytesperline = timblogiw_bytes_per_line(fh->cur_norm);
        format->fmt.pix.sizeimage = timblogiw_frame_size(fh->cur_norm);
        format->fmt.pix.field = V4L2_FIELD_NONE;

        mutex_unlock(&lw->lock);

        return 0;
}

static int timblogiw_try_fmt(struct file *file, void  *priv,
        struct v4l2_format *format)
{
        struct video_device *vdev = video_devdata(file);
        struct v4l2_pix_format *pix = &format->fmt.pix;

        dev_dbg(&vdev->dev,
                "%s - width=%d, height=%d, pixelformat=%d, field=%d\n"
                "bytes per line %d, size image: %d, colorspace: %d\n",
                __func__,
                pix->width, pix->height, pix->pixelformat, pix->field,
                pix->bytesperline, pix->sizeimage, pix->colorspace);

        if (format->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
                return -EINVAL;

        if (pix->field != V4L2_FIELD_NONE)
                return -EINVAL;

        if (pix->pixelformat != V4L2_PIX_FMT_UYVY)
                return -EINVAL;

        return 0;
}

static int timblogiw_s_fmt(struct file *file, void  *priv,
        struct v4l2_format *format)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw *lw = video_get_drvdata(vdev);
        struct timblogiw_fh *fh = priv;
        struct v4l2_pix_format *pix = &format->fmt.pix;
        int err;

        mutex_lock(&lw->lock);

        err = timblogiw_try_fmt(file, priv, format);
        if (err)
                goto out;

        if (videobuf_queue_is_busy(&fh->vb_vidq)) {
                dev_err(&vdev->dev, "%s queue busy\n", __func__);
                err = -EBUSY;
                goto out;
        }

        pix->width = fh->cur_norm->width;
        pix->height = fh->cur_norm->height;

out:
        mutex_unlock(&lw->lock);
        return err;
}

static int timblogiw_querycap(struct file *file, void  *priv,
        struct v4l2_capability *cap)
{
        struct video_device *vdev = video_devdata(file);

        dev_dbg(&vdev->dev, "%s: Entry\n",  __func__);
        memset(cap, 0, sizeof(*cap));
        strncpy(cap->card, TIMBLOGIWIN_NAME, sizeof(cap->card)-1);
        strncpy(cap->driver, DRIVER_NAME, sizeof(cap->driver) - 1);
        strlcpy(cap->bus_info, vdev->name, sizeof(cap->bus_info));
        cap->version = TIMBLOGIW_VERSION_CODE;
        cap->capabilities = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING |
                V4L2_CAP_READWRITE;

        return 0;
}

static int timblogiw_enum_fmt(struct file *file, void  *priv,
        struct v4l2_fmtdesc *fmt)
{
        struct video_device *vdev = video_devdata(file);

        dev_dbg(&vdev->dev, "%s, index: %d\n",  __func__, fmt->index);

        if (fmt->index != 0)
                return -EINVAL;
        memset(fmt, 0, sizeof(*fmt));
        fmt->index = 0;
        fmt->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
        strncpy(fmt->description, "4:2:2, packed, YUYV",
                sizeof(fmt->description)-1);
        fmt->pixelformat = V4L2_PIX_FMT_UYVY;

        return 0;
}

static int timblogiw_g_parm(struct file *file, void *priv,
        struct v4l2_streamparm *sp)
{
        struct timblogiw_fh *fh = priv;
        struct v4l2_captureparm *cp = &sp->parm.capture;

        cp->capability = V4L2_CAP_TIMEPERFRAME;
        cp->timeperframe.numerator = 1;
        cp->timeperframe.denominator = fh->cur_norm->fps;

        return 0;
}

static int timblogiw_reqbufs(struct file *file, void  *priv,
        struct v4l2_requestbuffers *rb)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw_fh *fh = priv;

        dev_dbg(&vdev->dev, "%s: entry\n",  __func__);

        return videobuf_reqbufs(&fh->vb_vidq, rb);
}

static int timblogiw_querybuf(struct file *file, void  *priv,
        struct v4l2_buffer *b)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw_fh *fh = priv;

        dev_dbg(&vdev->dev, "%s: entry\n",  __func__);

        return videobuf_querybuf(&fh->vb_vidq, b);
}

static int timblogiw_qbuf(struct file *file, void  *priv, struct v4l2_buffer *b)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw_fh *fh = priv;

        dev_dbg(&vdev->dev, "%s: entry\n",  __func__);

        return videobuf_qbuf(&fh->vb_vidq, b);
}

static int timblogiw_dqbuf(struct file *file, void  *priv,
        struct v4l2_buffer *b)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw_fh *fh = priv;

        dev_dbg(&vdev->dev, "%s: entry\n",  __func__);

        return videobuf_dqbuf(&fh->vb_vidq, b, file->f_flags & O_NONBLOCK);
}

static int timblogiw_g_std(struct file *file, void  *priv, v4l2_std_id *std)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw_fh *fh = priv;

        dev_dbg(&vdev->dev, "%s: entry\n",  __func__);

        *std = fh->cur_norm->std;
        return 0;
}

static int timblogiw_s_std(struct file *file, void  *priv, v4l2_std_id *std)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw *lw = video_get_drvdata(vdev);
        struct timblogiw_fh *fh = priv;
        int err = 0;

        dev_dbg(&vdev->dev, "%s: entry\n",  __func__);

        mutex_lock(&lw->lock);

        if (TIMBLOGIW_HAS_DECODER(lw))
                err = v4l2_subdev_call(lw->sd_enc, core, s_std, *std);

        if (!err)
                fh->cur_norm = timblogiw_get_norm(*std);

        mutex_unlock(&lw->lock);

        return err;
}

static int timblogiw_enuminput(struct file *file, void  *priv,
        struct v4l2_input *inp)
{
        struct video_device *vdev = video_devdata(file);
        int i;

        dev_dbg(&vdev->dev, "%s: Entry\n",  __func__);

        if (inp->index != 0)
                return -EINVAL;

        inp->index = 0;

        strncpy(inp->name, "Timb input 1", sizeof(inp->name) - 1);
        inp->type = V4L2_INPUT_TYPE_CAMERA;

        inp->std = 0;
        for (i = 0; i < ARRAY_SIZE(timblogiw_tvnorms); i++)
                inp->std |= timblogiw_tvnorms[i].std;

        return 0;
}

static int timblogiw_g_input(struct file *file, void  *priv,
        unsigned int *input)
{
        struct video_device *vdev = video_devdata(file);

        dev_dbg(&vdev->dev, "%s: Entry\n",  __func__);

        *input = 0;

        return 0;
}

static int timblogiw_s_input(struct file *file, void  *priv, unsigned int input)
{
        struct video_device *vdev = video_devdata(file);

        dev_dbg(&vdev->dev, "%s: Entry\n",  __func__);

        if (input != 0)
                return -EINVAL;
        return 0;
}

static int timblogiw_streamon(struct file *file, void  *priv, unsigned int type)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw_fh *fh = priv;

        dev_dbg(&vdev->dev, "%s: entry\n",  __func__);

        if (type != V4L2_BUF_TYPE_VIDEO_CAPTURE) {
                dev_dbg(&vdev->dev, "%s - No capture device\n", __func__);
                return -EINVAL;
        }

        fh->frame_count = 0;
        return videobuf_streamon(&fh->vb_vidq);
}

static int timblogiw_streamoff(struct file *file, void  *priv,
        unsigned int type)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw_fh *fh = priv;

        dev_dbg(&vdev->dev, "%s entry\n",  __func__);

        if (type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
                return -EINVAL;

        return videobuf_streamoff(&fh->vb_vidq);
}

static int timblogiw_querystd(struct file *file, void  *priv, v4l2_std_id *std)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw *lw = video_get_drvdata(vdev);
        struct timblogiw_fh *fh = priv;

        dev_dbg(&vdev->dev, "%s entry\n",  __func__);

        if (TIMBLOGIW_HAS_DECODER(lw))
                return v4l2_subdev_call(lw->sd_enc, video, querystd, std);
        else {
                *std = fh->cur_norm->std;
                return 0;
        }
}

static int timblogiw_enum_framesizes(struct file *file, void  *priv,
        struct v4l2_frmsizeenum *fsize)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw_fh *fh = priv;

        dev_dbg(&vdev->dev, "%s - index: %d, format: %d\n",  __func__,
                fsize->index, fsize->pixel_format);

        if ((fsize->index != 0) ||
                (fsize->pixel_format != V4L2_PIX_FMT_UYVY))
                return -EINVAL;

        fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE;
        fsize->discrete.width = fh->cur_norm->width;
        fsize->discrete.height = fh->cur_norm->height;

        return 0;
}

/* Video buffer functions */

static int buffer_setup(struct videobuf_queue *vq, unsigned int *count,
        unsigned int *size)
{
        struct timblogiw_fh *fh = vq->priv_data;

        *size = timblogiw_frame_size(fh->cur_norm);

        if (!*count)
                *count = 32;

        while (*size * *count > TIMBLOGIW_MAX_VIDEO_MEM * 1024 * 1024)
                (*count)--;

        return 0;
}

static int buffer_prepare(struct videobuf_queue *vq, struct videobuf_buffer *vb,
        enum v4l2_field field)
{
        struct timblogiw_fh *fh = vq->priv_data;
        struct timblogiw_buffer *buf = container_of(vb, struct timblogiw_buffer,
                vb);
        unsigned int data_size = timblogiw_frame_size(fh->cur_norm);
        int err = 0;

        if (vb->baddr && vb->bsize < data_size)
                /* User provided buffer, but it is too small */
                return -ENOMEM;

        vb->size = data_size;
        vb->width = fh->cur_norm->width;
        vb->height = fh->cur_norm->height;
        vb->field = field;

        if (vb->state == VIDEOBUF_NEEDS_INIT) {
                int i;
                unsigned int size;
                unsigned int bytes_per_desc = TIMBLOGIW_LINES_PER_DESC *
                        timblogiw_bytes_per_line(fh->cur_norm);
                dma_addr_t addr;

                sg_init_table(buf->sg, ARRAY_SIZE(buf->sg));

                err = videobuf_iolock(vq, vb, NULL);
                if (err)
                        goto err;

                addr = videobuf_to_dma_contig(vb);
                for (i = 0, size = 0; size < data_size; i++) {
                        sg_dma_address(buf->sg + i) = addr + size;
                        size += bytes_per_desc;
                        sg_dma_len(buf->sg + i) = (size > data_size) ?
                                (bytes_per_desc - (size - data_size)) :
                                bytes_per_desc;
                }

                vb->state = VIDEOBUF_PREPARED;
                buf->cookie = -1;
                buf->fh = fh;
        }

        return 0;

err:
        videobuf_dma_contig_free(vq, vb);
        vb->state = VIDEOBUF_NEEDS_INIT;
        return err;
}

static void buffer_queue(struct videobuf_queue *vq, struct videobuf_buffer *vb)
{
        struct timblogiw_fh *fh = vq->priv_data;
        struct timblogiw_buffer *buf = container_of(vb, struct timblogiw_buffer,
                vb);
        struct dma_async_tx_descriptor *desc;
        int sg_elems;
        int bytes_per_desc = TIMBLOGIW_LINES_PER_DESC *
                timblogiw_bytes_per_line(fh->cur_norm);

        sg_elems = timblogiw_frame_size(fh->cur_norm) / bytes_per_desc;
        sg_elems +=
                (timblogiw_frame_size(fh->cur_norm) % bytes_per_desc) ? 1 : 0;

        if (list_empty(&fh->capture))
                vb->state = VIDEOBUF_ACTIVE;
        else
                vb->state = VIDEOBUF_QUEUED;

        list_add_tail(&vb->queue, &fh->capture);

        spin_unlock_irq(&fh->queue_lock);

        desc = fh->chan->device->device_prep_slave_sg(fh->chan,
                buf->sg, sg_elems, DMA_FROM_DEVICE,
                DMA_PREP_INTERRUPT | DMA_COMPL_SKIP_SRC_UNMAP);
        if (!desc) {
                spin_lock_irq(&fh->queue_lock);
                list_del_init(&vb->queue);
                vb->state = VIDEOBUF_PREPARED;
                return;
        }

        desc->callback_param = buf;
        desc->callback = timblogiw_dma_cb;

        buf->cookie = desc->tx_submit(desc);

        spin_lock_irq(&fh->queue_lock);
}

static void buffer_release(struct videobuf_queue *vq,
        struct videobuf_buffer *vb)
{
        struct timblogiw_fh *fh = vq->priv_data;
        struct timblogiw_buffer *buf = container_of(vb, struct timblogiw_buffer,
                vb);

        videobuf_waiton(vq, vb, 0, 0);
        if (buf->cookie >= 0)
                dma_sync_wait(fh->chan, buf->cookie);

        videobuf_dma_contig_free(vq, vb);
        vb->state = VIDEOBUF_NEEDS_INIT;
}

static struct videobuf_queue_ops timblogiw_video_qops = {
        .buf_setup      = buffer_setup,
        .buf_prepare    = buffer_prepare,
        .buf_queue      = buffer_queue,
        .buf_release    = buffer_release,
};

/* Device Operations functions */

static int timblogiw_open(struct file *file)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw *lw = video_get_drvdata(vdev);
        struct timblogiw_fh *fh;
        v4l2_std_id std;
        dma_cap_mask_t mask;
        int err = 0;

        dev_dbg(&vdev->dev, "%s: entry\n", __func__);

        mutex_lock(&lw->lock);
        if (lw->opened) {
                err = -EBUSY;
                goto out;
        }

        if (TIMBLOGIW_HAS_DECODER(lw) && !lw->sd_enc) {
                struct i2c_adapter *adapt;

                /* find the video decoder */
                adapt = i2c_get_adapter(lw->pdata.i2c_adapter);
                if (!adapt) {
                        dev_err(&vdev->dev, "No I2C bus #%d\n",
                                lw->pdata.i2c_adapter);
                        err = -ENODEV;
                        goto out;
                }

                /* now find the encoder */
                lw->sd_enc = v4l2_i2c_new_subdev_board(&lw->v4l2_dev, adapt,
                        lw->pdata.encoder.info, NULL);

                i2c_put_adapter(adapt);

                if (!lw->sd_enc) {
                        dev_err(&vdev->dev, "Failed to get encoder: %s\n",
                                lw->pdata.encoder.module_name);
                        err = -ENODEV;
                        goto out;
                }
        }

        fh = kzalloc(sizeof(*fh), GFP_KERNEL);
        if (!fh) {
                err = -ENOMEM;
                goto out;
        }

        fh->cur_norm = timblogiw_tvnorms;
        timblogiw_querystd(file, fh, &std);
        fh->cur_norm = timblogiw_get_norm(std);

        INIT_LIST_HEAD(&fh->capture);
        spin_lock_init(&fh->queue_lock);

        dma_cap_zero(mask);
        dma_cap_set(DMA_SLAVE, mask);
        dma_cap_set(DMA_PRIVATE, mask);

        /* find the DMA channel */
        fh->chan = dma_request_channel(mask, timblogiw_dma_filter_fn,
                        (void *)(uintptr_t)lw->pdata.dma_channel);
        if (!fh->chan) {
                dev_err(&vdev->dev, "Failed to get DMA channel\n");
                kfree(fh);
                err = -ENODEV;
                goto out;
        }

        file->private_data = fh;
        videobuf_queue_dma_contig_init(&fh->vb_vidq,
                &timblogiw_video_qops, lw->dev, &fh->queue_lock,
                V4L2_BUF_TYPE_VIDEO_CAPTURE, V4L2_FIELD_NONE,
                sizeof(struct timblogiw_buffer), fh, NULL);

        lw->opened = true;
out:
        mutex_unlock(&lw->lock);

        return err;
}

static int timblogiw_close(struct file *file)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw *lw = video_get_drvdata(vdev);
        struct timblogiw_fh *fh = file->private_data;

        dev_dbg(&vdev->dev, "%s: Entry\n",  __func__);

        videobuf_stop(&fh->vb_vidq);
        videobuf_mmap_free(&fh->vb_vidq);

        dma_release_channel(fh->chan);

        kfree(fh);

        mutex_lock(&lw->lock);
        lw->opened = false;
        mutex_unlock(&lw->lock);
        return 0;
}

static ssize_t timblogiw_read(struct file *file, char __user *data,
        size_t count, loff_t *ppos)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw_fh *fh = file->private_data;

        dev_dbg(&vdev->dev, "%s: entry\n",  __func__);

        return videobuf_read_stream(&fh->vb_vidq, data, count, ppos, 0,
                file->f_flags & O_NONBLOCK);
}

static unsigned int timblogiw_poll(struct file *file,
        struct poll_table_struct *wait)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw_fh *fh = file->private_data;

        dev_dbg(&vdev->dev, "%s: entry\n",  __func__);

        return videobuf_poll_stream(file, &fh->vb_vidq, wait);
}

static int timblogiw_mmap(struct file *file, struct vm_area_struct *vma)
{
        struct video_device *vdev = video_devdata(file);
        struct timblogiw_fh *fh = file->private_data;

        dev_dbg(&vdev->dev, "%s: entry\n", __func__);

        return videobuf_mmap_mapper(&fh->vb_vidq, vma);
}

/* Platform device functions */

static __devinitconst struct v4l2_ioctl_ops timblogiw_ioctl_ops = {
        .vidioc_querycap                = timblogiw_querycap,
        .vidioc_enum_fmt_vid_cap        = timblogiw_enum_fmt,
        .vidioc_g_fmt_vid_cap           = timblogiw_g_fmt,
        .vidioc_try_fmt_vid_cap         = timblogiw_try_fmt,
        .vidioc_s_fmt_vid_cap           = timblogiw_s_fmt,
        .vidioc_g_parm                  = timblogiw_g_parm,
        .vidioc_reqbufs                 = timblogiw_reqbufs,
        .vidioc_querybuf                = timblogiw_querybuf,
        .vidioc_qbuf                    = timblogiw_qbuf,
        .vidioc_dqbuf                   = timblogiw_dqbuf,
        .vidioc_g_std                   = timblogiw_g_std,
        .vidioc_s_std                   = timblogiw_s_std,
        .vidioc_enum_input              = timblogiw_enuminput,
        .vidioc_g_input                 = timblogiw_g_input,
        .vidioc_s_input                 = timblogiw_s_input,
        .vidioc_streamon                = timblogiw_streamon,
        .vidioc_streamoff               = timblogiw_streamoff,
        .vidioc_querystd                = timblogiw_querystd,
        .vidioc_enum_framesizes         = timblogiw_enum_framesizes,
};

static __devinitconst struct v4l2_file_operations timblogiw_fops = {
        .owner          = THIS_MODULE,
        .open           = timblogiw_open,
        .release        = timblogiw_close,
        .unlocked_ioctl         = video_ioctl2, /* V4L2 ioctl handler */
        .mmap           = timblogiw_mmap,
        .read           = timblogiw_read,
        .poll           = timblogiw_poll,
};

static __devinitconst struct video_device timblogiw_template = {
        .name           = TIMBLOGIWIN_NAME,
        .fops           = &timblogiw_fops,
        .ioctl_ops      = &timblogiw_ioctl_ops,
        .release        = video_device_release_empty,
        .minor          = -1,
        .tvnorms        = V4L2_STD_PAL | V4L2_STD_NTSC
};

static int __devinit timblogiw_probe(struct platform_device *pdev)
{
        int err;
        struct timblogiw *lw = NULL;
        struct timb_video_platform_data *pdata = pdev->dev.platform_data;

        if (!pdata) {
                dev_err(&pdev->dev, "No platform data\n");
                err = -EINVAL;
                goto err;
        }

        if (!pdata->encoder.module_name)
                dev_info(&pdev->dev, "Running without decoder\n");

        lw = kzalloc(sizeof(*lw), GFP_KERNEL);
        if (!lw) {
                err = -ENOMEM;
                goto err;
        }

        if (pdev->dev.parent)
                lw->dev = pdev->dev.parent;
        else
                lw->dev = &pdev->dev;

        memcpy(&lw->pdata, pdata, sizeof(lw->pdata));

        mutex_init(&lw->lock);

        lw->video_dev = timblogiw_template;

        strlcpy(lw->v4l2_dev.name, DRIVER_NAME, sizeof(lw->v4l2_dev.name));
        err = v4l2_device_register(NULL, &lw->v4l2_dev);
        if (err)
                goto err_register;

        lw->video_dev.v4l2_dev = &lw->v4l2_dev;

        platform_set_drvdata(pdev, lw);
        video_set_drvdata(&lw->video_dev, lw);

        err = video_register_device(&lw->video_dev, VFL_TYPE_GRABBER, 0);
        if (err) {
                dev_err(&pdev->dev, "Error reg video: %d\n", err);
                goto err_request;
        }


        return 0;

err_request:
        platform_set_drvdata(pdev, NULL);
        v4l2_device_unregister(&lw->v4l2_dev);
err_register:
        kfree(lw);
err:
        dev_err(&pdev->dev, "Failed to register: %d\n", err);

        return err;
}

static int __devexit timblogiw_remove(struct platform_device *pdev)
{
        struct timblogiw *lw = platform_get_drvdata(pdev);

        video_unregister_device(&lw->video_dev);

        v4l2_device_unregister(&lw->v4l2_dev);

        kfree(lw);

        platform_set_drvdata(pdev, NULL);

        return 0;
}

static struct platform_driver timblogiw_platform_driver = {
        .driver = {
                .name   = DRIVER_NAME,
                .owner  = THIS_MODULE,
        },
        .probe          = timblogiw_probe,
        .remove         = __devexit_p(timblogiw_remove),
};

/* Module functions */

static int __init timblogiw_init(void)
{
        return platform_driver_register(&timblogiw_platform_driver);
}

static void __exit timblogiw_exit(void)
{
        platform_driver_unregister(&timblogiw_platform_driver);
}

module_init(timblogiw_init);
module_exit(timblogiw_exit);

MODULE_DESCRIPTION(TIMBLOGIWIN_NAME);
MODULE_AUTHOR("Pelagicore AB <info@pelagicore.com>");
MODULE_LICENSE("GPL v2");
MODULE_ALIAS("platform:"DRIVER_NAME);