| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | #include <media/saa7146_vv.h> | 
|  | 2 |  | 
|  | 3 | static int max_memory = 32; | 
|  | 4 |  | 
|  | 5 | module_param(max_memory, int, 0644); | 
|  | 6 | MODULE_PARM_DESC(max_memory, "maximum memory usage for capture buffers (default: 32Mb)"); | 
|  | 7 |  | 
|  | 8 | #define IS_CAPTURE_ACTIVE(fh) \ | 
|  | 9 | (((vv->video_status & STATUS_CAPTURE) != 0) && (vv->video_fh == fh)) | 
|  | 10 |  | 
|  | 11 | #define IS_OVERLAY_ACTIVE(fh) \ | 
|  | 12 | (((vv->video_status & STATUS_OVERLAY) != 0) && (vv->video_fh == fh)) | 
|  | 13 |  | 
|  | 14 | /* format descriptions for capture and preview */ | 
|  | 15 | static struct saa7146_format formats[] = { | 
|  | 16 | { | 
|  | 17 | .name		= "RGB-8 (3-3-2)", | 
|  | 18 | .pixelformat	= V4L2_PIX_FMT_RGB332, | 
|  | 19 | .trans		= RGB08_COMPOSED, | 
|  | 20 | .depth		= 8, | 
|  | 21 | .flags		= 0, | 
|  | 22 | }, { | 
|  | 23 | .name		= "RGB-16 (5/B-6/G-5/R)", | 
|  | 24 | .pixelformat	= V4L2_PIX_FMT_RGB565, | 
|  | 25 | .trans		= RGB16_COMPOSED, | 
|  | 26 | .depth		= 16, | 
|  | 27 | .flags		= 0, | 
|  | 28 | }, { | 
|  | 29 | .name		= "RGB-24 (B-G-R)", | 
|  | 30 | .pixelformat	= V4L2_PIX_FMT_BGR24, | 
|  | 31 | .trans		= RGB24_COMPOSED, | 
|  | 32 | .depth		= 24, | 
|  | 33 | .flags		= 0, | 
|  | 34 | }, { | 
|  | 35 | .name		= "RGB-32 (B-G-R)", | 
|  | 36 | .pixelformat	= V4L2_PIX_FMT_BGR32, | 
|  | 37 | .trans		= RGB32_COMPOSED, | 
|  | 38 | .depth		= 32, | 
|  | 39 | .flags		= 0, | 
|  | 40 | }, { | 
|  | 41 | .name		= "RGB-32 (R-G-B)", | 
|  | 42 | .pixelformat	= V4L2_PIX_FMT_RGB32, | 
|  | 43 | .trans		= RGB32_COMPOSED, | 
|  | 44 | .depth		= 32, | 
|  | 45 | .flags		= 0, | 
|  | 46 | .swap		= 0x2, | 
|  | 47 | }, { | 
|  | 48 | .name		= "Greyscale-8", | 
|  | 49 | .pixelformat	= V4L2_PIX_FMT_GREY, | 
|  | 50 | .trans		= Y8, | 
|  | 51 | .depth		= 8, | 
|  | 52 | .flags		= 0, | 
|  | 53 | }, { | 
|  | 54 | .name		= "YUV 4:2:2 planar (Y-Cb-Cr)", | 
|  | 55 | .pixelformat	= V4L2_PIX_FMT_YUV422P, | 
|  | 56 | .trans		= YUV422_DECOMPOSED, | 
|  | 57 | .depth		= 16, | 
|  | 58 | .flags		= FORMAT_BYTE_SWAP|FORMAT_IS_PLANAR, | 
|  | 59 | }, { | 
|  | 60 | .name		= "YVU 4:2:0 planar (Y-Cb-Cr)", | 
|  | 61 | .pixelformat	= V4L2_PIX_FMT_YVU420, | 
|  | 62 | .trans		= YUV420_DECOMPOSED, | 
|  | 63 | .depth		= 12, | 
|  | 64 | .flags		= FORMAT_BYTE_SWAP|FORMAT_IS_PLANAR, | 
|  | 65 | }, { | 
|  | 66 | .name		= "YUV 4:2:0 planar (Y-Cb-Cr)", | 
|  | 67 | .pixelformat	= V4L2_PIX_FMT_YUV420, | 
|  | 68 | .trans		= YUV420_DECOMPOSED, | 
|  | 69 | .depth		= 12, | 
|  | 70 | .flags		= FORMAT_IS_PLANAR, | 
|  | 71 | }, { | 
|  | 72 | .name		= "YUV 4:2:2 (U-Y-V-Y)", | 
|  | 73 | .pixelformat	= V4L2_PIX_FMT_UYVY, | 
|  | 74 | .trans		= YUV422_COMPOSED, | 
|  | 75 | .depth		= 16, | 
|  | 76 | .flags		= 0, | 
|  | 77 | } | 
|  | 78 | }; | 
|  | 79 |  | 
|  | 80 | /* unfortunately, the saa7146 contains a bug which prevents it from doing on-the-fly byte swaps. | 
|  | 81 | due to this, it's impossible to provide additional *packed* formats, which are simply byte swapped | 
|  | 82 | (like V4L2_PIX_FMT_YUYV) ... 8-( */ | 
|  | 83 |  | 
|  | 84 | static int NUM_FORMATS = sizeof(formats)/sizeof(struct saa7146_format); | 
|  | 85 |  | 
|  | 86 | struct saa7146_format* format_by_fourcc(struct saa7146_dev *dev, int fourcc) | 
|  | 87 | { | 
|  | 88 | int i, j = NUM_FORMATS; | 
|  | 89 |  | 
|  | 90 | for (i = 0; i < j; i++) { | 
|  | 91 | if (formats[i].pixelformat == fourcc) { | 
|  | 92 | return formats+i; | 
|  | 93 | } | 
|  | 94 | } | 
|  | 95 |  | 
|  | 96 | DEB_D(("unknown pixelformat:'%4.4s'\n",(char *)&fourcc)); | 
|  | 97 | return NULL; | 
|  | 98 | } | 
|  | 99 |  | 
|  | 100 | static int g_fmt(struct saa7146_fh *fh, struct v4l2_format *f) | 
|  | 101 | { | 
|  | 102 | struct saa7146_dev *dev = fh->dev; | 
|  | 103 | DEB_EE(("dev:%p, fh:%p\n",dev,fh)); | 
|  | 104 |  | 
|  | 105 | switch (f->type) { | 
|  | 106 | case V4L2_BUF_TYPE_VIDEO_CAPTURE: | 
|  | 107 | f->fmt.pix = fh->video_fmt; | 
|  | 108 | return 0; | 
|  | 109 | case V4L2_BUF_TYPE_VIDEO_OVERLAY: | 
|  | 110 | f->fmt.win = fh->ov.win; | 
|  | 111 | return 0; | 
|  | 112 | case V4L2_BUF_TYPE_VBI_CAPTURE: | 
|  | 113 | { | 
|  | 114 | f->fmt.vbi = fh->vbi_fmt; | 
|  | 115 | return 0; | 
|  | 116 | } | 
|  | 117 | default: | 
|  | 118 | DEB_D(("invalid format type '%d'.\n",f->type)); | 
|  | 119 | return -EINVAL; | 
|  | 120 | } | 
|  | 121 | } | 
|  | 122 |  | 
|  | 123 | static int try_win(struct saa7146_dev *dev, struct v4l2_window *win) | 
|  | 124 | { | 
|  | 125 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 126 | enum v4l2_field field; | 
|  | 127 | int maxw, maxh; | 
|  | 128 |  | 
|  | 129 | DEB_EE(("dev:%p\n",dev)); | 
|  | 130 |  | 
|  | 131 | if (NULL == vv->ov_fb.base) { | 
|  | 132 | DEB_D(("no fb base set.\n")); | 
|  | 133 | return -EINVAL; | 
|  | 134 | } | 
|  | 135 | if (NULL == vv->ov_fmt) { | 
|  | 136 | DEB_D(("no fb fmt set.\n")); | 
|  | 137 | return -EINVAL; | 
|  | 138 | } | 
|  | 139 | if (win->w.width < 48 || win->w.height <  32) { | 
|  | 140 | DEB_D(("min width/height. (%d,%d)\n",win->w.width,win->w.height)); | 
|  | 141 | return -EINVAL; | 
|  | 142 | } | 
|  | 143 | if (win->clipcount > 16) { | 
|  | 144 | DEB_D(("clipcount too big.\n")); | 
|  | 145 | return -EINVAL; | 
|  | 146 | } | 
|  | 147 |  | 
|  | 148 | field = win->field; | 
|  | 149 | maxw  = vv->standard->h_max_out; | 
|  | 150 | maxh  = vv->standard->v_max_out; | 
|  | 151 |  | 
|  | 152 | if (V4L2_FIELD_ANY == field) { | 
| Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 153 | field = (win->w.height > maxh/2) | 
| Michael Krufky | 50c25ff | 2006-01-09 15:25:34 -0200 | [diff] [blame] | 154 | ? V4L2_FIELD_INTERLACED | 
|  | 155 | : V4L2_FIELD_TOP; | 
| Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 156 | } | 
|  | 157 | switch (field) { | 
|  | 158 | case V4L2_FIELD_TOP: | 
|  | 159 | case V4L2_FIELD_BOTTOM: | 
|  | 160 | case V4L2_FIELD_ALTERNATE: | 
|  | 161 | maxh = maxh / 2; | 
|  | 162 | break; | 
|  | 163 | case V4L2_FIELD_INTERLACED: | 
|  | 164 | break; | 
|  | 165 | default: { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 166 | DEB_D(("no known field mode '%d'.\n",field)); | 
| Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 167 | return -EINVAL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 168 | } | 
| Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 169 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 170 |  | 
|  | 171 | win->field = field; | 
|  | 172 | if (win->w.width > maxw) | 
|  | 173 | win->w.width = maxw; | 
|  | 174 | if (win->w.height > maxh) | 
|  | 175 | win->w.height = maxh; | 
|  | 176 |  | 
|  | 177 | return 0; | 
|  | 178 | } | 
|  | 179 |  | 
|  | 180 | static int try_fmt(struct saa7146_fh *fh, struct v4l2_format *f) | 
|  | 181 | { | 
|  | 182 | struct saa7146_dev *dev = fh->dev; | 
|  | 183 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 184 | int err; | 
|  | 185 |  | 
|  | 186 | switch (f->type) { | 
|  | 187 | case V4L2_BUF_TYPE_VIDEO_CAPTURE: | 
|  | 188 | { | 
|  | 189 | struct saa7146_format *fmt; | 
|  | 190 | enum v4l2_field field; | 
|  | 191 | int maxw, maxh; | 
|  | 192 | int calc_bpl; | 
|  | 193 |  | 
|  | 194 | DEB_EE(("V4L2_BUF_TYPE_VIDEO_CAPTURE: dev:%p, fh:%p\n",dev,fh)); | 
|  | 195 |  | 
|  | 196 | fmt = format_by_fourcc(dev,f->fmt.pix.pixelformat); | 
|  | 197 | if (NULL == fmt) { | 
|  | 198 | return -EINVAL; | 
|  | 199 | } | 
|  | 200 |  | 
|  | 201 | field = f->fmt.pix.field; | 
|  | 202 | maxw  = vv->standard->h_max_out; | 
|  | 203 | maxh  = vv->standard->v_max_out; | 
|  | 204 |  | 
|  | 205 | if (V4L2_FIELD_ANY == field) { | 
|  | 206 | field = (f->fmt.pix.height > maxh/2) | 
|  | 207 | ? V4L2_FIELD_INTERLACED | 
|  | 208 | : V4L2_FIELD_BOTTOM; | 
|  | 209 | } | 
|  | 210 | switch (field) { | 
|  | 211 | case V4L2_FIELD_ALTERNATE: { | 
|  | 212 | vv->last_field = V4L2_FIELD_TOP; | 
|  | 213 | maxh = maxh / 2; | 
|  | 214 | break; | 
|  | 215 | } | 
|  | 216 | case V4L2_FIELD_TOP: | 
|  | 217 | case V4L2_FIELD_BOTTOM: | 
|  | 218 | vv->last_field = V4L2_FIELD_INTERLACED; | 
|  | 219 | maxh = maxh / 2; | 
|  | 220 | break; | 
|  | 221 | case V4L2_FIELD_INTERLACED: | 
|  | 222 | vv->last_field = V4L2_FIELD_INTERLACED; | 
|  | 223 | break; | 
|  | 224 | default: { | 
|  | 225 | DEB_D(("no known field mode '%d'.\n",field)); | 
|  | 226 | return -EINVAL; | 
|  | 227 | } | 
|  | 228 | } | 
|  | 229 |  | 
|  | 230 | f->fmt.pix.field = field; | 
|  | 231 | if (f->fmt.pix.width > maxw) | 
|  | 232 | f->fmt.pix.width = maxw; | 
|  | 233 | if (f->fmt.pix.height > maxh) | 
|  | 234 | f->fmt.pix.height = maxh; | 
|  | 235 |  | 
|  | 236 | calc_bpl = (f->fmt.pix.width * fmt->depth)/8; | 
|  | 237 |  | 
|  | 238 | if (f->fmt.pix.bytesperline < calc_bpl) | 
|  | 239 | f->fmt.pix.bytesperline = calc_bpl; | 
|  | 240 |  | 
|  | 241 | if (f->fmt.pix.bytesperline > (2*PAGE_SIZE * fmt->depth)/8) /* arbitrary constraint */ | 
|  | 242 | f->fmt.pix.bytesperline = calc_bpl; | 
|  | 243 |  | 
|  | 244 | f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * f->fmt.pix.height; | 
|  | 245 | DEB_D(("w:%d, h:%d, bytesperline:%d, sizeimage:%d\n",f->fmt.pix.width,f->fmt.pix.height,f->fmt.pix.bytesperline,f->fmt.pix.sizeimage)); | 
|  | 246 |  | 
|  | 247 | return 0; | 
|  | 248 | } | 
|  | 249 | case V4L2_BUF_TYPE_VIDEO_OVERLAY: | 
|  | 250 | DEB_EE(("V4L2_BUF_TYPE_VIDEO_OVERLAY: dev:%p, fh:%p\n",dev,fh)); | 
|  | 251 | err = try_win(dev,&f->fmt.win); | 
|  | 252 | if (0 != err) { | 
|  | 253 | return err; | 
|  | 254 | } | 
|  | 255 | return 0; | 
|  | 256 | default: | 
|  | 257 | DEB_EE(("unknown format type '%d'\n",f->type)); | 
|  | 258 | return -EINVAL; | 
|  | 259 | } | 
|  | 260 | } | 
|  | 261 |  | 
|  | 262 | int saa7146_start_preview(struct saa7146_fh *fh) | 
|  | 263 | { | 
|  | 264 | struct saa7146_dev *dev = fh->dev; | 
|  | 265 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 266 | int ret = 0, err = 0; | 
|  | 267 |  | 
|  | 268 | DEB_EE(("dev:%p, fh:%p\n",dev,fh)); | 
|  | 269 |  | 
|  | 270 | /* check if we have overlay informations */ | 
|  | 271 | if( NULL == fh->ov.fh ) { | 
|  | 272 | DEB_D(("no overlay data available. try S_FMT first.\n")); | 
|  | 273 | return -EAGAIN; | 
|  | 274 | } | 
|  | 275 |  | 
|  | 276 | /* check if streaming capture is running */ | 
|  | 277 | if (IS_CAPTURE_ACTIVE(fh) != 0) { | 
|  | 278 | DEB_D(("streaming capture is active.\n")); | 
|  | 279 | return -EBUSY; | 
|  | 280 | } | 
|  | 281 |  | 
|  | 282 | /* check if overlay is running */ | 
|  | 283 | if (IS_OVERLAY_ACTIVE(fh) != 0) { | 
|  | 284 | if (vv->video_fh == fh) { | 
|  | 285 | DEB_D(("overlay is already active.\n")); | 
|  | 286 | return 0; | 
|  | 287 | } | 
|  | 288 | DEB_D(("overlay is already active in another open.\n")); | 
|  | 289 | return -EBUSY; | 
|  | 290 | } | 
|  | 291 |  | 
|  | 292 | if (0 == saa7146_res_get(fh, RESOURCE_DMA1_HPS|RESOURCE_DMA2_CLP)) { | 
|  | 293 | DEB_D(("cannot get necessary overlay resources\n")); | 
|  | 294 | return -EBUSY; | 
|  | 295 | } | 
|  | 296 |  | 
|  | 297 | err = try_win(dev,&fh->ov.win); | 
|  | 298 | if (0 != err) { | 
|  | 299 | saa7146_res_free(vv->video_fh, RESOURCE_DMA1_HPS|RESOURCE_DMA2_CLP); | 
|  | 300 | return -EBUSY; | 
|  | 301 | } | 
|  | 302 |  | 
|  | 303 | vv->ov_data = &fh->ov; | 
|  | 304 |  | 
|  | 305 | DEB_D(("%dx%d+%d+%d %s field=%s\n", | 
|  | 306 | fh->ov.win.w.width,fh->ov.win.w.height, | 
|  | 307 | fh->ov.win.w.left,fh->ov.win.w.top, | 
|  | 308 | vv->ov_fmt->name,v4l2_field_names[fh->ov.win.field])); | 
|  | 309 |  | 
|  | 310 | if (0 != (ret = saa7146_enable_overlay(fh))) { | 
|  | 311 | DEB_D(("enabling overlay failed: %d\n",ret)); | 
|  | 312 | saa7146_res_free(vv->video_fh, RESOURCE_DMA1_HPS|RESOURCE_DMA2_CLP); | 
|  | 313 | return ret; | 
|  | 314 | } | 
|  | 315 |  | 
|  | 316 | vv->video_status = STATUS_OVERLAY; | 
|  | 317 | vv->video_fh = fh; | 
|  | 318 |  | 
|  | 319 | return 0; | 
|  | 320 | } | 
| Adrian Bunk | 5d7dc8c | 2006-04-11 10:26:57 -0300 | [diff] [blame] | 321 | EXPORT_SYMBOL_GPL(saa7146_start_preview); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 322 |  | 
|  | 323 | int saa7146_stop_preview(struct saa7146_fh *fh) | 
|  | 324 | { | 
|  | 325 | struct saa7146_dev *dev = fh->dev; | 
|  | 326 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 327 |  | 
|  | 328 | DEB_EE(("dev:%p, fh:%p\n",dev,fh)); | 
|  | 329 |  | 
|  | 330 | /* check if streaming capture is running */ | 
|  | 331 | if (IS_CAPTURE_ACTIVE(fh) != 0) { | 
|  | 332 | DEB_D(("streaming capture is active.\n")); | 
|  | 333 | return -EBUSY; | 
|  | 334 | } | 
|  | 335 |  | 
|  | 336 | /* check if overlay is running at all */ | 
|  | 337 | if ((vv->video_status & STATUS_OVERLAY) == 0) { | 
|  | 338 | DEB_D(("no active overlay.\n")); | 
|  | 339 | return 0; | 
|  | 340 | } | 
|  | 341 |  | 
|  | 342 | if (vv->video_fh != fh) { | 
|  | 343 | DEB_D(("overlay is active, but in another open.\n")); | 
|  | 344 | return -EBUSY; | 
|  | 345 | } | 
|  | 346 |  | 
|  | 347 | vv->video_status = 0; | 
|  | 348 | vv->video_fh = NULL; | 
|  | 349 |  | 
|  | 350 | saa7146_disable_overlay(fh); | 
|  | 351 |  | 
|  | 352 | saa7146_res_free(fh, RESOURCE_DMA1_HPS|RESOURCE_DMA2_CLP); | 
|  | 353 |  | 
|  | 354 | return 0; | 
|  | 355 | } | 
| Adrian Bunk | 5d7dc8c | 2006-04-11 10:26:57 -0300 | [diff] [blame] | 356 | EXPORT_SYMBOL_GPL(saa7146_stop_preview); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 357 |  | 
|  | 358 | static int s_fmt(struct saa7146_fh *fh, struct v4l2_format *f) | 
|  | 359 | { | 
|  | 360 | struct saa7146_dev *dev = fh->dev; | 
|  | 361 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 362 |  | 
|  | 363 | int err; | 
|  | 364 |  | 
|  | 365 | switch (f->type) { | 
|  | 366 | case V4L2_BUF_TYPE_VIDEO_CAPTURE: | 
|  | 367 | DEB_EE(("V4L2_BUF_TYPE_VIDEO_CAPTURE: dev:%p, fh:%p\n",dev,fh)); | 
|  | 368 | if (IS_CAPTURE_ACTIVE(fh) != 0) { | 
|  | 369 | DEB_EE(("streaming capture is active\n")); | 
|  | 370 | return -EBUSY; | 
|  | 371 | } | 
|  | 372 | err = try_fmt(fh,f); | 
|  | 373 | if (0 != err) | 
|  | 374 | return err; | 
|  | 375 | fh->video_fmt = f->fmt.pix; | 
|  | 376 | DEB_EE(("set to pixelformat '%4.4s'\n",(char *)&fh->video_fmt.pixelformat)); | 
|  | 377 | return 0; | 
|  | 378 | case V4L2_BUF_TYPE_VIDEO_OVERLAY: | 
|  | 379 | DEB_EE(("V4L2_BUF_TYPE_VIDEO_OVERLAY: dev:%p, fh:%p\n",dev,fh)); | 
|  | 380 | err = try_win(dev,&f->fmt.win); | 
|  | 381 | if (0 != err) | 
|  | 382 | return err; | 
| Ingo Molnar | 3593cab | 2006-02-07 06:49:14 -0200 | [diff] [blame] | 383 | mutex_lock(&dev->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 384 | fh->ov.win    = f->fmt.win; | 
|  | 385 | fh->ov.nclips = f->fmt.win.clipcount; | 
|  | 386 | if (fh->ov.nclips > 16) | 
|  | 387 | fh->ov.nclips = 16; | 
|  | 388 | if (copy_from_user(fh->ov.clips,f->fmt.win.clips,sizeof(struct v4l2_clip)*fh->ov.nclips)) { | 
| Ingo Molnar | 3593cab | 2006-02-07 06:49:14 -0200 | [diff] [blame] | 389 | mutex_unlock(&dev->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 390 | return -EFAULT; | 
|  | 391 | } | 
|  | 392 |  | 
|  | 393 | /* fh->ov.fh is used to indicate that we have valid overlay informations, too */ | 
|  | 394 | fh->ov.fh = fh; | 
|  | 395 |  | 
| Ingo Molnar | 3593cab | 2006-02-07 06:49:14 -0200 | [diff] [blame] | 396 | mutex_unlock(&dev->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 397 |  | 
|  | 398 | /* check if our current overlay is active */ | 
|  | 399 | if (IS_OVERLAY_ACTIVE(fh) != 0) { | 
|  | 400 | saa7146_stop_preview(fh); | 
|  | 401 | saa7146_start_preview(fh); | 
|  | 402 | } | 
|  | 403 | return 0; | 
|  | 404 | default: | 
|  | 405 | DEB_D(("unknown format type '%d'\n",f->type)); | 
|  | 406 | return -EINVAL; | 
|  | 407 | } | 
|  | 408 | } | 
|  | 409 |  | 
|  | 410 | /********************************************************************************/ | 
|  | 411 | /* device controls */ | 
|  | 412 |  | 
|  | 413 | static struct v4l2_queryctrl controls[] = { | 
|  | 414 | { | 
|  | 415 | .id		= V4L2_CID_BRIGHTNESS, | 
|  | 416 | .name		= "Brightness", | 
|  | 417 | .minimum	= 0, | 
|  | 418 | .maximum	= 255, | 
|  | 419 | .step		= 1, | 
|  | 420 | .default_value	= 128, | 
|  | 421 | .type		= V4L2_CTRL_TYPE_INTEGER, | 
|  | 422 | },{ | 
|  | 423 | .id		= V4L2_CID_CONTRAST, | 
|  | 424 | .name		= "Contrast", | 
|  | 425 | .minimum	= 0, | 
|  | 426 | .maximum	= 127, | 
|  | 427 | .step		= 1, | 
|  | 428 | .default_value	= 64, | 
|  | 429 | .type		= V4L2_CTRL_TYPE_INTEGER, | 
|  | 430 | },{ | 
|  | 431 | .id		= V4L2_CID_SATURATION, | 
|  | 432 | .name		= "Saturation", | 
|  | 433 | .minimum	= 0, | 
|  | 434 | .maximum	= 127, | 
|  | 435 | .step		= 1, | 
|  | 436 | .default_value	= 64, | 
|  | 437 | .type		= V4L2_CTRL_TYPE_INTEGER, | 
|  | 438 | },{ | 
|  | 439 | .id		= V4L2_CID_VFLIP, | 
|  | 440 | .name		= "Vertical flip", | 
|  | 441 | .minimum	= 0, | 
|  | 442 | .maximum	= 1, | 
|  | 443 | .type		= V4L2_CTRL_TYPE_BOOLEAN, | 
|  | 444 | },{ | 
|  | 445 | .id		= V4L2_CID_HFLIP, | 
|  | 446 | .name		= "Horizontal flip", | 
|  | 447 | .minimum	= 0, | 
|  | 448 | .maximum	= 1, | 
|  | 449 | .type		= V4L2_CTRL_TYPE_BOOLEAN, | 
|  | 450 | }, | 
|  | 451 | }; | 
|  | 452 | static int NUM_CONTROLS = sizeof(controls)/sizeof(struct v4l2_queryctrl); | 
|  | 453 |  | 
|  | 454 | #define V4L2_CID_PRIVATE_LASTP1      (V4L2_CID_PRIVATE_BASE + 0) | 
|  | 455 |  | 
|  | 456 | static struct v4l2_queryctrl* ctrl_by_id(int id) | 
|  | 457 | { | 
|  | 458 | int i; | 
|  | 459 |  | 
|  | 460 | for (i = 0; i < NUM_CONTROLS; i++) | 
|  | 461 | if (controls[i].id == id) | 
|  | 462 | return controls+i; | 
|  | 463 | return NULL; | 
|  | 464 | } | 
|  | 465 |  | 
|  | 466 | static int get_control(struct saa7146_fh *fh, struct v4l2_control *c) | 
|  | 467 | { | 
|  | 468 | struct saa7146_dev *dev = fh->dev; | 
|  | 469 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 470 |  | 
|  | 471 | const struct v4l2_queryctrl* ctrl; | 
|  | 472 | u32 value = 0; | 
|  | 473 |  | 
|  | 474 | ctrl = ctrl_by_id(c->id); | 
|  | 475 | if (NULL == ctrl) | 
|  | 476 | return -EINVAL; | 
|  | 477 | switch (c->id) { | 
|  | 478 | case V4L2_CID_BRIGHTNESS: | 
|  | 479 | value = saa7146_read(dev, BCS_CTRL); | 
|  | 480 | c->value = 0xff & (value >> 24); | 
|  | 481 | DEB_D(("V4L2_CID_BRIGHTNESS: %d\n",c->value)); | 
|  | 482 | break; | 
|  | 483 | case V4L2_CID_CONTRAST: | 
|  | 484 | value = saa7146_read(dev, BCS_CTRL); | 
|  | 485 | c->value = 0x7f & (value >> 16); | 
|  | 486 | DEB_D(("V4L2_CID_CONTRAST: %d\n",c->value)); | 
|  | 487 | break; | 
|  | 488 | case V4L2_CID_SATURATION: | 
|  | 489 | value = saa7146_read(dev, BCS_CTRL); | 
|  | 490 | c->value = 0x7f & (value >> 0); | 
|  | 491 | DEB_D(("V4L2_CID_SATURATION: %d\n",c->value)); | 
|  | 492 | break; | 
|  | 493 | case V4L2_CID_VFLIP: | 
|  | 494 | c->value = vv->vflip; | 
|  | 495 | DEB_D(("V4L2_CID_VFLIP: %d\n",c->value)); | 
|  | 496 | break; | 
|  | 497 | case V4L2_CID_HFLIP: | 
|  | 498 | c->value = vv->hflip; | 
|  | 499 | DEB_D(("V4L2_CID_HFLIP: %d\n",c->value)); | 
|  | 500 | break; | 
|  | 501 | default: | 
|  | 502 | return -EINVAL; | 
|  | 503 | } | 
|  | 504 |  | 
|  | 505 | return 0; | 
|  | 506 | } | 
|  | 507 |  | 
|  | 508 | static int set_control(struct saa7146_fh *fh, struct v4l2_control *c) | 
|  | 509 | { | 
|  | 510 | struct saa7146_dev *dev = fh->dev; | 
|  | 511 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 512 |  | 
|  | 513 | const struct v4l2_queryctrl* ctrl; | 
|  | 514 |  | 
|  | 515 | ctrl = ctrl_by_id(c->id); | 
|  | 516 | if (NULL == ctrl) { | 
|  | 517 | DEB_D(("unknown control %d\n",c->id)); | 
|  | 518 | return -EINVAL; | 
|  | 519 | } | 
|  | 520 |  | 
| Ingo Molnar | 3593cab | 2006-02-07 06:49:14 -0200 | [diff] [blame] | 521 | mutex_lock(&dev->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 522 |  | 
|  | 523 | switch (ctrl->type) { | 
|  | 524 | case V4L2_CTRL_TYPE_BOOLEAN: | 
|  | 525 | case V4L2_CTRL_TYPE_MENU: | 
|  | 526 | case V4L2_CTRL_TYPE_INTEGER: | 
|  | 527 | if (c->value < ctrl->minimum) | 
|  | 528 | c->value = ctrl->minimum; | 
|  | 529 | if (c->value > ctrl->maximum) | 
|  | 530 | c->value = ctrl->maximum; | 
|  | 531 | break; | 
|  | 532 | default: | 
|  | 533 | /* nothing */; | 
|  | 534 | }; | 
|  | 535 |  | 
|  | 536 | switch (c->id) { | 
|  | 537 | case V4L2_CID_BRIGHTNESS: { | 
|  | 538 | u32 value = saa7146_read(dev, BCS_CTRL); | 
|  | 539 | value &= 0x00ffffff; | 
|  | 540 | value |= (c->value << 24); | 
|  | 541 | saa7146_write(dev, BCS_CTRL, value); | 
|  | 542 | saa7146_write(dev, MC2, MASK_22 | MASK_06 ); | 
|  | 543 | break; | 
|  | 544 | } | 
|  | 545 | case V4L2_CID_CONTRAST: { | 
|  | 546 | u32 value = saa7146_read(dev, BCS_CTRL); | 
|  | 547 | value &= 0xff00ffff; | 
|  | 548 | value |= (c->value << 16); | 
|  | 549 | saa7146_write(dev, BCS_CTRL, value); | 
|  | 550 | saa7146_write(dev, MC2, MASK_22 | MASK_06 ); | 
|  | 551 | break; | 
|  | 552 | } | 
|  | 553 | case V4L2_CID_SATURATION: { | 
|  | 554 | u32 value = saa7146_read(dev, BCS_CTRL); | 
|  | 555 | value &= 0xffffff00; | 
|  | 556 | value |= (c->value << 0); | 
|  | 557 | saa7146_write(dev, BCS_CTRL, value); | 
|  | 558 | saa7146_write(dev, MC2, MASK_22 | MASK_06 ); | 
|  | 559 | break; | 
|  | 560 | } | 
|  | 561 | case V4L2_CID_HFLIP: | 
|  | 562 | /* fixme: we can support changing VFLIP and HFLIP here... */ | 
|  | 563 | if (IS_CAPTURE_ACTIVE(fh) != 0) { | 
|  | 564 | DEB_D(("V4L2_CID_HFLIP while active capture.\n")); | 
| Ingo Molnar | 3593cab | 2006-02-07 06:49:14 -0200 | [diff] [blame] | 565 | mutex_unlock(&dev->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 566 | return -EINVAL; | 
|  | 567 | } | 
|  | 568 | vv->hflip = c->value; | 
|  | 569 | break; | 
|  | 570 | case V4L2_CID_VFLIP: | 
|  | 571 | if (IS_CAPTURE_ACTIVE(fh) != 0) { | 
|  | 572 | DEB_D(("V4L2_CID_VFLIP while active capture.\n")); | 
| Ingo Molnar | 3593cab | 2006-02-07 06:49:14 -0200 | [diff] [blame] | 573 | mutex_unlock(&dev->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 574 | return -EINVAL; | 
|  | 575 | } | 
|  | 576 | vv->vflip = c->value; | 
|  | 577 | break; | 
|  | 578 | default: { | 
|  | 579 | return -EINVAL; | 
|  | 580 | } | 
|  | 581 | } | 
| Ingo Molnar | 3593cab | 2006-02-07 06:49:14 -0200 | [diff] [blame] | 582 | mutex_unlock(&dev->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 583 |  | 
|  | 584 | if (IS_OVERLAY_ACTIVE(fh) != 0) { | 
|  | 585 | saa7146_stop_preview(fh); | 
|  | 586 | saa7146_start_preview(fh); | 
|  | 587 | } | 
|  | 588 | return 0; | 
|  | 589 | } | 
|  | 590 |  | 
|  | 591 | /********************************************************************************/ | 
|  | 592 | /* common pagetable functions */ | 
|  | 593 |  | 
|  | 594 | static int saa7146_pgtable_build(struct saa7146_dev *dev, struct saa7146_buf *buf) | 
|  | 595 | { | 
|  | 596 | struct pci_dev *pci = dev->pci; | 
| Mauro Carvalho Chehab | c1accaa | 2007-08-23 16:37:49 -0300 | [diff] [blame] | 597 | struct videobuf_dmabuf *dma=videobuf_to_dma(&buf->vb); | 
|  | 598 | struct scatterlist *list = dma->sglist; | 
|  | 599 | int length = dma->sglen; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 600 | struct saa7146_format *sfmt = format_by_fourcc(dev,buf->fmt->pixelformat); | 
|  | 601 |  | 
|  | 602 | DEB_EE(("dev:%p, buf:%p, sg_len:%d\n",dev,buf,length)); | 
|  | 603 |  | 
|  | 604 | if( 0 != IS_PLANAR(sfmt->trans)) { | 
|  | 605 | struct saa7146_pgtable *pt1 = &buf->pt[0]; | 
|  | 606 | struct saa7146_pgtable *pt2 = &buf->pt[1]; | 
|  | 607 | struct saa7146_pgtable *pt3 = &buf->pt[2]; | 
| Al Viro | a36ef6b | 2008-06-22 14:19:19 -0300 | [diff] [blame] | 608 | __le32  *ptr1, *ptr2, *ptr3; | 
|  | 609 | __le32 fill; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 610 |  | 
|  | 611 | int size = buf->fmt->width*buf->fmt->height; | 
|  | 612 | int i,p,m1,m2,m3,o1,o2; | 
|  | 613 |  | 
|  | 614 | switch( sfmt->depth ) { | 
|  | 615 | case 12: { | 
|  | 616 | /* create some offsets inside the page table */ | 
|  | 617 | m1 = ((size+PAGE_SIZE)/PAGE_SIZE)-1; | 
|  | 618 | m2 = ((size+(size/4)+PAGE_SIZE)/PAGE_SIZE)-1; | 
|  | 619 | m3 = ((size+(size/2)+PAGE_SIZE)/PAGE_SIZE)-1; | 
|  | 620 | o1 = size%PAGE_SIZE; | 
|  | 621 | o2 = (size+(size/4))%PAGE_SIZE; | 
|  | 622 | DEB_CAP(("size:%d, m1:%d, m2:%d, m3:%d, o1:%d, o2:%d\n",size,m1,m2,m3,o1,o2)); | 
|  | 623 | break; | 
|  | 624 | } | 
|  | 625 | case 16: { | 
|  | 626 | /* create some offsets inside the page table */ | 
|  | 627 | m1 = ((size+PAGE_SIZE)/PAGE_SIZE)-1; | 
|  | 628 | m2 = ((size+(size/2)+PAGE_SIZE)/PAGE_SIZE)-1; | 
|  | 629 | m3 = ((2*size+PAGE_SIZE)/PAGE_SIZE)-1; | 
|  | 630 | o1 = size%PAGE_SIZE; | 
|  | 631 | o2 = (size+(size/2))%PAGE_SIZE; | 
|  | 632 | DEB_CAP(("size:%d, m1:%d, m2:%d, m3:%d, o1:%d, o2:%d\n",size,m1,m2,m3,o1,o2)); | 
|  | 633 | break; | 
|  | 634 | } | 
|  | 635 | default: { | 
|  | 636 | return -1; | 
|  | 637 | } | 
|  | 638 | } | 
|  | 639 |  | 
|  | 640 | ptr1 = pt1->cpu; | 
|  | 641 | ptr2 = pt2->cpu; | 
|  | 642 | ptr3 = pt3->cpu; | 
|  | 643 |  | 
|  | 644 | /* walk all pages, copy all page addresses to ptr1 */ | 
|  | 645 | for (i = 0; i < length; i++, list++) { | 
|  | 646 | for (p = 0; p * 4096 < list->length; p++, ptr1++) { | 
|  | 647 | *ptr1 = cpu_to_le32(sg_dma_address(list) - list->offset); | 
|  | 648 | } | 
|  | 649 | } | 
|  | 650 | /* | 
|  | 651 | ptr1 = pt1->cpu; | 
|  | 652 | for(j=0;j<40;j++) { | 
|  | 653 | printk("ptr1 %d: 0x%08x\n",j,ptr1[j]); | 
|  | 654 | } | 
|  | 655 | */ | 
|  | 656 |  | 
|  | 657 | /* if we have a user buffer, the first page may not be | 
|  | 658 | aligned to a page boundary. */ | 
| Hans Verkuil | 429e908 | 2008-07-27 14:08:54 -0300 | [diff] [blame] | 659 | pt1->offset = dma->sglist->offset; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 660 | pt2->offset = pt1->offset+o1; | 
|  | 661 | pt3->offset = pt1->offset+o2; | 
|  | 662 |  | 
|  | 663 | /* create video-dma2 page table */ | 
|  | 664 | ptr1 = pt1->cpu; | 
|  | 665 | for(i = m1; i <= m2 ; i++, ptr2++) { | 
|  | 666 | *ptr2 = ptr1[i]; | 
|  | 667 | } | 
|  | 668 | fill = *(ptr2-1); | 
|  | 669 | for(;i<1024;i++,ptr2++) { | 
|  | 670 | *ptr2 = fill; | 
|  | 671 | } | 
|  | 672 | /* create video-dma3 page table */ | 
|  | 673 | ptr1 = pt1->cpu; | 
|  | 674 | for(i = m2; i <= m3; i++,ptr3++) { | 
|  | 675 | *ptr3 = ptr1[i]; | 
|  | 676 | } | 
|  | 677 | fill = *(ptr3-1); | 
|  | 678 | for(;i<1024;i++,ptr3++) { | 
|  | 679 | *ptr3 = fill; | 
|  | 680 | } | 
|  | 681 | /* finally: finish up video-dma1 page table */ | 
|  | 682 | ptr1 = pt1->cpu+m1; | 
|  | 683 | fill = pt1->cpu[m1]; | 
|  | 684 | for(i=m1;i<1024;i++,ptr1++) { | 
|  | 685 | *ptr1 = fill; | 
|  | 686 | } | 
|  | 687 | /* | 
|  | 688 | ptr1 = pt1->cpu; | 
|  | 689 | ptr2 = pt2->cpu; | 
|  | 690 | ptr3 = pt3->cpu; | 
|  | 691 | for(j=0;j<40;j++) { | 
|  | 692 | printk("ptr1 %d: 0x%08x\n",j,ptr1[j]); | 
|  | 693 | } | 
|  | 694 | for(j=0;j<40;j++) { | 
|  | 695 | printk("ptr2 %d: 0x%08x\n",j,ptr2[j]); | 
|  | 696 | } | 
|  | 697 | for(j=0;j<40;j++) { | 
|  | 698 | printk("ptr3 %d: 0x%08x\n",j,ptr3[j]); | 
|  | 699 | } | 
|  | 700 | */ | 
|  | 701 | } else { | 
|  | 702 | struct saa7146_pgtable *pt = &buf->pt[0]; | 
|  | 703 | return saa7146_pgtable_build_single(pci, pt, list, length); | 
|  | 704 | } | 
|  | 705 |  | 
|  | 706 | return 0; | 
|  | 707 | } | 
|  | 708 |  | 
|  | 709 |  | 
|  | 710 | /********************************************************************************/ | 
|  | 711 | /* file operations */ | 
|  | 712 |  | 
|  | 713 | static int video_begin(struct saa7146_fh *fh) | 
|  | 714 | { | 
|  | 715 | struct saa7146_dev *dev = fh->dev; | 
|  | 716 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 717 | struct saa7146_format *fmt = NULL; | 
|  | 718 | unsigned int resource; | 
|  | 719 | int ret = 0, err = 0; | 
|  | 720 |  | 
|  | 721 | DEB_EE(("dev:%p, fh:%p\n",dev,fh)); | 
|  | 722 |  | 
|  | 723 | if ((vv->video_status & STATUS_CAPTURE) != 0) { | 
|  | 724 | if (vv->video_fh == fh) { | 
|  | 725 | DEB_S(("already capturing.\n")); | 
|  | 726 | return 0; | 
|  | 727 | } | 
|  | 728 | DEB_S(("already capturing in another open.\n")); | 
|  | 729 | return -EBUSY; | 
|  | 730 | } | 
|  | 731 |  | 
|  | 732 | if ((vv->video_status & STATUS_OVERLAY) != 0) { | 
|  | 733 | DEB_S(("warning: suspending overlay video for streaming capture.\n")); | 
|  | 734 | vv->ov_suspend = vv->video_fh; | 
|  | 735 | err = saa7146_stop_preview(vv->video_fh); /* side effect: video_status is now 0, video_fh is NULL */ | 
|  | 736 | if (0 != err) { | 
|  | 737 | DEB_D(("suspending video failed. aborting\n")); | 
|  | 738 | return err; | 
|  | 739 | } | 
|  | 740 | } | 
|  | 741 |  | 
|  | 742 | fmt = format_by_fourcc(dev,fh->video_fmt.pixelformat); | 
|  | 743 | /* we need to have a valid format set here */ | 
|  | 744 | BUG_ON(NULL == fmt); | 
|  | 745 |  | 
|  | 746 | if (0 != (fmt->flags & FORMAT_IS_PLANAR)) { | 
|  | 747 | resource = RESOURCE_DMA1_HPS|RESOURCE_DMA2_CLP|RESOURCE_DMA3_BRS; | 
|  | 748 | } else { | 
|  | 749 | resource = RESOURCE_DMA1_HPS; | 
|  | 750 | } | 
|  | 751 |  | 
|  | 752 | ret = saa7146_res_get(fh, resource); | 
|  | 753 | if (0 == ret) { | 
|  | 754 | DEB_S(("cannot get capture resource %d\n",resource)); | 
|  | 755 | if (vv->ov_suspend != NULL) { | 
|  | 756 | saa7146_start_preview(vv->ov_suspend); | 
|  | 757 | vv->ov_suspend = NULL; | 
|  | 758 | } | 
|  | 759 | return -EBUSY; | 
|  | 760 | } | 
|  | 761 |  | 
|  | 762 | /* clear out beginning of streaming bit (rps register 0)*/ | 
|  | 763 | saa7146_write(dev, MC2, MASK_27 ); | 
|  | 764 |  | 
|  | 765 | /* enable rps0 irqs */ | 
|  | 766 | SAA7146_IER_ENABLE(dev, MASK_27); | 
|  | 767 |  | 
|  | 768 | vv->video_fh = fh; | 
|  | 769 | vv->video_status = STATUS_CAPTURE; | 
|  | 770 |  | 
|  | 771 | return 0; | 
|  | 772 | } | 
|  | 773 |  | 
|  | 774 | static int video_end(struct saa7146_fh *fh, struct file *file) | 
|  | 775 | { | 
|  | 776 | struct saa7146_dev *dev = fh->dev; | 
|  | 777 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 778 | struct saa7146_format *fmt = NULL; | 
|  | 779 | unsigned long flags; | 
|  | 780 | unsigned int resource; | 
|  | 781 | u32 dmas = 0; | 
|  | 782 | DEB_EE(("dev:%p, fh:%p\n",dev,fh)); | 
|  | 783 |  | 
|  | 784 | if ((vv->video_status & STATUS_CAPTURE) != STATUS_CAPTURE) { | 
|  | 785 | DEB_S(("not capturing.\n")); | 
|  | 786 | return 0; | 
|  | 787 | } | 
|  | 788 |  | 
|  | 789 | if (vv->video_fh != fh) { | 
|  | 790 | DEB_S(("capturing, but in another open.\n")); | 
|  | 791 | return -EBUSY; | 
|  | 792 | } | 
|  | 793 |  | 
|  | 794 | fmt = format_by_fourcc(dev,fh->video_fmt.pixelformat); | 
|  | 795 | /* we need to have a valid format set here */ | 
|  | 796 | BUG_ON(NULL == fmt); | 
|  | 797 |  | 
|  | 798 | if (0 != (fmt->flags & FORMAT_IS_PLANAR)) { | 
|  | 799 | resource = RESOURCE_DMA1_HPS|RESOURCE_DMA2_CLP|RESOURCE_DMA3_BRS; | 
|  | 800 | dmas = MASK_22 | MASK_21 | MASK_20; | 
|  | 801 | } else { | 
|  | 802 | resource = RESOURCE_DMA1_HPS; | 
|  | 803 | dmas = MASK_22; | 
|  | 804 | } | 
|  | 805 | spin_lock_irqsave(&dev->slock,flags); | 
|  | 806 |  | 
|  | 807 | /* disable rps0  */ | 
|  | 808 | saa7146_write(dev, MC1, MASK_28); | 
|  | 809 |  | 
|  | 810 | /* disable rps0 irqs */ | 
|  | 811 | SAA7146_IER_DISABLE(dev, MASK_27); | 
|  | 812 |  | 
|  | 813 | /* shut down all used video dma transfers */ | 
|  | 814 | saa7146_write(dev, MC1, dmas); | 
|  | 815 |  | 
|  | 816 | spin_unlock_irqrestore(&dev->slock, flags); | 
|  | 817 |  | 
|  | 818 | vv->video_fh = NULL; | 
|  | 819 | vv->video_status = 0; | 
|  | 820 |  | 
|  | 821 | saa7146_res_free(fh, resource); | 
|  | 822 |  | 
|  | 823 | if (vv->ov_suspend != NULL) { | 
|  | 824 | saa7146_start_preview(vv->ov_suspend); | 
|  | 825 | vv->ov_suspend = NULL; | 
|  | 826 | } | 
|  | 827 |  | 
|  | 828 | return 0; | 
|  | 829 | } | 
|  | 830 |  | 
|  | 831 | /* | 
|  | 832 | * This function is _not_ called directly, but from | 
|  | 833 | * video_generic_ioctl (and maybe others).  userspace | 
|  | 834 | * copying is done already, arg is a kernel pointer. | 
|  | 835 | */ | 
|  | 836 |  | 
| Hans Verkuil | 069b747 | 2008-12-30 07:04:34 -0300 | [diff] [blame] | 837 | long saa7146_video_do_ioctl(struct file *file, unsigned int cmd, void *arg) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 838 | { | 
|  | 839 | struct saa7146_fh *fh  = file->private_data; | 
|  | 840 | struct saa7146_dev *dev = fh->dev; | 
|  | 841 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 842 |  | 
| Hans Verkuil | 069b747 | 2008-12-30 07:04:34 -0300 | [diff] [blame] | 843 | long err = 0; | 
|  | 844 | int result = 0, ee = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 845 |  | 
|  | 846 | struct saa7146_use_ops *ops; | 
|  | 847 | struct videobuf_queue *q; | 
|  | 848 |  | 
|  | 849 | /* check if extension handles the command */ | 
|  | 850 | for(ee = 0; dev->ext_vv_data->ioctls[ee].flags != 0; ee++) { | 
|  | 851 | if( cmd == dev->ext_vv_data->ioctls[ee].cmd ) | 
|  | 852 | break; | 
|  | 853 | } | 
|  | 854 |  | 
|  | 855 | if( 0 != (dev->ext_vv_data->ioctls[ee].flags & SAA7146_EXCLUSIVE) ) { | 
|  | 856 | DEB_D(("extension handles ioctl exclusive.\n")); | 
|  | 857 | result = dev->ext_vv_data->ioctl(fh, cmd, arg); | 
|  | 858 | return result; | 
|  | 859 | } | 
|  | 860 | if( 0 != (dev->ext_vv_data->ioctls[ee].flags & SAA7146_BEFORE) ) { | 
|  | 861 | DEB_D(("extension handles ioctl before.\n")); | 
|  | 862 | result = dev->ext_vv_data->ioctl(fh, cmd, arg); | 
|  | 863 | if( -EAGAIN != result ) { | 
|  | 864 | return result; | 
|  | 865 | } | 
|  | 866 | } | 
|  | 867 |  | 
|  | 868 | /* fixme: add handle "after" case (is it still needed?) */ | 
|  | 869 |  | 
|  | 870 | switch (fh->type) { | 
|  | 871 | case V4L2_BUF_TYPE_VIDEO_CAPTURE: { | 
|  | 872 | ops = &saa7146_video_uops; | 
|  | 873 | q = &fh->video_q; | 
|  | 874 | break; | 
|  | 875 | } | 
|  | 876 | case V4L2_BUF_TYPE_VBI_CAPTURE: { | 
|  | 877 | ops = &saa7146_vbi_uops; | 
|  | 878 | q = &fh->vbi_q; | 
|  | 879 | break; | 
|  | 880 | } | 
|  | 881 | default: | 
|  | 882 | BUG(); | 
|  | 883 | return 0; | 
|  | 884 | } | 
|  | 885 |  | 
|  | 886 | switch (cmd) { | 
|  | 887 | case VIDIOC_QUERYCAP: | 
|  | 888 | { | 
|  | 889 | struct v4l2_capability *cap = arg; | 
|  | 890 | memset(cap,0,sizeof(*cap)); | 
|  | 891 |  | 
|  | 892 | DEB_EE(("VIDIOC_QUERYCAP\n")); | 
|  | 893 |  | 
| Oliver Endriss | 804b445 | 2007-07-12 20:37:50 -0300 | [diff] [blame] | 894 | strcpy((char *)cap->driver, "saa7146 v4l2"); | 
|  | 895 | strlcpy((char *)cap->card, dev->ext->name, sizeof(cap->card)); | 
|  | 896 | sprintf((char *)cap->bus_info,"PCI:%s", pci_name(dev->pci)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 897 | cap->version = SAA7146_VERSION_CODE; | 
|  | 898 | cap->capabilities = | 
|  | 899 | V4L2_CAP_VIDEO_CAPTURE | | 
|  | 900 | V4L2_CAP_VIDEO_OVERLAY | | 
|  | 901 | V4L2_CAP_READWRITE | | 
|  | 902 | V4L2_CAP_STREAMING; | 
|  | 903 | cap->capabilities |= dev->ext_vv_data->capabilities; | 
|  | 904 | return 0; | 
|  | 905 | } | 
|  | 906 | case VIDIOC_G_FBUF: | 
|  | 907 | { | 
|  | 908 | struct v4l2_framebuffer *fb = arg; | 
|  | 909 |  | 
|  | 910 | DEB_EE(("VIDIOC_G_FBUF\n")); | 
|  | 911 |  | 
|  | 912 | *fb = vv->ov_fb; | 
|  | 913 | fb->capability = V4L2_FBUF_CAP_LIST_CLIPPING; | 
|  | 914 | return 0; | 
|  | 915 | } | 
|  | 916 | case VIDIOC_S_FBUF: | 
|  | 917 | { | 
|  | 918 | struct v4l2_framebuffer *fb = arg; | 
|  | 919 | struct saa7146_format *fmt; | 
|  | 920 |  | 
|  | 921 | DEB_EE(("VIDIOC_S_FBUF\n")); | 
|  | 922 |  | 
|  | 923 | if(!capable(CAP_SYS_ADMIN) && | 
|  | 924 | !capable(CAP_SYS_RAWIO)) | 
|  | 925 | return -EPERM; | 
|  | 926 |  | 
|  | 927 | /* check args */ | 
|  | 928 | fmt = format_by_fourcc(dev,fb->fmt.pixelformat); | 
|  | 929 | if (NULL == fmt) { | 
|  | 930 | return -EINVAL; | 
|  | 931 | } | 
|  | 932 |  | 
|  | 933 | /* planar formats are not allowed for overlay video, clipping and video dma would clash */ | 
|  | 934 | if (0 != (fmt->flags & FORMAT_IS_PLANAR)) { | 
|  | 935 | DEB_S(("planar pixelformat '%4.4s' not allowed for overlay\n",(char *)&fmt->pixelformat)); | 
|  | 936 | } | 
|  | 937 |  | 
|  | 938 | /* check if overlay is running */ | 
|  | 939 | if (IS_OVERLAY_ACTIVE(fh) != 0) { | 
|  | 940 | if (vv->video_fh != fh) { | 
|  | 941 | DEB_D(("refusing to change framebuffer informations while overlay is active in another open.\n")); | 
|  | 942 | return -EBUSY; | 
|  | 943 | } | 
|  | 944 | } | 
|  | 945 |  | 
| Ingo Molnar | 3593cab | 2006-02-07 06:49:14 -0200 | [diff] [blame] | 946 | mutex_lock(&dev->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 947 |  | 
|  | 948 | /* ok, accept it */ | 
|  | 949 | vv->ov_fb = *fb; | 
|  | 950 | vv->ov_fmt = fmt; | 
|  | 951 | if (0 == vv->ov_fb.fmt.bytesperline) | 
|  | 952 | vv->ov_fb.fmt.bytesperline = | 
|  | 953 | vv->ov_fb.fmt.width*fmt->depth/8; | 
|  | 954 |  | 
| Ingo Molnar | 3593cab | 2006-02-07 06:49:14 -0200 | [diff] [blame] | 955 | mutex_unlock(&dev->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 956 |  | 
|  | 957 | return 0; | 
|  | 958 | } | 
|  | 959 | case VIDIOC_ENUM_FMT: | 
|  | 960 | { | 
|  | 961 | struct v4l2_fmtdesc *f = arg; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 962 |  | 
|  | 963 | switch (f->type) { | 
|  | 964 | case V4L2_BUF_TYPE_VIDEO_CAPTURE: | 
| Hans Verkuil | f796804 | 2008-07-26 09:16:29 -0300 | [diff] [blame] | 965 | case V4L2_BUF_TYPE_VIDEO_OVERLAY: | 
|  | 966 | if (f->index >= NUM_FORMATS) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 967 | return -EINVAL; | 
| Hans Verkuil | f796804 | 2008-07-26 09:16:29 -0300 | [diff] [blame] | 968 | strlcpy((char *)f->description, formats[f->index].name, | 
|  | 969 | sizeof(f->description)); | 
|  | 970 | f->pixelformat = formats[f->index].pixelformat; | 
|  | 971 | f->flags = 0; | 
|  | 972 | memset(f->reserved, 0, sizeof(f->reserved)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 973 | break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 974 | default: | 
|  | 975 | return -EINVAL; | 
|  | 976 | } | 
|  | 977 |  | 
|  | 978 | DEB_EE(("VIDIOC_ENUM_FMT: type:%d, index:%d\n",f->type,f->index)); | 
|  | 979 | return 0; | 
|  | 980 | } | 
|  | 981 | case VIDIOC_QUERYCTRL: | 
|  | 982 | { | 
|  | 983 | const struct v4l2_queryctrl *ctrl; | 
|  | 984 | struct v4l2_queryctrl *c = arg; | 
|  | 985 |  | 
|  | 986 | if ((c->id <  V4L2_CID_BASE || | 
|  | 987 | c->id >= V4L2_CID_LASTP1) && | 
|  | 988 | (c->id <  V4L2_CID_PRIVATE_BASE || | 
|  | 989 | c->id >= V4L2_CID_PRIVATE_LASTP1)) | 
|  | 990 | return -EINVAL; | 
|  | 991 |  | 
|  | 992 | ctrl = ctrl_by_id(c->id); | 
|  | 993 | if( NULL == ctrl ) { | 
|  | 994 | return -EINVAL; | 
|  | 995 | /* | 
|  | 996 | c->flags = V4L2_CTRL_FLAG_DISABLED; | 
|  | 997 | return 0; | 
|  | 998 | */ | 
|  | 999 | } | 
|  | 1000 |  | 
|  | 1001 | DEB_EE(("VIDIOC_QUERYCTRL: id:%d\n",c->id)); | 
|  | 1002 | *c = *ctrl; | 
|  | 1003 | return 0; | 
|  | 1004 | } | 
|  | 1005 | case VIDIOC_G_CTRL: { | 
|  | 1006 | DEB_EE(("VIDIOC_G_CTRL\n")); | 
|  | 1007 | return get_control(fh,arg); | 
|  | 1008 | } | 
|  | 1009 | case VIDIOC_S_CTRL: | 
|  | 1010 | { | 
|  | 1011 | DEB_EE(("VIDIOC_S_CTRL\n")); | 
|  | 1012 | err = set_control(fh,arg); | 
|  | 1013 | return err; | 
|  | 1014 | } | 
| Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 1015 | case VIDIOC_G_PARM: | 
|  | 1016 | { | 
|  | 1017 | struct v4l2_streamparm *parm = arg; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1018 | if( parm->type != V4L2_BUF_TYPE_VIDEO_CAPTURE ) { | 
|  | 1019 | return -EINVAL; | 
|  | 1020 | } | 
| Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 1021 | memset(&parm->parm.capture,0,sizeof(struct v4l2_captureparm)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1022 | parm->parm.capture.readbuffers = 1; | 
|  | 1023 | // fixme: only for PAL! | 
|  | 1024 | parm->parm.capture.timeperframe.numerator = 1; | 
|  | 1025 | parm->parm.capture.timeperframe.denominator = 25; | 
| Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 1026 | return 0; | 
|  | 1027 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1028 | case VIDIOC_G_FMT: | 
|  | 1029 | { | 
|  | 1030 | struct v4l2_format *f = arg; | 
|  | 1031 | DEB_EE(("VIDIOC_G_FMT\n")); | 
|  | 1032 | return g_fmt(fh,f); | 
|  | 1033 | } | 
|  | 1034 | case VIDIOC_S_FMT: | 
|  | 1035 | { | 
|  | 1036 | struct v4l2_format *f = arg; | 
|  | 1037 | DEB_EE(("VIDIOC_S_FMT\n")); | 
|  | 1038 | return s_fmt(fh,f); | 
|  | 1039 | } | 
|  | 1040 | case VIDIOC_TRY_FMT: | 
|  | 1041 | { | 
|  | 1042 | struct v4l2_format *f = arg; | 
|  | 1043 | DEB_EE(("VIDIOC_TRY_FMT\n")); | 
|  | 1044 | return try_fmt(fh,f); | 
|  | 1045 | } | 
|  | 1046 | case VIDIOC_G_STD: | 
|  | 1047 | { | 
|  | 1048 | v4l2_std_id *id = arg; | 
|  | 1049 | DEB_EE(("VIDIOC_G_STD\n")); | 
|  | 1050 | *id = vv->standard->id; | 
|  | 1051 | return 0; | 
|  | 1052 | } | 
|  | 1053 | /* the saa7146 supfhrts (used in conjunction with the saa7111a for example) | 
|  | 1054 | PAL / NTSC / SECAM. if your hardware does not (or does more) | 
|  | 1055 | -- override this function in your extension */ | 
|  | 1056 | case VIDIOC_ENUMSTD: | 
|  | 1057 | { | 
|  | 1058 | struct v4l2_standard *e = arg; | 
|  | 1059 | if (e->index < 0 ) | 
|  | 1060 | return -EINVAL; | 
|  | 1061 | if( e->index < dev->ext_vv_data->num_stds ) { | 
|  | 1062 | DEB_EE(("VIDIOC_ENUMSTD: index:%d\n",e->index)); | 
|  | 1063 | v4l2_video_std_construct(e, dev->ext_vv_data->stds[e->index].id, dev->ext_vv_data->stds[e->index].name); | 
|  | 1064 | return 0; | 
|  | 1065 | } | 
|  | 1066 | return -EINVAL; | 
|  | 1067 | } | 
|  | 1068 | case VIDIOC_S_STD: | 
|  | 1069 | { | 
|  | 1070 | v4l2_std_id *id = arg; | 
|  | 1071 | int found = 0; | 
| Hans Verkuil | c6eb8ea | 2008-09-03 17:11:54 -0300 | [diff] [blame] | 1072 | int i; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1073 |  | 
|  | 1074 | DEB_EE(("VIDIOC_S_STD\n")); | 
|  | 1075 |  | 
|  | 1076 | if ((vv->video_status & STATUS_CAPTURE) == STATUS_CAPTURE) { | 
|  | 1077 | DEB_D(("cannot change video standard while streaming capture is active\n")); | 
|  | 1078 | return -EBUSY; | 
|  | 1079 | } | 
|  | 1080 |  | 
|  | 1081 | if ((vv->video_status & STATUS_OVERLAY) != 0) { | 
|  | 1082 | vv->ov_suspend = vv->video_fh; | 
|  | 1083 | err = saa7146_stop_preview(vv->video_fh); /* side effect: video_status is now 0, video_fh is NULL */ | 
|  | 1084 | if (0 != err) { | 
|  | 1085 | DEB_D(("suspending video failed. aborting\n")); | 
|  | 1086 | return err; | 
|  | 1087 | } | 
|  | 1088 | } | 
|  | 1089 |  | 
| Ingo Molnar | 3593cab | 2006-02-07 06:49:14 -0200 | [diff] [blame] | 1090 | mutex_lock(&dev->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1091 |  | 
|  | 1092 | for(i = 0; i < dev->ext_vv_data->num_stds; i++) | 
|  | 1093 | if (*id & dev->ext_vv_data->stds[i].id) | 
|  | 1094 | break; | 
|  | 1095 | if (i != dev->ext_vv_data->num_stds) { | 
|  | 1096 | vv->standard = &dev->ext_vv_data->stds[i]; | 
|  | 1097 | if( NULL != dev->ext_vv_data->std_callback ) | 
|  | 1098 | dev->ext_vv_data->std_callback(dev, vv->standard); | 
|  | 1099 | found = 1; | 
|  | 1100 | } | 
|  | 1101 |  | 
| Ingo Molnar | 3593cab | 2006-02-07 06:49:14 -0200 | [diff] [blame] | 1102 | mutex_unlock(&dev->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1103 |  | 
|  | 1104 | if (vv->ov_suspend != NULL) { | 
|  | 1105 | saa7146_start_preview(vv->ov_suspend); | 
|  | 1106 | vv->ov_suspend = NULL; | 
|  | 1107 | } | 
|  | 1108 |  | 
|  | 1109 | if( 0 == found ) { | 
|  | 1110 | DEB_EE(("VIDIOC_S_STD: standard not found.\n")); | 
|  | 1111 | return -EINVAL; | 
|  | 1112 | } | 
|  | 1113 |  | 
|  | 1114 | DEB_EE(("VIDIOC_S_STD: set to standard to '%s'\n",vv->standard->name)); | 
|  | 1115 | return 0; | 
|  | 1116 | } | 
|  | 1117 | case VIDIOC_OVERLAY: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1118 | { | 
|  | 1119 | int on = *(int *)arg; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1120 |  | 
|  | 1121 | DEB_D(("VIDIOC_OVERLAY on:%d\n",on)); | 
|  | 1122 | if (on != 0) { | 
|  | 1123 | err = saa7146_start_preview(fh); | 
|  | 1124 | } else { | 
|  | 1125 | err = saa7146_stop_preview(fh); | 
|  | 1126 | } | 
|  | 1127 | return err; | 
|  | 1128 | } | 
|  | 1129 | case VIDIOC_REQBUFS: { | 
|  | 1130 | struct v4l2_requestbuffers *req = arg; | 
|  | 1131 | DEB_D(("VIDIOC_REQBUFS, type:%d\n",req->type)); | 
|  | 1132 | return videobuf_reqbufs(q,req); | 
|  | 1133 | } | 
|  | 1134 | case VIDIOC_QUERYBUF: { | 
|  | 1135 | struct v4l2_buffer *buf = arg; | 
|  | 1136 | DEB_D(("VIDIOC_QUERYBUF, type:%d, offset:%d\n",buf->type,buf->m.offset)); | 
|  | 1137 | return videobuf_querybuf(q,buf); | 
|  | 1138 | } | 
|  | 1139 | case VIDIOC_QBUF: { | 
|  | 1140 | struct v4l2_buffer *buf = arg; | 
|  | 1141 | int ret = 0; | 
|  | 1142 | ret = videobuf_qbuf(q,buf); | 
|  | 1143 | DEB_D(("VIDIOC_QBUF: ret:%d, index:%d\n",ret,buf->index)); | 
|  | 1144 | return ret; | 
|  | 1145 | } | 
|  | 1146 | case VIDIOC_DQBUF: { | 
|  | 1147 | struct v4l2_buffer *buf = arg; | 
|  | 1148 | int ret = 0; | 
|  | 1149 | ret = videobuf_dqbuf(q,buf,file->f_flags & O_NONBLOCK); | 
|  | 1150 | DEB_D(("VIDIOC_DQBUF: ret:%d, index:%d\n",ret,buf->index)); | 
|  | 1151 | return ret; | 
|  | 1152 | } | 
|  | 1153 | case VIDIOC_STREAMON: { | 
|  | 1154 | int *type = arg; | 
|  | 1155 | DEB_D(("VIDIOC_STREAMON, type:%d\n",*type)); | 
|  | 1156 |  | 
|  | 1157 | err = video_begin(fh); | 
|  | 1158 | if( 0 != err) { | 
|  | 1159 | return err; | 
|  | 1160 | } | 
|  | 1161 | err = videobuf_streamon(q); | 
|  | 1162 | return err; | 
|  | 1163 | } | 
|  | 1164 | case VIDIOC_STREAMOFF: { | 
|  | 1165 | int *type = arg; | 
|  | 1166 |  | 
|  | 1167 | DEB_D(("VIDIOC_STREAMOFF, type:%d\n",*type)); | 
|  | 1168 |  | 
|  | 1169 | /* ugly: we need to copy some checks from video_end(), | 
|  | 1170 | because videobuf_streamoff() relies on the capture running. | 
|  | 1171 | check and fix this */ | 
|  | 1172 | if ((vv->video_status & STATUS_CAPTURE) != STATUS_CAPTURE) { | 
|  | 1173 | DEB_S(("not capturing.\n")); | 
|  | 1174 | return 0; | 
|  | 1175 | } | 
|  | 1176 |  | 
|  | 1177 | if (vv->video_fh != fh) { | 
|  | 1178 | DEB_S(("capturing, but in another open.\n")); | 
|  | 1179 | return -EBUSY; | 
|  | 1180 | } | 
|  | 1181 |  | 
|  | 1182 | err = videobuf_streamoff(q); | 
|  | 1183 | if (0 != err) { | 
|  | 1184 | DEB_D(("warning: videobuf_streamoff() failed.\n")); | 
|  | 1185 | video_end(fh, file); | 
|  | 1186 | } else { | 
|  | 1187 | err = video_end(fh, file); | 
|  | 1188 | } | 
|  | 1189 | return err; | 
|  | 1190 | } | 
| Mauro Carvalho Chehab | c3ab204 | 2006-09-10 09:31:37 -0300 | [diff] [blame] | 1191 | #ifdef CONFIG_VIDEO_V4L1_COMPAT | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1192 | case VIDIOCGMBUF: | 
|  | 1193 | { | 
|  | 1194 | struct video_mbuf *mbuf = arg; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1195 | int i; | 
|  | 1196 |  | 
|  | 1197 | /* fixme: number of capture buffers and sizes for v4l apps */ | 
|  | 1198 | int gbuffers = 2; | 
|  | 1199 | int gbufsize = 768*576*4; | 
|  | 1200 |  | 
|  | 1201 | DEB_D(("VIDIOCGMBUF \n")); | 
|  | 1202 |  | 
|  | 1203 | q = &fh->video_q; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1204 | err = videobuf_mmap_setup(q,gbuffers,gbufsize, | 
|  | 1205 | V4L2_MEMORY_MMAP); | 
| Brandon Philips | 820eacd | 2007-11-19 15:10:48 -0300 | [diff] [blame] | 1206 | if (err < 0) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1207 | return err; | 
| Brandon Philips | 49ee718 | 2007-10-05 16:26:27 -0300 | [diff] [blame] | 1208 |  | 
|  | 1209 | gbuffers = err; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1210 | memset(mbuf,0,sizeof(*mbuf)); | 
|  | 1211 | mbuf->frames = gbuffers; | 
|  | 1212 | mbuf->size   = gbuffers * gbufsize; | 
|  | 1213 | for (i = 0; i < gbuffers; i++) | 
|  | 1214 | mbuf->offsets[i] = i * gbufsize; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1215 | return 0; | 
|  | 1216 | } | 
| Mauro Carvalho Chehab | c3ab204 | 2006-09-10 09:31:37 -0300 | [diff] [blame] | 1217 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1218 | default: | 
| Mauro Carvalho Chehab | b1f8840 | 2008-10-21 11:27:20 -0300 | [diff] [blame] | 1219 | return v4l_compat_translate_ioctl(file, cmd, arg, | 
| Hans Verkuil | f473bf7 | 2008-11-01 08:25:11 -0300 | [diff] [blame] | 1220 | saa7146_video_do_ioctl); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1221 | } | 
|  | 1222 | return 0; | 
|  | 1223 | } | 
|  | 1224 |  | 
|  | 1225 | /*********************************************************************************/ | 
|  | 1226 | /* buffer handling functions                                                  */ | 
|  | 1227 |  | 
|  | 1228 | static int buffer_activate (struct saa7146_dev *dev, | 
|  | 1229 | struct saa7146_buf *buf, | 
|  | 1230 | struct saa7146_buf *next) | 
|  | 1231 | { | 
|  | 1232 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 1233 |  | 
| Brandon Philips | 0fc0686 | 2007-11-06 20:02:36 -0300 | [diff] [blame] | 1234 | buf->vb.state = VIDEOBUF_ACTIVE; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1235 | saa7146_set_capture(dev,buf,next); | 
|  | 1236 |  | 
|  | 1237 | mod_timer(&vv->video_q.timeout, jiffies+BUFFER_TIMEOUT); | 
|  | 1238 | return 0; | 
|  | 1239 | } | 
|  | 1240 |  | 
|  | 1241 | static int buffer_prepare(struct videobuf_queue *q, | 
|  | 1242 | struct videobuf_buffer *vb, enum v4l2_field field) | 
|  | 1243 | { | 
|  | 1244 | struct file *file = q->priv_data; | 
|  | 1245 | struct saa7146_fh *fh = file->private_data; | 
|  | 1246 | struct saa7146_dev *dev = fh->dev; | 
|  | 1247 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 1248 | struct saa7146_buf *buf = (struct saa7146_buf *)vb; | 
|  | 1249 | int size,err = 0; | 
|  | 1250 |  | 
|  | 1251 | DEB_CAP(("vbuf:%p\n",vb)); | 
|  | 1252 |  | 
|  | 1253 | /* sanity checks */ | 
|  | 1254 | if (fh->video_fmt.width  < 48 || | 
|  | 1255 | fh->video_fmt.height < 32 || | 
|  | 1256 | fh->video_fmt.width  > vv->standard->h_max_out || | 
|  | 1257 | fh->video_fmt.height > vv->standard->v_max_out) { | 
|  | 1258 | DEB_D(("w (%d) / h (%d) out of bounds.\n",fh->video_fmt.width,fh->video_fmt.height)); | 
|  | 1259 | return -EINVAL; | 
|  | 1260 | } | 
|  | 1261 |  | 
|  | 1262 | size = fh->video_fmt.sizeimage; | 
|  | 1263 | if (0 != buf->vb.baddr && buf->vb.bsize < size) { | 
|  | 1264 | DEB_D(("size mismatch.\n")); | 
|  | 1265 | return -EINVAL; | 
|  | 1266 | } | 
|  | 1267 |  | 
|  | 1268 | DEB_CAP(("buffer_prepare [size=%dx%d,bytes=%d,fields=%s]\n", | 
|  | 1269 | fh->video_fmt.width,fh->video_fmt.height,size,v4l2_field_names[fh->video_fmt.field])); | 
|  | 1270 | if (buf->vb.width  != fh->video_fmt.width  || | 
|  | 1271 | buf->vb.bytesperline != fh->video_fmt.bytesperline || | 
|  | 1272 | buf->vb.height != fh->video_fmt.height || | 
|  | 1273 | buf->vb.size   != size || | 
|  | 1274 | buf->vb.field  != field      || | 
|  | 1275 | buf->vb.field  != fh->video_fmt.field  || | 
|  | 1276 | buf->fmt       != &fh->video_fmt) { | 
| Mauro Carvalho Chehab | c7b0ac0 | 2006-03-10 12:29:15 -0300 | [diff] [blame] | 1277 | saa7146_dma_free(dev,q,buf); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1278 | } | 
|  | 1279 |  | 
| Brandon Philips | 0fc0686 | 2007-11-06 20:02:36 -0300 | [diff] [blame] | 1280 | if (VIDEOBUF_NEEDS_INIT == buf->vb.state) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1281 | struct saa7146_format *sfmt; | 
|  | 1282 |  | 
|  | 1283 | buf->vb.bytesperline  = fh->video_fmt.bytesperline; | 
|  | 1284 | buf->vb.width  = fh->video_fmt.width; | 
|  | 1285 | buf->vb.height = fh->video_fmt.height; | 
|  | 1286 | buf->vb.size   = size; | 
|  | 1287 | buf->vb.field  = field; | 
|  | 1288 | buf->fmt       = &fh->video_fmt; | 
|  | 1289 | buf->vb.field  = fh->video_fmt.field; | 
|  | 1290 |  | 
|  | 1291 | sfmt = format_by_fourcc(dev,buf->fmt->pixelformat); | 
|  | 1292 |  | 
|  | 1293 | if( 0 != IS_PLANAR(sfmt->trans)) { | 
|  | 1294 | saa7146_pgtable_free(dev->pci, &buf->pt[0]); | 
|  | 1295 | saa7146_pgtable_free(dev->pci, &buf->pt[1]); | 
|  | 1296 | saa7146_pgtable_free(dev->pci, &buf->pt[2]); | 
|  | 1297 |  | 
|  | 1298 | saa7146_pgtable_alloc(dev->pci, &buf->pt[0]); | 
|  | 1299 | saa7146_pgtable_alloc(dev->pci, &buf->pt[1]); | 
|  | 1300 | saa7146_pgtable_alloc(dev->pci, &buf->pt[2]); | 
|  | 1301 | } else { | 
|  | 1302 | saa7146_pgtable_free(dev->pci, &buf->pt[0]); | 
|  | 1303 | saa7146_pgtable_alloc(dev->pci, &buf->pt[0]); | 
|  | 1304 | } | 
|  | 1305 |  | 
| Mauro Carvalho Chehab | c7b0ac0 | 2006-03-10 12:29:15 -0300 | [diff] [blame] | 1306 | err = videobuf_iolock(q,&buf->vb, &vv->ov_fb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1307 | if (err) | 
|  | 1308 | goto oops; | 
|  | 1309 | err = saa7146_pgtable_build(dev,buf); | 
|  | 1310 | if (err) | 
|  | 1311 | goto oops; | 
|  | 1312 | } | 
| Brandon Philips | 0fc0686 | 2007-11-06 20:02:36 -0300 | [diff] [blame] | 1313 | buf->vb.state = VIDEOBUF_PREPARED; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1314 | buf->activate = buffer_activate; | 
|  | 1315 |  | 
|  | 1316 | return 0; | 
|  | 1317 |  | 
|  | 1318 | oops: | 
|  | 1319 | DEB_D(("error out.\n")); | 
| Mauro Carvalho Chehab | c7b0ac0 | 2006-03-10 12:29:15 -0300 | [diff] [blame] | 1320 | saa7146_dma_free(dev,q,buf); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1321 |  | 
|  | 1322 | return err; | 
|  | 1323 | } | 
|  | 1324 |  | 
|  | 1325 | static int buffer_setup(struct videobuf_queue *q, unsigned int *count, unsigned int *size) | 
|  | 1326 | { | 
|  | 1327 | struct file *file = q->priv_data; | 
|  | 1328 | struct saa7146_fh *fh = file->private_data; | 
|  | 1329 |  | 
|  | 1330 | if (0 == *count || *count > MAX_SAA7146_CAPTURE_BUFFERS) | 
|  | 1331 | *count = MAX_SAA7146_CAPTURE_BUFFERS; | 
|  | 1332 |  | 
|  | 1333 | *size = fh->video_fmt.sizeimage; | 
|  | 1334 |  | 
|  | 1335 | /* check if we exceed the "max_memory" parameter */ | 
|  | 1336 | if( (*count * *size) > (max_memory*1048576) ) { | 
|  | 1337 | *count = (max_memory*1048576) / *size; | 
|  | 1338 | } | 
|  | 1339 |  | 
|  | 1340 | DEB_CAP(("%d buffers, %d bytes each.\n",*count,*size)); | 
|  | 1341 |  | 
|  | 1342 | return 0; | 
|  | 1343 | } | 
|  | 1344 |  | 
|  | 1345 | static void buffer_queue(struct videobuf_queue *q, struct videobuf_buffer *vb) | 
|  | 1346 | { | 
|  | 1347 | struct file *file = q->priv_data; | 
|  | 1348 | struct saa7146_fh *fh = file->private_data; | 
|  | 1349 | struct saa7146_dev *dev = fh->dev; | 
|  | 1350 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 1351 | struct saa7146_buf *buf = (struct saa7146_buf *)vb; | 
|  | 1352 |  | 
|  | 1353 | DEB_CAP(("vbuf:%p\n",vb)); | 
|  | 1354 | saa7146_buffer_queue(fh->dev,&vv->video_q,buf); | 
|  | 1355 | } | 
|  | 1356 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1357 | static void buffer_release(struct videobuf_queue *q, struct videobuf_buffer *vb) | 
|  | 1358 | { | 
|  | 1359 | struct file *file = q->priv_data; | 
|  | 1360 | struct saa7146_fh *fh = file->private_data; | 
|  | 1361 | struct saa7146_dev *dev = fh->dev; | 
|  | 1362 | struct saa7146_buf *buf = (struct saa7146_buf *)vb; | 
|  | 1363 |  | 
|  | 1364 | DEB_CAP(("vbuf:%p\n",vb)); | 
| Mauro Carvalho Chehab | c7b0ac0 | 2006-03-10 12:29:15 -0300 | [diff] [blame] | 1365 | saa7146_dma_free(dev,q,buf); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1366 | } | 
|  | 1367 |  | 
|  | 1368 | static struct videobuf_queue_ops video_qops = { | 
|  | 1369 | .buf_setup    = buffer_setup, | 
|  | 1370 | .buf_prepare  = buffer_prepare, | 
|  | 1371 | .buf_queue    = buffer_queue, | 
|  | 1372 | .buf_release  = buffer_release, | 
|  | 1373 | }; | 
|  | 1374 |  | 
|  | 1375 | /********************************************************************************/ | 
|  | 1376 | /* file operations */ | 
|  | 1377 |  | 
|  | 1378 | static void video_init(struct saa7146_dev *dev, struct saa7146_vv *vv) | 
|  | 1379 | { | 
| Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 1380 | INIT_LIST_HEAD(&vv->video_q.queue); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1381 |  | 
|  | 1382 | init_timer(&vv->video_q.timeout); | 
|  | 1383 | vv->video_q.timeout.function = saa7146_buffer_timeout; | 
|  | 1384 | vv->video_q.timeout.data     = (unsigned long)(&vv->video_q); | 
|  | 1385 | vv->video_q.dev              = dev; | 
|  | 1386 |  | 
|  | 1387 | /* set some default values */ | 
|  | 1388 | vv->standard = &dev->ext_vv_data->stds[0]; | 
|  | 1389 |  | 
|  | 1390 | /* FIXME: what's this? */ | 
|  | 1391 | vv->current_hps_source = SAA7146_HPS_SOURCE_PORT_A; | 
|  | 1392 | vv->current_hps_sync = SAA7146_HPS_SYNC_PORT_A; | 
|  | 1393 | } | 
|  | 1394 |  | 
|  | 1395 |  | 
|  | 1396 | static int video_open(struct saa7146_dev *dev, struct file *file) | 
|  | 1397 | { | 
|  | 1398 | struct saa7146_fh *fh = (struct saa7146_fh *)file->private_data; | 
|  | 1399 | struct saa7146_format *sfmt; | 
|  | 1400 |  | 
|  | 1401 | fh->video_fmt.width = 384; | 
|  | 1402 | fh->video_fmt.height = 288; | 
|  | 1403 | fh->video_fmt.pixelformat = V4L2_PIX_FMT_BGR24; | 
|  | 1404 | fh->video_fmt.bytesperline = 0; | 
|  | 1405 | fh->video_fmt.field = V4L2_FIELD_ANY; | 
|  | 1406 | sfmt = format_by_fourcc(dev,fh->video_fmt.pixelformat); | 
|  | 1407 | fh->video_fmt.sizeimage = (fh->video_fmt.width * fh->video_fmt.height * sfmt->depth)/8; | 
|  | 1408 |  | 
| Guennadi Liakhovetski | 0705135 | 2008-04-22 14:42:13 -0300 | [diff] [blame] | 1409 | videobuf_queue_sg_init(&fh->video_q, &video_qops, | 
|  | 1410 | &dev->pci->dev, &dev->slock, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1411 | V4L2_BUF_TYPE_VIDEO_CAPTURE, | 
|  | 1412 | V4L2_FIELD_INTERLACED, | 
|  | 1413 | sizeof(struct saa7146_buf), | 
|  | 1414 | file); | 
|  | 1415 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1416 | return 0; | 
|  | 1417 | } | 
|  | 1418 |  | 
|  | 1419 |  | 
|  | 1420 | static void video_close(struct saa7146_dev *dev, struct file *file) | 
|  | 1421 | { | 
|  | 1422 | struct saa7146_fh *fh = (struct saa7146_fh *)file->private_data; | 
|  | 1423 | struct saa7146_vv *vv = dev->vv_data; | 
| Hartmut Birr | 2970c49 | 2007-04-22 06:57:26 -0300 | [diff] [blame] | 1424 | struct videobuf_queue *q = &fh->video_q; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1425 | int err; | 
|  | 1426 |  | 
|  | 1427 | if (IS_CAPTURE_ACTIVE(fh) != 0) { | 
|  | 1428 | err = video_end(fh, file); | 
|  | 1429 | } else if (IS_OVERLAY_ACTIVE(fh) != 0) { | 
|  | 1430 | err = saa7146_stop_preview(fh); | 
|  | 1431 | } | 
|  | 1432 |  | 
| Brandon Philips | 19bc513 | 2007-11-13 20:05:38 -0300 | [diff] [blame] | 1433 | videobuf_stop(q); | 
| Hartmut Birr | 2970c49 | 2007-04-22 06:57:26 -0300 | [diff] [blame] | 1434 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1435 | /* hmm, why is this function declared void? */ | 
|  | 1436 | /* return err */ | 
|  | 1437 | } | 
|  | 1438 |  | 
|  | 1439 |  | 
|  | 1440 | static void video_irq_done(struct saa7146_dev *dev, unsigned long st) | 
|  | 1441 | { | 
|  | 1442 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 1443 | struct saa7146_dmaqueue *q = &vv->video_q; | 
|  | 1444 |  | 
|  | 1445 | spin_lock(&dev->slock); | 
|  | 1446 | DEB_CAP(("called.\n")); | 
|  | 1447 |  | 
|  | 1448 | /* only finish the buffer if we have one... */ | 
|  | 1449 | if( NULL != q->curr ) { | 
| Brandon Philips | 0fc0686 | 2007-11-06 20:02:36 -0300 | [diff] [blame] | 1450 | saa7146_buffer_finish(dev,q,VIDEOBUF_DONE); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1451 | } | 
|  | 1452 | saa7146_buffer_next(dev,q,0); | 
|  | 1453 |  | 
|  | 1454 | spin_unlock(&dev->slock); | 
|  | 1455 | } | 
|  | 1456 |  | 
|  | 1457 | static ssize_t video_read(struct file *file, char __user *data, size_t count, loff_t *ppos) | 
|  | 1458 | { | 
|  | 1459 | struct saa7146_fh *fh = file->private_data; | 
|  | 1460 | struct saa7146_dev *dev = fh->dev; | 
|  | 1461 | struct saa7146_vv *vv = dev->vv_data; | 
|  | 1462 | ssize_t ret = 0; | 
|  | 1463 |  | 
|  | 1464 | DEB_EE(("called.\n")); | 
|  | 1465 |  | 
|  | 1466 | if ((vv->video_status & STATUS_CAPTURE) != 0) { | 
|  | 1467 | /* fixme: should we allow read() captures while streaming capture? */ | 
|  | 1468 | if (vv->video_fh == fh) { | 
|  | 1469 | DEB_S(("already capturing.\n")); | 
|  | 1470 | return -EBUSY; | 
|  | 1471 | } | 
|  | 1472 | DEB_S(("already capturing in another open.\n")); | 
|  | 1473 | return -EBUSY; | 
|  | 1474 | } | 
|  | 1475 |  | 
|  | 1476 | ret = video_begin(fh); | 
|  | 1477 | if( 0 != ret) { | 
|  | 1478 | goto out; | 
|  | 1479 | } | 
|  | 1480 |  | 
|  | 1481 | ret = videobuf_read_one(&fh->video_q , data, count, ppos, | 
|  | 1482 | file->f_flags & O_NONBLOCK); | 
|  | 1483 | if (ret != 0) { | 
|  | 1484 | video_end(fh, file); | 
|  | 1485 | } else { | 
|  | 1486 | ret = video_end(fh, file); | 
|  | 1487 | } | 
|  | 1488 | out: | 
|  | 1489 | /* restart overlay if it was active before */ | 
|  | 1490 | if (vv->ov_suspend != NULL) { | 
|  | 1491 | saa7146_start_preview(vv->ov_suspend); | 
|  | 1492 | vv->ov_suspend = NULL; | 
|  | 1493 | } | 
|  | 1494 |  | 
|  | 1495 | return ret; | 
|  | 1496 | } | 
|  | 1497 |  | 
|  | 1498 | struct saa7146_use_ops saa7146_video_uops = { | 
|  | 1499 | .init = video_init, | 
|  | 1500 | .open = video_open, | 
|  | 1501 | .release = video_close, | 
|  | 1502 | .irq_done = video_irq_done, | 
|  | 1503 | .read = video_read, | 
|  | 1504 | }; |