blob: b366b050a3dd487473345d1ddaee013b2740513f [file] [log] [blame]
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001/*
2 * Virtual Video driver - This code emulates a real video device with v4l2 api
3 *
4 * Copyright (c) 2006 by:
5 * Mauro Carvalho Chehab <mchehab--a.t--infradead.org>
6 * Ted Walther <ted--a.t--enumera.com>
7 * John Sokol <sokol--a.t--videotechnology.com>
8 * http://v4l.videotechnology.com/
9 *
Pawel Osciake007a322011-01-19 13:02:29 -020010 * Conversion to videobuf2 by Pawel Osciak & Marek Szyprowski
11 * Copyright (c) 2010 Samsung Electronics
12 *
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -030013 * This program is free software; you can redistribute it and/or modify
14 * it under the terms of the BSD Licence, GNU General Public License
15 * as published by the Free Software Foundation; either version 2 of the
16 * License, or (at your option) any later version
17 */
18#include <linux/module.h>
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -030019#include <linux/errno.h>
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -030020#include <linux/kernel.h>
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -030021#include <linux/init.h>
22#include <linux/sched.h>
Randy Dunlap6b46c392010-05-07 15:22:26 -030023#include <linux/slab.h>
Hans Verkuil730947b2010-04-10 04:13:53 -030024#include <linux/font.h>
Matthias Kaehlcke51b54022007-07-02 10:19:38 -030025#include <linux/mutex.h>
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -030026#include <linux/videodev2.h>
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -030027#include <linux/kthread.h>
Nigel Cunningham7dfb7102006-12-06 20:34:23 -080028#include <linux/freezer.h>
Pawel Osciake007a322011-01-19 13:02:29 -020029#include <media/videobuf2-vmalloc.h>
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -030030#include <media/v4l2-device.h>
31#include <media/v4l2-ioctl.h>
Hans Verkuil7e996af2011-01-23 12:33:16 -020032#include <media/v4l2-ctrls.h>
Hans Verkuil2e4784d2011-03-11 20:01:54 -030033#include <media/v4l2-fh.h>
Hans Verkuilc7a52f82011-06-07 10:20:23 -030034#include <media/v4l2-event.h>
Hans Verkuil730947b2010-04-10 04:13:53 -030035#include <media/v4l2-common.h>
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -030036
Mauro Carvalho Chehab584ce482008-06-10 15:21:49 -030037#define VIVI_MODULE_NAME "vivi"
Carl Karsten745271a2008-06-10 00:02:32 -030038
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -030039/* Wake up at about 30 fps */
40#define WAKE_NUMERATOR 30
41#define WAKE_DENOMINATOR 1001
42#define BUFFER_TIMEOUT msecs_to_jiffies(500) /* 0.5 seconds */
43
Hans Verkuil730947b2010-04-10 04:13:53 -030044#define MAX_WIDTH 1920
45#define MAX_HEIGHT 1200
46
Mauro Carvalho Chehab1990d502011-06-24 14:45:49 -030047#define VIVI_VERSION "0.8.1"
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -030048
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -030049MODULE_DESCRIPTION("Video Technology Magazine Virtual Video Capture Board");
50MODULE_AUTHOR("Mauro Carvalho Chehab, Ted Walther and John Sokol");
51MODULE_LICENSE("Dual BSD/GPL");
Mauro Carvalho Chehab1990d502011-06-24 14:45:49 -030052MODULE_VERSION(VIVI_VERSION);
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -030053
54static unsigned video_nr = -1;
55module_param(video_nr, uint, 0644);
56MODULE_PARM_DESC(video_nr, "videoX start number, -1 is autodetect");
57
58static unsigned n_devs = 1;
59module_param(n_devs, uint, 0644);
60MODULE_PARM_DESC(n_devs, "number of video devices to create");
61
62static unsigned debug;
63module_param(debug, uint, 0644);
64MODULE_PARM_DESC(debug, "activates debug info");
65
66static unsigned int vid_limit = 16;
67module_param(vid_limit, uint, 0644);
68MODULE_PARM_DESC(vid_limit, "capture memory limit in megabytes");
69
Hans Verkuil730947b2010-04-10 04:13:53 -030070/* Global font descriptor */
71static const u8 *font8x16;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -030072
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -030073#define dprintk(dev, level, fmt, arg...) \
74 v4l2_dbg(level, debug, &dev->v4l2_dev, fmt, ## arg)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -030075
76/* ------------------------------------------------------------------
77 Basic structures
78 ------------------------------------------------------------------*/
79
80struct vivi_fmt {
81 char *name;
82 u32 fourcc; /* v4l2 format id */
Hans Verkuil0a3a8a32012-08-06 10:36:18 -030083 u8 depth;
84 bool is_yuv;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -030085};
86
Magnus Dammd891f472008-10-14 12:47:09 -030087static struct vivi_fmt formats[] = {
88 {
89 .name = "4:2:2, packed, YUYV",
90 .fourcc = V4L2_PIX_FMT_YUYV,
91 .depth = 16,
Hans Verkuil0a3a8a32012-08-06 10:36:18 -030092 .is_yuv = true,
Magnus Dammd891f472008-10-14 12:47:09 -030093 },
Magnus Dammfca36ba2008-10-14 12:47:25 -030094 {
95 .name = "4:2:2, packed, UYVY",
96 .fourcc = V4L2_PIX_FMT_UYVY,
97 .depth = 16,
Hans Verkuil0a3a8a32012-08-06 10:36:18 -030098 .is_yuv = true,
Magnus Dammfca36ba2008-10-14 12:47:25 -030099 },
Magnus Dammaeadb5d2008-10-14 12:47:35 -0300100 {
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300101 .name = "4:2:2, packed, YVYU",
102 .fourcc = V4L2_PIX_FMT_YVYU,
103 .depth = 16,
Hans Verkuil0a3a8a32012-08-06 10:36:18 -0300104 .is_yuv = true,
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300105 },
106 {
107 .name = "4:2:2, packed, VYUY",
108 .fourcc = V4L2_PIX_FMT_VYUY,
109 .depth = 16,
Hans Verkuil0a3a8a32012-08-06 10:36:18 -0300110 .is_yuv = true,
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300111 },
112 {
Magnus Dammaeadb5d2008-10-14 12:47:35 -0300113 .name = "RGB565 (LE)",
114 .fourcc = V4L2_PIX_FMT_RGB565, /* gggbbbbb rrrrrggg */
115 .depth = 16,
116 },
117 {
118 .name = "RGB565 (BE)",
119 .fourcc = V4L2_PIX_FMT_RGB565X, /* rrrrrggg gggbbbbb */
120 .depth = 16,
121 },
Magnus Dammdef52392008-10-14 12:47:43 -0300122 {
123 .name = "RGB555 (LE)",
124 .fourcc = V4L2_PIX_FMT_RGB555, /* gggbbbbb arrrrrgg */
125 .depth = 16,
126 },
127 {
128 .name = "RGB555 (BE)",
129 .fourcc = V4L2_PIX_FMT_RGB555X, /* arrrrrgg gggbbbbb */
130 .depth = 16,
131 },
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300132 {
133 .name = "RGB24 (LE)",
134 .fourcc = V4L2_PIX_FMT_RGB24, /* rgb */
135 .depth = 24,
136 },
137 {
138 .name = "RGB24 (BE)",
139 .fourcc = V4L2_PIX_FMT_BGR24, /* bgr */
140 .depth = 24,
141 },
142 {
143 .name = "RGB32 (LE)",
144 .fourcc = V4L2_PIX_FMT_RGB32, /* argb */
145 .depth = 32,
146 },
147 {
148 .name = "RGB32 (BE)",
149 .fourcc = V4L2_PIX_FMT_BGR32, /* bgra */
150 .depth = 32,
151 },
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300152};
153
Magnus Dammd891f472008-10-14 12:47:09 -0300154static struct vivi_fmt *get_format(struct v4l2_format *f)
155{
156 struct vivi_fmt *fmt;
157 unsigned int k;
158
159 for (k = 0; k < ARRAY_SIZE(formats); k++) {
160 fmt = &formats[k];
161 if (fmt->fourcc == f->fmt.pix.pixelformat)
162 break;
163 }
164
165 if (k == ARRAY_SIZE(formats))
166 return NULL;
167
168 return &formats[k];
169}
170
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300171/* buffer for one video frame */
172struct vivi_buffer {
173 /* common v4l buffer stuff -- must be first */
Pawel Osciake007a322011-01-19 13:02:29 -0200174 struct vb2_buffer vb;
175 struct list_head list;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300176 struct vivi_fmt *fmt;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300177};
178
179struct vivi_dmaqueue {
180 struct list_head active;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300181
182 /* thread for generating video stream*/
183 struct task_struct *kthread;
184 wait_queue_head_t wq;
185 /* Counters to control fps rate */
186 int frame;
187 int ini_jiffies;
188};
189
190static LIST_HEAD(vivi_devlist);
191
192struct vivi_dev {
193 struct list_head vivi_devlist;
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -0300194 struct v4l2_device v4l2_dev;
Hans Verkuil7e996af2011-01-23 12:33:16 -0200195 struct v4l2_ctrl_handler ctrl_handler;
Hans Verkuil70bd97a2012-06-09 11:27:43 -0300196 struct video_device vdev;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300197
Hans Verkuil730947b2010-04-10 04:13:53 -0300198 /* controls */
Hans Verkuil7e996af2011-01-23 12:33:16 -0200199 struct v4l2_ctrl *brightness;
200 struct v4l2_ctrl *contrast;
201 struct v4l2_ctrl *saturation;
202 struct v4l2_ctrl *hue;
Hans Verkuila1c894f2011-06-07 06:34:41 -0300203 struct {
204 /* autogain/gain cluster */
205 struct v4l2_ctrl *autogain;
206 struct v4l2_ctrl *gain;
207 };
Hans Verkuil7e996af2011-01-23 12:33:16 -0200208 struct v4l2_ctrl *volume;
Hans Verkuil7088f4d2012-05-02 03:33:52 -0300209 struct v4l2_ctrl *alpha;
Hans Verkuil7e996af2011-01-23 12:33:16 -0200210 struct v4l2_ctrl *button;
211 struct v4l2_ctrl *boolean;
212 struct v4l2_ctrl *int32;
213 struct v4l2_ctrl *int64;
214 struct v4l2_ctrl *menu;
215 struct v4l2_ctrl *string;
Hans Verkuilb6d17a52011-03-29 16:33:11 -0300216 struct v4l2_ctrl *bitmask;
Sakari Ailusc5203312011-08-05 06:38:05 -0300217 struct v4l2_ctrl *int_menu;
Hans Verkuil730947b2010-04-10 04:13:53 -0300218
Mauro Carvalho Chehab55862ac2007-12-13 16:13:37 -0300219 spinlock_t slock;
Brandon Philipsaa9dbac2008-04-02 18:10:59 -0300220 struct mutex mutex;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300221
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300222 struct vivi_dmaqueue vidq;
223
224 /* Several counters */
Hans Verkuil730947b2010-04-10 04:13:53 -0300225 unsigned ms;
Mauro Carvalho Chehabdfd8c042008-01-13 19:36:11 -0300226 unsigned long jiffies;
Hans Verkuil7e996af2011-01-23 12:33:16 -0200227 unsigned button_pressed;
Mauro Carvalho Chehab025341d2007-12-10 04:43:38 -0300228
229 int mv_count; /* Controls bars movement */
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300230
231 /* Input Number */
232 int input;
Hans Verkuilc41ee242009-02-14 13:43:44 -0300233
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300234 /* video capture */
235 struct vivi_fmt *fmt;
Mauro Carvalho Chehab543323b2007-12-10 09:33:52 -0300236 unsigned int width, height;
Pawel Osciake007a322011-01-19 13:02:29 -0200237 struct vb2_queue vb_vidq;
Pawel Osciake007a322011-01-19 13:02:29 -0200238 unsigned int field_count;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300239
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300240 u8 bars[9][3];
241 u8 line[MAX_WIDTH * 8];
242 unsigned int pixelsize;
Hans Verkuil7088f4d2012-05-02 03:33:52 -0300243 u8 alpha_component;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300244};
245
246/* ------------------------------------------------------------------
247 DMA and thread functions
248 ------------------------------------------------------------------*/
249
250/* Bars and Colors should match positions */
251
252enum colors {
253 WHITE,
Hans Verkuil730947b2010-04-10 04:13:53 -0300254 AMBER,
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300255 CYAN,
256 GREEN,
257 MAGENTA,
258 RED,
Mauro Carvalho Chehab543323b2007-12-10 09:33:52 -0300259 BLUE,
260 BLACK,
Hans Verkuil730947b2010-04-10 04:13:53 -0300261 TEXT_BLACK,
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300262};
263
Hans Verkuil730947b2010-04-10 04:13:53 -0300264/* R G B */
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300265#define COLOR_WHITE {204, 204, 204}
Hans Verkuil730947b2010-04-10 04:13:53 -0300266#define COLOR_AMBER {208, 208, 0}
267#define COLOR_CYAN { 0, 206, 206}
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300268#define COLOR_GREEN { 0, 239, 0}
269#define COLOR_MAGENTA {239, 0, 239}
270#define COLOR_RED {205, 0, 0}
271#define COLOR_BLUE { 0, 0, 255}
272#define COLOR_BLACK { 0, 0, 0}
273
274struct bar_std {
Hans Verkuil730947b2010-04-10 04:13:53 -0300275 u8 bar[9][3];
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300276};
277
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300278/* Maximum number of bars are 10 - otherwise, the input print code
279 should be modified */
280static struct bar_std bars[] = {
281 { /* Standard ITU-R color bar sequence */
Hans Verkuil730947b2010-04-10 04:13:53 -0300282 { COLOR_WHITE, COLOR_AMBER, COLOR_CYAN, COLOR_GREEN,
283 COLOR_MAGENTA, COLOR_RED, COLOR_BLUE, COLOR_BLACK, COLOR_BLACK }
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300284 }, {
Hans Verkuil730947b2010-04-10 04:13:53 -0300285 { COLOR_WHITE, COLOR_AMBER, COLOR_BLACK, COLOR_WHITE,
286 COLOR_AMBER, COLOR_BLACK, COLOR_WHITE, COLOR_AMBER, COLOR_BLACK }
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300287 }, {
Hans Verkuil730947b2010-04-10 04:13:53 -0300288 { COLOR_WHITE, COLOR_CYAN, COLOR_BLACK, COLOR_WHITE,
289 COLOR_CYAN, COLOR_BLACK, COLOR_WHITE, COLOR_CYAN, COLOR_BLACK }
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300290 }, {
Hans Verkuil730947b2010-04-10 04:13:53 -0300291 { COLOR_WHITE, COLOR_GREEN, COLOR_BLACK, COLOR_WHITE,
292 COLOR_GREEN, COLOR_BLACK, COLOR_WHITE, COLOR_GREEN, COLOR_BLACK }
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300293 },
294};
295
296#define NUM_INPUTS ARRAY_SIZE(bars)
297
Mauro Carvalho Chehab543323b2007-12-10 09:33:52 -0300298#define TO_Y(r, g, b) \
299 (((16829 * r + 33039 * g + 6416 * b + 32768) >> 16) + 16)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300300/* RGB to V(Cr) Color transform */
Mauro Carvalho Chehab543323b2007-12-10 09:33:52 -0300301#define TO_V(r, g, b) \
302 (((28784 * r - 24103 * g - 4681 * b + 32768) >> 16) + 128)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300303/* RGB to U(Cb) Color transform */
Mauro Carvalho Chehab543323b2007-12-10 09:33:52 -0300304#define TO_U(r, g, b) \
305 (((-9714 * r - 19070 * g + 28784 * b + 32768) >> 16) + 128)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300306
Mauro Carvalho Chehabc285add2009-06-25 16:28:23 -0300307/* precalculate color bar values to speed up rendering */
Hans Verkuil730947b2010-04-10 04:13:53 -0300308static void precalculate_bars(struct vivi_dev *dev)
Mauro Carvalho Chehabc285add2009-06-25 16:28:23 -0300309{
Hans Verkuil730947b2010-04-10 04:13:53 -0300310 u8 r, g, b;
Mauro Carvalho Chehabc285add2009-06-25 16:28:23 -0300311 int k, is_yuv;
312
Hans Verkuil730947b2010-04-10 04:13:53 -0300313 for (k = 0; k < 9; k++) {
314 r = bars[dev->input].bar[k][0];
315 g = bars[dev->input].bar[k][1];
316 b = bars[dev->input].bar[k][2];
Hans Verkuil0a3a8a32012-08-06 10:36:18 -0300317 is_yuv = dev->fmt->is_yuv;
Mauro Carvalho Chehabc285add2009-06-25 16:28:23 -0300318
Hans Verkuil730947b2010-04-10 04:13:53 -0300319 switch (dev->fmt->fourcc) {
Mauro Carvalho Chehabc285add2009-06-25 16:28:23 -0300320 case V4L2_PIX_FMT_RGB565:
321 case V4L2_PIX_FMT_RGB565X:
322 r >>= 3;
323 g >>= 2;
324 b >>= 3;
325 break;
326 case V4L2_PIX_FMT_RGB555:
327 case V4L2_PIX_FMT_RGB555X:
328 r >>= 3;
329 g >>= 3;
330 b >>= 3;
331 break;
Hans Verkuil0a3a8a32012-08-06 10:36:18 -0300332 case V4L2_PIX_FMT_YUYV:
333 case V4L2_PIX_FMT_UYVY:
334 case V4L2_PIX_FMT_YVYU:
335 case V4L2_PIX_FMT_VYUY:
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300336 case V4L2_PIX_FMT_RGB24:
337 case V4L2_PIX_FMT_BGR24:
338 case V4L2_PIX_FMT_RGB32:
339 case V4L2_PIX_FMT_BGR32:
340 break;
Mauro Carvalho Chehabc285add2009-06-25 16:28:23 -0300341 }
342
343 if (is_yuv) {
Hans Verkuil730947b2010-04-10 04:13:53 -0300344 dev->bars[k][0] = TO_Y(r, g, b); /* Luma */
345 dev->bars[k][1] = TO_U(r, g, b); /* Cb */
346 dev->bars[k][2] = TO_V(r, g, b); /* Cr */
Mauro Carvalho Chehabc285add2009-06-25 16:28:23 -0300347 } else {
Hans Verkuil730947b2010-04-10 04:13:53 -0300348 dev->bars[k][0] = r;
349 dev->bars[k][1] = g;
350 dev->bars[k][2] = b;
Mauro Carvalho Chehabc285add2009-06-25 16:28:23 -0300351 }
352 }
Mauro Carvalho Chehabc285add2009-06-25 16:28:23 -0300353}
354
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300355#define TSTAMP_MIN_Y 24
356#define TSTAMP_MAX_Y (TSTAMP_MIN_Y + 15)
357#define TSTAMP_INPUT_X 10
358#define TSTAMP_MIN_X (54 + TSTAMP_INPUT_X)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300359
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300360/* 'odd' is true for pixels 1, 3, 5, etc. and false for pixels 0, 2, 4, etc. */
361static void gen_twopix(struct vivi_dev *dev, u8 *buf, int colorpos, bool odd)
Magnus Damm74d7c5a2008-10-14 12:46:59 -0300362{
Hans Verkuil730947b2010-04-10 04:13:53 -0300363 u8 r_y, g_u, b_v;
Hans Verkuil7088f4d2012-05-02 03:33:52 -0300364 u8 alpha = dev->alpha_component;
Magnus Damm74d7c5a2008-10-14 12:46:59 -0300365 int color;
Hans Verkuil730947b2010-04-10 04:13:53 -0300366 u8 *p;
Magnus Damm74d7c5a2008-10-14 12:46:59 -0300367
Hans Verkuil730947b2010-04-10 04:13:53 -0300368 r_y = dev->bars[colorpos][0]; /* R or precalculated Y */
369 g_u = dev->bars[colorpos][1]; /* G or precalculated U */
370 b_v = dev->bars[colorpos][2]; /* B or precalculated V */
Magnus Damm74d7c5a2008-10-14 12:46:59 -0300371
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300372 for (color = 0; color < dev->pixelsize; color++) {
Magnus Damm74d7c5a2008-10-14 12:46:59 -0300373 p = buf + color;
374
Hans Verkuil730947b2010-04-10 04:13:53 -0300375 switch (dev->fmt->fourcc) {
Magnus Dammd891f472008-10-14 12:47:09 -0300376 case V4L2_PIX_FMT_YUYV:
377 switch (color) {
378 case 0:
Magnus Dammd891f472008-10-14 12:47:09 -0300379 *p = r_y;
380 break;
381 case 1:
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300382 *p = odd ? b_v : g_u;
Magnus Dammd891f472008-10-14 12:47:09 -0300383 break;
384 }
Magnus Damm74d7c5a2008-10-14 12:46:59 -0300385 break;
Magnus Dammfca36ba2008-10-14 12:47:25 -0300386 case V4L2_PIX_FMT_UYVY:
387 switch (color) {
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300388 case 0:
389 *p = odd ? b_v : g_u;
390 break;
Magnus Dammfca36ba2008-10-14 12:47:25 -0300391 case 1:
Magnus Dammfca36ba2008-10-14 12:47:25 -0300392 *p = r_y;
393 break;
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300394 }
395 break;
396 case V4L2_PIX_FMT_YVYU:
397 switch (color) {
Magnus Dammfca36ba2008-10-14 12:47:25 -0300398 case 0:
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300399 *p = r_y;
Magnus Dammfca36ba2008-10-14 12:47:25 -0300400 break;
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300401 case 1:
402 *p = odd ? g_u : b_v;
403 break;
404 }
405 break;
406 case V4L2_PIX_FMT_VYUY:
407 switch (color) {
408 case 0:
409 *p = odd ? g_u : b_v;
410 break;
411 case 1:
412 *p = r_y;
Magnus Dammfca36ba2008-10-14 12:47:25 -0300413 break;
414 }
415 break;
Magnus Dammaeadb5d2008-10-14 12:47:35 -0300416 case V4L2_PIX_FMT_RGB565:
417 switch (color) {
418 case 0:
Magnus Dammaeadb5d2008-10-14 12:47:35 -0300419 *p = (g_u << 5) | b_v;
420 break;
421 case 1:
Magnus Dammaeadb5d2008-10-14 12:47:35 -0300422 *p = (r_y << 3) | (g_u >> 3);
423 break;
424 }
425 break;
426 case V4L2_PIX_FMT_RGB565X:
427 switch (color) {
428 case 0:
Magnus Dammaeadb5d2008-10-14 12:47:35 -0300429 *p = (r_y << 3) | (g_u >> 3);
430 break;
431 case 1:
Magnus Dammaeadb5d2008-10-14 12:47:35 -0300432 *p = (g_u << 5) | b_v;
433 break;
434 }
435 break;
Magnus Dammdef52392008-10-14 12:47:43 -0300436 case V4L2_PIX_FMT_RGB555:
437 switch (color) {
438 case 0:
Magnus Dammdef52392008-10-14 12:47:43 -0300439 *p = (g_u << 5) | b_v;
440 break;
441 case 1:
Hans Verkuil7088f4d2012-05-02 03:33:52 -0300442 *p = (alpha & 0x80) | (r_y << 2) | (g_u >> 3);
Magnus Dammdef52392008-10-14 12:47:43 -0300443 break;
444 }
445 break;
446 case V4L2_PIX_FMT_RGB555X:
447 switch (color) {
448 case 0:
Hans Verkuil7088f4d2012-05-02 03:33:52 -0300449 *p = (alpha & 0x80) | (r_y << 2) | (g_u >> 3);
Magnus Dammdef52392008-10-14 12:47:43 -0300450 break;
451 case 1:
Magnus Dammdef52392008-10-14 12:47:43 -0300452 *p = (g_u << 5) | b_v;
453 break;
454 }
455 break;
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300456 case V4L2_PIX_FMT_RGB24:
457 switch (color) {
458 case 0:
459 *p = r_y;
460 break;
461 case 1:
462 *p = g_u;
463 break;
464 case 2:
465 *p = b_v;
466 break;
467 }
468 break;
469 case V4L2_PIX_FMT_BGR24:
470 switch (color) {
471 case 0:
472 *p = b_v;
473 break;
474 case 1:
475 *p = g_u;
476 break;
477 case 2:
478 *p = r_y;
479 break;
480 }
481 break;
482 case V4L2_PIX_FMT_RGB32:
483 switch (color) {
484 case 0:
Hans Verkuil7088f4d2012-05-02 03:33:52 -0300485 *p = alpha;
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300486 break;
487 case 1:
488 *p = r_y;
489 break;
490 case 2:
491 *p = g_u;
492 break;
493 case 3:
494 *p = b_v;
495 break;
496 }
497 break;
498 case V4L2_PIX_FMT_BGR32:
499 switch (color) {
500 case 0:
501 *p = b_v;
502 break;
503 case 1:
504 *p = g_u;
505 break;
506 case 2:
507 *p = r_y;
508 break;
509 case 3:
Hans Verkuil7088f4d2012-05-02 03:33:52 -0300510 *p = alpha;
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300511 break;
512 }
513 break;
Magnus Damm74d7c5a2008-10-14 12:46:59 -0300514 }
515 }
516}
517
Hans Verkuil730947b2010-04-10 04:13:53 -0300518static void precalculate_line(struct vivi_dev *dev)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300519{
Hans Verkuil730947b2010-04-10 04:13:53 -0300520 int w;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300521
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300522 for (w = 0; w < dev->width * 2; w++) {
523 int colorpos = w / (dev->width / 8) % 8;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300524
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300525 gen_twopix(dev, dev->line + w * dev->pixelsize, colorpos, w & 1);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300526 }
Hans Verkuil730947b2010-04-10 04:13:53 -0300527}
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300528
Hans Verkuil730947b2010-04-10 04:13:53 -0300529static void gen_text(struct vivi_dev *dev, char *basep,
530 int y, int x, char *text)
531{
532 int line;
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300533
Hans Verkuil730947b2010-04-10 04:13:53 -0300534 /* Checks if it is possible to show string */
535 if (y + 16 >= dev->height || x + strlen(text) * 8 >= dev->width)
536 return;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300537
538 /* Print stream time */
Hans Verkuil730947b2010-04-10 04:13:53 -0300539 for (line = y; line < y + 16; line++) {
540 int j = 0;
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300541 char *pos = basep + line * dev->width * dev->pixelsize + x * dev->pixelsize;
Hans Verkuil730947b2010-04-10 04:13:53 -0300542 char *s;
543
544 for (s = text; *s; s++) {
545 u8 chr = font8x16[*s * 16 + line - y];
546 int i;
547
548 for (i = 0; i < 7; i++, j++) {
Magnus Damm74d7c5a2008-10-14 12:46:59 -0300549 /* Draw white font on black background */
Hans Verkuil730947b2010-04-10 04:13:53 -0300550 if (chr & (1 << (7 - i)))
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300551 gen_twopix(dev, pos + j * dev->pixelsize, WHITE, (x+y) & 1);
Magnus Damm74d7c5a2008-10-14 12:46:59 -0300552 else
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300553 gen_twopix(dev, pos + j * dev->pixelsize, TEXT_BLACK, (x+y) & 1);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300554 }
555 }
556 }
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300557}
Brandon Philips78718e52008-04-02 18:10:59 -0300558
Hans Verkuil730947b2010-04-10 04:13:53 -0300559static void vivi_fillbuff(struct vivi_dev *dev, struct vivi_buffer *buf)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300560{
Pawel Osciake007a322011-01-19 13:02:29 -0200561 int wmax = dev->width;
562 int hmax = dev->height;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300563 struct timeval ts;
Pawel Osciake007a322011-01-19 13:02:29 -0200564 void *vbuf = vb2_plane_vaddr(&buf->vb, 0);
Hans Verkuil730947b2010-04-10 04:13:53 -0300565 unsigned ms;
566 char str[100];
567 int h, line = 1;
Hans Verkuila1c894f2011-06-07 06:34:41 -0300568 s32 gain;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300569
Marcin Slusarz5c554e62008-06-22 09:11:40 -0300570 if (!vbuf)
Mauro Carvalho Chehab5a037702007-08-02 23:31:54 -0300571 return;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300572
Hans Verkuil730947b2010-04-10 04:13:53 -0300573 for (h = 0; h < hmax; h++)
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300574 memcpy(vbuf + h * wmax * dev->pixelsize,
575 dev->line + (dev->mv_count % wmax) * dev->pixelsize,
576 wmax * dev->pixelsize);
Mauro Carvalho Chehab5a037702007-08-02 23:31:54 -0300577
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300578 /* Updates stream time */
579
Hans Verkuil730947b2010-04-10 04:13:53 -0300580 dev->ms += jiffies_to_msecs(jiffies - dev->jiffies);
Mauro Carvalho Chehab543323b2007-12-10 09:33:52 -0300581 dev->jiffies = jiffies;
Hans Verkuil730947b2010-04-10 04:13:53 -0300582 ms = dev->ms;
583 snprintf(str, sizeof(str), " %02d:%02d:%02d:%03d ",
584 (ms / (60 * 60 * 1000)) % 24,
585 (ms / (60 * 1000)) % 60,
586 (ms / 1000) % 60,
587 ms % 1000);
588 gen_text(dev, vbuf, line++ * 16, 16, str);
589 snprintf(str, sizeof(str), " %dx%d, input %d ",
590 dev->width, dev->height, dev->input);
591 gen_text(dev, vbuf, line++ * 16, 16, str);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300592
Hans Verkuila1c894f2011-06-07 06:34:41 -0300593 gain = v4l2_ctrl_g_ctrl(dev->gain);
Sakari Ailus77e7c4e2012-01-24 21:05:34 -0300594 mutex_lock(dev->ctrl_handler.lock);
Hans Verkuil730947b2010-04-10 04:13:53 -0300595 snprintf(str, sizeof(str), " brightness %3d, contrast %3d, saturation %3d, hue %d ",
Hans Verkuil7e996af2011-01-23 12:33:16 -0200596 dev->brightness->cur.val,
597 dev->contrast->cur.val,
598 dev->saturation->cur.val,
599 dev->hue->cur.val);
Hans Verkuil730947b2010-04-10 04:13:53 -0300600 gen_text(dev, vbuf, line++ * 16, 16, str);
Hans Verkuil7088f4d2012-05-02 03:33:52 -0300601 snprintf(str, sizeof(str), " autogain %d, gain %3d, volume %3d, alpha 0x%02x ",
602 dev->autogain->cur.val, gain, dev->volume->cur.val,
603 dev->alpha->cur.val);
Hans Verkuil730947b2010-04-10 04:13:53 -0300604 gen_text(dev, vbuf, line++ * 16, 16, str);
Hans Verkuilb6d17a52011-03-29 16:33:11 -0300605 snprintf(str, sizeof(str), " int32 %d, int64 %lld, bitmask %08x ",
Hans Verkuil7e996af2011-01-23 12:33:16 -0200606 dev->int32->cur.val,
Hans Verkuilb6d17a52011-03-29 16:33:11 -0300607 dev->int64->cur.val64,
608 dev->bitmask->cur.val);
Hans Verkuil7e996af2011-01-23 12:33:16 -0200609 gen_text(dev, vbuf, line++ * 16, 16, str);
610 snprintf(str, sizeof(str), " boolean %d, menu %s, string \"%s\" ",
611 dev->boolean->cur.val,
612 dev->menu->qmenu[dev->menu->cur.val],
613 dev->string->cur.string);
Hans Verkuilf70cfc72012-04-19 11:44:18 -0300614 gen_text(dev, vbuf, line++ * 16, 16, str);
Sakari Ailusc5203312011-08-05 06:38:05 -0300615 snprintf(str, sizeof(str), " integer_menu %lld, value %d ",
616 dev->int_menu->qmenu_int[dev->int_menu->cur.val],
617 dev->int_menu->cur.val);
618 gen_text(dev, vbuf, line++ * 16, 16, str);
Sakari Ailus77e7c4e2012-01-24 21:05:34 -0300619 mutex_unlock(dev->ctrl_handler.lock);
Hans Verkuil7e996af2011-01-23 12:33:16 -0200620 if (dev->button_pressed) {
621 dev->button_pressed--;
622 snprintf(str, sizeof(str), " button pressed!");
623 gen_text(dev, vbuf, line++ * 16, 16, str);
624 }
Hans Verkuil730947b2010-04-10 04:13:53 -0300625
626 dev->mv_count += 2;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300627
Hans Verkuilcd779252012-07-25 11:48:53 -0300628 buf->vb.v4l2_buf.field = V4L2_FIELD_INTERLACED;
Pawel Osciake007a322011-01-19 13:02:29 -0200629 dev->field_count++;
630 buf->vb.v4l2_buf.sequence = dev->field_count >> 1;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300631 do_gettimeofday(&ts);
Pawel Osciake007a322011-01-19 13:02:29 -0200632 buf->vb.v4l2_buf.timestamp = ts;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300633}
634
Hans Verkuil730947b2010-04-10 04:13:53 -0300635static void vivi_thread_tick(struct vivi_dev *dev)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300636{
Brandon Philips78718e52008-04-02 18:10:59 -0300637 struct vivi_dmaqueue *dma_q = &dev->vidq;
Hans Verkuil730947b2010-04-10 04:13:53 -0300638 struct vivi_buffer *buf;
Brandon Philips78718e52008-04-02 18:10:59 -0300639 unsigned long flags = 0;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300640
Brandon Philips78718e52008-04-02 18:10:59 -0300641 dprintk(dev, 1, "Thread tick\n");
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300642
Brandon Philips78718e52008-04-02 18:10:59 -0300643 spin_lock_irqsave(&dev->slock, flags);
644 if (list_empty(&dma_q->active)) {
645 dprintk(dev, 1, "No active queue to serve\n");
Hans Verkuil1de5be52011-07-05 07:19:23 -0300646 spin_unlock_irqrestore(&dev->slock, flags);
647 return;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300648 }
Brandon Philips78718e52008-04-02 18:10:59 -0300649
Pawel Osciake007a322011-01-19 13:02:29 -0200650 buf = list_entry(dma_q->active.next, struct vivi_buffer, list);
651 list_del(&buf->list);
Hans Verkuil1de5be52011-07-05 07:19:23 -0300652 spin_unlock_irqrestore(&dev->slock, flags);
Brandon Philips78718e52008-04-02 18:10:59 -0300653
Pawel Osciake007a322011-01-19 13:02:29 -0200654 do_gettimeofday(&buf->vb.v4l2_buf.timestamp);
Brandon Philips78718e52008-04-02 18:10:59 -0300655
656 /* Fill buffer */
Hans Verkuil730947b2010-04-10 04:13:53 -0300657 vivi_fillbuff(dev, buf);
Brandon Philips78718e52008-04-02 18:10:59 -0300658 dprintk(dev, 1, "filled buffer %p\n", buf);
659
Pawel Osciake007a322011-01-19 13:02:29 -0200660 vb2_buffer_done(&buf->vb, VB2_BUF_STATE_DONE);
661 dprintk(dev, 2, "[%p/%d] done\n", buf, buf->vb.v4l2_buf.index);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300662}
663
Mauro Carvalho Chehab6594ad82007-12-13 16:15:41 -0300664#define frames_to_ms(frames) \
665 ((frames * WAKE_NUMERATOR * 1000) / WAKE_DENOMINATOR)
666
Hans Verkuil730947b2010-04-10 04:13:53 -0300667static void vivi_sleep(struct vivi_dev *dev)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300668{
Brandon Philips78718e52008-04-02 18:10:59 -0300669 struct vivi_dmaqueue *dma_q = &dev->vidq;
670 int timeout;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300671 DECLARE_WAITQUEUE(wait, current);
672
Harvey Harrison7e28adb2008-04-08 23:20:00 -0300673 dprintk(dev, 1, "%s dma_q=0x%08lx\n", __func__,
Mauro Carvalho Chehab6c2f9902007-12-13 13:30:14 -0300674 (unsigned long)dma_q);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300675
676 add_wait_queue(&dma_q->wq, &wait);
Mauro Carvalho Chehab6594ad82007-12-13 16:15:41 -0300677 if (kthread_should_stop())
678 goto stop_task;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300679
Mauro Carvalho Chehab6594ad82007-12-13 16:15:41 -0300680 /* Calculate time to wake up */
Brandon Philips78718e52008-04-02 18:10:59 -0300681 timeout = msecs_to_jiffies(frames_to_ms(1));
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300682
Hans Verkuil730947b2010-04-10 04:13:53 -0300683 vivi_thread_tick(dev);
Mauro Carvalho Chehab6594ad82007-12-13 16:15:41 -0300684
685 schedule_timeout_interruptible(timeout);
686
687stop_task:
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300688 remove_wait_queue(&dma_q->wq, &wait);
689 try_to_freeze();
690}
691
Adrian Bunk972c3512006-04-27 21:06:50 -0300692static int vivi_thread(void *data)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300693{
Hans Verkuil730947b2010-04-10 04:13:53 -0300694 struct vivi_dev *dev = data;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300695
Mauro Carvalho Chehab6c2f9902007-12-13 13:30:14 -0300696 dprintk(dev, 1, "thread started\n");
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300697
Rafael J. Wysocki83144182007-07-17 04:03:35 -0700698 set_freezable();
Mauro Carvalho Chehab0b600512007-01-14 08:33:24 -0300699
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300700 for (;;) {
Hans Verkuil730947b2010-04-10 04:13:53 -0300701 vivi_sleep(dev);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300702
703 if (kthread_should_stop())
704 break;
705 }
Mauro Carvalho Chehab6c2f9902007-12-13 13:30:14 -0300706 dprintk(dev, 1, "thread: exit\n");
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300707 return 0;
708}
709
Pawel Osciake007a322011-01-19 13:02:29 -0200710static int vivi_start_generating(struct vivi_dev *dev)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300711{
Brandon Philips78718e52008-04-02 18:10:59 -0300712 struct vivi_dmaqueue *dma_q = &dev->vidq;
Mauro Carvalho Chehab6c2f9902007-12-13 13:30:14 -0300713
Harvey Harrison7e28adb2008-04-08 23:20:00 -0300714 dprintk(dev, 1, "%s\n", __func__);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300715
Hans Verkuil730947b2010-04-10 04:13:53 -0300716 /* Resets frame counters */
717 dev->ms = 0;
718 dev->mv_count = 0;
719 dev->jiffies = jiffies;
720
721 dma_q->frame = 0;
722 dma_q->ini_jiffies = jiffies;
723 dma_q->kthread = kthread_run(vivi_thread, dev, dev->v4l2_dev.name);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300724
Akinobu Mita054afee2006-12-20 10:04:00 -0300725 if (IS_ERR(dma_q->kthread)) {
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -0300726 v4l2_err(&dev->v4l2_dev, "kernel_thread() failed\n");
Pawel Osciake007a322011-01-19 13:02:29 -0200727 return PTR_ERR(dma_q->kthread);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300728 }
Mauro Carvalho Chehab0b600512007-01-14 08:33:24 -0300729 /* Wakes thread */
730 wake_up_interruptible(&dma_q->wq);
731
Harvey Harrison7e28adb2008-04-08 23:20:00 -0300732 dprintk(dev, 1, "returning from %s\n", __func__);
Pawel Osciake007a322011-01-19 13:02:29 -0200733 return 0;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300734}
735
Pawel Osciake007a322011-01-19 13:02:29 -0200736static void vivi_stop_generating(struct vivi_dev *dev)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300737{
Hans Verkuil730947b2010-04-10 04:13:53 -0300738 struct vivi_dmaqueue *dma_q = &dev->vidq;
Mauro Carvalho Chehab6c2f9902007-12-13 13:30:14 -0300739
Harvey Harrison7e28adb2008-04-08 23:20:00 -0300740 dprintk(dev, 1, "%s\n", __func__);
Hans Verkuil730947b2010-04-10 04:13:53 -0300741
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300742 /* shutdown control thread */
743 if (dma_q->kthread) {
744 kthread_stop(dma_q->kthread);
Mauro Carvalho Chehab543323b2007-12-10 09:33:52 -0300745 dma_q->kthread = NULL;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300746 }
Hans Verkuil730947b2010-04-10 04:13:53 -0300747
Pawel Osciake007a322011-01-19 13:02:29 -0200748 /*
749 * Typical driver might need to wait here until dma engine stops.
750 * In this case we can abort imiedetly, so it's just a noop.
751 */
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300752
Pawel Osciake007a322011-01-19 13:02:29 -0200753 /* Release all active buffers */
754 while (!list_empty(&dma_q->active)) {
755 struct vivi_buffer *buf;
756 buf = list_entry(dma_q->active.next, struct vivi_buffer, list);
757 list_del(&buf->list);
758 vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR);
759 dprintk(dev, 2, "[%p/%d] done\n", buf, buf->vb.v4l2_buf.index);
760 }
761}
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300762/* ------------------------------------------------------------------
763 Videobuf operations
764 ------------------------------------------------------------------*/
Guennadi Liakhovetskifc714e702011-08-24 10:30:21 -0300765static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *fmt,
766 unsigned int *nbuffers, unsigned int *nplanes,
767 unsigned int sizes[], void *alloc_ctxs[])
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300768{
Pawel Osciake007a322011-01-19 13:02:29 -0200769 struct vivi_dev *dev = vb2_get_drv_priv(vq);
770 unsigned long size;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300771
Hans Verkuil2e90c6c2012-06-22 05:53:31 -0300772 if (fmt)
773 size = fmt->fmt.pix.sizeimage;
774 else
775 size = dev->width * dev->height * dev->pixelsize;
776
777 if (size == 0)
778 return -EINVAL;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300779
Pawel Osciake007a322011-01-19 13:02:29 -0200780 if (0 == *nbuffers)
781 *nbuffers = 32;
Mauro Carvalho Chehab6bb27902007-08-23 16:41:14 -0300782
Pawel Osciake007a322011-01-19 13:02:29 -0200783 while (size * *nbuffers > vid_limit * 1024 * 1024)
784 (*nbuffers)--;
Mauro Carvalho Chehab6bb27902007-08-23 16:41:14 -0300785
Pawel Osciake007a322011-01-19 13:02:29 -0200786 *nplanes = 1;
787
788 sizes[0] = size;
789
790 /*
791 * videobuf2-vmalloc allocator is context-less so no need to set
792 * alloc_ctxs array.
793 */
794
795 dprintk(dev, 1, "%s, count=%d, size=%ld\n", __func__,
796 *nbuffers, size);
Mauro Carvalho Chehab6bb27902007-08-23 16:41:14 -0300797
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300798 return 0;
799}
800
Pawel Osciake007a322011-01-19 13:02:29 -0200801static int buffer_prepare(struct vb2_buffer *vb)
802{
803 struct vivi_dev *dev = vb2_get_drv_priv(vb->vb2_queue);
804 struct vivi_buffer *buf = container_of(vb, struct vivi_buffer, vb);
805 unsigned long size;
806
807 dprintk(dev, 1, "%s, field=%d\n", __func__, vb->v4l2_buf.field);
808
809 BUG_ON(NULL == dev->fmt);
810
811 /*
812 * Theses properties only change when queue is idle, see s_fmt.
813 * The below checks should not be performed here, on each
814 * buffer_prepare (i.e. on each qbuf). Most of the code in this function
815 * should thus be moved to buffer_init and s_fmt.
816 */
Hans Verkuil730947b2010-04-10 04:13:53 -0300817 if (dev->width < 48 || dev->width > MAX_WIDTH ||
818 dev->height < 32 || dev->height > MAX_HEIGHT)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300819 return -EINVAL;
Brandon Philips78718e52008-04-02 18:10:59 -0300820
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300821 size = dev->width * dev->height * dev->pixelsize;
Pawel Osciake007a322011-01-19 13:02:29 -0200822 if (vb2_plane_size(vb, 0) < size) {
823 dprintk(dev, 1, "%s data will not fit into plane (%lu < %lu)\n",
824 __func__, vb2_plane_size(vb, 0), size);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300825 return -EINVAL;
Pawel Osciake007a322011-01-19 13:02:29 -0200826 }
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300827
Pawel Osciake007a322011-01-19 13:02:29 -0200828 vb2_set_plane_payload(&buf->vb, 0, size);
829
830 buf->fmt = dev->fmt;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300831
Hans Verkuil730947b2010-04-10 04:13:53 -0300832 precalculate_bars(dev);
833 precalculate_line(dev);
Mauro Carvalho Chehabc285add2009-06-25 16:28:23 -0300834
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300835 return 0;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300836}
837
Pawel Osciake007a322011-01-19 13:02:29 -0200838static void buffer_queue(struct vb2_buffer *vb)
839{
840 struct vivi_dev *dev = vb2_get_drv_priv(vb->vb2_queue);
Hans Verkuil730947b2010-04-10 04:13:53 -0300841 struct vivi_buffer *buf = container_of(vb, struct vivi_buffer, vb);
Brandon Philips78718e52008-04-02 18:10:59 -0300842 struct vivi_dmaqueue *vidq = &dev->vidq;
Pawel Osciake007a322011-01-19 13:02:29 -0200843 unsigned long flags = 0;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300844
Harvey Harrison7e28adb2008-04-08 23:20:00 -0300845 dprintk(dev, 1, "%s\n", __func__);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300846
Pawel Osciake007a322011-01-19 13:02:29 -0200847 spin_lock_irqsave(&dev->slock, flags);
848 list_add_tail(&buf->list, &vidq->active);
849 spin_unlock_irqrestore(&dev->slock, flags);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300850}
851
Marek Szyprowskibd323e22011-08-29 08:51:49 -0300852static int start_streaming(struct vb2_queue *vq, unsigned int count)
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300853{
Pawel Osciake007a322011-01-19 13:02:29 -0200854 struct vivi_dev *dev = vb2_get_drv_priv(vq);
Harvey Harrison7e28adb2008-04-08 23:20:00 -0300855 dprintk(dev, 1, "%s\n", __func__);
Pawel Osciake007a322011-01-19 13:02:29 -0200856 return vivi_start_generating(dev);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300857}
858
Pawel Osciake007a322011-01-19 13:02:29 -0200859/* abort streaming and wait for last buffer */
860static int stop_streaming(struct vb2_queue *vq)
861{
862 struct vivi_dev *dev = vb2_get_drv_priv(vq);
863 dprintk(dev, 1, "%s\n", __func__);
864 vivi_stop_generating(dev);
865 return 0;
866}
867
868static void vivi_lock(struct vb2_queue *vq)
869{
870 struct vivi_dev *dev = vb2_get_drv_priv(vq);
871 mutex_lock(&dev->mutex);
872}
873
874static void vivi_unlock(struct vb2_queue *vq)
875{
876 struct vivi_dev *dev = vb2_get_drv_priv(vq);
877 mutex_unlock(&dev->mutex);
878}
879
880
881static struct vb2_ops vivi_video_qops = {
882 .queue_setup = queue_setup,
Pawel Osciake007a322011-01-19 13:02:29 -0200883 .buf_prepare = buffer_prepare,
Pawel Osciake007a322011-01-19 13:02:29 -0200884 .buf_queue = buffer_queue,
885 .start_streaming = start_streaming,
886 .stop_streaming = stop_streaming,
887 .wait_prepare = vivi_unlock,
888 .wait_finish = vivi_lock,
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300889};
890
891/* ------------------------------------------------------------------
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -0300892 IOCTL vidioc handling
893 ------------------------------------------------------------------*/
Mauro Carvalho Chehab543323b2007-12-10 09:33:52 -0300894static int vidioc_querycap(struct file *file, void *priv,
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -0300895 struct v4l2_capability *cap)
896{
Hans Verkuil730947b2010-04-10 04:13:53 -0300897 struct vivi_dev *dev = video_drvdata(file);
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -0300898
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -0300899 strcpy(cap->driver, "vivi");
900 strcpy(cap->card, "vivi");
Hans Verkuil72c2af62012-09-14 06:23:12 -0300901 snprintf(cap->bus_info, sizeof(cap->bus_info),
902 "platform:%s", dev->v4l2_dev.name);
Hans Verkuil23268ae2012-01-24 05:24:36 -0300903 cap->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING |
904 V4L2_CAP_READWRITE;
905 cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS;
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -0300906 return 0;
907}
908
Hans Verkuil78b526a2008-05-28 12:16:41 -0300909static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv,
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -0300910 struct v4l2_fmtdesc *f)
911{
Magnus Dammd891f472008-10-14 12:47:09 -0300912 struct vivi_fmt *fmt;
913
914 if (f->index >= ARRAY_SIZE(formats))
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -0300915 return -EINVAL;
916
Magnus Dammd891f472008-10-14 12:47:09 -0300917 fmt = &formats[f->index];
918
919 strlcpy(f->description, fmt->name, sizeof(f->description));
920 f->pixelformat = fmt->fourcc;
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -0300921 return 0;
922}
923
Hans Verkuil78b526a2008-05-28 12:16:41 -0300924static int vidioc_g_fmt_vid_cap(struct file *file, void *priv,
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -0300925 struct v4l2_format *f)
926{
Hans Verkuil730947b2010-04-10 04:13:53 -0300927 struct vivi_dev *dev = video_drvdata(file);
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -0300928
Hans Verkuil730947b2010-04-10 04:13:53 -0300929 f->fmt.pix.width = dev->width;
930 f->fmt.pix.height = dev->height;
Hans Verkuilcd779252012-07-25 11:48:53 -0300931 f->fmt.pix.field = V4L2_FIELD_INTERLACED;
Hans Verkuil730947b2010-04-10 04:13:53 -0300932 f->fmt.pix.pixelformat = dev->fmt->fourcc;
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -0300933 f->fmt.pix.bytesperline =
Hans Verkuil730947b2010-04-10 04:13:53 -0300934 (f->fmt.pix.width * dev->fmt->depth) >> 3;
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -0300935 f->fmt.pix.sizeimage =
936 f->fmt.pix.height * f->fmt.pix.bytesperline;
Hans Verkuil0a3a8a32012-08-06 10:36:18 -0300937 if (dev->fmt->is_yuv)
Hans Verkuil8c79eec2011-07-29 07:19:46 -0300938 f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
939 else
940 f->fmt.pix.colorspace = V4L2_COLORSPACE_SRGB;
Hans Verkuil730947b2010-04-10 04:13:53 -0300941 return 0;
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -0300942}
943
Hans Verkuil78b526a2008-05-28 12:16:41 -0300944static int vidioc_try_fmt_vid_cap(struct file *file, void *priv,
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300945 struct v4l2_format *f)
946{
Hans Verkuil730947b2010-04-10 04:13:53 -0300947 struct vivi_dev *dev = video_drvdata(file);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300948 struct vivi_fmt *fmt;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300949
Magnus Dammd891f472008-10-14 12:47:09 -0300950 fmt = get_format(f);
951 if (!fmt) {
Hans Verkuilcd779252012-07-25 11:48:53 -0300952 dprintk(dev, 1, "Fourcc format (0x%08x) unknown.\n",
Magnus Dammd891f472008-10-14 12:47:09 -0300953 f->fmt.pix.pixelformat);
Hans Verkuilcd779252012-07-25 11:48:53 -0300954 f->fmt.pix.pixelformat = V4L2_PIX_FMT_YUYV;
955 fmt = get_format(f);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300956 }
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300957
Hans Verkuilcd779252012-07-25 11:48:53 -0300958 f->fmt.pix.field = V4L2_FIELD_INTERLACED;
Hans Verkuil730947b2010-04-10 04:13:53 -0300959 v4l_bound_align_image(&f->fmt.pix.width, 48, MAX_WIDTH, 2,
960 &f->fmt.pix.height, 32, MAX_HEIGHT, 0, 0);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300961 f->fmt.pix.bytesperline =
962 (f->fmt.pix.width * fmt->depth) >> 3;
963 f->fmt.pix.sizeimage =
964 f->fmt.pix.height * f->fmt.pix.bytesperline;
Hans Verkuil0a3a8a32012-08-06 10:36:18 -0300965 if (fmt->is_yuv)
Hans Verkuil8c79eec2011-07-29 07:19:46 -0300966 f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
967 else
968 f->fmt.pix.colorspace = V4L2_COLORSPACE_SRGB;
Hans Verkuil2f65f462012-08-06 10:43:13 -0300969 f->fmt.pix.priv = 0;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300970 return 0;
971}
972
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300973static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
974 struct v4l2_format *f)
975{
Hans Verkuil730947b2010-04-10 04:13:53 -0300976 struct vivi_dev *dev = video_drvdata(file);
Pawel Osciake007a322011-01-19 13:02:29 -0200977 struct vb2_queue *q = &dev->vb_vidq;
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300978
Hans Verkuil730947b2010-04-10 04:13:53 -0300979 int ret = vidioc_try_fmt_vid_cap(file, priv, f);
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300980 if (ret < 0)
981 return ret;
982
Hans Verkuilf2ba5a02012-06-22 05:53:02 -0300983 if (vb2_is_busy(q)) {
Hans Verkuil730947b2010-04-10 04:13:53 -0300984 dprintk(dev, 1, "%s device busy\n", __func__);
Pawel Osciake007a322011-01-19 13:02:29 -0200985 return -EBUSY;
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -0300986 }
987
Hans Verkuil730947b2010-04-10 04:13:53 -0300988 dev->fmt = get_format(f);
Hans Verkuil3d51dca2012-05-02 03:15:11 -0300989 dev->pixelsize = dev->fmt->depth / 8;
Hans Verkuil730947b2010-04-10 04:13:53 -0300990 dev->width = f->fmt.pix.width;
991 dev->height = f->fmt.pix.height;
Pawel Osciake007a322011-01-19 13:02:29 -0200992
993 return 0;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -0300994}
995
Hans Verkuil77747f72012-08-06 10:37:18 -0300996static int vidioc_enum_framesizes(struct file *file, void *fh,
997 struct v4l2_frmsizeenum *fsize)
998{
999 static const struct v4l2_frmsize_stepwise sizes = {
1000 48, MAX_WIDTH, 4,
1001 32, MAX_HEIGHT, 1
1002 };
1003 int i;
1004
1005 if (fsize->index)
1006 return -EINVAL;
1007 for (i = 0; i < ARRAY_SIZE(formats); i++)
1008 if (formats[i].fourcc == fsize->pixel_format)
1009 break;
1010 if (i == ARRAY_SIZE(formats))
1011 return -EINVAL;
1012 fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE;
1013 fsize->stepwise = sizes;
1014 return 0;
1015}
1016
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001017/* only one input in this sample driver */
Mauro Carvalho Chehab543323b2007-12-10 09:33:52 -03001018static int vidioc_enum_input(struct file *file, void *priv,
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001019 struct v4l2_input *inp)
1020{
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -03001021 if (inp->index >= NUM_INPUTS)
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001022 return -EINVAL;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001023
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001024 inp->type = V4L2_INPUT_TYPE_CAMERA;
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -03001025 sprintf(inp->name, "Camera %u", inp->index);
Hans Verkuil730947b2010-04-10 04:13:53 -03001026 return 0;
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001027}
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001028
Mauro Carvalho Chehab543323b2007-12-10 09:33:52 -03001029static int vidioc_g_input(struct file *file, void *priv, unsigned int *i)
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001030{
Hans Verkuil730947b2010-04-10 04:13:53 -03001031 struct vivi_dev *dev = video_drvdata(file);
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -03001032
1033 *i = dev->input;
Hans Verkuil730947b2010-04-10 04:13:53 -03001034 return 0;
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001035}
Hans Verkuil730947b2010-04-10 04:13:53 -03001036
Mauro Carvalho Chehab543323b2007-12-10 09:33:52 -03001037static int vidioc_s_input(struct file *file, void *priv, unsigned int i)
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001038{
Hans Verkuil730947b2010-04-10 04:13:53 -03001039 struct vivi_dev *dev = video_drvdata(file);
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -03001040
1041 if (i >= NUM_INPUTS)
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001042 return -EINVAL;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001043
Hans Verkuilc7a52f82011-06-07 10:20:23 -03001044 if (i == dev->input)
1045 return 0;
1046
Mauro Carvalho Chehabe164b582009-01-11 10:29:43 -03001047 dev->input = i;
Hans Verkuil730947b2010-04-10 04:13:53 -03001048 precalculate_bars(dev);
1049 precalculate_line(dev);
1050 return 0;
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001051}
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001052
Hans Verkuil730947b2010-04-10 04:13:53 -03001053/* --- controls ---------------------------------------------- */
Hans Verkuil7e996af2011-01-23 12:33:16 -02001054
Hans Verkuila1c894f2011-06-07 06:34:41 -03001055static int vivi_g_volatile_ctrl(struct v4l2_ctrl *ctrl)
1056{
1057 struct vivi_dev *dev = container_of(ctrl->handler, struct vivi_dev, ctrl_handler);
1058
1059 if (ctrl == dev->autogain)
1060 dev->gain->val = jiffies & 0xff;
1061 return 0;
1062}
1063
Hans Verkuil7e996af2011-01-23 12:33:16 -02001064static int vivi_s_ctrl(struct v4l2_ctrl *ctrl)
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001065{
Hans Verkuil7e996af2011-01-23 12:33:16 -02001066 struct vivi_dev *dev = container_of(ctrl->handler, struct vivi_dev, ctrl_handler);
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001067
Hans Verkuil7088f4d2012-05-02 03:33:52 -03001068 switch (ctrl->id) {
1069 case V4L2_CID_ALPHA_COMPONENT:
1070 dev->alpha_component = ctrl->val;
1071 break;
1072 default:
1073 if (ctrl == dev->button)
1074 dev->button_pressed = 30;
1075 break;
1076 }
Hans Verkuil7e996af2011-01-23 12:33:16 -02001077 return 0;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001078}
1079
1080/* ------------------------------------------------------------------
1081 File operations for the device
1082 ------------------------------------------------------------------*/
1083
Hans Verkuil7e996af2011-01-23 12:33:16 -02001084static const struct v4l2_ctrl_ops vivi_ctrl_ops = {
Hans Verkuila1c894f2011-06-07 06:34:41 -03001085 .g_volatile_ctrl = vivi_g_volatile_ctrl,
Hans Verkuil7e996af2011-01-23 12:33:16 -02001086 .s_ctrl = vivi_s_ctrl,
1087};
1088
1089#define VIVI_CID_CUSTOM_BASE (V4L2_CID_USER_BASE | 0xf000)
1090
1091static const struct v4l2_ctrl_config vivi_ctrl_button = {
1092 .ops = &vivi_ctrl_ops,
1093 .id = VIVI_CID_CUSTOM_BASE + 0,
1094 .name = "Button",
1095 .type = V4L2_CTRL_TYPE_BUTTON,
1096};
1097
1098static const struct v4l2_ctrl_config vivi_ctrl_boolean = {
1099 .ops = &vivi_ctrl_ops,
1100 .id = VIVI_CID_CUSTOM_BASE + 1,
1101 .name = "Boolean",
1102 .type = V4L2_CTRL_TYPE_BOOLEAN,
1103 .min = 0,
1104 .max = 1,
1105 .step = 1,
1106 .def = 1,
1107};
1108
1109static const struct v4l2_ctrl_config vivi_ctrl_int32 = {
1110 .ops = &vivi_ctrl_ops,
1111 .id = VIVI_CID_CUSTOM_BASE + 2,
1112 .name = "Integer 32 Bits",
1113 .type = V4L2_CTRL_TYPE_INTEGER,
Hans Verkuil5b283022011-01-11 17:32:28 -03001114 .min = 0x80000000,
1115 .max = 0x7fffffff,
Hans Verkuil7e996af2011-01-23 12:33:16 -02001116 .step = 1,
1117};
1118
1119static const struct v4l2_ctrl_config vivi_ctrl_int64 = {
1120 .ops = &vivi_ctrl_ops,
1121 .id = VIVI_CID_CUSTOM_BASE + 3,
1122 .name = "Integer 64 Bits",
1123 .type = V4L2_CTRL_TYPE_INTEGER64,
1124};
1125
1126static const char * const vivi_ctrl_menu_strings[] = {
1127 "Menu Item 0 (Skipped)",
1128 "Menu Item 1",
1129 "Menu Item 2 (Skipped)",
1130 "Menu Item 3",
1131 "Menu Item 4",
1132 "Menu Item 5 (Skipped)",
1133 NULL,
1134};
1135
1136static const struct v4l2_ctrl_config vivi_ctrl_menu = {
1137 .ops = &vivi_ctrl_ops,
1138 .id = VIVI_CID_CUSTOM_BASE + 4,
1139 .name = "Menu",
1140 .type = V4L2_CTRL_TYPE_MENU,
1141 .min = 1,
1142 .max = 4,
1143 .def = 3,
1144 .menu_skip_mask = 0x04,
1145 .qmenu = vivi_ctrl_menu_strings,
1146};
1147
1148static const struct v4l2_ctrl_config vivi_ctrl_string = {
1149 .ops = &vivi_ctrl_ops,
1150 .id = VIVI_CID_CUSTOM_BASE + 5,
1151 .name = "String",
1152 .type = V4L2_CTRL_TYPE_STRING,
1153 .min = 2,
1154 .max = 4,
1155 .step = 1,
1156};
1157
Hans Verkuilb6d17a52011-03-29 16:33:11 -03001158static const struct v4l2_ctrl_config vivi_ctrl_bitmask = {
1159 .ops = &vivi_ctrl_ops,
1160 .id = VIVI_CID_CUSTOM_BASE + 6,
1161 .name = "Bitmask",
1162 .type = V4L2_CTRL_TYPE_BITMASK,
1163 .def = 0x80002000,
1164 .min = 0,
1165 .max = 0x80402010,
1166 .step = 0,
1167};
1168
Sakari Ailusc5203312011-08-05 06:38:05 -03001169static const s64 vivi_ctrl_int_menu_values[] = {
1170 1, 1, 2, 3, 5, 8, 13, 21, 42,
1171};
1172
1173static const struct v4l2_ctrl_config vivi_ctrl_int_menu = {
1174 .ops = &vivi_ctrl_ops,
1175 .id = VIVI_CID_CUSTOM_BASE + 7,
1176 .name = "Integer menu",
1177 .type = V4L2_CTRL_TYPE_INTEGER_MENU,
1178 .min = 1,
1179 .max = 8,
1180 .def = 4,
1181 .menu_skip_mask = 0x02,
1182 .qmenu_int = vivi_ctrl_int_menu_values,
1183};
1184
Hans Verkuilbec43662008-12-30 06:58:20 -03001185static const struct v4l2_file_operations vivi_fops = {
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001186 .owner = THIS_MODULE,
Hans Verkuilc7a52f82011-06-07 10:20:23 -03001187 .open = v4l2_fh_open,
Hans Verkuilf2ba5a02012-06-22 05:53:02 -03001188 .release = vb2_fop_release,
1189 .read = vb2_fop_read,
1190 .poll = vb2_fop_poll,
Hans Verkuilfedc6c82010-09-20 18:25:55 -03001191 .unlocked_ioctl = video_ioctl2, /* V4L2 ioctl handler */
Hans Verkuilf2ba5a02012-06-22 05:53:02 -03001192 .mmap = vb2_fop_mmap,
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001193};
1194
Hans Verkuila3998102008-07-21 02:57:38 -03001195static const struct v4l2_ioctl_ops vivi_ioctl_ops = {
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001196 .vidioc_querycap = vidioc_querycap,
Hans Verkuil78b526a2008-05-28 12:16:41 -03001197 .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap,
1198 .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap,
1199 .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap,
1200 .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap,
Hans Verkuil77747f72012-08-06 10:37:18 -03001201 .vidioc_enum_framesizes = vidioc_enum_framesizes,
Hans Verkuilf2ba5a02012-06-22 05:53:02 -03001202 .vidioc_reqbufs = vb2_ioctl_reqbufs,
Hans Verkuil2e90c6c2012-06-22 05:53:31 -03001203 .vidioc_create_bufs = vb2_ioctl_create_bufs,
1204 .vidioc_prepare_buf = vb2_ioctl_prepare_buf,
Hans Verkuilf2ba5a02012-06-22 05:53:02 -03001205 .vidioc_querybuf = vb2_ioctl_querybuf,
1206 .vidioc_qbuf = vb2_ioctl_qbuf,
1207 .vidioc_dqbuf = vb2_ioctl_dqbuf,
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001208 .vidioc_enum_input = vidioc_enum_input,
1209 .vidioc_g_input = vidioc_g_input,
1210 .vidioc_s_input = vidioc_s_input,
Hans Verkuilf2ba5a02012-06-22 05:53:02 -03001211 .vidioc_streamon = vb2_ioctl_streamon,
1212 .vidioc_streamoff = vb2_ioctl_streamoff,
Hans Verkuile2ecb252012-02-02 08:20:53 -03001213 .vidioc_log_status = v4l2_ctrl_log_status,
Hans Verkuil6d6604f2012-01-27 16:21:10 -03001214 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
Hans Verkuilc7a52f82011-06-07 10:20:23 -03001215 .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
Hans Verkuila3998102008-07-21 02:57:38 -03001216};
1217
1218static struct video_device vivi_template = {
1219 .name = "vivi",
Hans Verkuila3998102008-07-21 02:57:38 -03001220 .fops = &vivi_fops,
1221 .ioctl_ops = &vivi_ioctl_ops,
Hans Verkuil70bd97a2012-06-09 11:27:43 -03001222 .release = video_device_release_empty,
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001223};
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001224
Mauro Carvalho Chehabc820cc42006-06-04 10:34:12 -03001225/* -----------------------------------------------------------------
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001226 Initialization and module stuff
1227 ------------------------------------------------------------------*/
1228
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001229static int vivi_release(void)
1230{
1231 struct vivi_dev *dev;
1232 struct list_head *list;
1233
1234 while (!list_empty(&vivi_devlist)) {
1235 list = vivi_devlist.next;
1236 list_del(list);
1237 dev = list_entry(list, struct vivi_dev, vivi_devlist);
1238
Laurent Pinchart38c7c032009-11-27 13:57:15 -03001239 v4l2_info(&dev->v4l2_dev, "unregistering %s\n",
Hans Verkuil70bd97a2012-06-09 11:27:43 -03001240 video_device_node_name(&dev->vdev));
1241 video_unregister_device(&dev->vdev);
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001242 v4l2_device_unregister(&dev->v4l2_dev);
Hans Verkuil7e996af2011-01-23 12:33:16 -02001243 v4l2_ctrl_handler_free(&dev->ctrl_handler);
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001244 kfree(dev);
1245 }
1246
1247 return 0;
1248}
1249
Hans Verkuilc41ee242009-02-14 13:43:44 -03001250static int __init vivi_create_instance(int inst)
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001251{
1252 struct vivi_dev *dev;
1253 struct video_device *vfd;
Hans Verkuil7e996af2011-01-23 12:33:16 -02001254 struct v4l2_ctrl_handler *hdl;
Pawel Osciake007a322011-01-19 13:02:29 -02001255 struct vb2_queue *q;
Hans Verkuil730947b2010-04-10 04:13:53 -03001256 int ret;
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001257
1258 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
1259 if (!dev)
1260 return -ENOMEM;
1261
1262 snprintf(dev->v4l2_dev.name, sizeof(dev->v4l2_dev.name),
Hans Verkuilc41ee242009-02-14 13:43:44 -03001263 "%s-%03d", VIVI_MODULE_NAME, inst);
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001264 ret = v4l2_device_register(NULL, &dev->v4l2_dev);
1265 if (ret)
1266 goto free_dev;
1267
Hans Verkuil730947b2010-04-10 04:13:53 -03001268 dev->fmt = &formats[0];
1269 dev->width = 640;
1270 dev->height = 480;
Hans Verkuil3d51dca2012-05-02 03:15:11 -03001271 dev->pixelsize = dev->fmt->depth / 8;
Hans Verkuil7e996af2011-01-23 12:33:16 -02001272 hdl = &dev->ctrl_handler;
1273 v4l2_ctrl_handler_init(hdl, 11);
1274 dev->volume = v4l2_ctrl_new_std(hdl, &vivi_ctrl_ops,
1275 V4L2_CID_AUDIO_VOLUME, 0, 255, 1, 200);
1276 dev->brightness = v4l2_ctrl_new_std(hdl, &vivi_ctrl_ops,
1277 V4L2_CID_BRIGHTNESS, 0, 255, 1, 127);
1278 dev->contrast = v4l2_ctrl_new_std(hdl, &vivi_ctrl_ops,
1279 V4L2_CID_CONTRAST, 0, 255, 1, 16);
1280 dev->saturation = v4l2_ctrl_new_std(hdl, &vivi_ctrl_ops,
1281 V4L2_CID_SATURATION, 0, 255, 1, 127);
1282 dev->hue = v4l2_ctrl_new_std(hdl, &vivi_ctrl_ops,
1283 V4L2_CID_HUE, -128, 127, 1, 0);
Hans Verkuila1c894f2011-06-07 06:34:41 -03001284 dev->autogain = v4l2_ctrl_new_std(hdl, &vivi_ctrl_ops,
1285 V4L2_CID_AUTOGAIN, 0, 1, 1, 1);
1286 dev->gain = v4l2_ctrl_new_std(hdl, &vivi_ctrl_ops,
1287 V4L2_CID_GAIN, 0, 255, 1, 100);
Hans Verkuil7088f4d2012-05-02 03:33:52 -03001288 dev->alpha = v4l2_ctrl_new_std(hdl, &vivi_ctrl_ops,
1289 V4L2_CID_ALPHA_COMPONENT, 0, 255, 1, 0);
Hans Verkuil7e996af2011-01-23 12:33:16 -02001290 dev->button = v4l2_ctrl_new_custom(hdl, &vivi_ctrl_button, NULL);
1291 dev->int32 = v4l2_ctrl_new_custom(hdl, &vivi_ctrl_int32, NULL);
1292 dev->int64 = v4l2_ctrl_new_custom(hdl, &vivi_ctrl_int64, NULL);
1293 dev->boolean = v4l2_ctrl_new_custom(hdl, &vivi_ctrl_boolean, NULL);
1294 dev->menu = v4l2_ctrl_new_custom(hdl, &vivi_ctrl_menu, NULL);
1295 dev->string = v4l2_ctrl_new_custom(hdl, &vivi_ctrl_string, NULL);
Hans Verkuilb6d17a52011-03-29 16:33:11 -03001296 dev->bitmask = v4l2_ctrl_new_custom(hdl, &vivi_ctrl_bitmask, NULL);
Sakari Ailusc5203312011-08-05 06:38:05 -03001297 dev->int_menu = v4l2_ctrl_new_custom(hdl, &vivi_ctrl_int_menu, NULL);
Hans Verkuil7e996af2011-01-23 12:33:16 -02001298 if (hdl->error) {
1299 ret = hdl->error;
1300 goto unreg_dev;
1301 }
Hans Verkuila1c894f2011-06-07 06:34:41 -03001302 v4l2_ctrl_auto_cluster(2, &dev->autogain, 0, true);
Hans Verkuil7e996af2011-01-23 12:33:16 -02001303 dev->v4l2_dev.ctrl_handler = hdl;
Hans Verkuil730947b2010-04-10 04:13:53 -03001304
Hans Verkuilfedc6c82010-09-20 18:25:55 -03001305 /* initialize locks */
1306 spin_lock_init(&dev->slock);
Hans Verkuilfedc6c82010-09-20 18:25:55 -03001307
Pawel Osciake007a322011-01-19 13:02:29 -02001308 /* initialize queue */
1309 q = &dev->vb_vidq;
Pawel Osciake007a322011-01-19 13:02:29 -02001310 q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1311 q->io_modes = VB2_MMAP | VB2_USERPTR | VB2_READ;
1312 q->drv_priv = dev;
1313 q->buf_struct_size = sizeof(struct vivi_buffer);
1314 q->ops = &vivi_video_qops;
1315 q->mem_ops = &vb2_vmalloc_memops;
1316
Ezequiel Garcia4195ec72012-09-17 09:49:38 -03001317 ret = vb2_queue_init(q);
1318 if (ret)
1319 goto unreg_dev;
Pawel Osciake007a322011-01-19 13:02:29 -02001320
1321 mutex_init(&dev->mutex);
Hans Verkuil730947b2010-04-10 04:13:53 -03001322
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001323 /* init video dma queues */
1324 INIT_LIST_HEAD(&dev->vidq.active);
1325 init_waitqueue_head(&dev->vidq.wq);
1326
Hans Verkuil70bd97a2012-06-09 11:27:43 -03001327 vfd = &dev->vdev;
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001328 *vfd = vivi_template;
Mauro Carvalho Chehabc285add2009-06-25 16:28:23 -03001329 vfd->debug = debug;
Hans Verkuil730947b2010-04-10 04:13:53 -03001330 vfd->v4l2_dev = &dev->v4l2_dev;
Hans Verkuilf2ba5a02012-06-22 05:53:02 -03001331 vfd->queue = q;
Hans Verkuilb1a873a2011-03-22 10:14:07 -03001332 set_bit(V4L2_FL_USE_FH_PRIO, &vfd->flags);
Pawel Osciake007a322011-01-19 13:02:29 -02001333
1334 /*
1335 * Provide a mutex to v4l2 core. It will be used to protect
1336 * all fops and v4l2 ioctls.
1337 */
Hans Verkuilfedc6c82010-09-20 18:25:55 -03001338 vfd->lock = &dev->mutex;
Hans Verkuil70bd97a2012-06-09 11:27:43 -03001339 video_set_drvdata(vfd, dev);
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001340
1341 ret = video_register_device(vfd, VFL_TYPE_GRABBER, video_nr);
1342 if (ret < 0)
Hans Verkuil70bd97a2012-06-09 11:27:43 -03001343 goto unreg_dev;
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001344
1345 /* Now that everything is fine, let's add it to device list */
1346 list_add_tail(&dev->vivi_devlist, &vivi_devlist);
1347
Laurent Pinchart38c7c032009-11-27 13:57:15 -03001348 v4l2_info(&dev->v4l2_dev, "V4L2 device registered as %s\n",
1349 video_device_node_name(vfd));
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001350 return 0;
1351
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001352unreg_dev:
Hans Verkuil7e996af2011-01-23 12:33:16 -02001353 v4l2_ctrl_handler_free(hdl);
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001354 v4l2_device_unregister(&dev->v4l2_dev);
1355free_dev:
1356 kfree(dev);
1357 return ret;
1358}
1359
Mauro Carvalho Chehab980d4f12008-09-03 17:11:53 -03001360/* This routine allocates from 1 to n_devs virtual drivers.
1361
1362 The real maximum number of virtual drivers will depend on how many drivers
1363 will succeed. This is limited to the maximum number of devices that
Hans Verkuil62cfdac2009-02-14 11:37:17 -03001364 videodev supports, which is equal to VIDEO_NUM_DEVICES.
Mauro Carvalho Chehab980d4f12008-09-03 17:11:53 -03001365 */
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001366static int __init vivi_init(void)
1367{
Hans Verkuil730947b2010-04-10 04:13:53 -03001368 const struct font_desc *font = find_font("VGA8x16");
Hans Verkuil9185cbf2009-03-06 09:58:12 -03001369 int ret = 0, i;
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001370
Hans Verkuil730947b2010-04-10 04:13:53 -03001371 if (font == NULL) {
1372 printk(KERN_ERR "vivi: could not find font\n");
1373 return -ENODEV;
1374 }
1375 font8x16 = font->data;
1376
Mauro Carvalho Chehab980d4f12008-09-03 17:11:53 -03001377 if (n_devs <= 0)
1378 n_devs = 1;
1379
Mauro Carvalho Chehab55712ff2007-12-10 04:38:11 -03001380 for (i = 0; i < n_devs; i++) {
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001381 ret = vivi_create_instance(i);
1382 if (ret) {
1383 /* If some instantiations succeeded, keep driver */
Mauro Carvalho Chehab980d4f12008-09-03 17:11:53 -03001384 if (i)
1385 ret = 0;
Mauro Carvalho Chehab55712ff2007-12-10 04:38:11 -03001386 break;
Mauro Carvalho Chehab980d4f12008-09-03 17:11:53 -03001387 }
Mauro Carvalho Chehab55712ff2007-12-10 04:38:11 -03001388 }
1389
1390 if (ret < 0) {
Hans Verkuil730947b2010-04-10 04:13:53 -03001391 printk(KERN_ERR "vivi: error %d while loading driver\n", ret);
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001392 return ret;
1393 }
1394
1395 printk(KERN_INFO "Video Technology Magazine Virtual Video "
Mauro Carvalho Chehab1990d502011-06-24 14:45:49 -03001396 "Capture Board ver %s successfully loaded.\n",
1397 VIVI_VERSION);
Mauro Carvalho Chehab980d4f12008-09-03 17:11:53 -03001398
Hans Verkuil5ab6c9a2009-02-14 13:23:12 -03001399 /* n_devs will reflect the actual number of allocated devices */
1400 n_devs = i;
Mauro Carvalho Chehab980d4f12008-09-03 17:11:53 -03001401
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001402 return ret;
1403}
1404
1405static void __exit vivi_exit(void)
1406{
Mauro Carvalho Chehab55712ff2007-12-10 04:38:11 -03001407 vivi_release();
Mauro Carvalho Chehab1e6dd652006-03-10 12:40:10 -03001408}
1409
1410module_init(vivi_init);
1411module_exit(vivi_exit);