Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/sparc-2.6
[pandora-kernel.git] / drivers / media / video / soc_camera.c
index 7217de2..6d8bfd4 100644 (file)
 #include <media/videobuf-core.h>
 #include <media/soc_camera.h>
 
+/* Default to VGA resolution */
+#define DEFAULT_WIDTH  640
+#define DEFAULT_HEIGHT 480
+
 static LIST_HEAD(hosts);
 static LIST_HEAD(devices);
 static DEFINE_MUTEX(list_lock);
-static DEFINE_MUTEX(video_lock);
 
-const static struct soc_camera_data_format *format_by_fourcc(
+const struct soc_camera_data_format *soc_camera_format_by_fourcc(
        struct soc_camera_device *icd, unsigned int fourcc)
 {
        unsigned int i;
@@ -45,62 +48,87 @@ const static struct soc_camera_data_format *format_by_fourcc(
                        return icd->formats + i;
        return NULL;
 }
+EXPORT_SYMBOL(soc_camera_format_by_fourcc);
 
-static int soc_camera_try_fmt_vid_cap(struct file *file, void *priv,
-                                     struct v4l2_format *f)
+const struct soc_camera_format_xlate *soc_camera_xlate_by_fourcc(
+       struct soc_camera_device *icd, unsigned int fourcc)
 {
-       struct soc_camera_file *icf = file->private_data;
-       struct soc_camera_device *icd = icf->icd;
-       struct soc_camera_host *ici =
-               to_soc_camera_host(icd->dev.parent);
-       enum v4l2_field field;
-       const struct soc_camera_data_format *fmt;
-       int ret;
+       unsigned int i;
 
-       WARN_ON(priv != file->private_data);
+       for (i = 0; i < icd->num_user_formats; i++)
+               if (icd->user_formats[i].host_fmt->fourcc == fourcc)
+                       return icd->user_formats + i;
+       return NULL;
+}
+EXPORT_SYMBOL(soc_camera_xlate_by_fourcc);
 
-       fmt = format_by_fourcc(icd, f->fmt.pix.pixelformat);
-       if (!fmt) {
-               dev_dbg(&icd->dev, "invalid format 0x%08x\n",
-                       f->fmt.pix.pixelformat);
-               return -EINVAL;
-       }
+/**
+ * soc_camera_apply_sensor_flags() - apply platform SOCAM_SENSOR_INVERT_* flags
+ * @icl:       camera platform parameters
+ * @flags:     flags to be inverted according to platform configuration
+ * @return:    resulting flags
+ */
+unsigned long soc_camera_apply_sensor_flags(struct soc_camera_link *icl,
+                                           unsigned long flags)
+{
+       unsigned long f;
 
-       dev_dbg(&icd->dev, "fmt: 0x%08x\n", fmt->fourcc);
+       /* If only one of the two polarities is supported, switch to the opposite */
+       if (icl->flags & SOCAM_SENSOR_INVERT_HSYNC) {
+               f = flags & (SOCAM_HSYNC_ACTIVE_HIGH | SOCAM_HSYNC_ACTIVE_LOW);
+               if (f == SOCAM_HSYNC_ACTIVE_HIGH || f == SOCAM_HSYNC_ACTIVE_LOW)
+                       flags ^= SOCAM_HSYNC_ACTIVE_HIGH | SOCAM_HSYNC_ACTIVE_LOW;
+       }
 
-       field = f->fmt.pix.field;
+       if (icl->flags & SOCAM_SENSOR_INVERT_VSYNC) {
+               f = flags & (SOCAM_VSYNC_ACTIVE_HIGH | SOCAM_VSYNC_ACTIVE_LOW);
+               if (f == SOCAM_VSYNC_ACTIVE_HIGH || f == SOCAM_VSYNC_ACTIVE_LOW)
+                       flags ^= SOCAM_VSYNC_ACTIVE_HIGH | SOCAM_VSYNC_ACTIVE_LOW;
+       }
 
-       if (field == V4L2_FIELD_ANY) {
-               field = V4L2_FIELD_NONE;
-       } else if (V4L2_FIELD_NONE != field) {
-               dev_err(&icd->dev, "Field type invalid.\n");
-               return -EINVAL;
+       if (icl->flags & SOCAM_SENSOR_INVERT_PCLK) {
+               f = flags & (SOCAM_PCLK_SAMPLE_RISING | SOCAM_PCLK_SAMPLE_FALLING);
+               if (f == SOCAM_PCLK_SAMPLE_RISING || f == SOCAM_PCLK_SAMPLE_FALLING)
+                       flags ^= SOCAM_PCLK_SAMPLE_RISING | SOCAM_PCLK_SAMPLE_FALLING;
        }
 
-       /* limit format to hardware capabilities */
-       ret = ici->ops->try_fmt_cap(icd, f);
+       return flags;
+}
+EXPORT_SYMBOL(soc_camera_apply_sensor_flags);
 
-       /* calculate missing fields */
-       f->fmt.pix.field = field;
-       f->fmt.pix.bytesperline =
-               (f->fmt.pix.width * fmt->depth) >> 3;
-       f->fmt.pix.sizeimage =
-               f->fmt.pix.height * f->fmt.pix.bytesperline;
+static int soc_camera_try_fmt_vid_cap(struct file *file, void *priv,
+                                     struct v4l2_format *f)
+{
+       struct soc_camera_file *icf = file->private_data;
+       struct soc_camera_device *icd = icf->icd;
+       struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
 
-       return ret;
+       WARN_ON(priv != file->private_data);
+
+       /* limit format to hardware capabilities */
+       return ici->ops->try_fmt(icd, f);
 }
 
 static int soc_camera_enum_input(struct file *file, void *priv,
                                 struct v4l2_input *inp)
 {
+       struct soc_camera_file *icf = file->private_data;
+       struct soc_camera_device *icd = icf->icd;
+       int ret = 0;
+
        if (inp->index != 0)
                return -EINVAL;
 
-       inp->type = V4L2_INPUT_TYPE_CAMERA;
-       inp->std = V4L2_STD_UNKNOWN;
-       strcpy(inp->name, "Camera");
+       if (icd->ops->enum_input)
+               ret = icd->ops->enum_input(icd, inp);
+       else {
+               /* default is camera */
+               inp->type = V4L2_INPUT_TYPE_CAMERA;
+               inp->std  = V4L2_STD_UNKNOWN;
+               strcpy(inp->name, "Camera");
+       }
 
-       return 0;
+       return ret;
 }
 
 static int soc_camera_g_input(struct file *file, void *priv, unsigned int *i)
@@ -120,7 +148,14 @@ static int soc_camera_s_input(struct file *file, void *priv, unsigned int i)
 
 static int soc_camera_s_std(struct file *file, void *priv, v4l2_std_id *a)
 {
-       return 0;
+       struct soc_camera_file *icf = file->private_data;
+       struct soc_camera_device *icd = icf->icd;
+       int ret = 0;
+
+       if (icd->ops->set_std)
+               ret = icd->ops->set_std(icd, a);
+
+       return ret;
 }
 
 static int soc_camera_reqbufs(struct file *file, void *priv,
@@ -129,8 +164,7 @@ static int soc_camera_reqbufs(struct file *file, void *priv,
        int ret;
        struct soc_camera_file *icf = file->private_data;
        struct soc_camera_device *icd = icf->icd;
-       struct soc_camera_host *ici =
-               to_soc_camera_host(icd->dev.parent);
+       struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
 
        WARN_ON(priv != file->private_data);
 
@@ -173,7 +207,100 @@ static int soc_camera_dqbuf(struct file *file, void *priv,
        return videobuf_dqbuf(&icf->vb_vidq, p, file->f_flags & O_NONBLOCK);
 }
 
-static int soc_camera_open(struct inode *inode, struct file *file)
+static int soc_camera_init_user_formats(struct soc_camera_device *icd)
+{
+       struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
+       int i, fmts = 0;
+
+       if (!ici->ops->get_formats)
+               /*
+                * Fallback mode - the host will have to serve all
+                * sensor-provided formats one-to-one to the user
+                */
+               fmts = icd->num_formats;
+       else
+               /*
+                * First pass - only count formats this host-sensor
+                * configuration can provide
+                */
+               for (i = 0; i < icd->num_formats; i++)
+                       fmts += ici->ops->get_formats(icd, i, NULL);
+
+       if (!fmts)
+               return -ENXIO;
+
+       icd->user_formats =
+               vmalloc(fmts * sizeof(struct soc_camera_format_xlate));
+       if (!icd->user_formats)
+               return -ENOMEM;
+
+       icd->num_user_formats = fmts;
+       fmts = 0;
+
+       dev_dbg(&icd->dev, "Found %d supported formats.\n", fmts);
+
+       /* Second pass - actually fill data formats */
+       for (i = 0; i < icd->num_formats; i++)
+               if (!ici->ops->get_formats) {
+                       icd->user_formats[i].host_fmt = icd->formats + i;
+                       icd->user_formats[i].cam_fmt = icd->formats + i;
+                       icd->user_formats[i].buswidth = icd->formats[i].depth;
+               } else {
+                       fmts += ici->ops->get_formats(icd, i,
+                                                     &icd->user_formats[fmts]);
+               }
+
+       icd->current_fmt = icd->user_formats[0].host_fmt;
+
+       return 0;
+}
+
+static void soc_camera_free_user_formats(struct soc_camera_device *icd)
+{
+       vfree(icd->user_formats);
+}
+
+/* Called with .vb_lock held */
+static int soc_camera_set_fmt(struct soc_camera_file *icf,
+                             struct v4l2_format *f)
+{
+       struct soc_camera_device *icd = icf->icd;
+       struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
+       struct v4l2_pix_format *pix = &f->fmt.pix;
+       int ret;
+
+       /* We always call try_fmt() before set_fmt() or set_crop() */
+       ret = ici->ops->try_fmt(icd, f);
+       if (ret < 0)
+               return ret;
+
+       ret = ici->ops->set_fmt(icd, f);
+       if (ret < 0) {
+               return ret;
+       } else if (!icd->current_fmt ||
+                  icd->current_fmt->fourcc != pix->pixelformat) {
+               dev_err(&ici->dev,
+                       "Host driver hasn't set up current format correctly!\n");
+               return -EINVAL;
+       }
+
+       icd->width              = pix->width;
+       icd->height             = pix->height;
+       icf->vb_vidq.field      =
+               icd->field      = pix->field;
+
+       if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
+               dev_warn(&icd->dev, "Attention! Wrong buf-type %d\n",
+                        f->type);
+
+       dev_dbg(&icd->dev, "set width: %d height: %d\n",
+               icd->width, icd->height);
+
+       /* set physical bus parameters */
+       return ici->ops->set_bus_param(icd, pix->pixelformat);
+}
+
+static int soc_camera_open(struct file *file)
 {
        struct video_device *vdev;
        struct soc_camera_device *icd;
@@ -185,8 +312,10 @@ static int soc_camera_open(struct inode *inode, struct file *file)
        if (!icf)
                return -ENOMEM;
 
-       /* Protect against icd->remove() until we module_get() both drivers. */
-       mutex_lock(&video_lock);
+       /*
+        * It is safe to dereference these pointers now as long as a user has
+        * the video device open - we are protected by the held cdev reference.
+        */
 
        vdev = video_devdata(file);
        icd = container_of(vdev->parent, struct soc_camera_device, dev);
@@ -204,20 +333,39 @@ static int soc_camera_open(struct inode *inode, struct file *file)
                goto emgi;
        }
 
+       /* Protect against icd->remove() until we module_get() both drivers. */
+       mutex_lock(&icd->video_lock);
+
        icf->icd = icd;
        icd->use_count++;
 
        /* Now we really have to activate the camera */
        if (icd->use_count == 1) {
+               /* Restore parameters before the last close() per V4L2 API */
+               struct v4l2_format f = {
+                       .type = V4L2_BUF_TYPE_VIDEO_CAPTURE,
+                       .fmt.pix = {
+                               .width          = icd->width,
+                               .height         = icd->height,
+                               .field          = icd->field,
+                               .pixelformat    = icd->current_fmt->fourcc,
+                               .colorspace     = icd->current_fmt->colorspace,
+                       },
+               };
+
                ret = ici->ops->add(icd);
                if (ret < 0) {
                        dev_err(&icd->dev, "Couldn't activate the camera: %d\n", ret);
-                       icd->use_count--;
                        goto eiciadd;
                }
+
+               /* Try to configure with default parameters */
+               ret = soc_camera_set_fmt(icf, &f);
+               if (ret < 0)
+                       goto esfmt;
        }
 
-       mutex_unlock(&video_lock);
+       mutex_unlock(&icd->video_lock);
 
        file->private_data = icf;
        dev_dbg(&icd->dev, "camera device open\n");
@@ -226,31 +374,39 @@ static int soc_camera_open(struct inode *inode, struct file *file)
 
        return 0;
 
-       /* All errors are entered with the video_lock held */
+       /*
+        * First three errors are entered with the .video_lock held
+        * and use_count == 1
+        */
+esfmt:
+       ici->ops->remove(icd);
 eiciadd:
+       icd->use_count--;
+       mutex_unlock(&icd->video_lock);
        module_put(ici->ops->owner);
 emgi:
        module_put(icd->ops->owner);
 emgd:
-       mutex_unlock(&video_lock);
        vfree(icf);
        return ret;
 }
 
-static int soc_camera_close(struct inode *inode, struct file *file)
+static int soc_camera_close(struct file *file)
 {
        struct soc_camera_file *icf = file->private_data;
        struct soc_camera_device *icd = icf->icd;
        struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
        struct video_device *vdev = icd->vdev;
 
-       mutex_lock(&video_lock);
+       mutex_lock(&icd->video_lock);
        icd->use_count--;
        if (!icd->use_count)
                ici->ops->remove(icd);
+
+       mutex_unlock(&icd->video_lock);
+
        module_put(icd->ops->owner);
        module_put(ici->ops->owner);
-       mutex_unlock(&video_lock);
 
        vfree(icf);
 
@@ -294,8 +450,7 @@ static unsigned int soc_camera_poll(struct file *file, poll_table *pt)
 {
        struct soc_camera_file *icf = file->private_data;
        struct soc_camera_device *icd = icf->icd;
-       struct soc_camera_host *ici =
-               to_soc_camera_host(icd->dev.parent);
+       struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
 
        if (list_empty(&icf->vb_vidq.stream)) {
                dev_err(&icd->dev, "Trying to poll with no queued buffers!\n");
@@ -305,7 +460,7 @@ static unsigned int soc_camera_poll(struct file *file, poll_table *pt)
        return ici->ops->poll(file, pt);
 }
 
-static struct file_operations soc_camera_fops = {
+static struct v4l2_file_operations soc_camera_fops = {
        .owner          = THIS_MODULE,
        .open           = soc_camera_open,
        .release        = soc_camera_close,
@@ -313,7 +468,6 @@ static struct file_operations soc_camera_fops = {
        .read           = soc_camera_read,
        .mmap           = soc_camera_mmap,
        .poll           = soc_camera_poll,
-       .llseek         = no_llseek,
 };
 
 static int soc_camera_s_fmt_vid_cap(struct file *file, void *priv,
@@ -321,46 +475,24 @@ static int soc_camera_s_fmt_vid_cap(struct file *file, void *priv,
 {
        struct soc_camera_file *icf = file->private_data;
        struct soc_camera_device *icd = icf->icd;
-       struct soc_camera_host *ici =
-               to_soc_camera_host(icd->dev.parent);
        int ret;
-       struct v4l2_rect rect;
-       const static struct soc_camera_data_format *data_fmt;
 
        WARN_ON(priv != file->private_data);
 
-       data_fmt = format_by_fourcc(icd, f->fmt.pix.pixelformat);
-       if (!data_fmt)
-               return -EINVAL;
-
-       /* buswidth may be further adjusted by the ici */
-       icd->buswidth = data_fmt->depth;
+       mutex_lock(&icf->vb_vidq.vb_lock);
 
-       ret = soc_camera_try_fmt_vid_cap(file, icf, f);
-       if (ret < 0)
-               return ret;
-
-       rect.left       = icd->x_current;
-       rect.top        = icd->y_current;
-       rect.width      = f->fmt.pix.width;
-       rect.height     = f->fmt.pix.height;
-       ret = ici->ops->set_fmt_cap(icd, f->fmt.pix.pixelformat, &rect);
-       if (ret < 0)
-               return ret;
+       if (videobuf_queue_is_busy(&icf->vb_vidq)) {
+               dev_err(&icd->dev, "S_FMT denied: queue busy\n");
+               ret = -EBUSY;
+               goto unlock;
+       }
 
-       icd->current_fmt        = data_fmt;
-       icd->width              = rect.width;
-       icd->height             = rect.height;
-       icf->vb_vidq.field      = f->fmt.pix.field;
-       if (V4L2_BUF_TYPE_VIDEO_CAPTURE != f->type)
-               dev_warn(&icd->dev, "Attention! Wrong buf-type %d\n",
-                        f->type);
+       ret = soc_camera_set_fmt(icf, f);
 
-       dev_dbg(&icd->dev, "set width: %d height: %d\n",
-               icd->width, icd->height);
+unlock:
+       mutex_unlock(&icf->vb_vidq.vb_lock);
 
-       /* set physical bus parameters */
-       return ici->ops->set_bus_param(icd, f->fmt.pix.pixelformat);
+       return ret;
 }
 
 static int soc_camera_enum_fmt_vid_cap(struct file *file, void  *priv,
@@ -372,10 +504,10 @@ static int soc_camera_enum_fmt_vid_cap(struct file *file, void  *priv,
 
        WARN_ON(priv != file->private_data);
 
-       if (f->index >= icd->num_formats)
+       if (f->index >= icd->num_user_formats)
                return -EINVAL;
 
-       format = &icd->formats[f->index];
+       format = icd->user_formats[f->index].host_fmt;
 
        strlcpy(f->description, format->name, sizeof(f->description));
        f->pixelformat = format->fourcc;
@@ -387,17 +519,17 @@ static int soc_camera_g_fmt_vid_cap(struct file *file, void *priv,
 {
        struct soc_camera_file *icf = file->private_data;
        struct soc_camera_device *icd = icf->icd;
+       struct v4l2_pix_format *pix = &f->fmt.pix;
 
        WARN_ON(priv != file->private_data);
 
-       f->fmt.pix.width        = icd->width;
-       f->fmt.pix.height       = icd->height;
-       f->fmt.pix.field        = icf->vb_vidq.field;
-       f->fmt.pix.pixelformat  = icd->current_fmt->fourcc;
-       f->fmt.pix.bytesperline =
-               (f->fmt.pix.width * icd->current_fmt->depth) >> 3;
-       f->fmt.pix.sizeimage    =
-               f->fmt.pix.height * f->fmt.pix.bytesperline;
+       pix->width              = icd->width;
+       pix->height             = icd->height;
+       pix->field              = icf->vb_vidq.field;
+       pix->pixelformat        = icd->current_fmt->fourcc;
+       pix->bytesperline       = pix->width *
+               DIV_ROUND_UP(icd->current_fmt->depth, 8);
+       pix->sizeimage          = pix->height * pix->bytesperline;
        dev_dbg(&icd->dev, "current_fmt->fourcc: 0x%08x\n",
                icd->current_fmt->fourcc);
        return 0;
@@ -408,8 +540,7 @@ static int soc_camera_querycap(struct file *file, void  *priv,
 {
        struct soc_camera_file *icf = file->private_data;
        struct soc_camera_device *icd = icf->icd;
-       struct soc_camera_host *ici =
-               to_soc_camera_host(icd->dev.parent);
+       struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
 
        WARN_ON(priv != file->private_data);
 
@@ -422,6 +553,7 @@ static int soc_camera_streamon(struct file *file, void *priv,
 {
        struct soc_camera_file *icf = file->private_data;
        struct soc_camera_device *icd = icf->icd;
+       int ret;
 
        WARN_ON(priv != file->private_data);
 
@@ -430,10 +562,16 @@ static int soc_camera_streamon(struct file *file, void *priv,
        if (i != V4L2_BUF_TYPE_VIDEO_CAPTURE)
                return -EINVAL;
 
+       mutex_lock(&icd->video_lock);
+
        icd->ops->start_capture(icd);
 
        /* This calls buf_queue from host driver's videobuf_queue_ops */
-       return videobuf_streamon(&icf->vb_vidq);
+       ret = videobuf_streamon(&icf->vb_vidq);
+
+       mutex_unlock(&icd->video_lock);
+
+       return ret;
 }
 
 static int soc_camera_streamoff(struct file *file, void *priv,
@@ -449,12 +587,16 @@ static int soc_camera_streamoff(struct file *file, void *priv,
        if (i != V4L2_BUF_TYPE_VIDEO_CAPTURE)
                return -EINVAL;
 
+       mutex_lock(&icd->video_lock);
+
        /* This calls buf_release from host driver's videobuf_queue_ops for all
         * remaining buffers. When the last buffer is freed, stop capture */
        videobuf_streamoff(&icf->vb_vidq);
 
        icd->ops->stop_capture(icd);
 
+       mutex_unlock(&icd->video_lock);
+
        return 0;
 }
 
@@ -532,8 +674,8 @@ static int soc_camera_cropcap(struct file *file, void *fh,
        a->bounds.height                = icd->height_max;
        a->defrect.left                 = icd->x_min;
        a->defrect.top                  = icd->y_min;
-       a->defrect.width                = 640;
-       a->defrect.height               = 480;
+       a->defrect.width                = DEFAULT_WIDTH;
+       a->defrect.height               = DEFAULT_HEIGHT;
        a->pixelaspect.numerator        = 1;
        a->pixelaspect.denominator      = 1;
 
@@ -560,14 +702,16 @@ static int soc_camera_s_crop(struct file *file, void *fh,
 {
        struct soc_camera_file *icf = file->private_data;
        struct soc_camera_device *icd = icf->icd;
-       struct soc_camera_host *ici =
-               to_soc_camera_host(icd->dev.parent);
+       struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
        int ret;
 
        if (a->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
                return -EINVAL;
 
-       ret = ici->ops->set_fmt_cap(icd, 0, &a->c);
+       /* Cropping is allowed during a running capture, guard consistency */
+       mutex_lock(&icf->vb_vidq.vb_lock);
+
+       ret = ici->ops->set_crop(icd, &a->c);
        if (!ret) {
                icd->width      = a->c.width;
                icd->height     = a->c.height;
@@ -575,11 +719,13 @@ static int soc_camera_s_crop(struct file *file, void *fh,
                icd->y_current  = a->c.top;
        }
 
+       mutex_unlock(&icf->vb_vidq.vb_lock);
+
        return ret;
 }
 
 static int soc_camera_g_chip_ident(struct file *file, void *fh,
-                                  struct v4l2_chip_ident *id)
+                                  struct v4l2_dbg_chip_ident *id)
 {
        struct soc_camera_file *icf = file->private_data;
        struct soc_camera_device *icd = icf->icd;
@@ -592,7 +738,7 @@ static int soc_camera_g_chip_ident(struct file *file, void *fh,
 
 #ifdef CONFIG_VIDEO_ADV_DEBUG
 static int soc_camera_g_register(struct file *file, void *fh,
-                                struct v4l2_register *reg)
+                                struct v4l2_dbg_register *reg)
 {
        struct soc_camera_file *icf = file->private_data;
        struct soc_camera_device *icd = icf->icd;
@@ -604,7 +750,7 @@ static int soc_camera_g_register(struct file *file, void *fh,
 }
 
 static int soc_camera_s_register(struct file *file, void *fh,
-                                struct v4l2_register *reg)
+                                struct v4l2_dbg_register *reg)
 {
        struct soc_camera_file *icf = file->private_data;
        struct soc_camera_device *icd = icf->icd;
@@ -685,18 +831,35 @@ static int scan_add_device(struct soc_camera_device *icd)
 static int soc_camera_probe(struct device *dev)
 {
        struct soc_camera_device *icd = to_soc_camera_dev(dev);
-       struct soc_camera_host *ici =
-               to_soc_camera_host(icd->dev.parent);
+       struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
        int ret;
 
-       if (!icd->ops->probe)
-               return -ENODEV;
+       /*
+        * Possible race scenario:
+        * modprobe <camera-host-driver> triggers __func__
+        * at this moment respective <camera-sensor-driver> gets rmmod'ed
+        * to protect take module references.
+        */
+
+       if (!try_module_get(icd->ops->owner)) {
+               dev_err(&icd->dev, "Couldn't lock sensor driver.\n");
+               ret = -EINVAL;
+               goto emgd;
+       }
+
+       if (!try_module_get(ici->ops->owner)) {
+               dev_err(&icd->dev, "Couldn't lock capture bus driver.\n");
+               ret = -EINVAL;
+               goto emgi;
+       }
+
+       mutex_lock(&icd->video_lock);
 
        /* We only call ->add() here to activate and probe the camera.
         * We shall ->remove() and deactivate it immediately afterwards. */
        ret = ici->ops->add(icd);
        if (ret < 0)
-               return ret;
+               goto eiadd;
 
        ret = icd->ops->probe(icd);
        if (ret >= 0) {
@@ -707,9 +870,24 @@ static int soc_camera_probe(struct device *dev)
                qctrl = soc_camera_find_qctrl(icd->ops, V4L2_CID_EXPOSURE);
                icd->exposure = qctrl ? qctrl->default_value :
                        (unsigned short)~0;
+
+               ret = soc_camera_init_user_formats(icd);
+               if (ret < 0)
+                       goto eiufmt;
+
+               icd->height     = DEFAULT_HEIGHT;
+               icd->width      = DEFAULT_WIDTH;
+               icd->field      = V4L2_FIELD_ANY;
        }
-       ici->ops->remove(icd);
 
+eiufmt:
+       ici->ops->remove(icd);
+eiadd:
+       mutex_unlock(&icd->video_lock);
+       module_put(ici->ops->owner);
+emgi:
+       module_put(icd->ops->owner);
+emgd:
        return ret;
 }
 
@@ -722,6 +900,8 @@ static int soc_camera_remove(struct device *dev)
        if (icd->ops->remove)
                icd->ops->remove(icd);
 
+       soc_camera_free_user_formats(icd);
+
        return 0;
 }
 
@@ -772,7 +952,17 @@ int soc_camera_host_register(struct soc_camera_host *ici)
        int ret;
        struct soc_camera_host *ix;
 
-       if (!ici->ops->init_videobuf || !ici->ops->add || !ici->ops->remove)
+       if (!ici || !ici->ops ||
+           !ici->ops->try_fmt ||
+           !ici->ops->set_fmt ||
+           !ici->ops->set_crop ||
+           !ici->ops->set_bus_param ||
+           !ici->ops->querycap ||
+           !ici->ops->init_videobuf ||
+           !ici->ops->reqbufs ||
+           !ici->ops->add ||
+           !ici->ops->remove ||
+           !ici->ops->poll)
                return -EINVAL;
 
        /* Number might be equal to the platform device ID */
@@ -840,7 +1030,17 @@ int soc_camera_device_register(struct soc_camera_device *icd)
        struct soc_camera_device *ix;
        int num = -1, i;
 
-       if (!icd)
+       if (!icd || !icd->ops ||
+           !icd->ops->probe ||
+           !icd->ops->init ||
+           !icd->ops->release ||
+           !icd->ops->start_capture ||
+           !icd->ops->stop_capture ||
+           !icd->ops->set_crop ||
+           !icd->ops->set_fmt ||
+           !icd->ops->try_fmt ||
+           !icd->ops->query_bus_param ||
+           !icd->ops->set_bus_param)
                return -EINVAL;
 
        for (i = 0; i < 256 && num < 0; i++) {
@@ -862,7 +1062,10 @@ int soc_camera_device_register(struct soc_camera_device *icd)
        icd->dev.bus = &soc_camera_bus_type;
        dev_set_name(&icd->dev, "%u-%u", icd->iface, icd->devnum);
 
-       icd->dev.release = dummy_release;
+       icd->dev.release        = dummy_release;
+       icd->use_count          = 0;
+       icd->host_priv          = NULL;
+       mutex_init(&icd->video_lock);
 
        return scan_add_device(icd);
 }
@@ -909,6 +1112,10 @@ static const struct v4l2_ioctl_ops soc_camera_ioctl_ops = {
 #endif
 };
 
+/*
+ * Usually called from the struct soc_camera_ops .probe() method, i.e., from
+ * soc_camera_probe() above with .video_lock held
+ */
 int soc_camera_video_start(struct soc_camera_device *icd)
 {
        struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
@@ -924,7 +1131,7 @@ int soc_camera_video_start(struct soc_camera_device *icd)
        dev_dbg(&ici->dev, "Allocated video_device %p\n", vdev);
 
        strlcpy(vdev->name, ici->drv_name, sizeof(vdev->name));
-       /* Maybe better &ici->dev */
+
        vdev->parent            = &icd->dev;
        vdev->current_norm      = V4L2_STD_UNKNOWN;
        vdev->fops              = &soc_camera_fops;
@@ -933,8 +1140,6 @@ int soc_camera_video_start(struct soc_camera_device *icd)
        vdev->minor             = -1;
        vdev->tvnorms           = V4L2_STD_UNKNOWN,
 
-       icd->current_fmt = &icd->formats[0];
-
        err = video_register_device(vdev, VFL_TYPE_GRABBER, vdev->minor);
        if (err < 0) {
                dev_err(vdev->parent, "video_register_device failed\n");
@@ -960,10 +1165,10 @@ void soc_camera_video_stop(struct soc_camera_device *icd)
        if (!icd->dev.parent || !vdev)
                return;
 
-       mutex_lock(&video_lock);
+       mutex_lock(&icd->video_lock);
        video_unregister_device(vdev);
        icd->vdev = NULL;
-       mutex_unlock(&video_lock);
+       mutex_unlock(&icd->video_lock);
 }
 EXPORT_SYMBOL(soc_camera_video_stop);