185756a06SHans Verkuil /* 285756a06SHans Verkuil * cobalt interrupt handling 385756a06SHans Verkuil * 485756a06SHans Verkuil * Copyright 2012-2015 Cisco Systems, Inc. and/or its affiliates. 585756a06SHans Verkuil * All rights reserved. 685756a06SHans Verkuil * 785756a06SHans Verkuil * This program is free software; you may redistribute it and/or modify 885756a06SHans Verkuil * it under the terms of the GNU General Public License as published by 985756a06SHans Verkuil * the Free Software Foundation; version 2 of the License. 1085756a06SHans Verkuil * 1185756a06SHans Verkuil * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 1285756a06SHans Verkuil * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 1385756a06SHans Verkuil * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 1485756a06SHans Verkuil * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 1585756a06SHans Verkuil * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 1685756a06SHans Verkuil * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 1785756a06SHans Verkuil * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 1885756a06SHans Verkuil * SOFTWARE. 1985756a06SHans Verkuil */ 2085756a06SHans Verkuil 21b5dcee22SMauro Carvalho Chehab #include <media/i2c/adv7604.h> 2285756a06SHans Verkuil 2385756a06SHans Verkuil #include "cobalt-driver.h" 2485756a06SHans Verkuil #include "cobalt-irq.h" 2585756a06SHans Verkuil #include "cobalt-omnitek.h" 2685756a06SHans Verkuil 2785756a06SHans Verkuil static void cobalt_dma_stream_queue_handler(struct cobalt_stream *s) 2885756a06SHans Verkuil { 2985756a06SHans Verkuil struct cobalt *cobalt = s->cobalt; 3085756a06SHans Verkuil int rx = s->video_channel; 31c0ce6220SHans Verkuil struct m00473_freewheel_regmap __iomem *fw = 3285756a06SHans Verkuil COBALT_CVI_FREEWHEEL(s->cobalt, rx); 33c0ce6220SHans Verkuil struct m00233_video_measure_regmap __iomem *vmr = 3485756a06SHans Verkuil COBALT_CVI_VMR(s->cobalt, rx); 35c0ce6220SHans Verkuil struct m00389_cvi_regmap __iomem *cvi = 3685756a06SHans Verkuil COBALT_CVI(s->cobalt, rx); 37c0ce6220SHans Verkuil struct m00479_clk_loss_detector_regmap __iomem *clkloss = 3885756a06SHans Verkuil COBALT_CVI_CLK_LOSS(s->cobalt, rx); 3985756a06SHans Verkuil struct cobalt_buffer *cb; 4085756a06SHans Verkuil bool skip = false; 4185756a06SHans Verkuil 4285756a06SHans Verkuil spin_lock(&s->irqlock); 4385756a06SHans Verkuil 4485756a06SHans Verkuil if (list_empty(&s->bufs)) { 4585756a06SHans Verkuil pr_err("no buffers!\n"); 4685756a06SHans Verkuil spin_unlock(&s->irqlock); 4785756a06SHans Verkuil return; 4885756a06SHans Verkuil } 4985756a06SHans Verkuil 5085756a06SHans Verkuil /* Give the fresh filled up buffer to the user. 5185756a06SHans Verkuil * Note that the interrupt is only sent if the DMA can continue 5285756a06SHans Verkuil * with a new buffer, so it is always safe to return this buffer 5385756a06SHans Verkuil * to userspace. */ 5485756a06SHans Verkuil cb = list_first_entry(&s->bufs, struct cobalt_buffer, list); 5585756a06SHans Verkuil list_del(&cb->list); 5685756a06SHans Verkuil spin_unlock(&s->irqlock); 5785756a06SHans Verkuil 5885756a06SHans Verkuil if (s->is_audio || s->is_output) 5985756a06SHans Verkuil goto done; 6085756a06SHans Verkuil 6185756a06SHans Verkuil if (s->unstable_frame) { 62c0ce6220SHans Verkuil uint32_t stat = ioread32(&vmr->irq_status); 6385756a06SHans Verkuil 64c0ce6220SHans Verkuil iowrite32(stat, &vmr->irq_status); 65c0ce6220SHans Verkuil if (!(ioread32(&vmr->status) & 66c0ce6220SHans Verkuil M00233_STATUS_BITMAP_INIT_DONE_MSK)) { 6785756a06SHans Verkuil cobalt_dbg(1, "!init_done\n"); 6885756a06SHans Verkuil if (s->enable_freewheel) 6985756a06SHans Verkuil goto restart_fw; 7085756a06SHans Verkuil goto done; 7185756a06SHans Verkuil } 7285756a06SHans Verkuil 73c0ce6220SHans Verkuil if (ioread32(&clkloss->status) & 74c0ce6220SHans Verkuil M00479_STATUS_BITMAP_CLOCK_MISSING_MSK) { 75c0ce6220SHans Verkuil iowrite32(0, &clkloss->ctrl); 76c0ce6220SHans Verkuil iowrite32(M00479_CTRL_BITMAP_ENABLE_MSK, &clkloss->ctrl); 7785756a06SHans Verkuil cobalt_dbg(1, "no clock\n"); 7885756a06SHans Verkuil if (s->enable_freewheel) 7985756a06SHans Verkuil goto restart_fw; 8085756a06SHans Verkuil goto done; 8185756a06SHans Verkuil } 8285756a06SHans Verkuil if ((stat & (M00233_IRQ_STATUS_BITMAP_VACTIVE_AREA_MSK | 8385756a06SHans Verkuil M00233_IRQ_STATUS_BITMAP_HACTIVE_AREA_MSK)) || 84c0ce6220SHans Verkuil ioread32(&vmr->vactive_area) != s->timings.bt.height || 85c0ce6220SHans Verkuil ioread32(&vmr->hactive_area) != s->timings.bt.width) { 8685756a06SHans Verkuil cobalt_dbg(1, "unstable\n"); 8785756a06SHans Verkuil if (s->enable_freewheel) 8885756a06SHans Verkuil goto restart_fw; 8985756a06SHans Verkuil goto done; 9085756a06SHans Verkuil } 9185756a06SHans Verkuil if (!s->enable_cvi) { 9285756a06SHans Verkuil s->enable_cvi = true; 93c0ce6220SHans Verkuil iowrite32(M00389_CONTROL_BITMAP_ENABLE_MSK, &cvi->control); 9485756a06SHans Verkuil goto done; 9585756a06SHans Verkuil } 96c0ce6220SHans Verkuil if (!(ioread32(&cvi->status) & M00389_STATUS_BITMAP_LOCK_MSK)) { 9785756a06SHans Verkuil cobalt_dbg(1, "cvi no lock\n"); 9885756a06SHans Verkuil if (s->enable_freewheel) 9985756a06SHans Verkuil goto restart_fw; 10085756a06SHans Verkuil goto done; 10185756a06SHans Verkuil } 10285756a06SHans Verkuil if (!s->enable_freewheel) { 10385756a06SHans Verkuil cobalt_dbg(1, "stable\n"); 10485756a06SHans Verkuil s->enable_freewheel = true; 105c0ce6220SHans Verkuil iowrite32(0, &fw->ctrl); 10685756a06SHans Verkuil goto done; 10785756a06SHans Verkuil } 10885756a06SHans Verkuil cobalt_dbg(1, "enabled fw\n"); 109c0ce6220SHans Verkuil iowrite32(M00233_CONTROL_BITMAP_ENABLE_MEASURE_MSK | 110c0ce6220SHans Verkuil M00233_CONTROL_BITMAP_ENABLE_INTERRUPT_MSK, 111c0ce6220SHans Verkuil &vmr->control); 112c0ce6220SHans Verkuil iowrite32(M00473_CTRL_BITMAP_ENABLE_MSK, &fw->ctrl); 11385756a06SHans Verkuil s->enable_freewheel = false; 11485756a06SHans Verkuil s->unstable_frame = false; 11585756a06SHans Verkuil s->skip_first_frames = 2; 11685756a06SHans Verkuil skip = true; 11785756a06SHans Verkuil goto done; 11885756a06SHans Verkuil } 119c0ce6220SHans Verkuil if (ioread32(&fw->status) & M00473_STATUS_BITMAP_FREEWHEEL_MODE_MSK) { 12085756a06SHans Verkuil restart_fw: 12185756a06SHans Verkuil cobalt_dbg(1, "lost lock\n"); 122c0ce6220SHans Verkuil iowrite32(M00233_CONTROL_BITMAP_ENABLE_MEASURE_MSK, 123c0ce6220SHans Verkuil &vmr->control); 124c0ce6220SHans Verkuil iowrite32(M00473_CTRL_BITMAP_ENABLE_MSK | 125c0ce6220SHans Verkuil M00473_CTRL_BITMAP_FORCE_FREEWHEEL_MODE_MSK, 126c0ce6220SHans Verkuil &fw->ctrl); 127c0ce6220SHans Verkuil iowrite32(0, &cvi->control); 12885756a06SHans Verkuil s->unstable_frame = true; 12985756a06SHans Verkuil s->enable_freewheel = false; 13085756a06SHans Verkuil s->enable_cvi = false; 13185756a06SHans Verkuil } 13285756a06SHans Verkuil done: 13385756a06SHans Verkuil if (s->skip_first_frames) { 13485756a06SHans Verkuil skip = true; 13585756a06SHans Verkuil s->skip_first_frames--; 13685756a06SHans Verkuil } 137d6dd645eSJunghak Sung cb->vb.vb2_buf.timestamp = ktime_get_ns(); 13885756a06SHans Verkuil /* TODO: the sequence number should be read from the FPGA so we 13985756a06SHans Verkuil also know about dropped frames. */ 1402d700715SJunghak Sung cb->vb.sequence = s->sequence++; 1412d700715SJunghak Sung vb2_buffer_done(&cb->vb.vb2_buf, 1422d700715SJunghak Sung (skip || s->unstable_frame) ? 1436d058c56SSakari Ailus VB2_BUF_STATE_REQUEUEING : VB2_BUF_STATE_DONE); 14485756a06SHans Verkuil } 14585756a06SHans Verkuil 14685756a06SHans Verkuil irqreturn_t cobalt_irq_handler(int irq, void *dev_id) 14785756a06SHans Verkuil { 14885756a06SHans Verkuil struct cobalt *cobalt = (struct cobalt *)dev_id; 14985756a06SHans Verkuil u32 dma_interrupt = 15085756a06SHans Verkuil cobalt_read_bar0(cobalt, DMA_INTERRUPT_STATUS_REG) & 0xffff; 15185756a06SHans Verkuil u32 mask = cobalt_read_bar1(cobalt, COBALT_SYS_STAT_MASK); 15285756a06SHans Verkuil u32 edge = cobalt_read_bar1(cobalt, COBALT_SYS_STAT_EDGE); 15385756a06SHans Verkuil int i; 15485756a06SHans Verkuil 15585756a06SHans Verkuil /* Clear DMA interrupt */ 15685756a06SHans Verkuil cobalt_write_bar0(cobalt, DMA_INTERRUPT_STATUS_REG, dma_interrupt); 15785756a06SHans Verkuil cobalt_write_bar1(cobalt, COBALT_SYS_STAT_MASK, mask & ~edge); 15885756a06SHans Verkuil cobalt_write_bar1(cobalt, COBALT_SYS_STAT_EDGE, edge); 15985756a06SHans Verkuil 16085756a06SHans Verkuil for (i = 0; i < COBALT_NUM_STREAMS; i++) { 16185756a06SHans Verkuil struct cobalt_stream *s = &cobalt->streams[i]; 16286bad00aSHans Verkuil unsigned dma_fifo_mask = s->dma_fifo_mask; 16385756a06SHans Verkuil 16485756a06SHans Verkuil if (dma_interrupt & (1 << s->dma_channel)) { 16585756a06SHans Verkuil cobalt->irq_dma[i]++; 16685756a06SHans Verkuil /* Give fresh buffer to user and chain newly 16785756a06SHans Verkuil * queued buffers */ 16885756a06SHans Verkuil cobalt_dma_stream_queue_handler(s); 16985756a06SHans Verkuil if (!s->is_audio) { 17085756a06SHans Verkuil edge &= ~dma_fifo_mask; 17185756a06SHans Verkuil cobalt_write_bar1(cobalt, COBALT_SYS_STAT_MASK, 17285756a06SHans Verkuil mask & ~edge); 17385756a06SHans Verkuil } 17485756a06SHans Verkuil } 17585756a06SHans Verkuil if (s->is_audio) 17685756a06SHans Verkuil continue; 17786bad00aSHans Verkuil if (edge & s->adv_irq_mask) 17885756a06SHans Verkuil set_bit(COBALT_STREAM_FL_ADV_IRQ, &s->flags); 17985756a06SHans Verkuil if ((edge & mask & dma_fifo_mask) && vb2_is_streaming(&s->q)) { 18085756a06SHans Verkuil cobalt_info("full rx FIFO %d\n", i); 18185756a06SHans Verkuil cobalt->irq_full_fifo++; 18285756a06SHans Verkuil } 18385756a06SHans Verkuil } 18485756a06SHans Verkuil 18585756a06SHans Verkuil queue_work(cobalt->irq_work_queues, &cobalt->irq_work_queue); 18685756a06SHans Verkuil 18785756a06SHans Verkuil if (edge & mask & (COBALT_SYSSTAT_VI0_INT1_MSK | 18885756a06SHans Verkuil COBALT_SYSSTAT_VI1_INT1_MSK | 18985756a06SHans Verkuil COBALT_SYSSTAT_VI2_INT1_MSK | 19085756a06SHans Verkuil COBALT_SYSSTAT_VI3_INT1_MSK | 19185756a06SHans Verkuil COBALT_SYSSTAT_VIHSMA_INT1_MSK | 19285756a06SHans Verkuil COBALT_SYSSTAT_VOHSMA_INT1_MSK)) 19385756a06SHans Verkuil cobalt->irq_adv1++; 19485756a06SHans Verkuil if (edge & mask & (COBALT_SYSSTAT_VI0_INT2_MSK | 19585756a06SHans Verkuil COBALT_SYSSTAT_VI1_INT2_MSK | 19685756a06SHans Verkuil COBALT_SYSSTAT_VI2_INT2_MSK | 19785756a06SHans Verkuil COBALT_SYSSTAT_VI3_INT2_MSK | 19885756a06SHans Verkuil COBALT_SYSSTAT_VIHSMA_INT2_MSK)) 19985756a06SHans Verkuil cobalt->irq_adv2++; 20085756a06SHans Verkuil if (edge & mask & COBALT_SYSSTAT_VOHSMA_INT1_MSK) 20185756a06SHans Verkuil cobalt->irq_advout++; 20285756a06SHans Verkuil if (dma_interrupt) 20385756a06SHans Verkuil cobalt->irq_dma_tot++; 20485756a06SHans Verkuil if (!(edge & mask) && !dma_interrupt) 20585756a06SHans Verkuil cobalt->irq_none++; 20685756a06SHans Verkuil dma_interrupt = cobalt_read_bar0(cobalt, DMA_INTERRUPT_STATUS_REG); 20785756a06SHans Verkuil 20885756a06SHans Verkuil return IRQ_HANDLED; 20985756a06SHans Verkuil } 21085756a06SHans Verkuil 21185756a06SHans Verkuil void cobalt_irq_work_handler(struct work_struct *work) 21285756a06SHans Verkuil { 21385756a06SHans Verkuil struct cobalt *cobalt = 21485756a06SHans Verkuil container_of(work, struct cobalt, irq_work_queue); 21585756a06SHans Verkuil int i; 21685756a06SHans Verkuil 21785756a06SHans Verkuil for (i = 0; i < COBALT_NUM_NODES; i++) { 21885756a06SHans Verkuil struct cobalt_stream *s = &cobalt->streams[i]; 21985756a06SHans Verkuil 22085756a06SHans Verkuil if (test_and_clear_bit(COBALT_STREAM_FL_ADV_IRQ, &s->flags)) { 22185756a06SHans Verkuil u32 mask; 22285756a06SHans Verkuil 22385756a06SHans Verkuil v4l2_subdev_call(cobalt->streams[i].sd, core, 22485756a06SHans Verkuil interrupt_service_routine, 0, NULL); 22585756a06SHans Verkuil mask = cobalt_read_bar1(cobalt, COBALT_SYS_STAT_MASK); 22685756a06SHans Verkuil cobalt_write_bar1(cobalt, COBALT_SYS_STAT_MASK, 22786bad00aSHans Verkuil mask | s->adv_irq_mask); 22885756a06SHans Verkuil } 22985756a06SHans Verkuil } 23085756a06SHans Verkuil } 23185756a06SHans Verkuil 23285756a06SHans Verkuil void cobalt_irq_log_status(struct cobalt *cobalt) 23385756a06SHans Verkuil { 23485756a06SHans Verkuil u32 mask; 23585756a06SHans Verkuil int i; 23685756a06SHans Verkuil 23785756a06SHans Verkuil cobalt_info("irq: adv1=%u adv2=%u advout=%u none=%u full=%u\n", 23885756a06SHans Verkuil cobalt->irq_adv1, cobalt->irq_adv2, cobalt->irq_advout, 23985756a06SHans Verkuil cobalt->irq_none, cobalt->irq_full_fifo); 24085756a06SHans Verkuil cobalt_info("irq: dma_tot=%u (", cobalt->irq_dma_tot); 24185756a06SHans Verkuil for (i = 0; i < COBALT_NUM_STREAMS; i++) 24285756a06SHans Verkuil pr_cont("%s%u", i ? "/" : "", cobalt->irq_dma[i]); 24385756a06SHans Verkuil pr_cont(")\n"); 24485756a06SHans Verkuil cobalt->irq_dma_tot = cobalt->irq_adv1 = cobalt->irq_adv2 = 0; 24585756a06SHans Verkuil cobalt->irq_advout = cobalt->irq_none = cobalt->irq_full_fifo = 0; 24685756a06SHans Verkuil memset(cobalt->irq_dma, 0, sizeof(cobalt->irq_dma)); 24785756a06SHans Verkuil 24885756a06SHans Verkuil mask = cobalt_read_bar1(cobalt, COBALT_SYS_STAT_MASK); 24985756a06SHans Verkuil cobalt_write_bar1(cobalt, COBALT_SYS_STAT_MASK, 25085756a06SHans Verkuil mask | 25185756a06SHans Verkuil COBALT_SYSSTAT_VI0_LOST_DATA_MSK | 25285756a06SHans Verkuil COBALT_SYSSTAT_VI1_LOST_DATA_MSK | 25385756a06SHans Verkuil COBALT_SYSSTAT_VI2_LOST_DATA_MSK | 25485756a06SHans Verkuil COBALT_SYSSTAT_VI3_LOST_DATA_MSK | 25585756a06SHans Verkuil COBALT_SYSSTAT_VIHSMA_LOST_DATA_MSK | 25685756a06SHans Verkuil COBALT_SYSSTAT_VOHSMA_LOST_DATA_MSK | 25785756a06SHans Verkuil COBALT_SYSSTAT_AUD_IN_LOST_DATA_MSK | 25885756a06SHans Verkuil COBALT_SYSSTAT_AUD_OUT_LOST_DATA_MSK); 25985756a06SHans Verkuil } 260