blob: 46284489e4eb8b89e96e354e4defca8bd1710ebd [file] [log] [blame]
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001/*
2 * camera image capture (abstract) bus driver
3 *
4 * Copyright (C) 2008, Guennadi Liakhovetski <kernel@pengutronix.de>
5 *
6 * This driver provides an interface between platform-specific camera
7 * busses and camera devices. It should be used if the camera is
8 * connected not over a "proper" bus like PCI or USB, but over a
9 * special bus, like, for example, the Quick Capture interface on PXA270
10 * SoCs. Later it should also be used for i.MX31 SoCs from Freescale.
11 * It can handle multiple cameras and / or multiple busses, which can
12 * be used, e.g., in stereo-vision applications.
13 *
14 * This program is free software; you can redistribute it and/or modify
15 * it under the terms of the GNU General Public License version 2 as
16 * published by the Free Software Foundation.
17 */
18
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -030019#include <linux/device.h>
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -030020#include <linux/err.h>
Guennadi Liakhovetski0fd327b2009-05-07 13:25:32 -030021#include <linux/i2c.h>
22#include <linux/init.h>
23#include <linux/list.h>
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -030024#include <linux/mutex.h>
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -030025#include <linux/module.h>
Guennadi Liakhovetski0fd327b2009-05-07 13:25:32 -030026#include <linux/platform_device.h>
Alberto Panizzo96e442c2010-12-02 07:43:37 -030027#include <linux/regulator/consumer.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090028#include <linux/slab.h>
Mauro Carvalho Chehab4f9fb5e2010-05-18 00:46:09 -030029#include <linux/pm_runtime.h>
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -030030#include <linux/vmalloc.h>
31
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -030032#include <media/soc_camera.h>
Guennadi Liakhovetski0fd327b2009-05-07 13:25:32 -030033#include <media/v4l2-common.h>
Guennadi Liakhovetski0fd327b2009-05-07 13:25:32 -030034#include <media/v4l2-ioctl.h>
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -030035#include <media/v4l2-dev.h>
Guennadi Liakhovetski0fd327b2009-05-07 13:25:32 -030036#include <media/videobuf-core.h>
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -030037#include <media/videobuf2-core.h>
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -030038#include <media/soc_mediabus.h>
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -030039
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -030040/* Default to VGA resolution */
41#define DEFAULT_WIDTH 640
42#define DEFAULT_HEIGHT 480
43
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -030044static LIST_HEAD(hosts);
45static LIST_HEAD(devices);
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -030046static DEFINE_MUTEX(list_lock); /* Protects the list of hosts */
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -030047
Alberto Panizzo96e442c2010-12-02 07:43:37 -030048static int soc_camera_power_set(struct soc_camera_device *icd,
49 struct soc_camera_link *icl,
50 int power_on)
51{
52 int ret;
53
54 if (power_on) {
55 ret = regulator_bulk_enable(icl->num_regulators,
56 icl->regulators);
57 if (ret < 0) {
58 dev_err(&icd->dev, "Cannot enable regulators\n");
59 return ret;
60 }
61
62 if (icl->power)
63 ret = icl->power(icd->pdev, power_on);
64 if (ret < 0) {
65 dev_err(&icd->dev,
66 "Platform failed to power-on the camera.\n");
67
68 regulator_bulk_disable(icl->num_regulators,
69 icl->regulators);
70 return ret;
71 }
72 } else {
73 ret = 0;
74 if (icl->power)
75 ret = icl->power(icd->pdev, 0);
76 if (ret < 0) {
77 dev_err(&icd->dev,
78 "Platform failed to power-off the camera.\n");
79 return ret;
80 }
81
82 ret = regulator_bulk_disable(icl->num_regulators,
83 icl->regulators);
84 if (ret < 0) {
85 dev_err(&icd->dev, "Cannot disable regulators\n");
86 return ret;
87 }
88 }
89
90 return 0;
91}
92
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -030093const struct soc_camera_format_xlate *soc_camera_xlate_by_fourcc(
94 struct soc_camera_device *icd, unsigned int fourcc)
95{
96 unsigned int i;
97
98 for (i = 0; i < icd->num_user_formats; i++)
99 if (icd->user_formats[i].host_fmt->fourcc == fourcc)
100 return icd->user_formats + i;
101 return NULL;
102}
103EXPORT_SYMBOL(soc_camera_xlate_by_fourcc);
104
Guennadi Liakhovetskibd73b362008-12-23 05:54:45 -0300105/**
106 * soc_camera_apply_sensor_flags() - apply platform SOCAM_SENSOR_INVERT_* flags
107 * @icl: camera platform parameters
108 * @flags: flags to be inverted according to platform configuration
109 * @return: resulting flags
110 */
111unsigned long soc_camera_apply_sensor_flags(struct soc_camera_link *icl,
112 unsigned long flags)
113{
114 unsigned long f;
115
116 /* If only one of the two polarities is supported, switch to the opposite */
117 if (icl->flags & SOCAM_SENSOR_INVERT_HSYNC) {
118 f = flags & (SOCAM_HSYNC_ACTIVE_HIGH | SOCAM_HSYNC_ACTIVE_LOW);
119 if (f == SOCAM_HSYNC_ACTIVE_HIGH || f == SOCAM_HSYNC_ACTIVE_LOW)
120 flags ^= SOCAM_HSYNC_ACTIVE_HIGH | SOCAM_HSYNC_ACTIVE_LOW;
121 }
122
123 if (icl->flags & SOCAM_SENSOR_INVERT_VSYNC) {
124 f = flags & (SOCAM_VSYNC_ACTIVE_HIGH | SOCAM_VSYNC_ACTIVE_LOW);
125 if (f == SOCAM_VSYNC_ACTIVE_HIGH || f == SOCAM_VSYNC_ACTIVE_LOW)
126 flags ^= SOCAM_VSYNC_ACTIVE_HIGH | SOCAM_VSYNC_ACTIVE_LOW;
127 }
128
129 if (icl->flags & SOCAM_SENSOR_INVERT_PCLK) {
130 f = flags & (SOCAM_PCLK_SAMPLE_RISING | SOCAM_PCLK_SAMPLE_FALLING);
131 if (f == SOCAM_PCLK_SAMPLE_RISING || f == SOCAM_PCLK_SAMPLE_FALLING)
132 flags ^= SOCAM_PCLK_SAMPLE_RISING | SOCAM_PCLK_SAMPLE_FALLING;
133 }
134
135 return flags;
136}
137EXPORT_SYMBOL(soc_camera_apply_sensor_flags);
138
Hans Verkuil72937892008-06-01 10:35:18 -0300139static int soc_camera_try_fmt_vid_cap(struct file *file, void *priv,
Guennadi Liakhovetskiabe4c472008-12-01 09:44:56 -0300140 struct v4l2_format *f)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300141{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300142 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski64f59052008-12-18 11:51:55 -0300143 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300144
145 WARN_ON(priv != file->private_data);
146
Guennadi Liakhovetskid366d4a2011-03-21 06:33:25 -0300147 /* Only single-plane capture is supported so far */
148 if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
149 return -EINVAL;
150
Guennadi Liakhovetskiad5f2e82008-03-07 21:57:18 -0300151 /* limit format to hardware capabilities */
Guennadi Liakhovetski06daa1a2008-12-18 12:52:08 -0300152 return ici->ops->try_fmt(icd, f);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300153}
154
155static int soc_camera_enum_input(struct file *file, void *priv,
156 struct v4l2_input *inp)
157{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300158 struct soc_camera_device *icd = file->private_data;
Kuninori Morimoto34d359d2008-12-18 12:47:46 -0300159 int ret = 0;
160
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300161 if (inp->index != 0)
162 return -EINVAL;
163
Kuninori Morimoto34d359d2008-12-18 12:47:46 -0300164 if (icd->ops->enum_input)
165 ret = icd->ops->enum_input(icd, inp);
166 else {
167 /* default is camera */
168 inp->type = V4L2_INPUT_TYPE_CAMERA;
169 inp->std = V4L2_STD_UNKNOWN;
170 strcpy(inp->name, "Camera");
171 }
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300172
Kuninori Morimoto34d359d2008-12-18 12:47:46 -0300173 return ret;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300174}
175
176static int soc_camera_g_input(struct file *file, void *priv, unsigned int *i)
177{
178 *i = 0;
179
180 return 0;
181}
182
183static int soc_camera_s_input(struct file *file, void *priv, unsigned int i)
184{
185 if (i > 0)
186 return -EINVAL;
187
188 return 0;
189}
190
191static int soc_camera_s_std(struct file *file, void *priv, v4l2_std_id *a)
192{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300193 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300194 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
Kuninori Morimoto513791a2008-12-18 12:46:45 -0300195
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300196 return v4l2_subdev_call(sd, core, s_std, *a);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300197}
198
Qing Xued5b65d2011-01-20 05:19:40 -0300199static int soc_camera_enum_fsizes(struct file *file, void *fh,
200 struct v4l2_frmsizeenum *fsize)
201{
202 struct soc_camera_device *icd = file->private_data;
203 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
204
205 return ici->ops->enum_fsizes(icd, fsize);
206}
207
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300208static int soc_camera_reqbufs(struct file *file, void *priv,
209 struct v4l2_requestbuffers *p)
210{
211 int ret;
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300212 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski64f59052008-12-18 11:51:55 -0300213 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300214
215 WARN_ON(priv != file->private_data);
216
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300217 if (icd->streamer && icd->streamer != file)
218 return -EBUSY;
219
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300220 if (ici->ops->init_videobuf) {
221 ret = videobuf_reqbufs(&icd->vb_vidq, p);
222 if (ret < 0)
223 return ret;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300224
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300225 ret = ici->ops->reqbufs(icd, p);
226 } else {
227 ret = vb2_reqbufs(&icd->vb2_vidq, p);
228 }
229
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300230 if (!ret && !icd->streamer)
231 icd->streamer = file;
232
233 return ret;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300234}
235
236static int soc_camera_querybuf(struct file *file, void *priv,
237 struct v4l2_buffer *p)
238{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300239 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300240 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300241
242 WARN_ON(priv != file->private_data);
243
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300244 if (ici->ops->init_videobuf)
245 return videobuf_querybuf(&icd->vb_vidq, p);
246 else
247 return vb2_querybuf(&icd->vb2_vidq, p);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300248}
249
250static int soc_camera_qbuf(struct file *file, void *priv,
251 struct v4l2_buffer *p)
252{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300253 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300254 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300255
256 WARN_ON(priv != file->private_data);
257
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300258 if (icd->streamer != file)
259 return -EBUSY;
260
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300261 if (ici->ops->init_videobuf)
262 return videobuf_qbuf(&icd->vb_vidq, p);
263 else
264 return vb2_qbuf(&icd->vb2_vidq, p);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300265}
266
267static int soc_camera_dqbuf(struct file *file, void *priv,
268 struct v4l2_buffer *p)
269{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300270 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300271 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300272
273 WARN_ON(priv != file->private_data);
274
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300275 if (icd->streamer != file)
276 return -EBUSY;
277
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300278 if (ici->ops->init_videobuf)
279 return videobuf_dqbuf(&icd->vb_vidq, p, file->f_flags & O_NONBLOCK);
280 else
281 return vb2_dqbuf(&icd->vb2_vidq, p, file->f_flags & O_NONBLOCK);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300282}
283
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300284/* Always entered with .video_lock held */
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300285static int soc_camera_init_user_formats(struct soc_camera_device *icd)
286{
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300287 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300288 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Hans Verkuil3805f202010-05-08 17:55:00 -0300289 unsigned int i, fmts = 0, raw_fmts = 0;
290 int ret;
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300291 enum v4l2_mbus_pixelcode code;
292
293 while (!v4l2_subdev_call(sd, video, enum_mbus_fmt, raw_fmts, &code))
294 raw_fmts++;
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300295
296 if (!ici->ops->get_formats)
297 /*
298 * Fallback mode - the host will have to serve all
299 * sensor-provided formats one-to-one to the user
300 */
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300301 fmts = raw_fmts;
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300302 else
303 /*
304 * First pass - only count formats this host-sensor
305 * configuration can provide
306 */
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300307 for (i = 0; i < raw_fmts; i++) {
Guennadi Liakhovetskifa489842009-08-25 11:46:43 -0300308 ret = ici->ops->get_formats(icd, i, NULL);
309 if (ret < 0)
310 return ret;
311 fmts += ret;
312 }
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300313
314 if (!fmts)
315 return -ENXIO;
316
317 icd->user_formats =
318 vmalloc(fmts * sizeof(struct soc_camera_format_xlate));
319 if (!icd->user_formats)
320 return -ENOMEM;
321
322 icd->num_user_formats = fmts;
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300323
324 dev_dbg(&icd->dev, "Found %d supported formats.\n", fmts);
325
326 /* Second pass - actually fill data formats */
Stefan Herbrechtsmeier14df2cc2009-06-24 10:31:25 -0300327 fmts = 0;
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300328 for (i = 0; i < raw_fmts; i++)
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300329 if (!ici->ops->get_formats) {
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300330 v4l2_subdev_call(sd, video, enum_mbus_fmt, i, &code);
331 icd->user_formats[i].host_fmt =
332 soc_mbus_get_fmtdesc(code);
333 icd->user_formats[i].code = code;
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300334 } else {
Guennadi Liakhovetskifa489842009-08-25 11:46:43 -0300335 ret = ici->ops->get_formats(icd, i,
336 &icd->user_formats[fmts]);
337 if (ret < 0)
338 goto egfmt;
339 fmts += ret;
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300340 }
341
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300342 icd->current_fmt = &icd->user_formats[0];
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300343
344 return 0;
Guennadi Liakhovetskifa489842009-08-25 11:46:43 -0300345
346egfmt:
347 icd->num_user_formats = 0;
348 vfree(icd->user_formats);
349 return ret;
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300350}
351
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300352/* Always entered with .video_lock held */
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300353static void soc_camera_free_user_formats(struct soc_camera_device *icd)
354{
Guennadi Liakhovetskifa489842009-08-25 11:46:43 -0300355 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
356
357 if (ici->ops->put_formats)
358 ici->ops->put_formats(icd);
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300359 icd->current_fmt = NULL;
Guennadi Liakhovetskifa489842009-08-25 11:46:43 -0300360 icd->num_user_formats = 0;
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300361 vfree(icd->user_formats);
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300362 icd->user_formats = NULL;
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300363}
364
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300365#define pixfmtstr(x) (x) & 0xff, ((x) >> 8) & 0xff, ((x) >> 16) & 0xff, \
366 ((x) >> 24) & 0xff
367
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300368/* Called with .vb_lock held, or from the first open(2), see comment there */
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300369static int soc_camera_set_fmt(struct soc_camera_device *icd,
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300370 struct v4l2_format *f)
371{
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300372 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
373 struct v4l2_pix_format *pix = &f->fmt.pix;
374 int ret;
375
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300376 dev_dbg(&icd->dev, "S_FMT(%c%c%c%c, %ux%u)\n",
377 pixfmtstr(pix->pixelformat), pix->width, pix->height);
378
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300379 /* We always call try_fmt() before set_fmt() or set_crop() */
380 ret = ici->ops->try_fmt(icd, f);
381 if (ret < 0)
382 return ret;
383
384 ret = ici->ops->set_fmt(icd, f);
385 if (ret < 0) {
386 return ret;
387 } else if (!icd->current_fmt ||
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300388 icd->current_fmt->host_fmt->fourcc != pix->pixelformat) {
Guennadi Liakhovetski2aa58db2009-08-25 11:47:00 -0300389 dev_err(&icd->dev,
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300390 "Host driver hasn't set up current format correctly!\n");
391 return -EINVAL;
392 }
393
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300394 icd->user_width = pix->width;
395 icd->user_height = pix->height;
Sergio Aguirre0e4c1802011-03-07 21:49:48 -0300396 icd->bytesperline = pix->bytesperline;
397 icd->sizeimage = pix->sizeimage;
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300398 icd->colorspace = pix->colorspace;
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300399 icd->field = pix->field;
400 if (ici->ops->init_videobuf)
401 icd->vb_vidq.field = pix->field;
Guennadi Liakhovetski025c18a2009-03-13 06:08:20 -0300402
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300403 dev_dbg(&icd->dev, "set width: %d height: %d\n",
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300404 icd->user_width, icd->user_height);
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300405
406 /* set physical bus parameters */
407 return ici->ops->set_bus_param(icd, pix->pixelformat);
408}
409
Hans Verkuilbec43662008-12-30 06:58:20 -0300410static int soc_camera_open(struct file *file)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300411{
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -0300412 struct video_device *vdev = video_devdata(file);
Guennadi Liakhovetski96c75392009-08-25 11:53:23 -0300413 struct soc_camera_device *icd = container_of(vdev->parent,
414 struct soc_camera_device,
415 dev);
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -0300416 struct soc_camera_link *icl = to_soc_camera_link(icd);
Guennadi Liakhovetski9dc4e482008-04-22 14:45:32 -0300417 struct soc_camera_host *ici;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300418 int ret;
419
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300420 if (!icd->ops)
421 /* No device driver attached */
422 return -ENODEV;
423
Guennadi Liakhovetski9dc4e482008-04-22 14:45:32 -0300424 ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300425
Guennadi Liakhovetskib8d99042008-04-04 13:41:25 -0300426 if (!try_module_get(ici->ops->owner)) {
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300427 dev_err(&icd->dev, "Couldn't lock capture bus driver.\n");
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300428 return -EINVAL;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300429 }
430
Guennadi Liakhovetski1a0063a2008-04-04 13:46:34 -0300431 icd->use_count++;
432
Guennadi Liakhovetski9dc4e482008-04-22 14:45:32 -0300433 /* Now we really have to activate the camera */
434 if (icd->use_count == 1) {
Guennadi Liakhovetski025c18a2009-03-13 06:08:20 -0300435 /* Restore parameters before the last close() per V4L2 API */
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300436 struct v4l2_format f = {
437 .type = V4L2_BUF_TYPE_VIDEO_CAPTURE,
438 .fmt.pix = {
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300439 .width = icd->user_width,
440 .height = icd->user_height,
Guennadi Liakhovetski025c18a2009-03-13 06:08:20 -0300441 .field = icd->field,
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300442 .colorspace = icd->colorspace,
443 .pixelformat =
444 icd->current_fmt->host_fmt->fourcc,
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300445 },
446 };
447
Alberto Panizzo96e442c2010-12-02 07:43:37 -0300448 ret = soc_camera_power_set(icd, icl, 1);
449 if (ret < 0)
450 goto epower;
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -0300451
452 /* The camera could have been already on, try to reset */
453 if (icl->reset)
454 icl->reset(icd->pdev);
455
Guennadi Liakhovetskib8d99042008-04-04 13:41:25 -0300456 ret = ici->ops->add(icd);
Guennadi Liakhovetski9dc4e482008-04-22 14:45:32 -0300457 if (ret < 0) {
458 dev_err(&icd->dev, "Couldn't activate the camera: %d\n", ret);
Guennadi Liakhovetski9dc4e482008-04-22 14:45:32 -0300459 goto eiciadd;
460 }
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300461
Mauro Carvalho Chehab4f9fb5e2010-05-18 00:46:09 -0300462 pm_runtime_enable(&icd->vdev->dev);
463 ret = pm_runtime_resume(&icd->vdev->dev);
464 if (ret < 0 && ret != -ENOSYS)
465 goto eresume;
466
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300467 /*
468 * Try to configure with default parameters. Notice: this is the
469 * very first open, so, we cannot race against other calls,
470 * apart from someone else calling open() simultaneously, but
471 * .video_lock is protecting us against it.
472 */
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300473 ret = soc_camera_set_fmt(icd, &f);
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300474 if (ret < 0)
475 goto esfmt;
Guennadi Liakhovetski24d8c022010-12-25 18:29:52 -0300476
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300477 if (ici->ops->init_videobuf) {
478 ici->ops->init_videobuf(&icd->vb_vidq, icd);
479 } else {
480 ret = ici->ops->init_videobuf2(&icd->vb2_vidq, icd);
481 if (ret < 0)
482 goto einitvb;
483 }
Guennadi Liakhovetski9dc4e482008-04-22 14:45:32 -0300484 }
485
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300486 file->private_data = icd;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300487 dev_dbg(&icd->dev, "camera device open\n");
488
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300489 return 0;
490
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300491 /*
Mauro Carvalho Chehab4f9fb5e2010-05-18 00:46:09 -0300492 * First four errors are entered with the .video_lock held
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300493 * and use_count == 1
494 */
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300495einitvb:
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300496esfmt:
Mauro Carvalho Chehab4f9fb5e2010-05-18 00:46:09 -0300497 pm_runtime_disable(&icd->vdev->dev);
498eresume:
Guennadi Liakhovetskidf2ed072009-03-13 06:08:20 -0300499 ici->ops->remove(icd);
Guennadi Liakhovetski9dc4e482008-04-22 14:45:32 -0300500eiciadd:
Alberto Panizzo96e442c2010-12-02 07:43:37 -0300501 soc_camera_power_set(icd, icl, 0);
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -0300502epower:
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300503 icd->use_count--;
Guennadi Liakhovetskib8d99042008-04-04 13:41:25 -0300504 module_put(ici->ops->owner);
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300505
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300506 return ret;
507}
508
Hans Verkuilbec43662008-12-30 06:58:20 -0300509static int soc_camera_close(struct file *file)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300510{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300511 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300512 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300513
Guennadi Liakhovetski9dc4e482008-04-22 14:45:32 -0300514 icd->use_count--;
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300515 if (!icd->use_count) {
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -0300516 struct soc_camera_link *icl = to_soc_camera_link(icd);
517
Mauro Carvalho Chehab4f9fb5e2010-05-18 00:46:09 -0300518 pm_runtime_suspend(&icd->vdev->dev);
519 pm_runtime_disable(&icd->vdev->dev);
520
Guennadi Liakhovetskib8d99042008-04-04 13:41:25 -0300521 ici->ops->remove(icd);
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300522 if (ici->ops->init_videobuf2)
523 vb2_queue_release(&icd->vb2_vidq);
Mauro Carvalho Chehab4f9fb5e2010-05-18 00:46:09 -0300524
Alberto Panizzo96e442c2010-12-02 07:43:37 -0300525 soc_camera_power_set(icd, icl, 0);
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300526 }
Guennadi Liakhovetski025c18a2009-03-13 06:08:20 -0300527
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300528 if (icd->streamer == file)
529 icd->streamer = NULL;
530
Guennadi Liakhovetskib8d99042008-04-04 13:41:25 -0300531 module_put(ici->ops->owner);
Guennadi Liakhovetski9dc4e482008-04-22 14:45:32 -0300532
Guennadi Liakhovetski2aa58db2009-08-25 11:47:00 -0300533 dev_dbg(&icd->dev, "camera device close\n");
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300534
535 return 0;
536}
537
Andrew Mortonaba360d2008-04-22 14:45:59 -0300538static ssize_t soc_camera_read(struct file *file, char __user *buf,
Guennadi Liakhovetskiabe4c472008-12-01 09:44:56 -0300539 size_t count, loff_t *ppos)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300540{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300541 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300542 int err = -EINVAL;
543
Guennadi Liakhovetski2aa58db2009-08-25 11:47:00 -0300544 dev_err(&icd->dev, "camera device read not implemented\n");
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300545
546 return err;
547}
548
549static int soc_camera_mmap(struct file *file, struct vm_area_struct *vma)
550{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300551 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300552 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300553 int err;
554
555 dev_dbg(&icd->dev, "mmap called, vma=0x%08lx\n", (unsigned long)vma);
556
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300557 if (icd->streamer != file)
558 return -EBUSY;
559
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300560 if (ici->ops->init_videobuf)
561 err = videobuf_mmap_mapper(&icd->vb_vidq, vma);
562 else
563 err = vb2_mmap(&icd->vb2_vidq, vma);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300564
565 dev_dbg(&icd->dev, "vma start=0x%08lx, size=%ld, ret=%d\n",
566 (unsigned long)vma->vm_start,
567 (unsigned long)vma->vm_end - (unsigned long)vma->vm_start,
568 err);
569
570 return err;
571}
572
573static unsigned int soc_camera_poll(struct file *file, poll_table *pt)
574{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300575 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski64f59052008-12-18 11:51:55 -0300576 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300577
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300578 if (icd->streamer != file)
579 return -EBUSY;
580
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300581 if (ici->ops->init_videobuf && list_empty(&icd->vb_vidq.stream)) {
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300582 dev_err(&icd->dev, "Trying to poll with no queued buffers!\n");
583 return POLLERR;
584 }
585
Guennadi Liakhovetskib8d99042008-04-04 13:41:25 -0300586 return ici->ops->poll(file, pt);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300587}
588
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300589void soc_camera_lock(struct vb2_queue *vq)
590{
591 struct soc_camera_device *icd = vb2_get_drv_priv(vq);
592 mutex_lock(&icd->video_lock);
593}
594EXPORT_SYMBOL(soc_camera_lock);
595
596void soc_camera_unlock(struct vb2_queue *vq)
597{
598 struct soc_camera_device *icd = vb2_get_drv_priv(vq);
599 mutex_unlock(&icd->video_lock);
600}
601EXPORT_SYMBOL(soc_camera_unlock);
602
Hans Verkuilbec43662008-12-30 06:58:20 -0300603static struct v4l2_file_operations soc_camera_fops = {
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300604 .owner = THIS_MODULE,
605 .open = soc_camera_open,
606 .release = soc_camera_close,
Guennadi Liakhovetskib6a633c2010-12-25 17:40:26 -0300607 .unlocked_ioctl = video_ioctl2,
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300608 .read = soc_camera_read,
609 .mmap = soc_camera_mmap,
610 .poll = soc_camera_poll,
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300611};
612
Hans Verkuil72937892008-06-01 10:35:18 -0300613static int soc_camera_s_fmt_vid_cap(struct file *file, void *priv,
Guennadi Liakhovetskiabe4c472008-12-01 09:44:56 -0300614 struct v4l2_format *f)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300615{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300616 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300617 int ret;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300618
619 WARN_ON(priv != file->private_data);
620
Guennadi Liakhovetskid366d4a2011-03-21 06:33:25 -0300621 if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) {
622 dev_warn(&icd->dev, "Wrong buf-type %d\n", f->type);
623 return -EINVAL;
624 }
625
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300626 if (icd->streamer && icd->streamer != file)
627 return -EBUSY;
Guennadi Liakhovetski1c3bb742008-12-18 12:28:54 -0300628
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300629 if (icd->vb_vidq.bufs[0]) {
Guennadi Liakhovetskib897a912009-08-25 11:46:53 -0300630 dev_err(&icd->dev, "S_FMT denied: queue initialised\n");
Guennadi Liakhovetskib6a633c2010-12-25 17:40:26 -0300631 return -EBUSY;
Guennadi Liakhovetski1c3bb742008-12-18 12:28:54 -0300632 }
633
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300634 ret = soc_camera_set_fmt(icd, f);
635
636 if (!ret && !icd->streamer)
637 icd->streamer = file;
Guennadi Liakhovetski1c3bb742008-12-18 12:28:54 -0300638
Guennadi Liakhovetski1c3bb742008-12-18 12:28:54 -0300639 return ret;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300640}
641
Hans Verkuil72937892008-06-01 10:35:18 -0300642static int soc_camera_enum_fmt_vid_cap(struct file *file, void *priv,
Guennadi Liakhovetskiabe4c472008-12-01 09:44:56 -0300643 struct v4l2_fmtdesc *f)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300644{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300645 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300646 const struct soc_mbus_pixelfmt *format;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300647
648 WARN_ON(priv != file->private_data);
649
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300650 if (f->index >= icd->num_user_formats)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300651 return -EINVAL;
652
Guennadi Liakhovetskic2786ad2008-12-01 09:45:27 -0300653 format = icd->user_formats[f->index].host_fmt;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300654
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300655 if (format->name)
656 strlcpy(f->description, format->name, sizeof(f->description));
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300657 f->pixelformat = format->fourcc;
658 return 0;
659}
660
Hans Verkuil72937892008-06-01 10:35:18 -0300661static int soc_camera_g_fmt_vid_cap(struct file *file, void *priv,
Guennadi Liakhovetskiabe4c472008-12-01 09:44:56 -0300662 struct v4l2_format *f)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300663{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300664 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski64f59052008-12-18 11:51:55 -0300665 struct v4l2_pix_format *pix = &f->fmt.pix;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300666
667 WARN_ON(priv != file->private_data);
668
Guennadi Liakhovetskid366d4a2011-03-21 06:33:25 -0300669 if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
670 return -EINVAL;
671
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300672 pix->width = icd->user_width;
673 pix->height = icd->user_height;
Sergio Aguirre0e4c1802011-03-07 21:49:48 -0300674 pix->bytesperline = icd->bytesperline;
675 pix->sizeimage = icd->sizeimage;
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300676 pix->field = icd->field;
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300677 pix->pixelformat = icd->current_fmt->host_fmt->fourcc;
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300678 pix->colorspace = icd->colorspace;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300679 dev_dbg(&icd->dev, "current_fmt->fourcc: 0x%08x\n",
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -0300680 icd->current_fmt->host_fmt->fourcc);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300681 return 0;
682}
683
684static int soc_camera_querycap(struct file *file, void *priv,
685 struct v4l2_capability *cap)
686{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300687 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski64f59052008-12-18 11:51:55 -0300688 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300689
690 WARN_ON(priv != file->private_data);
691
692 strlcpy(cap->driver, ici->drv_name, sizeof(cap->driver));
Guennadi Liakhovetskib8d99042008-04-04 13:41:25 -0300693 return ici->ops->querycap(ici, cap);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300694}
695
696static int soc_camera_streamon(struct file *file, void *priv,
697 enum v4l2_buf_type i)
698{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300699 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300700 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300701 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
Guennadi Liakhovetski1c3bb742008-12-18 12:28:54 -0300702 int ret;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300703
704 WARN_ON(priv != file->private_data);
705
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300706 if (i != V4L2_BUF_TYPE_VIDEO_CAPTURE)
707 return -EINVAL;
708
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300709 if (icd->streamer != file)
710 return -EBUSY;
711
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300712 /* This calls buf_queue from host driver's videobuf_queue_ops */
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300713 if (ici->ops->init_videobuf)
714 ret = videobuf_streamon(&icd->vb_vidq);
715 else
716 ret = vb2_streamon(&icd->vb2_vidq, i);
717
Anatolij Gustschin7fdbd852011-01-31 09:19:32 -0300718 if (!ret)
719 v4l2_subdev_call(sd, video, s_stream, 1);
Guennadi Liakhovetski1c3bb742008-12-18 12:28:54 -0300720
Guennadi Liakhovetski1c3bb742008-12-18 12:28:54 -0300721 return ret;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300722}
723
724static int soc_camera_streamoff(struct file *file, void *priv,
725 enum v4l2_buf_type i)
726{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300727 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300728 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300729 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300730
731 WARN_ON(priv != file->private_data);
732
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300733 if (i != V4L2_BUF_TYPE_VIDEO_CAPTURE)
734 return -EINVAL;
735
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300736 if (icd->streamer != file)
737 return -EBUSY;
738
Guennadi Liakhovetski5d28d522009-12-11 11:15:05 -0300739 /*
740 * This calls buf_release from host driver's videobuf_queue_ops for all
741 * remaining buffers. When the last buffer is freed, stop capture
742 */
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -0300743 if (ici->ops->init_videobuf)
744 videobuf_streamoff(&icd->vb_vidq);
745 else
746 vb2_streamoff(&icd->vb2_vidq, i);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300747
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300748 v4l2_subdev_call(sd, video, s_stream, 0);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300749
750 return 0;
751}
752
753static int soc_camera_queryctrl(struct file *file, void *priv,
754 struct v4l2_queryctrl *qc)
755{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300756 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski2840d242009-08-25 11:44:15 -0300757 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300758 int i;
759
760 WARN_ON(priv != file->private_data);
761
762 if (!qc->id)
763 return -EINVAL;
764
Guennadi Liakhovetski2840d242009-08-25 11:44:15 -0300765 /* First check host controls */
766 for (i = 0; i < ici->ops->num_controls; i++)
767 if (qc->id == ici->ops->controls[i].id) {
768 memcpy(qc, &(ici->ops->controls[i]),
769 sizeof(*qc));
770 return 0;
771 }
772
773 /* Then device controls */
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300774 for (i = 0; i < icd->ops->num_controls; i++)
775 if (qc->id == icd->ops->controls[i].id) {
776 memcpy(qc, &(icd->ops->controls[i]),
777 sizeof(*qc));
778 return 0;
779 }
780
781 return -EINVAL;
782}
783
784static int soc_camera_g_ctrl(struct file *file, void *priv,
785 struct v4l2_control *ctrl)
786{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300787 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -0300788 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300789 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
Guennadi Liakhovetski2840d242009-08-25 11:44:15 -0300790 int ret;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300791
792 WARN_ON(priv != file->private_data);
793
Guennadi Liakhovetski2840d242009-08-25 11:44:15 -0300794 if (ici->ops->get_ctrl) {
795 ret = ici->ops->get_ctrl(icd, ctrl);
796 if (ret != -ENOIOCTLCMD)
797 return ret;
798 }
799
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300800 return v4l2_subdev_call(sd, core, g_ctrl, ctrl);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300801}
802
803static int soc_camera_s_ctrl(struct file *file, void *priv,
804 struct v4l2_control *ctrl)
805{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300806 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -0300807 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300808 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
Guennadi Liakhovetski2840d242009-08-25 11:44:15 -0300809 int ret;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300810
811 WARN_ON(priv != file->private_data);
812
Guennadi Liakhovetski2840d242009-08-25 11:44:15 -0300813 if (ici->ops->set_ctrl) {
814 ret = ici->ops->set_ctrl(icd, ctrl);
815 if (ret != -ENOIOCTLCMD)
816 return ret;
817 }
818
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300819 return v4l2_subdev_call(sd, core, s_ctrl, ctrl);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300820}
821
822static int soc_camera_cropcap(struct file *file, void *fh,
823 struct v4l2_cropcap *a)
824{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300825 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300826 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300827
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300828 return ici->ops->cropcap(icd, a);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300829}
830
831static int soc_camera_g_crop(struct file *file, void *fh,
832 struct v4l2_crop *a)
833{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300834 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300835 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
836 int ret;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300837
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300838 ret = ici->ops->get_crop(icd, a);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300839
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300840 return ret;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300841}
842
Guennadi Liakhovetski68a54f02009-08-25 11:46:52 -0300843/*
844 * According to the V4L2 API, drivers shall not update the struct v4l2_crop
845 * argument with the actual geometry, instead, the user shall use G_CROP to
Guennadi Liakhovetskiab56d5e2010-03-23 11:31:46 -0300846 * retrieve it.
Guennadi Liakhovetski68a54f02009-08-25 11:46:52 -0300847 */
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300848static int soc_camera_s_crop(struct file *file, void *fh,
849 struct v4l2_crop *a)
850{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300851 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetski64f59052008-12-18 11:51:55 -0300852 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300853 struct v4l2_rect *rect = &a->c;
854 struct v4l2_crop current_crop;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300855 int ret;
856
857 if (a->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
858 return -EINVAL;
859
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300860 dev_dbg(&icd->dev, "S_CROP(%ux%u@%u:%u)\n",
861 rect->width, rect->height, rect->left, rect->top);
862
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300863 /* If get_crop fails, we'll let host and / or client drivers decide */
864 ret = ici->ops->get_crop(icd, &current_crop);
865
Guennadi Liakhovetskib897a912009-08-25 11:46:53 -0300866 /* Prohibit window size change with initialised buffers */
Guennadi Liakhovetski103754a2010-08-05 19:23:44 -0300867 if (ret < 0) {
868 dev_err(&icd->dev,
869 "S_CROP denied: getting current crop failed\n");
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300870 } else if (icd->vb_vidq.bufs[0] &&
Guennadi Liakhovetski103754a2010-08-05 19:23:44 -0300871 (a->c.width != current_crop.c.width ||
872 a->c.height != current_crop.c.height)) {
Guennadi Liakhovetskib897a912009-08-25 11:46:53 -0300873 dev_err(&icd->dev,
874 "S_CROP denied: queue initialised and sizes differ\n");
875 ret = -EBUSY;
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -0300876 } else {
877 ret = ici->ops->set_crop(icd, a);
Guennadi Liakhovetskib897a912009-08-25 11:46:53 -0300878 }
879
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300880 return ret;
881}
882
Guennadi Liakhovetskic9f6ef62010-02-09 18:00:30 +0100883static int soc_camera_g_parm(struct file *file, void *fh,
884 struct v4l2_streamparm *a)
885{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300886 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetskic9f6ef62010-02-09 18:00:30 +0100887 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
888
889 if (ici->ops->get_parm)
890 return ici->ops->get_parm(icd, a);
891
892 return -ENOIOCTLCMD;
893}
894
895static int soc_camera_s_parm(struct file *file, void *fh,
896 struct v4l2_streamparm *a)
897{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300898 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetskic9f6ef62010-02-09 18:00:30 +0100899 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
900
901 if (ici->ops->set_parm)
902 return ici->ops->set_parm(icd, a);
903
904 return -ENOIOCTLCMD;
905}
906
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300907static int soc_camera_g_chip_ident(struct file *file, void *fh,
Hans Verkuilaecde8b52008-12-30 07:14:19 -0300908 struct v4l2_dbg_chip_ident *id)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300909{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300910 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300911 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300912
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300913 return v4l2_subdev_call(sd, core, g_chip_ident, id);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300914}
915
916#ifdef CONFIG_VIDEO_ADV_DEBUG
917static int soc_camera_g_register(struct file *file, void *fh,
Hans Verkuilaecde8b52008-12-30 07:14:19 -0300918 struct v4l2_dbg_register *reg)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300919{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300920 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300921 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300922
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300923 return v4l2_subdev_call(sd, core, g_register, reg);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300924}
925
926static int soc_camera_s_register(struct file *file, void *fh,
Hans Verkuilaecde8b52008-12-30 07:14:19 -0300927 struct v4l2_dbg_register *reg)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300928{
Guennadi Liakhovetski57bee292010-08-17 14:29:51 -0300929 struct soc_camera_device *icd = file->private_data;
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300930 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300931
Guennadi Liakhovetskic9c1f1c2009-08-25 11:46:59 -0300932 return v4l2_subdev_call(sd, core, s_register, reg);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300933}
934#endif
935
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300936/* So far this function cannot fail */
937static void scan_add_host(struct soc_camera_host *ici)
938{
939 struct soc_camera_device *icd;
940
941 mutex_lock(&list_lock);
942
943 list_for_each_entry(icd, &devices, list) {
944 if (icd->iface == ici->nr) {
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300945 int ret;
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -0300946 icd->dev.parent = ici->v4l2_dev.dev;
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300947 dev_set_name(&icd->dev, "%u-%u", icd->iface,
948 icd->devnum);
949 ret = device_register(&icd->dev);
950 if (ret < 0) {
951 icd->dev.parent = NULL;
952 dev_err(&icd->dev,
953 "Cannot register device: %d\n", ret);
954 }
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300955 }
956 }
957
958 mutex_unlock(&list_lock);
959}
960
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300961#ifdef CONFIG_I2C_BOARDINFO
962static int soc_camera_init_i2c(struct soc_camera_device *icd,
963 struct soc_camera_link *icl)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300964{
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300965 struct i2c_client *client;
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -0300966 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300967 struct i2c_adapter *adap = i2c_get_adapter(icl->i2c_adapter_id);
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -0300968 struct v4l2_subdev *subdev;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300969
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300970 if (!adap) {
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300971 dev_err(&icd->dev, "Cannot get I2C adapter #%d. No driver?\n",
972 icl->i2c_adapter_id);
973 goto ei2cga;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300974 }
975
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300976 icl->board_info->platform_data = icd;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300977
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -0300978 subdev = v4l2_i2c_new_subdev_board(&ici->v4l2_dev, adap,
Laurent Pinchart9a1f8b32010-09-24 10:16:44 -0300979 icl->board_info, NULL);
Magnus Dammd74f8412010-02-09 17:40:40 +0900980 if (!subdev)
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300981 goto ei2cnd;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300982
Laurent Pinchartc4ce6d12010-07-30 17:24:54 -0300983 client = v4l2_get_subdevdata(subdev);
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -0300984
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300985 /* Use to_i2c_client(dev) to recover the i2c client */
986 dev_set_drvdata(&icd->dev, &client->dev);
987
988 return 0;
989ei2cnd:
990 i2c_put_adapter(adap);
991ei2cga:
Magnus Dammd74f8412010-02-09 17:40:40 +0900992 return -ENODEV;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -0300993}
994
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -0300995static void soc_camera_free_i2c(struct soc_camera_device *icd)
996{
997 struct i2c_client *client =
998 to_i2c_client(to_soc_camera_control(icd));
999 dev_set_drvdata(&icd->dev, NULL);
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001000 v4l2_device_unregister_subdev(i2c_get_clientdata(client));
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001001 i2c_unregister_device(client);
1002 i2c_put_adapter(client->adapter);
1003}
1004#else
1005#define soc_camera_init_i2c(icd, icl) (-ENODEV)
1006#define soc_camera_free_i2c(icd) do {} while (0)
1007#endif
1008
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001009static int soc_camera_video_start(struct soc_camera_device *icd);
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001010static int video_dev_create(struct soc_camera_device *icd);
1011/* Called during host-driver probe */
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001012static int soc_camera_probe(struct device *dev)
1013{
1014 struct soc_camera_device *icd = to_soc_camera_dev(dev);
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001015 struct soc_camera_host *ici = to_soc_camera_host(dev->parent);
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001016 struct soc_camera_link *icl = to_soc_camera_link(icd);
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001017 struct device *control = NULL;
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -03001018 struct v4l2_subdev *sd;
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -03001019 struct v4l2_mbus_framefmt mf;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001020 int ret;
1021
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001022 dev_info(dev, "Probing %s\n", dev_name(dev));
Guennadi Liakhovetski1c3bb742008-12-18 12:28:54 -03001023
Alberto Panizzo96e442c2010-12-02 07:43:37 -03001024 ret = regulator_bulk_get(icd->pdev, icl->num_regulators,
1025 icl->regulators);
1026 if (ret < 0)
1027 goto ereg;
1028
1029 ret = soc_camera_power_set(icd, icl, 1);
1030 if (ret < 0)
1031 goto epower;
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001032
1033 /* The camera could have been already on, try to reset */
1034 if (icl->reset)
1035 icl->reset(icd->pdev);
1036
1037 ret = ici->ops->add(icd);
1038 if (ret < 0)
1039 goto eadd;
1040
1041 /* Must have icd->vdev before registering the device */
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001042 ret = video_dev_create(icd);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001043 if (ret < 0)
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001044 goto evdc;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001045
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001046 /* Non-i2c cameras, e.g., soc_camera_platform, have no board_info */
1047 if (icl->board_info) {
1048 ret = soc_camera_init_i2c(icd, icl);
1049 if (ret < 0)
1050 goto eadddev;
1051 } else if (!icl->add_device || !icl->del_device) {
1052 ret = -EINVAL;
1053 goto eadddev;
1054 } else {
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001055 if (icl->module_name)
1056 ret = request_module(icl->module_name);
1057
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001058 ret = icl->add_device(icl, &icd->dev);
1059 if (ret < 0)
1060 goto eadddev;
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001061
Guennadi Liakhovetski96c75392009-08-25 11:53:23 -03001062 /*
1063 * FIXME: this is racy, have to use driver-binding notification,
1064 * when it is available
1065 */
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001066 control = to_soc_camera_control(icd);
Guennadi Liakhovetski08590b92009-08-25 11:46:54 -03001067 if (!control || !control->driver || !dev_get_drvdata(control) ||
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001068 !try_module_get(control->driver->owner)) {
1069 icl->del_device(icl);
1070 goto enodrv;
1071 }
Guennadi Liakhovetski025c18a2009-03-13 06:08:20 -03001072 }
1073
Guennadi Liakhovetskifa489842009-08-25 11:46:43 -03001074 /* At this point client .probe() should have run already */
1075 ret = soc_camera_init_user_formats(icd);
1076 if (ret < 0)
1077 goto eiufmt;
1078
Guennadi Liakhovetskifa489842009-08-25 11:46:43 -03001079 icd->field = V4L2_FIELD_ANY;
1080
Guennadi Liakhovetskib6a633c2010-12-25 17:40:26 -03001081 icd->vdev->lock = &icd->video_lock;
1082
1083 /*
1084 * ..._video_start() will create a device node, video_register_device()
1085 * itself is protected against concurrent open() calls, but we also have
1086 * to protect our data.
1087 */
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001088 mutex_lock(&icd->video_lock);
1089
1090 ret = soc_camera_video_start(icd);
1091 if (ret < 0)
1092 goto evidstart;
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001093
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -03001094 /* Try to improve our guess of a reasonable window format */
1095 sd = soc_camera_to_subdev(icd);
Guennadi Liakhovetski760697b2009-12-11 11:46:49 -03001096 if (!v4l2_subdev_call(sd, video, g_mbus_fmt, &mf)) {
1097 icd->user_width = mf.width;
1098 icd->user_height = mf.height;
1099 icd->colorspace = mf.colorspace;
1100 icd->field = mf.field;
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -03001101 }
1102
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001103 /* Do we have to sysfs_remove_link() before device_unregister()? */
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -03001104 if (sysfs_create_link(&icd->dev.kobj, &to_soc_camera_control(icd)->kobj,
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001105 "control"))
1106 dev_warn(&icd->dev, "Failed creating the control symlink\n");
1107
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001108 ici->ops->remove(icd);
1109
Alberto Panizzo96e442c2010-12-02 07:43:37 -03001110 soc_camera_power_set(icd, icl, 0);
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001111
1112 mutex_unlock(&icd->video_lock);
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001113
1114 return 0;
1115
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001116evidstart:
1117 mutex_unlock(&icd->video_lock);
Guennadi Liakhovetskifa489842009-08-25 11:46:43 -03001118 soc_camera_free_user_formats(icd);
1119eiufmt:
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001120 if (icl->board_info) {
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001121 soc_camera_free_i2c(icd);
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001122 } else {
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001123 icl->del_device(icl);
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001124 module_put(control->driver->owner);
1125 }
1126enodrv:
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001127eadddev:
1128 video_device_release(icd->vdev);
1129evdc:
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001130 ici->ops->remove(icd);
1131eadd:
Alberto Panizzo96e442c2010-12-02 07:43:37 -03001132 soc_camera_power_set(icd, icl, 0);
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001133epower:
Alberto Panizzo96e442c2010-12-02 07:43:37 -03001134 regulator_bulk_free(icl->num_regulators, icl->regulators);
1135ereg:
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001136 return ret;
1137}
1138
Guennadi Liakhovetski5d28d522009-12-11 11:15:05 -03001139/*
1140 * This is called on device_unregister, which only means we have to disconnect
1141 * from the host, but not remove ourselves from the device list
1142 */
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001143static int soc_camera_remove(struct device *dev)
1144{
1145 struct soc_camera_device *icd = to_soc_camera_dev(dev);
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001146 struct soc_camera_link *icl = to_soc_camera_link(icd);
1147 struct video_device *vdev = icd->vdev;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001148
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001149 BUG_ON(!dev->parent);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001150
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001151 if (vdev) {
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001152 video_unregister_device(vdev);
1153 icd->vdev = NULL;
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001154 }
1155
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001156 if (icl->board_info) {
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001157 soc_camera_free_i2c(icd);
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001158 } else {
1159 struct device_driver *drv = to_soc_camera_control(icd) ?
1160 to_soc_camera_control(icd)->driver : NULL;
1161 if (drv) {
1162 icl->del_device(icl);
1163 module_put(drv->owner);
1164 }
1165 }
Guennadi Liakhovetskifa489842009-08-25 11:46:43 -03001166 soc_camera_free_user_formats(icd);
Guennadi Liakhovetski025c18a2009-03-13 06:08:20 -03001167
Alberto Panizzo96e442c2010-12-02 07:43:37 -03001168 regulator_bulk_free(icl->num_regulators, icl->regulators);
1169
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001170 return 0;
1171}
1172
Robert Jarzmik2e521062008-08-01 20:14:50 -03001173static int soc_camera_suspend(struct device *dev, pm_message_t state)
1174{
1175 struct soc_camera_device *icd = to_soc_camera_dev(dev);
1176 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
1177 int ret = 0;
1178
1179 if (ici->ops->suspend)
1180 ret = ici->ops->suspend(icd, state);
1181
1182 return ret;
1183}
1184
1185static int soc_camera_resume(struct device *dev)
1186{
1187 struct soc_camera_device *icd = to_soc_camera_dev(dev);
1188 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
1189 int ret = 0;
1190
1191 if (ici->ops->resume)
1192 ret = ici->ops->resume(icd);
1193
1194 return ret;
1195}
1196
Guennadi Liakhovetski52d268a2010-07-26 11:37:13 -03001197struct bus_type soc_camera_bus_type = {
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001198 .name = "soc-camera",
1199 .probe = soc_camera_probe,
1200 .remove = soc_camera_remove,
Robert Jarzmik2e521062008-08-01 20:14:50 -03001201 .suspend = soc_camera_suspend,
1202 .resume = soc_camera_resume,
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001203};
Guennadi Liakhovetski52d268a2010-07-26 11:37:13 -03001204EXPORT_SYMBOL_GPL(soc_camera_bus_type);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001205
1206static struct device_driver ic_drv = {
1207 .name = "camera",
1208 .bus = &soc_camera_bus_type,
1209 .owner = THIS_MODULE,
1210};
1211
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001212static void dummy_release(struct device *dev)
1213{
1214}
1215
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -03001216static int default_cropcap(struct soc_camera_device *icd,
1217 struct v4l2_cropcap *a)
1218{
1219 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
1220 return v4l2_subdev_call(sd, video, cropcap, a);
1221}
1222
1223static int default_g_crop(struct soc_camera_device *icd, struct v4l2_crop *a)
1224{
1225 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
1226 return v4l2_subdev_call(sd, video, g_crop, a);
1227}
1228
1229static int default_s_crop(struct soc_camera_device *icd, struct v4l2_crop *a)
1230{
1231 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
1232 return v4l2_subdev_call(sd, video, s_crop, a);
1233}
1234
Janusz Krzysztofik06e17822010-09-10 22:26:16 -03001235static int default_g_parm(struct soc_camera_device *icd,
1236 struct v4l2_streamparm *parm)
1237{
1238 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
1239 return v4l2_subdev_call(sd, video, g_parm, parm);
1240}
1241
1242static int default_s_parm(struct soc_camera_device *icd,
1243 struct v4l2_streamparm *parm)
1244{
1245 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
1246 return v4l2_subdev_call(sd, video, s_parm, parm);
1247}
1248
Qing Xued5b65d2011-01-20 05:19:40 -03001249static int default_enum_fsizes(struct soc_camera_device *icd,
1250 struct v4l2_frmsizeenum *fsize)
1251{
1252 int ret;
1253 struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
1254 const struct soc_camera_format_xlate *xlate;
1255 __u32 pixfmt = fsize->pixel_format;
1256 struct v4l2_frmsizeenum fsize_mbus = *fsize;
1257
1258 xlate = soc_camera_xlate_by_fourcc(icd, pixfmt);
1259 if (!xlate)
1260 return -EINVAL;
1261 /* map xlate-code to pixel_format, sensor only handle xlate-code*/
1262 fsize_mbus.pixel_format = xlate->code;
1263
1264 ret = v4l2_subdev_call(sd, video, enum_mbus_fsizes, &fsize_mbus);
1265 if (ret < 0)
1266 return ret;
1267
1268 *fsize = fsize_mbus;
1269 fsize->pixel_format = pixfmt;
1270
1271 return 0;
1272}
1273
Guennadi Liakhovetski64ff9ba2009-11-09 16:12:37 -03001274static void soc_camera_device_init(struct device *dev, void *pdata)
1275{
1276 dev->platform_data = pdata;
1277 dev->bus = &soc_camera_bus_type;
1278 dev->release = dummy_release;
1279}
1280
Guennadi Liakhovetskib8d99042008-04-04 13:41:25 -03001281int soc_camera_host_register(struct soc_camera_host *ici)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001282{
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001283 struct soc_camera_host *ix;
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001284 int ret;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001285
Guennadi Liakhovetski64f59052008-12-18 11:51:55 -03001286 if (!ici || !ici->ops ||
1287 !ici->ops->try_fmt ||
1288 !ici->ops->set_fmt ||
1289 !ici->ops->set_bus_param ||
1290 !ici->ops->querycap ||
Guennadi Liakhovetski592c2ab2011-01-29 12:44:51 -03001291 ((!ici->ops->init_videobuf ||
1292 !ici->ops->reqbufs) &&
1293 !ici->ops->init_videobuf2) ||
Guennadi Liakhovetski64f59052008-12-18 11:51:55 -03001294 !ici->ops->add ||
1295 !ici->ops->remove ||
Guennadi Liakhovetskieff505f2009-04-24 12:55:48 -03001296 !ici->ops->poll ||
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001297 !ici->v4l2_dev.dev)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001298 return -EINVAL;
1299
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -03001300 if (!ici->ops->set_crop)
1301 ici->ops->set_crop = default_s_crop;
1302 if (!ici->ops->get_crop)
1303 ici->ops->get_crop = default_g_crop;
1304 if (!ici->ops->cropcap)
1305 ici->ops->cropcap = default_cropcap;
Janusz Krzysztofik06e17822010-09-10 22:26:16 -03001306 if (!ici->ops->set_parm)
1307 ici->ops->set_parm = default_s_parm;
1308 if (!ici->ops->get_parm)
1309 ici->ops->get_parm = default_g_parm;
Qing Xued5b65d2011-01-20 05:19:40 -03001310 if (!ici->ops->enum_fsizes)
1311 ici->ops->enum_fsizes = default_enum_fsizes;
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -03001312
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001313 mutex_lock(&list_lock);
1314 list_for_each_entry(ix, &hosts, list) {
1315 if (ix->nr == ici->nr) {
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001316 ret = -EBUSY;
1317 goto edevreg;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001318 }
1319 }
1320
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001321 ret = v4l2_device_register(ici->v4l2_dev.dev, &ici->v4l2_dev);
1322 if (ret < 0)
1323 goto edevreg;
Guennadi Liakhovetskieff505f2009-04-24 12:55:48 -03001324
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001325 list_add_tail(&ici->list, &hosts);
1326 mutex_unlock(&list_lock);
1327
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001328 scan_add_host(ici);
1329
1330 return 0;
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001331
1332edevreg:
1333 mutex_unlock(&list_lock);
1334 return ret;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001335}
1336EXPORT_SYMBOL(soc_camera_host_register);
1337
1338/* Unregister all clients! */
1339void soc_camera_host_unregister(struct soc_camera_host *ici)
1340{
1341 struct soc_camera_device *icd;
1342
1343 mutex_lock(&list_lock);
1344
1345 list_del(&ici->list);
1346
1347 list_for_each_entry(icd, &devices, list) {
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001348 if (icd->iface == ici->nr) {
Guennadi Liakhovetski64ff9ba2009-11-09 16:12:37 -03001349 void *pdata = icd->dev.platform_data;
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001350 /* The bus->remove will be called */
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001351 device_unregister(&icd->dev);
Guennadi Liakhovetski76823b72009-10-05 12:54:54 -03001352 /*
1353 * Not before device_unregister(), .remove
1354 * needs parent to call ici->ops->remove().
1355 * If the host module is loaded again, device_register()
1356 * would complain "already initialised," since 2.6.32
1357 * this is also needed to prevent use-after-free of the
1358 * device private data.
1359 */
1360 memset(&icd->dev, 0, sizeof(icd->dev));
Guennadi Liakhovetski64ff9ba2009-11-09 16:12:37 -03001361 soc_camera_device_init(&icd->dev, pdata);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001362 }
1363 }
1364
1365 mutex_unlock(&list_lock);
1366
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001367 v4l2_device_unregister(&ici->v4l2_dev);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001368}
1369EXPORT_SYMBOL(soc_camera_host_unregister);
1370
1371/* Image capture device */
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001372static int soc_camera_device_register(struct soc_camera_device *icd)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001373{
1374 struct soc_camera_device *ix;
1375 int num = -1, i;
1376
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001377 for (i = 0; i < 256 && num < 0; i++) {
1378 num = i;
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001379 /* Check if this index is available on this interface */
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001380 list_for_each_entry(ix, &devices, list) {
1381 if (ix->iface == icd->iface && ix->devnum == i) {
1382 num = -1;
1383 break;
1384 }
1385 }
1386 }
1387
1388 if (num < 0)
Guennadi Liakhovetski5d28d522009-12-11 11:15:05 -03001389 /*
1390 * ok, we have 256 cameras on this host...
1391 * man, stay reasonable...
1392 */
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001393 return -ENOMEM;
1394
Guennadi Liakhovetski64ff9ba2009-11-09 16:12:37 -03001395 icd->devnum = num;
Guennadi Liakhovetski64f59052008-12-18 11:51:55 -03001396 icd->use_count = 0;
1397 icd->host_priv = NULL;
Guennadi Liakhovetski1c3bb742008-12-18 12:28:54 -03001398 mutex_init(&icd->video_lock);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001399
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001400 list_add_tail(&icd->list, &devices);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001401
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001402 return 0;
1403}
1404
1405static void soc_camera_device_unregister(struct soc_camera_device *icd)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001406{
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001407 list_del(&icd->list);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001408}
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001409
Hans Verkuila3998102008-07-21 02:57:38 -03001410static const struct v4l2_ioctl_ops soc_camera_ioctl_ops = {
1411 .vidioc_querycap = soc_camera_querycap,
1412 .vidioc_g_fmt_vid_cap = soc_camera_g_fmt_vid_cap,
1413 .vidioc_enum_fmt_vid_cap = soc_camera_enum_fmt_vid_cap,
1414 .vidioc_s_fmt_vid_cap = soc_camera_s_fmt_vid_cap,
1415 .vidioc_enum_input = soc_camera_enum_input,
1416 .vidioc_g_input = soc_camera_g_input,
1417 .vidioc_s_input = soc_camera_s_input,
1418 .vidioc_s_std = soc_camera_s_std,
Qing Xued5b65d2011-01-20 05:19:40 -03001419 .vidioc_enum_framesizes = soc_camera_enum_fsizes,
Hans Verkuila3998102008-07-21 02:57:38 -03001420 .vidioc_reqbufs = soc_camera_reqbufs,
1421 .vidioc_try_fmt_vid_cap = soc_camera_try_fmt_vid_cap,
1422 .vidioc_querybuf = soc_camera_querybuf,
1423 .vidioc_qbuf = soc_camera_qbuf,
1424 .vidioc_dqbuf = soc_camera_dqbuf,
1425 .vidioc_streamon = soc_camera_streamon,
1426 .vidioc_streamoff = soc_camera_streamoff,
1427 .vidioc_queryctrl = soc_camera_queryctrl,
1428 .vidioc_g_ctrl = soc_camera_g_ctrl,
1429 .vidioc_s_ctrl = soc_camera_s_ctrl,
1430 .vidioc_cropcap = soc_camera_cropcap,
1431 .vidioc_g_crop = soc_camera_g_crop,
1432 .vidioc_s_crop = soc_camera_s_crop,
Guennadi Liakhovetskic9f6ef62010-02-09 18:00:30 +01001433 .vidioc_g_parm = soc_camera_g_parm,
1434 .vidioc_s_parm = soc_camera_s_parm,
Hans Verkuila3998102008-07-21 02:57:38 -03001435 .vidioc_g_chip_ident = soc_camera_g_chip_ident,
1436#ifdef CONFIG_VIDEO_ADV_DEBUG
1437 .vidioc_g_register = soc_camera_g_register,
1438 .vidioc_s_register = soc_camera_s_register,
1439#endif
1440};
1441
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001442static int video_dev_create(struct soc_camera_device *icd)
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001443{
1444 struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001445 struct video_device *vdev = video_device_alloc();
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001446
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001447 if (!vdev)
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001448 return -ENOMEM;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001449
1450 strlcpy(vdev->name, ici->drv_name, sizeof(vdev->name));
Guennadi Liakhovetski1c3bb742008-12-18 12:28:54 -03001451
Hans Verkuil5e85e732008-07-20 06:31:39 -03001452 vdev->parent = &icd->dev;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001453 vdev->current_norm = V4L2_STD_UNKNOWN;
1454 vdev->fops = &soc_camera_fops;
Hans Verkuila3998102008-07-21 02:57:38 -03001455 vdev->ioctl_ops = &soc_camera_ioctl_ops;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001456 vdev->release = video_device_release;
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001457 vdev->tvnorms = V4L2_STD_UNKNOWN;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001458
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001459 icd->vdev = vdev;
1460
1461 return 0;
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001462}
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001463
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001464/*
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001465 * Called from soc_camera_probe() above (with .video_lock held???)
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001466 */
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001467static int soc_camera_video_start(struct soc_camera_device *icd)
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001468{
Mauro Carvalho Chehab4f9fb5e2010-05-18 00:46:09 -03001469 struct device_type *type = icd->vdev->dev.type;
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001470 int ret;
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001471
1472 if (!icd->dev.parent)
1473 return -ENODEV;
1474
1475 if (!icd->ops ||
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001476 !icd->ops->query_bus_param ||
1477 !icd->ops->set_bus_param)
1478 return -EINVAL;
1479
Laurent Pinchart46b21092009-12-10 11:51:38 -02001480 ret = video_register_device(icd->vdev, VFL_TYPE_GRABBER, -1);
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001481 if (ret < 0) {
1482 dev_err(&icd->dev, "video_register_device failed: %d\n", ret);
1483 return ret;
1484 }
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001485
Mauro Carvalho Chehab4f9fb5e2010-05-18 00:46:09 -03001486 /* Restore device type, possibly set by the subdevice driver */
1487 icd->vdev->dev.type = type;
1488
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001489 return 0;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001490}
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001491
Guennadi Liakhovetskic41deba2009-08-25 11:06:21 -03001492static int __devinit soc_camera_pdrv_probe(struct platform_device *pdev)
1493{
1494 struct soc_camera_link *icl = pdev->dev.platform_data;
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001495 struct soc_camera_device *icd;
1496 int ret;
Guennadi Liakhovetskic41deba2009-08-25 11:06:21 -03001497
1498 if (!icl)
1499 return -EINVAL;
1500
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001501 icd = kzalloc(sizeof(*icd), GFP_KERNEL);
1502 if (!icd)
1503 return -ENOMEM;
Guennadi Liakhovetskic41deba2009-08-25 11:06:21 -03001504
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001505 icd->iface = icl->bus_id;
Guennadi Liakhovetski979ea1d2009-08-25 11:43:33 -03001506 icd->pdev = &pdev->dev;
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001507 platform_set_drvdata(pdev, icd);
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001508
1509 ret = soc_camera_device_register(icd);
1510 if (ret < 0)
1511 goto escdevreg;
1512
Guennadi Liakhovetski64ff9ba2009-11-09 16:12:37 -03001513 soc_camera_device_init(&icd->dev, icl);
1514
Guennadi Liakhovetski6a6c8782009-08-25 11:50:46 -03001515 icd->user_width = DEFAULT_WIDTH;
1516 icd->user_height = DEFAULT_HEIGHT;
1517
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001518 return 0;
1519
1520escdevreg:
1521 kfree(icd);
1522
1523 return ret;
Guennadi Liakhovetskic41deba2009-08-25 11:06:21 -03001524}
1525
Guennadi Liakhovetski5d28d522009-12-11 11:15:05 -03001526/*
1527 * Only called on rmmod for each platform device, since they are not
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001528 * hot-pluggable. Now we know, that all our users - hosts and devices have
Guennadi Liakhovetski5d28d522009-12-11 11:15:05 -03001529 * been unloaded already
1530 */
Guennadi Liakhovetskic41deba2009-08-25 11:06:21 -03001531static int __devexit soc_camera_pdrv_remove(struct platform_device *pdev)
1532{
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001533 struct soc_camera_device *icd = platform_get_drvdata(pdev);
Guennadi Liakhovetskic41deba2009-08-25 11:06:21 -03001534
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001535 if (!icd)
1536 return -EINVAL;
1537
1538 soc_camera_device_unregister(icd);
1539
1540 kfree(icd);
1541
Guennadi Liakhovetski0fd327b2009-05-07 13:25:32 -03001542 return 0;
1543}
1544
1545static struct platform_driver __refdata soc_camera_pdrv = {
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001546 .remove = __devexit_p(soc_camera_pdrv_remove),
1547 .driver = {
1548 .name = "soc-camera-pdrv",
1549 .owner = THIS_MODULE,
Guennadi Liakhovetski0fd327b2009-05-07 13:25:32 -03001550 },
1551};
1552
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001553static int __init soc_camera_init(void)
1554{
1555 int ret = bus_register(&soc_camera_bus_type);
1556 if (ret)
1557 return ret;
1558 ret = driver_register(&ic_drv);
1559 if (ret)
1560 goto edrvr;
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001561
Guennadi Liakhovetski40e2e092009-08-25 11:28:22 -03001562 ret = platform_driver_probe(&soc_camera_pdrv, soc_camera_pdrv_probe);
Guennadi Liakhovetski0fd327b2009-05-07 13:25:32 -03001563 if (ret)
1564 goto epdr;
1565
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001566 return 0;
1567
Guennadi Liakhovetski0fd327b2009-05-07 13:25:32 -03001568epdr:
1569 driver_unregister(&ic_drv);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001570edrvr:
1571 bus_unregister(&soc_camera_bus_type);
1572 return ret;
1573}
1574
1575static void __exit soc_camera_exit(void)
1576{
Guennadi Liakhovetski0fd327b2009-05-07 13:25:32 -03001577 platform_driver_unregister(&soc_camera_pdrv);
Guennadi Liakhovetskie55222e2008-04-22 14:42:03 -03001578 driver_unregister(&ic_drv);
1579 bus_unregister(&soc_camera_bus_type);
1580}
1581
1582module_init(soc_camera_init);
1583module_exit(soc_camera_exit);
1584
1585MODULE_DESCRIPTION("Image capture bus driver");
1586MODULE_AUTHOR("Guennadi Liakhovetski <kernel@pengutronix.de>");
1587MODULE_LICENSE("GPL");
Guennadi Liakhovetski0fd327b2009-05-07 13:25:32 -03001588MODULE_ALIAS("platform:soc-camera-pdrv");