1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * 4 * device driver for philips saa7134 based TV cards 5 * video4linux video interface 6 * 7 * (c) 2001,02 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs] 8 */ 9 10 #include "saa7134.h" 11 #include "saa7134-reg.h" 12 13 #include <linux/init.h> 14 #include <linux/list.h> 15 #include <linux/module.h> 16 #include <linux/kernel.h> 17 #include <linux/delay.h> 18 19 /* ------------------------------------------------------------------ */ 20 21 static unsigned int ts_debug; 22 module_param(ts_debug, int, 0644); 23 MODULE_PARM_DESC(ts_debug,"enable debug messages [ts]"); 24 25 #define ts_dbg(fmt, arg...) do { \ 26 if (ts_debug) \ 27 printk(KERN_DEBUG pr_fmt("ts: " fmt), ## arg); \ 28 } while (0) 29 30 /* ------------------------------------------------------------------ */ 31 static int buffer_activate(struct saa7134_dev *dev, 32 struct saa7134_buf *buf, 33 struct saa7134_buf *next) 34 { 35 36 ts_dbg("buffer_activate [%p]", buf); 37 buf->top_seen = 0; 38 39 if (!dev->ts_started) 40 dev->ts_field = V4L2_FIELD_TOP; 41 42 if (NULL == next) 43 next = buf; 44 if (V4L2_FIELD_TOP == dev->ts_field) { 45 ts_dbg("- [top] buf=%p next=%p\n", buf, next); 46 saa_writel(SAA7134_RS_BA1(5),saa7134_buffer_base(buf)); 47 saa_writel(SAA7134_RS_BA2(5),saa7134_buffer_base(next)); 48 dev->ts_field = V4L2_FIELD_BOTTOM; 49 } else { 50 ts_dbg("- [bottom] buf=%p next=%p\n", buf, next); 51 saa_writel(SAA7134_RS_BA1(5),saa7134_buffer_base(next)); 52 saa_writel(SAA7134_RS_BA2(5),saa7134_buffer_base(buf)); 53 dev->ts_field = V4L2_FIELD_TOP; 54 } 55 56 /* start DMA */ 57 saa7134_set_dmabits(dev); 58 59 mod_timer(&dev->ts_q.timeout, jiffies+TS_BUFFER_TIMEOUT); 60 61 if (!dev->ts_started) 62 saa7134_ts_start(dev); 63 64 return 0; 65 } 66 67 int saa7134_ts_buffer_init(struct vb2_buffer *vb2) 68 { 69 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb2); 70 struct saa7134_dmaqueue *dmaq = vb2->vb2_queue->drv_priv; 71 struct saa7134_buf *buf = container_of(vbuf, struct saa7134_buf, vb2); 72 73 dmaq->curr = NULL; 74 buf->activate = buffer_activate; 75 76 return 0; 77 } 78 EXPORT_SYMBOL_GPL(saa7134_ts_buffer_init); 79 80 int saa7134_ts_buffer_prepare(struct vb2_buffer *vb2) 81 { 82 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb2); 83 struct saa7134_dmaqueue *dmaq = vb2->vb2_queue->drv_priv; 84 struct saa7134_dev *dev = dmaq->dev; 85 struct saa7134_buf *buf = container_of(vbuf, struct saa7134_buf, vb2); 86 struct sg_table *dma = vb2_dma_sg_plane_desc(vb2, 0); 87 unsigned int lines, llength, size; 88 89 ts_dbg("buffer_prepare [%p]\n", buf); 90 91 llength = TS_PACKET_SIZE; 92 lines = dev->ts.nr_packets; 93 94 size = lines * llength; 95 if (vb2_plane_size(vb2, 0) < size) 96 return -EINVAL; 97 98 vb2_set_plane_payload(vb2, 0, size); 99 vbuf->field = dev->field; 100 101 return saa7134_pgtable_build(dev->pci, &dmaq->pt, dma->sgl, dma->nents, 102 saa7134_buffer_startpage(buf)); 103 } 104 EXPORT_SYMBOL_GPL(saa7134_ts_buffer_prepare); 105 106 int saa7134_ts_queue_setup(struct vb2_queue *q, 107 unsigned int *nbuffers, unsigned int *nplanes, 108 unsigned int sizes[], struct device *alloc_devs[]) 109 { 110 struct saa7134_dmaqueue *dmaq = q->drv_priv; 111 struct saa7134_dev *dev = dmaq->dev; 112 int size = TS_PACKET_SIZE * dev->ts.nr_packets; 113 114 if (0 == *nbuffers) 115 *nbuffers = dev->ts.nr_bufs; 116 *nbuffers = saa7134_buffer_count(size, *nbuffers); 117 if (*nbuffers < 3) 118 *nbuffers = 3; 119 *nplanes = 1; 120 sizes[0] = size; 121 return 0; 122 } 123 EXPORT_SYMBOL_GPL(saa7134_ts_queue_setup); 124 125 int saa7134_ts_start_streaming(struct vb2_queue *vq, unsigned int count) 126 { 127 struct saa7134_dmaqueue *dmaq = vq->drv_priv; 128 struct saa7134_dev *dev = dmaq->dev; 129 130 /* 131 * Planar video capture and TS share the same DMA channel, 132 * so only one can be active at a time. 133 */ 134 if (vb2_is_busy(&dev->video_vbq) && dev->fmt->planar) { 135 struct saa7134_buf *buf, *tmp; 136 137 list_for_each_entry_safe(buf, tmp, &dmaq->queue, entry) { 138 list_del(&buf->entry); 139 vb2_buffer_done(&buf->vb2.vb2_buf, 140 VB2_BUF_STATE_QUEUED); 141 } 142 if (dmaq->curr) { 143 vb2_buffer_done(&dmaq->curr->vb2.vb2_buf, 144 VB2_BUF_STATE_QUEUED); 145 dmaq->curr = NULL; 146 } 147 return -EBUSY; 148 } 149 dmaq->seq_nr = 0; 150 return 0; 151 } 152 EXPORT_SYMBOL_GPL(saa7134_ts_start_streaming); 153 154 void saa7134_ts_stop_streaming(struct vb2_queue *vq) 155 { 156 struct saa7134_dmaqueue *dmaq = vq->drv_priv; 157 struct saa7134_dev *dev = dmaq->dev; 158 159 saa7134_ts_stop(dev); 160 saa7134_stop_streaming(dev, dmaq); 161 } 162 EXPORT_SYMBOL_GPL(saa7134_ts_stop_streaming); 163 164 struct vb2_ops saa7134_ts_qops = { 165 .queue_setup = saa7134_ts_queue_setup, 166 .buf_init = saa7134_ts_buffer_init, 167 .buf_prepare = saa7134_ts_buffer_prepare, 168 .buf_queue = saa7134_vb2_buffer_queue, 169 .stop_streaming = saa7134_ts_stop_streaming, 170 }; 171 EXPORT_SYMBOL_GPL(saa7134_ts_qops); 172 173 /* ----------------------------------------------------------- */ 174 /* exported stuff */ 175 176 static unsigned int tsbufs = 8; 177 module_param(tsbufs, int, 0444); 178 MODULE_PARM_DESC(tsbufs, "number of ts buffers for read/write IO, range 2-32"); 179 180 static unsigned int ts_nr_packets = 64; 181 module_param(ts_nr_packets, int, 0444); 182 MODULE_PARM_DESC(ts_nr_packets,"size of a ts buffers (in ts packets)"); 183 184 int saa7134_ts_init_hw(struct saa7134_dev *dev) 185 { 186 /* deactivate TS softreset */ 187 saa_writeb(SAA7134_TS_SERIAL1, 0x00); 188 /* TSSOP high active, TSVAL high active, TSLOCK ignored */ 189 saa_writeb(SAA7134_TS_PARALLEL, 0x6c); 190 saa_writeb(SAA7134_TS_PARALLEL_SERIAL, (TS_PACKET_SIZE-1)); 191 saa_writeb(SAA7134_TS_DMA0, ((dev->ts.nr_packets-1)&0xff)); 192 saa_writeb(SAA7134_TS_DMA1, (((dev->ts.nr_packets-1)>>8)&0xff)); 193 /* TSNOPIT=0, TSCOLAP=0 */ 194 saa_writeb(SAA7134_TS_DMA2, 195 ((((dev->ts.nr_packets-1)>>16)&0x3f) | 0x00)); 196 197 return 0; 198 } 199 200 int saa7134_ts_init1(struct saa7134_dev *dev) 201 { 202 /* sanitycheck insmod options */ 203 if (tsbufs < 2) 204 tsbufs = 2; 205 if (tsbufs > VIDEO_MAX_FRAME) 206 tsbufs = VIDEO_MAX_FRAME; 207 if (ts_nr_packets < 4) 208 ts_nr_packets = 4; 209 if (ts_nr_packets > 312) 210 ts_nr_packets = 312; 211 dev->ts.nr_bufs = tsbufs; 212 dev->ts.nr_packets = ts_nr_packets; 213 214 INIT_LIST_HEAD(&dev->ts_q.queue); 215 timer_setup(&dev->ts_q.timeout, saa7134_buffer_timeout, 0); 216 dev->ts_q.dev = dev; 217 dev->ts_q.need_two = 1; 218 dev->ts_started = 0; 219 saa7134_pgtable_alloc(dev->pci, &dev->ts_q.pt); 220 221 /* init TS hw */ 222 saa7134_ts_init_hw(dev); 223 224 return 0; 225 } 226 227 /* Function for stop TS */ 228 int saa7134_ts_stop(struct saa7134_dev *dev) 229 { 230 ts_dbg("TS stop\n"); 231 232 if (!dev->ts_started) 233 return 0; 234 235 /* Stop TS stream */ 236 switch (saa7134_boards[dev->board].ts_type) { 237 case SAA7134_MPEG_TS_PARALLEL: 238 saa_writeb(SAA7134_TS_PARALLEL, 0x6c); 239 dev->ts_started = 0; 240 break; 241 case SAA7134_MPEG_TS_SERIAL: 242 saa_writeb(SAA7134_TS_SERIAL0, 0x40); 243 dev->ts_started = 0; 244 break; 245 } 246 return 0; 247 } 248 249 /* Function for start TS */ 250 int saa7134_ts_start(struct saa7134_dev *dev) 251 { 252 ts_dbg("TS start\n"); 253 254 if (WARN_ON(dev->ts_started)) 255 return 0; 256 257 /* dma: setup channel 5 (= TS) */ 258 saa_writeb(SAA7134_TS_DMA0, (dev->ts.nr_packets - 1) & 0xff); 259 saa_writeb(SAA7134_TS_DMA1, 260 ((dev->ts.nr_packets - 1) >> 8) & 0xff); 261 /* TSNOPIT=0, TSCOLAP=0 */ 262 saa_writeb(SAA7134_TS_DMA2, 263 (((dev->ts.nr_packets - 1) >> 16) & 0x3f) | 0x00); 264 saa_writel(SAA7134_RS_PITCH(5), TS_PACKET_SIZE); 265 saa_writel(SAA7134_RS_CONTROL(5), SAA7134_RS_CONTROL_BURST_16 | 266 SAA7134_RS_CONTROL_ME | 267 (dev->ts_q.pt.dma >> 12)); 268 269 /* reset hardware TS buffers */ 270 saa_writeb(SAA7134_TS_SERIAL1, 0x00); 271 saa_writeb(SAA7134_TS_SERIAL1, 0x03); 272 saa_writeb(SAA7134_TS_SERIAL1, 0x00); 273 saa_writeb(SAA7134_TS_SERIAL1, 0x01); 274 275 /* TS clock non-inverted */ 276 saa_writeb(SAA7134_TS_SERIAL1, 0x00); 277 278 /* Start TS stream */ 279 switch (saa7134_boards[dev->board].ts_type) { 280 case SAA7134_MPEG_TS_PARALLEL: 281 saa_writeb(SAA7134_TS_SERIAL0, 0x40); 282 saa_writeb(SAA7134_TS_PARALLEL, 0xec | 283 (saa7134_boards[dev->board].ts_force_val << 4)); 284 break; 285 case SAA7134_MPEG_TS_SERIAL: 286 saa_writeb(SAA7134_TS_SERIAL0, 0xd8); 287 saa_writeb(SAA7134_TS_PARALLEL, 0x6c | 288 (saa7134_boards[dev->board].ts_force_val << 4)); 289 saa_writeb(SAA7134_TS_PARALLEL_SERIAL, 0xbc); 290 saa_writeb(SAA7134_TS_SERIAL1, 0x02); 291 break; 292 } 293 294 dev->ts_started = 1; 295 296 return 0; 297 } 298 299 int saa7134_ts_fini(struct saa7134_dev *dev) 300 { 301 del_timer_sync(&dev->ts_q.timeout); 302 saa7134_pgtable_free(dev->pci, &dev->ts_q.pt); 303 return 0; 304 } 305 306 void saa7134_irq_ts_done(struct saa7134_dev *dev, unsigned long status) 307 { 308 enum v4l2_field field; 309 310 spin_lock(&dev->slock); 311 if (dev->ts_q.curr) { 312 field = dev->ts_field; 313 if (field != V4L2_FIELD_TOP) { 314 if ((status & 0x100000) != 0x000000) 315 goto done; 316 } else { 317 if ((status & 0x100000) != 0x100000) 318 goto done; 319 } 320 saa7134_buffer_finish(dev, &dev->ts_q, VB2_BUF_STATE_DONE); 321 } 322 saa7134_buffer_next(dev,&dev->ts_q); 323 324 done: 325 spin_unlock(&dev->slock); 326 } 327