comparison vloopback.c @ 11:b904131a3807

Allow to build with kernel 2.6.27.git and 2.6.28-rc9

10:bce647a9dd4b

 *
 * 24.08.08    (Angel Carpintero)
 *            Added compat_iotcl32 init in fopsl, replace tabs by 4 spaces in source code,
 *            add number of buffers as module param.
 *
 * 13.10.09    (Stephan Berberig & Angel Carpintero)
 *            Release to work on 2.6.27 , allow v4l_compat_ioctl32 work in 2.6.27 and a little cleanup 
 *            in Makefile.
 */


#define VLOOPBACK_VERSION "1.2-trunk"

#endif

/* v4l_compat_ioctl32 */ 
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27)
 #include <media/v4l2-ioctl.h>
#endif

#include <linux/videodev.h>
#include <linux/vmalloc.h>
#include <linux/wait.h>

typedef struct vloopback_private *priv_ptr;

struct vloopback_pipe {
    struct video_device *vloopin;
     struct video_device *vloopout;
    char *buffer;
    unsigned long buflength;
    unsigned int width, height;
    unsigned int palette;
    unsigned long frameswrite;

}

static int vloopback_open(struct inode *inod, struct file *f)
{    
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->priv;
    int nr = ptr->pipenr;

    if (debug > LOG_NODEBUG)
        info("Video loopback %d", nr);    

}

