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-subdev.h>
20 #include <media/soc_camera.h>
21 #include <media/soc_camera_platform.h>
23 struct soc_camera_platform_priv
{
24 struct v4l2_subdev subdev
;
25 struct soc_camera_data_format format
;
28 static struct soc_camera_platform_info
*
29 soc_camera_platform_get_info(struct soc_camera_device
*icd
)
31 struct platform_device
*pdev
= to_platform_device(dev_get_drvdata(&icd
->dev
));
32 return pdev
->dev
.platform_data
;
35 static int soc_camera_platform_s_stream(struct v4l2_subdev
*sd
, int enable
)
37 struct soc_camera_platform_info
*p
= v4l2_get_subdevdata(sd
);
38 return p
->set_capture(p
, enable
);
41 static int soc_camera_platform_set_bus_param(struct soc_camera_device
*icd
,
48 soc_camera_platform_query_bus_param(struct soc_camera_device
*icd
)
50 struct soc_camera_platform_info
*p
= soc_camera_platform_get_info(icd
);
54 static int soc_camera_platform_set_crop(struct soc_camera_device
*icd
,
55 struct v4l2_rect
*rect
)
60 static int soc_camera_platform_try_fmt(struct v4l2_subdev
*sd
,
61 struct v4l2_format
*f
)
63 struct soc_camera_platform_info
*p
= v4l2_get_subdevdata(sd
);
64 struct v4l2_pix_format
*pix
= &f
->fmt
.pix
;
66 pix
->width
= p
->format
.width
;
67 pix
->height
= p
->format
.height
;
71 static void soc_camera_platform_video_probe(struct soc_camera_device
*icd
,
72 struct platform_device
*pdev
)
74 struct soc_camera_platform_priv
*priv
= platform_get_drvdata(pdev
);
75 struct soc_camera_platform_info
*p
= pdev
->dev
.platform_data
;
77 priv
->format
.name
= p
->format_name
;
78 priv
->format
.depth
= p
->format_depth
;
79 priv
->format
.fourcc
= p
->format
.pixelformat
;
80 priv
->format
.colorspace
= p
->format
.colorspace
;
82 icd
->formats
= &priv
->format
;
86 static struct v4l2_subdev_core_ops platform_subdev_core_ops
;
88 static struct v4l2_subdev_video_ops platform_subdev_video_ops
= {
89 .s_stream
= soc_camera_platform_s_stream
,
90 .try_fmt
= soc_camera_platform_try_fmt
,
93 static struct v4l2_subdev_ops platform_subdev_ops
= {
94 .core
= &platform_subdev_core_ops
,
95 .video
= &platform_subdev_video_ops
,
98 static struct soc_camera_ops soc_camera_platform_ops
= {
99 .set_crop
= soc_camera_platform_set_crop
,
100 .set_bus_param
= soc_camera_platform_set_bus_param
,
101 .query_bus_param
= soc_camera_platform_query_bus_param
,
104 static int soc_camera_platform_probe(struct platform_device
*pdev
)
106 struct soc_camera_host
*ici
;
107 struct soc_camera_platform_priv
*priv
;
108 struct soc_camera_platform_info
*p
= pdev
->dev
.platform_data
;
109 struct soc_camera_device
*icd
;
117 "Platform has not set soc_camera_device pointer!\n");
121 priv
= kzalloc(sizeof(*priv
), GFP_KERNEL
);
125 icd
= to_soc_camera_dev(p
->dev
);
127 platform_set_drvdata(pdev
, priv
);
128 dev_set_drvdata(&icd
->dev
, &pdev
->dev
);
131 icd
->rect_max
.width
= p
->format
.width
;
133 icd
->rect_max
.height
= p
->format
.height
;
135 icd
->ops
= &soc_camera_platform_ops
;
137 ici
= to_soc_camera_host(icd
->dev
.parent
);
139 soc_camera_platform_video_probe(icd
, pdev
);
141 v4l2_subdev_init(&priv
->subdev
, &platform_subdev_ops
);
142 v4l2_set_subdevdata(&priv
->subdev
, p
);
143 priv
->subdev
.grp_id
= (__u32
)icd
;
144 strncpy(priv
->subdev
.name
, dev_name(&pdev
->dev
), V4L2_SUBDEV_NAME_SIZE
);
146 ret
= v4l2_device_register_subdev(&ici
->v4l2_dev
, &priv
->subdev
);
154 platform_set_drvdata(pdev
, NULL
);
159 static int soc_camera_platform_remove(struct platform_device
*pdev
)
161 struct soc_camera_platform_priv
*priv
= platform_get_drvdata(pdev
);
162 struct soc_camera_platform_info
*p
= pdev
->dev
.platform_data
;
163 struct soc_camera_device
*icd
= to_soc_camera_dev(p
->dev
);
165 v4l2_device_unregister_subdev(&priv
->subdev
);
167 platform_set_drvdata(pdev
, NULL
);
172 static struct platform_driver soc_camera_platform_driver
= {
174 .name
= "soc_camera_platform",
175 .owner
= THIS_MODULE
,
177 .probe
= soc_camera_platform_probe
,
178 .remove
= soc_camera_platform_remove
,
181 static int __init
soc_camera_platform_module_init(void)
183 return platform_driver_register(&soc_camera_platform_driver
);
186 static void __exit
soc_camera_platform_module_exit(void)
188 platform_driver_unregister(&soc_camera_platform_driver
);
191 module_init(soc_camera_platform_module_init
);
192 module_exit(soc_camera_platform_module_exit
);
194 MODULE_DESCRIPTION("SoC Camera Platform driver");
195 MODULE_AUTHOR("Magnus Damm");
196 MODULE_LICENSE("GPL v2");
197 MODULE_ALIAS("platform:soc_camera_platform");