dt3155.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /***************************************************************************
  3. * Copyright (C) 2006-2010 by Marin Mitov *
  4. * [email protected] *
  5. * *
  6. * *
  7. ***************************************************************************/
  8. #include <linux/module.h>
  9. #include <linux/stringify.h>
  10. #include <linux/delay.h>
  11. #include <linux/kthread.h>
  12. #include <linux/slab.h>
  13. #include <media/v4l2-dev.h>
  14. #include <media/v4l2-ioctl.h>
  15. #include <media/v4l2-common.h>
  16. #include <media/videobuf2-dma-contig.h>
  17. #include "dt3155.h"
  18. #define DT3155_DEVICE_ID 0x1223
  19. /**
  20. * read_i2c_reg - reads an internal i2c register
  21. *
  22. * @addr: dt3155 mmio base address
  23. * @index: index (internal address) of register to read
  24. * @data: pointer to byte the read data will be placed in
  25. *
  26. * returns: zero on success or error code
  27. *
  28. * This function starts reading the specified (by index) register
  29. * and busy waits for the process to finish. The result is placed
  30. * in a byte pointed by data.
  31. */
  32. static int read_i2c_reg(void __iomem *addr, u8 index, u8 *data)
  33. {
  34. u32 tmp = index;
  35. iowrite32((tmp << 17) | IIC_READ, addr + IIC_CSR2);
  36. udelay(45); /* wait at least 43 usec for NEW_CYCLE to clear */
  37. if (ioread32(addr + IIC_CSR2) & NEW_CYCLE)
  38. return -EIO; /* error: NEW_CYCLE not cleared */
  39. tmp = ioread32(addr + IIC_CSR1);
  40. if (tmp & DIRECT_ABORT) {
  41. /* reset DIRECT_ABORT bit */
  42. iowrite32(DIRECT_ABORT, addr + IIC_CSR1);
  43. return -EIO; /* error: DIRECT_ABORT set */
  44. }
  45. *data = tmp >> 24;
  46. return 0;
  47. }
  48. /**
  49. * write_i2c_reg - writes to an internal i2c register
  50. *
  51. * @addr: dt3155 mmio base address
  52. * @index: index (internal address) of register to read
  53. * @data: data to be written
  54. *
  55. * returns: zero on success or error code
  56. *
  57. * This function starts writing the specified (by index) register
  58. * and busy waits for the process to finish.
  59. */
  60. static int write_i2c_reg(void __iomem *addr, u8 index, u8 data)
  61. {
  62. u32 tmp = index;
  63. iowrite32((tmp << 17) | IIC_WRITE | data, addr + IIC_CSR2);
  64. udelay(65); /* wait at least 63 usec for NEW_CYCLE to clear */
  65. if (ioread32(addr + IIC_CSR2) & NEW_CYCLE)
  66. return -EIO; /* error: NEW_CYCLE not cleared */
  67. if (ioread32(addr + IIC_CSR1) & DIRECT_ABORT) {
  68. /* reset DIRECT_ABORT bit */
  69. iowrite32(DIRECT_ABORT, addr + IIC_CSR1);
  70. return -EIO; /* error: DIRECT_ABORT set */
  71. }
  72. return 0;
  73. }
  74. /**
  75. * write_i2c_reg_nowait - writes to an internal i2c register
  76. *
  77. * @addr: dt3155 mmio base address
  78. * @index: index (internal address) of register to read
  79. * @data: data to be written
  80. *
  81. * This function starts writing the specified (by index) register
  82. * and then returns.
  83. */
  84. static void write_i2c_reg_nowait(void __iomem *addr, u8 index, u8 data)
  85. {
  86. u32 tmp = index;
  87. iowrite32((tmp << 17) | IIC_WRITE | data, addr + IIC_CSR2);
  88. }
  89. /**
  90. * wait_i2c_reg - waits the read/write to finish
  91. *
  92. * @addr: dt3155 mmio base address
  93. *
  94. * returns: zero on success or error code
  95. *
  96. * This function waits reading/writing to finish.
  97. */
  98. static int wait_i2c_reg(void __iomem *addr)
  99. {
  100. if (ioread32(addr + IIC_CSR2) & NEW_CYCLE)
  101. udelay(65); /* wait at least 63 usec for NEW_CYCLE to clear */
  102. if (ioread32(addr + IIC_CSR2) & NEW_CYCLE)
  103. return -EIO; /* error: NEW_CYCLE not cleared */
  104. if (ioread32(addr + IIC_CSR1) & DIRECT_ABORT) {
  105. /* reset DIRECT_ABORT bit */
  106. iowrite32(DIRECT_ABORT, addr + IIC_CSR1);
  107. return -EIO; /* error: DIRECT_ABORT set */
  108. }
  109. return 0;
  110. }
  111. static int
  112. dt3155_queue_setup(struct vb2_queue *vq,
  113. unsigned int *nbuffers, unsigned int *num_planes,
  114. unsigned int sizes[], struct device *alloc_devs[])
  115. {
  116. struct dt3155_priv *pd = vb2_get_drv_priv(vq);
  117. unsigned size = pd->width * pd->height;
  118. if (vq->num_buffers + *nbuffers < 2)
  119. *nbuffers = 2 - vq->num_buffers;
  120. if (*num_planes)
  121. return sizes[0] < size ? -EINVAL : 0;
  122. *num_planes = 1;
  123. sizes[0] = size;
  124. return 0;
  125. }
  126. static int dt3155_buf_prepare(struct vb2_buffer *vb)
  127. {
  128. struct dt3155_priv *pd = vb2_get_drv_priv(vb->vb2_queue);
  129. vb2_set_plane_payload(vb, 0, pd->width * pd->height);
  130. return 0;
  131. }
  132. static int dt3155_start_streaming(struct vb2_queue *q, unsigned count)
  133. {
  134. struct dt3155_priv *pd = vb2_get_drv_priv(q);
  135. struct vb2_buffer *vb = &pd->curr_buf->vb2_buf;
  136. dma_addr_t dma_addr;
  137. pd->sequence = 0;
  138. dma_addr = vb2_dma_contig_plane_dma_addr(vb, 0);
  139. iowrite32(dma_addr, pd->regs + EVEN_DMA_START);
  140. iowrite32(dma_addr + pd->width, pd->regs + ODD_DMA_START);
  141. iowrite32(pd->width, pd->regs + EVEN_DMA_STRIDE);
  142. iowrite32(pd->width, pd->regs + ODD_DMA_STRIDE);
  143. /* enable interrupts, clear all irq flags */
  144. iowrite32(FLD_START_EN | FLD_END_ODD_EN | FLD_START |
  145. FLD_END_EVEN | FLD_END_ODD, pd->regs + INT_CSR);
  146. iowrite32(FIFO_EN | SRST | FLD_CRPT_ODD | FLD_CRPT_EVEN |
  147. FLD_DN_ODD | FLD_DN_EVEN | CAP_CONT_EVEN | CAP_CONT_ODD,
  148. pd->regs + CSR1);
  149. wait_i2c_reg(pd->regs);
  150. write_i2c_reg(pd->regs, CONFIG, pd->config);
  151. write_i2c_reg(pd->regs, EVEN_CSR, CSR_ERROR | CSR_DONE);
  152. write_i2c_reg(pd->regs, ODD_CSR, CSR_ERROR | CSR_DONE);
  153. /* start the board */
  154. write_i2c_reg(pd->regs, CSR2, pd->csr2 | BUSY_EVEN | BUSY_ODD);
  155. return 0;
  156. }
  157. static void dt3155_stop_streaming(struct vb2_queue *q)
  158. {
  159. struct dt3155_priv *pd = vb2_get_drv_priv(q);
  160. struct vb2_buffer *vb;
  161. spin_lock_irq(&pd->lock);
  162. /* stop the board */
  163. write_i2c_reg_nowait(pd->regs, CSR2, pd->csr2);
  164. iowrite32(FIFO_EN | SRST | FLD_CRPT_ODD | FLD_CRPT_EVEN |
  165. FLD_DN_ODD | FLD_DN_EVEN, pd->regs + CSR1);
  166. /* disable interrupts, clear all irq flags */
  167. iowrite32(FLD_START | FLD_END_EVEN | FLD_END_ODD, pd->regs + INT_CSR);
  168. spin_unlock_irq(&pd->lock);
  169. /*
  170. * It is not clear whether the DMA stops at once or whether it
  171. * will finish the current frame or field first. To be on the
  172. * safe side we wait a bit.
  173. */
  174. msleep(45);
  175. spin_lock_irq(&pd->lock);
  176. if (pd->curr_buf) {
  177. vb2_buffer_done(&pd->curr_buf->vb2_buf, VB2_BUF_STATE_ERROR);
  178. pd->curr_buf = NULL;
  179. }
  180. while (!list_empty(&pd->dmaq)) {
  181. vb = list_first_entry(&pd->dmaq, typeof(*vb), done_entry);
  182. list_del(&vb->done_entry);
  183. vb2_buffer_done(vb, VB2_BUF_STATE_ERROR);
  184. }
  185. spin_unlock_irq(&pd->lock);
  186. }
  187. static void dt3155_buf_queue(struct vb2_buffer *vb)
  188. {
  189. struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
  190. struct dt3155_priv *pd = vb2_get_drv_priv(vb->vb2_queue);
  191. /* pd->vidq.streaming = 1 when dt3155_buf_queue() is invoked */
  192. spin_lock_irq(&pd->lock);
  193. if (pd->curr_buf)
  194. list_add_tail(&vb->done_entry, &pd->dmaq);
  195. else
  196. pd->curr_buf = vbuf;
  197. spin_unlock_irq(&pd->lock);
  198. }
  199. static const struct vb2_ops q_ops = {
  200. .queue_setup = dt3155_queue_setup,
  201. .wait_prepare = vb2_ops_wait_prepare,
  202. .wait_finish = vb2_ops_wait_finish,
  203. .buf_prepare = dt3155_buf_prepare,
  204. .start_streaming = dt3155_start_streaming,
  205. .stop_streaming = dt3155_stop_streaming,
  206. .buf_queue = dt3155_buf_queue,
  207. };
  208. static irqreturn_t dt3155_irq_handler_even(int irq, void *dev_id)
  209. {
  210. struct dt3155_priv *ipd = dev_id;
  211. struct vb2_buffer *ivb;
  212. dma_addr_t dma_addr;
  213. u32 tmp;
  214. tmp = ioread32(ipd->regs + INT_CSR) & (FLD_START | FLD_END_ODD);
  215. if (!tmp)
  216. return IRQ_NONE; /* not our irq */
  217. if ((tmp & FLD_START) && !(tmp & FLD_END_ODD)) {
  218. iowrite32(FLD_START_EN | FLD_END_ODD_EN | FLD_START,
  219. ipd->regs + INT_CSR);
  220. return IRQ_HANDLED; /* start of field irq */
  221. }
  222. tmp = ioread32(ipd->regs + CSR1) & (FLD_CRPT_EVEN | FLD_CRPT_ODD);
  223. if (tmp) {
  224. iowrite32(FIFO_EN | SRST | FLD_CRPT_ODD | FLD_CRPT_EVEN |
  225. FLD_DN_ODD | FLD_DN_EVEN |
  226. CAP_CONT_EVEN | CAP_CONT_ODD,
  227. ipd->regs + CSR1);
  228. }
  229. spin_lock(&ipd->lock);
  230. if (ipd->curr_buf && !list_empty(&ipd->dmaq)) {
  231. ipd->curr_buf->vb2_buf.timestamp = ktime_get_ns();
  232. ipd->curr_buf->sequence = ipd->sequence++;
  233. ipd->curr_buf->field = V4L2_FIELD_NONE;
  234. vb2_buffer_done(&ipd->curr_buf->vb2_buf, VB2_BUF_STATE_DONE);
  235. ivb = list_first_entry(&ipd->dmaq, typeof(*ivb), done_entry);
  236. list_del(&ivb->done_entry);
  237. ipd->curr_buf = to_vb2_v4l2_buffer(ivb);
  238. dma_addr = vb2_dma_contig_plane_dma_addr(ivb, 0);
  239. iowrite32(dma_addr, ipd->regs + EVEN_DMA_START);
  240. iowrite32(dma_addr + ipd->width, ipd->regs + ODD_DMA_START);
  241. iowrite32(ipd->width, ipd->regs + EVEN_DMA_STRIDE);
  242. iowrite32(ipd->width, ipd->regs + ODD_DMA_STRIDE);
  243. }
  244. /* enable interrupts, clear all irq flags */
  245. iowrite32(FLD_START_EN | FLD_END_ODD_EN | FLD_START |
  246. FLD_END_EVEN | FLD_END_ODD, ipd->regs + INT_CSR);
  247. spin_unlock(&ipd->lock);
  248. return IRQ_HANDLED;
  249. }
  250. static const struct v4l2_file_operations dt3155_fops = {
  251. .owner = THIS_MODULE,
  252. .open = v4l2_fh_open,
  253. .release = vb2_fop_release,
  254. .unlocked_ioctl = video_ioctl2,
  255. .read = vb2_fop_read,
  256. .mmap = vb2_fop_mmap,
  257. .poll = vb2_fop_poll
  258. };
  259. static int dt3155_querycap(struct file *filp, void *p,
  260. struct v4l2_capability *cap)
  261. {
  262. strscpy(cap->driver, DT3155_NAME, sizeof(cap->driver));
  263. strscpy(cap->card, DT3155_NAME " frame grabber", sizeof(cap->card));
  264. return 0;
  265. }
  266. static int dt3155_enum_fmt_vid_cap(struct file *filp,
  267. void *p, struct v4l2_fmtdesc *f)
  268. {
  269. if (f->index)
  270. return -EINVAL;
  271. f->pixelformat = V4L2_PIX_FMT_GREY;
  272. return 0;
  273. }
  274. static int dt3155_fmt_vid_cap(struct file *filp, void *p, struct v4l2_format *f)
  275. {
  276. struct dt3155_priv *pd = video_drvdata(filp);
  277. f->fmt.pix.width = pd->width;
  278. f->fmt.pix.height = pd->height;
  279. f->fmt.pix.pixelformat = V4L2_PIX_FMT_GREY;
  280. f->fmt.pix.field = V4L2_FIELD_NONE;
  281. f->fmt.pix.bytesperline = f->fmt.pix.width;
  282. f->fmt.pix.sizeimage = f->fmt.pix.width * f->fmt.pix.height;
  283. f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
  284. return 0;
  285. }
  286. static int dt3155_g_std(struct file *filp, void *p, v4l2_std_id *norm)
  287. {
  288. struct dt3155_priv *pd = video_drvdata(filp);
  289. *norm = pd->std;
  290. return 0;
  291. }
  292. static int dt3155_s_std(struct file *filp, void *p, v4l2_std_id norm)
  293. {
  294. struct dt3155_priv *pd = video_drvdata(filp);
  295. if (pd->std == norm)
  296. return 0;
  297. if (vb2_is_busy(&pd->vidq))
  298. return -EBUSY;
  299. pd->std = norm;
  300. if (pd->std & V4L2_STD_525_60) {
  301. pd->csr2 = VT_60HZ;
  302. pd->width = 640;
  303. pd->height = 480;
  304. } else {
  305. pd->csr2 = VT_50HZ;
  306. pd->width = 768;
  307. pd->height = 576;
  308. }
  309. return 0;
  310. }
  311. static int dt3155_enum_input(struct file *filp, void *p,
  312. struct v4l2_input *input)
  313. {
  314. if (input->index > 3)
  315. return -EINVAL;
  316. if (input->index)
  317. snprintf(input->name, sizeof(input->name), "VID%d",
  318. input->index);
  319. else
  320. strscpy(input->name, "J2/VID0", sizeof(input->name));
  321. input->type = V4L2_INPUT_TYPE_CAMERA;
  322. input->std = V4L2_STD_ALL;
  323. input->status = 0;
  324. return 0;
  325. }
  326. static int dt3155_g_input(struct file *filp, void *p, unsigned int *i)
  327. {
  328. struct dt3155_priv *pd = video_drvdata(filp);
  329. *i = pd->input;
  330. return 0;
  331. }
  332. static int dt3155_s_input(struct file *filp, void *p, unsigned int i)
  333. {
  334. struct dt3155_priv *pd = video_drvdata(filp);
  335. if (i > 3)
  336. return -EINVAL;
  337. pd->input = i;
  338. write_i2c_reg(pd->regs, AD_ADDR, AD_CMD_REG);
  339. write_i2c_reg(pd->regs, AD_CMD, (i << 6) | (i << 4) | SYNC_LVL_3);
  340. return 0;
  341. }
  342. static const struct v4l2_ioctl_ops dt3155_ioctl_ops = {
  343. .vidioc_querycap = dt3155_querycap,
  344. .vidioc_enum_fmt_vid_cap = dt3155_enum_fmt_vid_cap,
  345. .vidioc_try_fmt_vid_cap = dt3155_fmt_vid_cap,
  346. .vidioc_g_fmt_vid_cap = dt3155_fmt_vid_cap,
  347. .vidioc_s_fmt_vid_cap = dt3155_fmt_vid_cap,
  348. .vidioc_reqbufs = vb2_ioctl_reqbufs,
  349. .vidioc_create_bufs = vb2_ioctl_create_bufs,
  350. .vidioc_querybuf = vb2_ioctl_querybuf,
  351. .vidioc_expbuf = vb2_ioctl_expbuf,
  352. .vidioc_qbuf = vb2_ioctl_qbuf,
  353. .vidioc_dqbuf = vb2_ioctl_dqbuf,
  354. .vidioc_streamon = vb2_ioctl_streamon,
  355. .vidioc_streamoff = vb2_ioctl_streamoff,
  356. .vidioc_g_std = dt3155_g_std,
  357. .vidioc_s_std = dt3155_s_std,
  358. .vidioc_enum_input = dt3155_enum_input,
  359. .vidioc_g_input = dt3155_g_input,
  360. .vidioc_s_input = dt3155_s_input,
  361. };
  362. static int dt3155_init_board(struct dt3155_priv *pd)
  363. {
  364. struct pci_dev *pdev = pd->pdev;
  365. int i;
  366. u8 tmp = 0;
  367. pci_set_master(pdev); /* dt3155 needs it */
  368. /* resetting the adapter */
  369. iowrite32(ADDR_ERR_ODD | ADDR_ERR_EVEN | FLD_CRPT_ODD | FLD_CRPT_EVEN |
  370. FLD_DN_ODD | FLD_DN_EVEN, pd->regs + CSR1);
  371. msleep(20);
  372. /* initializing adapter registers */
  373. iowrite32(FIFO_EN | SRST, pd->regs + CSR1);
  374. iowrite32(0xEEEEEE01, pd->regs + EVEN_PIXEL_FMT);
  375. iowrite32(0xEEEEEE01, pd->regs + ODD_PIXEL_FMT);
  376. iowrite32(0x00000020, pd->regs + FIFO_TRIGGER);
  377. iowrite32(0x00000103, pd->regs + XFER_MODE);
  378. iowrite32(0, pd->regs + RETRY_WAIT_CNT);
  379. iowrite32(0, pd->regs + INT_CSR);
  380. iowrite32(1, pd->regs + EVEN_FLD_MASK);
  381. iowrite32(1, pd->regs + ODD_FLD_MASK);
  382. iowrite32(0, pd->regs + MASK_LENGTH);
  383. iowrite32(0x0005007C, pd->regs + FIFO_FLAG_CNT);
  384. iowrite32(0x01010101, pd->regs + IIC_CLK_DUR);
  385. /* verifying that we have a DT3155 board (not just a SAA7116 chip) */
  386. read_i2c_reg(pd->regs, DT_ID, &tmp);
  387. if (tmp != DT3155_ID)
  388. return -ENODEV;
  389. /* initialize AD LUT */
  390. write_i2c_reg(pd->regs, AD_ADDR, 0);
  391. for (i = 0; i < 256; i++)
  392. write_i2c_reg(pd->regs, AD_LUT, i);
  393. /* initialize ADC references */
  394. /* FIXME: pos_ref & neg_ref depend on VT_50HZ */
  395. write_i2c_reg(pd->regs, AD_ADDR, AD_CMD_REG);
  396. write_i2c_reg(pd->regs, AD_CMD, VIDEO_CNL_1 | SYNC_CNL_1 | SYNC_LVL_3);
  397. write_i2c_reg(pd->regs, AD_ADDR, AD_POS_REF);
  398. write_i2c_reg(pd->regs, AD_CMD, 34);
  399. write_i2c_reg(pd->regs, AD_ADDR, AD_NEG_REF);
  400. write_i2c_reg(pd->regs, AD_CMD, 0);
  401. /* initialize PM LUT */
  402. write_i2c_reg(pd->regs, CONFIG, pd->config | PM_LUT_PGM);
  403. for (i = 0; i < 256; i++) {
  404. write_i2c_reg(pd->regs, PM_LUT_ADDR, i);
  405. write_i2c_reg(pd->regs, PM_LUT_DATA, i);
  406. }
  407. write_i2c_reg(pd->regs, CONFIG, pd->config | PM_LUT_PGM | PM_LUT_SEL);
  408. for (i = 0; i < 256; i++) {
  409. write_i2c_reg(pd->regs, PM_LUT_ADDR, i);
  410. write_i2c_reg(pd->regs, PM_LUT_DATA, i);
  411. }
  412. write_i2c_reg(pd->regs, CONFIG, pd->config); /* ACQ_MODE_EVEN */
  413. /* select channel 1 for input and set sync level */
  414. write_i2c_reg(pd->regs, AD_ADDR, AD_CMD_REG);
  415. write_i2c_reg(pd->regs, AD_CMD, VIDEO_CNL_1 | SYNC_CNL_1 | SYNC_LVL_3);
  416. /* disable all irqs, clear all irq flags */
  417. iowrite32(FLD_START | FLD_END_EVEN | FLD_END_ODD,
  418. pd->regs + INT_CSR);
  419. return 0;
  420. }
  421. static const struct video_device dt3155_vdev = {
  422. .name = DT3155_NAME,
  423. .fops = &dt3155_fops,
  424. .ioctl_ops = &dt3155_ioctl_ops,
  425. .minor = -1,
  426. .release = video_device_release_empty,
  427. .tvnorms = V4L2_STD_ALL,
  428. .device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING |
  429. V4L2_CAP_READWRITE,
  430. };
  431. static int dt3155_probe(struct pci_dev *pdev, const struct pci_device_id *id)
  432. {
  433. int err;
  434. struct dt3155_priv *pd;
  435. err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
  436. if (err)
  437. return -ENODEV;
  438. pd = devm_kzalloc(&pdev->dev, sizeof(*pd), GFP_KERNEL);
  439. if (!pd)
  440. return -ENOMEM;
  441. err = v4l2_device_register(&pdev->dev, &pd->v4l2_dev);
  442. if (err)
  443. return err;
  444. pd->vdev = dt3155_vdev;
  445. pd->vdev.v4l2_dev = &pd->v4l2_dev;
  446. video_set_drvdata(&pd->vdev, pd); /* for use in video_fops */
  447. pd->pdev = pdev;
  448. pd->std = V4L2_STD_625_50;
  449. pd->csr2 = VT_50HZ;
  450. pd->width = 768;
  451. pd->height = 576;
  452. INIT_LIST_HEAD(&pd->dmaq);
  453. mutex_init(&pd->mux);
  454. pd->vdev.lock = &pd->mux; /* for locking v4l2_file_operations */
  455. pd->vidq.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  456. pd->vidq.timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC;
  457. pd->vidq.io_modes = VB2_MMAP | VB2_DMABUF | VB2_READ;
  458. pd->vidq.ops = &q_ops;
  459. pd->vidq.mem_ops = &vb2_dma_contig_memops;
  460. pd->vidq.drv_priv = pd;
  461. pd->vidq.min_buffers_needed = 2;
  462. pd->vidq.gfp_flags = GFP_DMA32;
  463. pd->vidq.lock = &pd->mux; /* for locking v4l2_file_operations */
  464. pd->vidq.dev = &pdev->dev;
  465. pd->vdev.queue = &pd->vidq;
  466. err = vb2_queue_init(&pd->vidq);
  467. if (err < 0)
  468. goto err_v4l2_dev_unreg;
  469. spin_lock_init(&pd->lock);
  470. pd->config = ACQ_MODE_EVEN;
  471. err = pci_enable_device(pdev);
  472. if (err)
  473. goto err_v4l2_dev_unreg;
  474. err = pci_request_region(pdev, 0, pci_name(pdev));
  475. if (err)
  476. goto err_pci_disable;
  477. pd->regs = pci_iomap(pdev, 0, pci_resource_len(pd->pdev, 0));
  478. if (!pd->regs) {
  479. err = -ENOMEM;
  480. goto err_free_reg;
  481. }
  482. err = dt3155_init_board(pd);
  483. if (err)
  484. goto err_iounmap;
  485. err = request_irq(pd->pdev->irq, dt3155_irq_handler_even,
  486. IRQF_SHARED, DT3155_NAME, pd);
  487. if (err)
  488. goto err_iounmap;
  489. err = video_register_device(&pd->vdev, VFL_TYPE_VIDEO, -1);
  490. if (err)
  491. goto err_free_irq;
  492. dev_info(&pdev->dev, "/dev/video%i is ready\n", pd->vdev.minor);
  493. return 0; /* success */
  494. err_free_irq:
  495. free_irq(pd->pdev->irq, pd);
  496. err_iounmap:
  497. pci_iounmap(pdev, pd->regs);
  498. err_free_reg:
  499. pci_release_region(pdev, 0);
  500. err_pci_disable:
  501. pci_disable_device(pdev);
  502. err_v4l2_dev_unreg:
  503. v4l2_device_unregister(&pd->v4l2_dev);
  504. return err;
  505. }
  506. static void dt3155_remove(struct pci_dev *pdev)
  507. {
  508. struct v4l2_device *v4l2_dev = pci_get_drvdata(pdev);
  509. struct dt3155_priv *pd = container_of(v4l2_dev, struct dt3155_priv,
  510. v4l2_dev);
  511. vb2_video_unregister_device(&pd->vdev);
  512. free_irq(pd->pdev->irq, pd);
  513. v4l2_device_unregister(&pd->v4l2_dev);
  514. pci_iounmap(pdev, pd->regs);
  515. pci_release_region(pdev, 0);
  516. pci_disable_device(pdev);
  517. }
  518. static const struct pci_device_id pci_ids[] = {
  519. { PCI_DEVICE(PCI_VENDOR_ID_INTEL, DT3155_DEVICE_ID) },
  520. { 0, /* zero marks the end */ },
  521. };
  522. MODULE_DEVICE_TABLE(pci, pci_ids);
  523. static struct pci_driver pci_driver = {
  524. .name = DT3155_NAME,
  525. .id_table = pci_ids,
  526. .probe = dt3155_probe,
  527. .remove = dt3155_remove,
  528. };
  529. module_pci_driver(pci_driver);
  530. MODULE_DESCRIPTION("video4linux pci-driver for dt3155 frame grabber");
  531. MODULE_AUTHOR("Marin Mitov <[email protected]>");
  532. MODULE_VERSION(DT3155_VERSION);
  533. MODULE_LICENSE("GPL");