1/*
2 * Generic Platform Camera Driver
3 *
4 * Copyright (C) 2008 Magnus Damm
5 * Based on mt9m001 driver,
6 * Copyright (C) 2008, Guennadi Liakhovetski <kernel@pengutronix.de>
7 *
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.
11 */
12
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>
22
23struct soc_camera_platform_priv {
24	struct v4l2_subdev subdev;
25};
26
27static struct soc_camera_platform_priv *get_priv(struct platform_device *pdev)
28{
29	struct v4l2_subdev *subdev = platform_get_drvdata(pdev);
30	return container_of(subdev, struct soc_camera_platform_priv, subdev);
31}
32
33static int soc_camera_platform_s_stream(struct v4l2_subdev *sd, int enable)
34{
35	struct soc_camera_platform_info *p = v4l2_get_subdevdata(sd);
36	return p->set_capture(p, enable);
37}
38
39static int soc_camera_platform_fill_fmt(struct v4l2_subdev *sd,
40					struct v4l2_mbus_framefmt *mf)
41{
42	struct soc_camera_platform_info *p = v4l2_get_subdevdata(sd);
43
44	mf->width	= p->format.width;
45	mf->height	= p->format.height;
46	mf->code	= p->format.code;
47	mf->colorspace	= p->format.colorspace;
48	mf->field	= p->format.field;
49
50	return 0;
51}
52
53static int soc_camera_platform_s_power(struct v4l2_subdev *sd, int on)
54{
55	struct soc_camera_platform_info *p = v4l2_get_subdevdata(sd);
56
57	return soc_camera_set_power(p->icd->control, &p->icd->sdesc->subdev_desc, NULL, on);
58}
59
60static struct v4l2_subdev_core_ops platform_subdev_core_ops = {
61	.s_power = soc_camera_platform_s_power,
62};
63
64static int soc_camera_platform_enum_fmt(struct v4l2_subdev *sd, unsigned int index,
65					u32 *code)
66{
67	struct soc_camera_platform_info *p = v4l2_get_subdevdata(sd);
68
69	if (index)
70		return -EINVAL;
71
72	*code = p->format.code;
73	return 0;
74}
75
76static int soc_camera_platform_g_crop(struct v4l2_subdev *sd,
77				      struct v4l2_crop *a)
78{
79	struct soc_camera_platform_info *p = v4l2_get_subdevdata(sd);
80
81	a->c.left	= 0;
82	a->c.top	= 0;
83	a->c.width	= p->format.width;
84	a->c.height	= p->format.height;
85	a->type		= V4L2_BUF_TYPE_VIDEO_CAPTURE;
86
87	return 0;
88}
89
90static int soc_camera_platform_cropcap(struct v4l2_subdev *sd,
91				       struct v4l2_cropcap *a)
92{
93	struct soc_camera_platform_info *p = v4l2_get_subdevdata(sd);
94
95	a->bounds.left			= 0;
96	a->bounds.top			= 0;
97	a->bounds.width			= p->format.width;
98	a->bounds.height		= p->format.height;
99	a->defrect			= a->bounds;
100	a->type				= V4L2_BUF_TYPE_VIDEO_CAPTURE;
101	a->pixelaspect.numerator	= 1;
102	a->pixelaspect.denominator	= 1;
103
104	return 0;
105}
106
107static int soc_camera_platform_g_mbus_config(struct v4l2_subdev *sd,
108					     struct v4l2_mbus_config *cfg)
109{
110	struct soc_camera_platform_info *p = v4l2_get_subdevdata(sd);
111
112	cfg->flags = p->mbus_param;
113	cfg->type = p->mbus_type;
114
115	return 0;
116}
117
118static struct v4l2_subdev_video_ops platform_subdev_video_ops = {
119	.s_stream	= soc_camera_platform_s_stream,
120	.enum_mbus_fmt	= soc_camera_platform_enum_fmt,
121	.cropcap	= soc_camera_platform_cropcap,
122	.g_crop		= soc_camera_platform_g_crop,
123	.try_mbus_fmt	= soc_camera_platform_fill_fmt,
124	.g_mbus_fmt	= soc_camera_platform_fill_fmt,
125	.s_mbus_fmt	= soc_camera_platform_fill_fmt,
126	.g_mbus_config	= soc_camera_platform_g_mbus_config,
127};
128
129static struct v4l2_subdev_ops platform_subdev_ops = {
130	.core	= &platform_subdev_core_ops,
131	.video	= &platform_subdev_video_ops,
132};
133
134static int soc_camera_platform_probe(struct platform_device *pdev)
135{
136	struct soc_camera_host *ici;
137	struct soc_camera_platform_priv *priv;
138	struct soc_camera_platform_info *p = pdev->dev.platform_data;
139	struct soc_camera_device *icd;
140
141	if (!p)
142		return -EINVAL;
143
144	if (!p->icd) {
145		dev_err(&pdev->dev,
146			"Platform has not set soc_camera_device pointer!\n");
147		return -EINVAL;
148	}
149
150	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
151	if (!priv)
152		return -ENOMEM;
153
154	icd = p->icd;
155
156	/* soc-camera convention: control's drvdata points to the subdev */
157	platform_set_drvdata(pdev, &priv->subdev);
158	/* Set the control device reference */
159	icd->control = &pdev->dev;
160
161	ici = to_soc_camera_host(icd->parent);
162
163	v4l2_subdev_init(&priv->subdev, &platform_subdev_ops);
164	v4l2_set_subdevdata(&priv->subdev, p);
165	strncpy(priv->subdev.name, dev_name(&pdev->dev), V4L2_SUBDEV_NAME_SIZE);
166
167	return v4l2_device_register_subdev(&ici->v4l2_dev, &priv->subdev);
168}
169
170static int soc_camera_platform_remove(struct platform_device *pdev)
171{
172	struct soc_camera_platform_priv *priv = get_priv(pdev);
173	struct soc_camera_platform_info *p = v4l2_get_subdevdata(&priv->subdev);
174
175	p->icd->control = NULL;
176	v4l2_device_unregister_subdev(&priv->subdev);
177	return 0;
178}
179
180static struct platform_driver soc_camera_platform_driver = {
181	.driver		= {
182		.name	= "soc_camera_platform",
183	},
184	.probe		= soc_camera_platform_probe,
185	.remove		= soc_camera_platform_remove,
186};
187
188module_platform_driver(soc_camera_platform_driver);
189
190MODULE_DESCRIPTION("SoC Camera Platform driver");
191MODULE_AUTHOR("Magnus Damm");
192MODULE_LICENSE("GPL v2");
193MODULE_ALIAS("platform:soc_camera_platform");
194