static int vloopback_release(struct inode * inod, struct file *f)
{
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->priv;
    int nr = ptr->pipenr;

    if (debug > LOG_NODEBUG)
        info("Video loopback %d", nr);

static ssize_t vloopback_write(struct file *f, const char *buf,
               size_t count, loff_t *offset)
{
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->priv;
    int nr = ptr->pipenr;
    unsigned long realcount = count;

    if (debug > LOG_IOCTL)
        info("Video loopback %d", nr);

static ssize_t vloopback_read(struct file * f, char * buf, size_t count, 
               loff_t *offset)
{
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->priv;
    int nr = ptr->pipenr;
    unsigned long realcount = count;

    if (debug > LOG_IOCTL)
        info("Video loopback %d", nr);

}

static int vloopback_mmap(struct file *f, struct vm_area_struct *vma)
{
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->priv;
    int nr = ptr->pipenr;
    unsigned long start = (unsigned long)vma->vm_start;
    long size = vma->vm_end - vma->vm_start;
    unsigned long page, pos;

static int vloopback_ioctl(struct inode *inod, struct file *f, unsigned int cmd, 
           unsigned long arg)
{
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->priv;
    int nr = ptr->pipenr;
    int i;

    if (debug > LOG_NODEBUG)
        info("Video loopback %d cmd %u", nr, cmd);

}

static unsigned int vloopback_poll(struct file *f, struct poll_table_struct *wait)
{
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->priv;
    int nr = ptr->pipenr;

    if (debug > LOG_NODEBUG)
        info("Video loopback %d", nr);

    loops[nr]->vloopin = video_device_alloc();

    if (loops[nr]->vloopin == NULL)
        return -ENOMEM;
    *loops[nr]->vloopin = vloopback_template;
    loops[nr]->vloopin->priv = kmalloc(sizeof(struct vloopback_private),
                                       GFP_KERNEL);
    if (loops[nr]->vloopin->priv == NULL) {
        kfree(loops[nr]->vloopin);
        return -ENOMEM;
    }
    /* repeat for the output device */
    loops[nr]->vloopout = video_device_alloc();

    if (loops[nr]->vloopout == NULL) {
        kfree(loops[nr]->vloopin->priv);
        kfree(loops[nr]->vloopin);
        return -ENOMEM;
    }
    *loops[nr]->vloopout = vloopback_template;
    loops[nr]->vloopout->priv = kmalloc(sizeof(struct vloopback_private),
                                        GFP_KERNEL);

    if (loops[nr]->vloopout->priv == NULL) {
        kfree(loops[nr]->vloopin->priv);
        kfree(loops[nr]->vloopin);
        kfree(loops[nr]->vloopout);
        return -ENOMEM;
    }

    ((priv_ptr)loops[nr]->vloopin->priv)->pipenr = nr;
    ((priv_ptr)loops[nr]->vloopout->priv)->pipenr = nr;
    loops[nr]->invalid_ioctl = 0; /* tibit */
    loops[nr]->buffer = NULL;
    loops[nr]->width = 0;
    loops[nr]->height = 0;
    loops[nr]->palette = 0;

    loops[nr]->framesdumped = 0;
    loops[nr]->wopen = 0;
    loops[nr]->ropen = 0;
    loops[nr]->frame = 0;
    
    ((priv_ptr)loops[nr]->vloopin->priv)->in = 1;
    ((priv_ptr)loops[nr]->vloopout->priv)->in = 0;
    sprintf(loops[nr]->vloopin->name, "Video loopback %d input", nr);
    sprintf(loops[nr]->vloopout->name, "Video loopback %d output", nr);

#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,27)
    loops[nr]->vloopin->type = 0;

    
    ret = video_register_device(loops[nr]->vloopin, VFL_TYPE_GRABBER, minor_in);
    
    if ((ret == -1 ) || ( ret == -23 )) {
        info("error registering device %s", loops[nr]->vloopin->name);
        kfree(loops[nr]->vloopin->priv);
        kfree(loops[nr]->vloopin);
        kfree(loops[nr]->vloopout->priv);
        kfree(loops[nr]->vloopout);
        kfree(loops[nr]);
        loops[nr] = NULL;
        return ret;
    }
    
    ret = video_register_device(loops[nr]->vloopout, VFL_TYPE_GRABBER, minor_out);
    
    if ((ret ==-1) || (ret == -23)) {
        info("error registering device %s", loops[nr]->vloopout->name);
        kfree(loops[nr]->vloopin->priv);
        video_unregister_device(loops[nr]->vloopin);
        kfree(loops[nr]->vloopout->priv);
        kfree(loops[nr]->vloopout);
        kfree(loops[nr]);
        loops[nr] = NULL;
        return ret;
    }

    info("Unregistering video4linux loopback devices");

    for (i = 0; i < nr_o_pipes; i++) {
        if (loops[i]) {
            kfree(loops[i]->vloopin->priv);
            video_unregister_device(loops[i]->vloopin);
            kfree(loops[i]->vloopout->priv);
            video_unregister_device(loops[i]->vloopout);
            
            if (loops[i]->buffer) 
                rvfree(loops[i]->buffer, loops[i]->buflength * num_buffers);

11:b904131a3807

 *
 * 24.08.08    (Angel Carpintero)
 *            Added compat_iotcl32 init in fopsl, replace tabs by 4 spaces in source code,
 *            add number of buffers as module param.
 *
 * 13.10.08    (Stephan Berberig & Angel Carpintero)
 *            Release to work on 2.6.27 , allow v4l_compat_ioctl32 work in 2.6.27 and a little cleanup 
 *            in Makefile.
 *
 * 22.12.08    (Angel Carpintero)
 *            Allow build with kernel 2.6.28 and 2.6.27.git ( struct video_dev has not priv member anymore).          
 */


#define VLOOPBACK_VERSION "1.2-trunk"

#endif

/* v4l_compat_ioctl32 */ 
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27)
 #include <media/v4l2-ioctl.h>
#endif

#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,27)
 #define vd_private_data dev.driver_data
#else
 #define vd_private_data priv
#endif

#include <linux/videodev.h>
#include <linux/vmalloc.h>
#include <linux/wait.h>

typedef struct vloopback_private *priv_ptr;

struct vloopback_pipe {
    struct video_device *vloopin;
    struct video_device *vloopout;
    char *buffer;
    unsigned long buflength;
    unsigned int width, height;
    unsigned int palette;
    unsigned long frameswrite;

}

static int vloopback_open(struct inode *inod, struct file *f)
{    
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->vd_private_data; 
    //priv_ptr ptr = (priv_ptr)video_get_drvdata(loopdev);
    int nr = ptr->pipenr;

    if (debug > LOG_NODEBUG)
        info("Video loopback %d", nr);    

}

static int vloopback_release(struct inode * inod, struct file *f)
{
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->vd_private_data;
    //priv_ptr ptr = (priv_ptr)video_get_drvdata(loopdev);
    int nr = ptr->pipenr;

    if (debug > LOG_NODEBUG)
        info("Video loopback %d", nr);

static ssize_t vloopback_write(struct file *f, const char *buf,
               size_t count, loff_t *offset)
{
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->vd_private_data;
    //priv_ptr ptr = (priv_ptr)video_get_drvdata(loopdev);
    int nr = ptr->pipenr;
    unsigned long realcount = count;

    if (debug > LOG_IOCTL)
        info("Video loopback %d", nr);

static ssize_t vloopback_read(struct file * f, char * buf, size_t count, 
               loff_t *offset)
{
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->vd_private_data;
    //priv_ptr ptr = (priv_ptr)video_get_drvdata(loopdev);
    int nr = ptr->pipenr;
    unsigned long realcount = count;

    if (debug > LOG_IOCTL)
        info("Video loopback %d", nr);

}

static int vloopback_mmap(struct file *f, struct vm_area_struct *vma)
{
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->vd_private_data;
    //priv_ptr ptr = (priv_ptr)video_get_drvdata(loopdev);
    int nr = ptr->pipenr;
    unsigned long start = (unsigned long)vma->vm_start;
    long size = vma->vm_end - vma->vm_start;
    unsigned long page, pos;

static int vloopback_ioctl(struct inode *inod, struct file *f, unsigned int cmd, 
           unsigned long arg)
{
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->vd_private_data;
    //priv_ptr ptr = (priv_ptr)video_get_drvdata(loopdev);
    int nr = ptr->pipenr;
    int i;

    if (debug > LOG_NODEBUG)
        info("Video loopback %d cmd %u", nr, cmd);

}

static unsigned int vloopback_poll(struct file *f, struct poll_table_struct *wait)
{
    struct video_device *loopdev = video_devdata(f);
    priv_ptr ptr = (priv_ptr)loopdev->vd_private_data;
    //priv_ptr ptr = (priv_ptr)video_get_drvdata(loopdev);
    int nr = ptr->pipenr;

    if (debug > LOG_NODEBUG)
        info("Video loopback %d", nr);

    loops[nr]->vloopin = video_device_alloc();

    if (loops[nr]->vloopin == NULL)
        return -ENOMEM;
    *loops[nr]->vloopin = vloopback_template;

    loops[nr]->vloopin->vd_private_data = kmalloc(sizeof(struct vloopback_private),
                                                  GFP_KERNEL);

    if (loops[nr]->vloopin->vd_private_data == NULL) {
        kfree(loops[nr]->vloopin);
        return -ENOMEM;
    }
    /* repeat for the output device */
    loops[nr]->vloopout = video_device_alloc();

    if (loops[nr]->vloopout == NULL) {
        kfree(loops[nr]->vloopin->vd_private_data);
        kfree(loops[nr]->vloopin);
        return -ENOMEM;
    }
    *loops[nr]->vloopout = vloopback_template;
    loops[nr]->vloopout->vd_private_data = kmalloc(sizeof(struct vloopback_private),
                                                   GFP_KERNEL);

    if (loops[nr]->vloopout->vd_private_data == NULL) {
        kfree(loops[nr]->vloopin->vd_private_data);
        kfree(loops[nr]->vloopin);
        kfree(loops[nr]->vloopout);
        return -ENOMEM;
    }

    ((priv_ptr)loops[nr]->vloopin->vd_private_data)->pipenr = nr;
    ((priv_ptr)loops[nr]->vloopout->vd_private_data)->pipenr = nr;
    loops[nr]->invalid_ioctl = 0; /* tibit */
    loops[nr]->buffer = NULL;
    loops[nr]->width = 0;
    loops[nr]->height = 0;
    loops[nr]->palette = 0;

    loops[nr]->framesdumped = 0;
    loops[nr]->wopen = 0;
    loops[nr]->ropen = 0;
    loops[nr]->frame = 0;
    
    ((priv_ptr)loops[nr]->vloopin->vd_private_data)->in = 1;
    ((priv_ptr)loops[nr]->vloopout->vd_private_data)->in = 0;
    sprintf(loops[nr]->vloopin->name, "Video loopback %d input", nr);
    sprintf(loops[nr]->vloopout->name, "Video loopback %d output", nr);

#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,27)
    loops[nr]->vloopin->type = 0;

    
    ret = video_register_device(loops[nr]->vloopin, VFL_TYPE_GRABBER, minor_in);
    
    if ((ret == -1 ) || ( ret == -23 )) {
        info("error registering device %s", loops[nr]->vloopin->name);
        kfree(loops[nr]->vloopin->vd_private_data);
        kfree(loops[nr]->vloopin);
        kfree(loops[nr]->vloopout->vd_private_data);
        kfree(loops[nr]->vloopout);
        kfree(loops[nr]);
        loops[nr] = NULL;
        return ret;
    }
    
    ret = video_register_device(loops[nr]->vloopout, VFL_TYPE_GRABBER, minor_out);
    
    if ((ret ==-1) || (ret == -23)) {
        info("error registering device %s", loops[nr]->vloopout->name);
        kfree(loops[nr]->vloopin->vd_private_data);
        video_unregister_device(loops[nr]->vloopin);
        kfree(loops[nr]->vloopout->vd_private_data);
        kfree(loops[nr]->vloopout);
        kfree(loops[nr]);
        loops[nr] = NULL;
        return ret;
    }

    info("Unregistering video4linux loopback devices");

    for (i = 0; i < nr_o_pipes; i++) {
        if (loops[i]) {
            kfree(loops[i]->vloopin->vd_private_data);
            video_unregister_device(loops[i]->vloopin);
            kfree(loops[i]->vloopout->vd_private_data);
            video_unregister_device(loops[i]->vloopout);
            
            if (loops[i]->buffer) 
                rvfree(loops[i]->buffer, loops[i]->buflength * num_buffers);