2 * Generic Platform Camera Driver
4 * Copyright (C) 2008 Magnus Damm
5 * Based on mt9m001 driver,
6 * Copyright (C) 2008, Guennadi Liakhovetski <kernel@pengutronix.de>
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
13 #include <linux/init.h>
14 #include <linux/module.h>
15 #include <linux/slab.h>
16 #include <linux/delay.h>
17 #include <linux/platform_device.h>
18 #include <linux/videodev2.h>
19 #include <media/v4l2-common.h>
20 #include <media/soc_camera.h>
21 #include <media/soc_camera_platform.h>
23 struct soc_camera_platform_priv
{
24 struct soc_camera_platform_info
*info
;
25 struct soc_camera_device icd
;
26 struct soc_camera_data_format format
;
29 static struct soc_camera_platform_info
*
30 soc_camera_platform_get_info(struct soc_camera_device
*icd
)
32 struct soc_camera_platform_priv
*priv
;
33 priv
= container_of(icd
, struct soc_camera_platform_priv
, icd
);
37 static int soc_camera_platform_init(struct soc_camera_device
*icd
)
39 struct soc_camera_platform_info
*p
= soc_camera_platform_get_info(icd
);
47 static int soc_camera_platform_release(struct soc_camera_device
*icd
)
49 struct soc_camera_platform_info
*p
= soc_camera_platform_get_info(icd
);
57 static int soc_camera_platform_start_capture(struct soc_camera_device
*icd
)
59 struct soc_camera_platform_info
*p
= soc_camera_platform_get_info(icd
);
60 return p
->set_capture(p
, 1);
63 static int soc_camera_platform_stop_capture(struct soc_camera_device
*icd
)
65 struct soc_camera_platform_info
*p
= soc_camera_platform_get_info(icd
);
66 return p
->set_capture(p
, 0);
69 static int soc_camera_platform_set_bus_param(struct soc_camera_device
*icd
,
76 soc_camera_platform_query_bus_param(struct soc_camera_device
*icd
)
78 struct soc_camera_platform_info
*p
= soc_camera_platform_get_info(icd
);
82 static int soc_camera_platform_set_fmt(struct soc_camera_device
*icd
,
83 __u32 pixfmt
, struct v4l2_rect
*rect
)
88 static int soc_camera_platform_try_fmt(struct soc_camera_device
*icd
,
89 struct v4l2_format
*f
)
91 struct soc_camera_platform_info
*p
= soc_camera_platform_get_info(icd
);
92 struct v4l2_pix_format
*pix
= &f
->fmt
.pix
;
94 pix
->width
= p
->format
.width
;
95 pix
->height
= p
->format
.height
;
99 static int soc_camera_platform_video_probe(struct soc_camera_device
*icd
)
101 struct soc_camera_platform_priv
*priv
;
102 priv
= container_of(icd
, struct soc_camera_platform_priv
, icd
);
104 priv
->format
.name
= priv
->info
->format_name
;
105 priv
->format
.depth
= priv
->info
->format_depth
;
106 priv
->format
.fourcc
= priv
->info
->format
.pixelformat
;
107 priv
->format
.colorspace
= priv
->info
->format
.colorspace
;
109 icd
->formats
= &priv
->format
;
110 icd
->num_formats
= 1;
112 return soc_camera_video_start(icd
);
115 static void soc_camera_platform_video_remove(struct soc_camera_device
*icd
)
117 soc_camera_video_stop(icd
);
120 static struct soc_camera_ops soc_camera_platform_ops
= {
121 .owner
= THIS_MODULE
,
122 .probe
= soc_camera_platform_video_probe
,
123 .remove
= soc_camera_platform_video_remove
,
124 .init
= soc_camera_platform_init
,
125 .release
= soc_camera_platform_release
,
126 .start_capture
= soc_camera_platform_start_capture
,
127 .stop_capture
= soc_camera_platform_stop_capture
,
128 .set_fmt
= soc_camera_platform_set_fmt
,
129 .try_fmt
= soc_camera_platform_try_fmt
,
130 .set_bus_param
= soc_camera_platform_set_bus_param
,
131 .query_bus_param
= soc_camera_platform_query_bus_param
,
134 static int soc_camera_platform_probe(struct platform_device
*pdev
)
136 struct soc_camera_platform_priv
*priv
;
137 struct soc_camera_platform_info
*p
;
138 struct soc_camera_device
*icd
;
141 p
= pdev
->dev
.platform_data
;
145 priv
= kzalloc(sizeof(*priv
), GFP_KERNEL
);
150 platform_set_drvdata(pdev
, priv
);
153 icd
->ops
= &soc_camera_platform_ops
;
154 icd
->control
= &pdev
->dev
;
156 icd
->width_max
= priv
->info
->format
.width
;
158 icd
->height_max
= priv
->info
->format
.height
;
160 icd
->iface
= priv
->info
->iface
;
162 ret
= soc_camera_device_register(icd
);
169 static int soc_camera_platform_remove(struct platform_device
*pdev
)
171 struct soc_camera_platform_priv
*priv
= platform_get_drvdata(pdev
);
173 soc_camera_device_unregister(&priv
->icd
);
178 static struct platform_driver soc_camera_platform_driver
= {
180 .name
= "soc_camera_platform",
182 .probe
= soc_camera_platform_probe
,
183 .remove
= soc_camera_platform_remove
,
186 static int __init
soc_camera_platform_module_init(void)
188 return platform_driver_register(&soc_camera_platform_driver
);
191 static void __exit
soc_camera_platform_module_exit(void)
193 platform_driver_unregister(&soc_camera_platform_driver
);
196 module_init(soc_camera_platform_module_init
);
197 module_exit(soc_camera_platform_module_exit
);
199 MODULE_DESCRIPTION("SoC Camera Platform driver");
200 MODULE_AUTHOR("Magnus Damm");
201 MODULE_LICENSE("GPL v2");