drivers/media/pci/cobalt/cobalt-irq.c

   1 /*
   2  *  cobalt interrupt handling
   3  *
   4  *  Copyright 2012-2015 Cisco Systems, Inc. and/or its affiliates.
   5  *  All rights reserved.
   6  *
   7  *  This program is free software; you may redistribute it and/or modify
   8  *  it under the terms of the GNU General Public License as published by
   9  *  the Free Software Foundation; version 2 of the License.
  10  *
  11  *  THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  12  *  EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  13  *  MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  14  *  NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  15  *  BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  16  *  ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  17  *  CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  18  *  SOFTWARE.
  19  */
  20
  21 #include <media/i2c/adv7604.h>
  22
  23 #include "cobalt-driver.h"
  24 #include "cobalt-irq.h"
  25 #include "cobalt-omnitek.h"
  26
  27 static void cobalt_dma_stream_queue_handler(struct cobalt_stream *s)
  28 {
  29         struct cobalt *cobalt = s->cobalt;
  30         int rx = s->video_channel;
  31         struct m00473_freewheel_regmap __iomem *fw =
  32                 COBALT_CVI_FREEWHEEL(s->cobalt, rx);
  33         struct m00233_video_measure_regmap __iomem *vmr =
  34                 COBALT_CVI_VMR(s->cobalt, rx);
  35         struct m00389_cvi_regmap __iomem *cvi =
  36                 COBALT_CVI(s->cobalt, rx);
  37         struct m00479_clk_loss_detector_regmap __iomem *clkloss =
  38                 COBALT_CVI_CLK_LOSS(s->cobalt, rx);
  39         struct cobalt_buffer *cb;
  40         bool skip = false;
  41
  42         spin_lock(&s->irqlock);
  43
  44         if (list_empty(&s->bufs)) {
  45                 pr_err("no buffers!\n");
  46                 spin_unlock(&s->irqlock);
  47                 return;
  48         }
  49
  50         /* Give the fresh filled up buffer to the user.
  51          * Note that the interrupt is only sent if the DMA can continue
  52          * with a new buffer, so it is always safe to return this buffer
  53          * to userspace. */
  54         cb = list_first_entry(&s->bufs, struct cobalt_buffer, list);
  55         list_del(&cb->list);
  56         spin_unlock(&s->irqlock);
  57
  58         if (s->is_audio || s->is_output)
  59                 goto done;
  60
  61         if (s->unstable_frame) {
  62                 uint32_t stat = ioread32(&vmr->irq_status);
  63
  64                 iowrite32(stat, &vmr->irq_status);
  65                 if (!(ioread32(&vmr->status) &
  66                       M00233_STATUS_BITMAP_INIT_DONE_MSK)) {
  67                         cobalt_dbg(1, "!init_done\n");
  68                         if (s->enable_freewheel)
  69                                 goto restart_fw;
  70                         goto done;
  71                 }
  72
  73                 if (ioread32(&clkloss->status) &
  74                     M00479_STATUS_BITMAP_CLOCK_MISSING_MSK) {
  75                         iowrite32(0, &clkloss->ctrl);
  76                         iowrite32(M00479_CTRL_BITMAP_ENABLE_MSK, &clkloss->ctrl);
  77                         cobalt_dbg(1, "no clock\n");
  78                         if (s->enable_freewheel)
  79                                 goto restart_fw;
  80                         goto done;
  81                 }
  82                 if ((stat & (M00233_IRQ_STATUS_BITMAP_VACTIVE_AREA_MSK |
  83                              M00233_IRQ_STATUS_BITMAP_HACTIVE_AREA_MSK)) ||
  84                                 ioread32(&vmr->vactive_area) != s->timings.bt.height ||
  85                                 ioread32(&vmr->hactive_area) != s->timings.bt.width) {
  86                         cobalt_dbg(1, "unstable\n");
  87                         if (s->enable_freewheel)
  88                                 goto restart_fw;
  89                         goto done;
  90                 }
  91                 if (!s->enable_cvi) {
  92                         s->enable_cvi = true;
  93                         iowrite32(M00389_CONTROL_BITMAP_ENABLE_MSK, &cvi->control);
  94                         goto done;
  95                 }
  96                 if (!(ioread32(&cvi->status) & M00389_STATUS_BITMAP_LOCK_MSK)) {
  97                         cobalt_dbg(1, "cvi no lock\n");
  98                         if (s->enable_freewheel)
  99                                 goto restart_fw;
 100                         goto done;
 101                 }
 102                 if (!s->enable_freewheel) {
 103                         cobalt_dbg(1, "stable\n");
 104                         s->enable_freewheel = true;
 105                         iowrite32(0, &fw->ctrl);
 106                         goto done;
 107                 }
 108                 cobalt_dbg(1, "enabled fw\n");
 109                 iowrite32(M00233_CONTROL_BITMAP_ENABLE_MEASURE_MSK |
 110                           M00233_CONTROL_BITMAP_ENABLE_INTERRUPT_MSK,
 111                           &vmr->control);
 112                 iowrite32(M00473_CTRL_BITMAP_ENABLE_MSK, &fw->ctrl);
 113                 s->enable_freewheel = false;
 114                 s->unstable_frame = false;
 115                 s->skip_first_frames = 2;
 116                 skip = true;
 117                 goto done;
 118         }
 119         if (ioread32(&fw->status) & M00473_STATUS_BITMAP_FREEWHEEL_MODE_MSK) {
 120 restart_fw:
 121                 cobalt_dbg(1, "lost lock\n");
 122                 iowrite32(M00233_CONTROL_BITMAP_ENABLE_MEASURE_MSK,
 123                           &vmr->control);
 124                 iowrite32(M00473_CTRL_BITMAP_ENABLE_MSK |
 125                           M00473_CTRL_BITMAP_FORCE_FREEWHEEL_MODE_MSK,
 126                           &fw->ctrl);
 127                 iowrite32(0, &cvi->control);
 128                 s->unstable_frame = true;
 129                 s->enable_freewheel = false;
 130                 s->enable_cvi = false;
 131         }
 132 done:
 133         if (s->skip_first_frames) {
 134                 skip = true;
 135                 s->skip_first_frames--;
 136         }
 137         cb->vb.vb2_buf.timestamp = ktime_get_ns();
 138         /* TODO: the sequence number should be read from the FPGA so we
 139            also know about dropped frames. */
 140         cb->vb.sequence = s->sequence++;
 141         vb2_buffer_done(&cb->vb.vb2_buf,
 142                         (skip || s->unstable_frame) ?
 143                         VB2_BUF_STATE_REQUEUEING : VB2_BUF_STATE_DONE);
 144 }
 145
 146 irqreturn_t cobalt_irq_handler(int irq, void *dev_id)
 147 {
 148         struct cobalt *cobalt = (struct cobalt *)dev_id;
 149         u32 dma_interrupt =
 150                 cobalt_read_bar0(cobalt, DMA_INTERRUPT_STATUS_REG) & 0xffff;
 151         u32 mask = cobalt_read_bar1(cobalt, COBALT_SYS_STAT_MASK);
 152         u32 edge = cobalt_read_bar1(cobalt, COBALT_SYS_STAT_EDGE);
 153         int i;
 154
 155         /* Clear DMA interrupt */
 156         cobalt_write_bar0(cobalt, DMA_INTERRUPT_STATUS_REG, dma_interrupt);
 157         cobalt_write_bar1(cobalt, COBALT_SYS_STAT_MASK, mask & ~edge);
 158         cobalt_write_bar1(cobalt, COBALT_SYS_STAT_EDGE, edge);
 159
 160         for (i = 0; i < COBALT_NUM_STREAMS; i++) {
 161                 struct cobalt_stream *s = &cobalt->streams[i];
 162                 unsigned dma_fifo_mask = s->dma_fifo_mask;
 163
 164                 if (dma_interrupt & (1 << s->dma_channel)) {
 165                         cobalt->irq_dma[i]++;
 166                         /* Give fresh buffer to user and chain newly
 167                          * queued buffers */
 168                         cobalt_dma_stream_queue_handler(s);
 169                         if (!s->is_audio) {
 170                                 edge &= ~dma_fifo_mask;
 171                                 cobalt_write_bar1(cobalt, COBALT_SYS_STAT_MASK,
 172                                                   mask & ~edge);
 173                         }
 174                 }
 175                 if (s->is_audio)
 176                         continue;
 177                 if (edge & s->adv_irq_mask)
 178                         set_bit(COBALT_STREAM_FL_ADV_IRQ, &s->flags);
 179                 if ((edge & mask & dma_fifo_mask) && vb2_is_streaming(&s->q)) {
 180                         cobalt_info("full rx FIFO %d\n", i);
 181                         cobalt->irq_full_fifo++;
 182                 }
 183         }
 184
 185         queue_work(cobalt->irq_work_queues, &cobalt->irq_work_queue);
 186
 187         if (edge & mask & (COBALT_SYSSTAT_VI0_INT1_MSK |
 188                            COBALT_SYSSTAT_VI1_INT1_MSK |
 189                            COBALT_SYSSTAT_VI2_INT1_MSK |
 190                            COBALT_SYSSTAT_VI3_INT1_MSK |
 191                            COBALT_SYSSTAT_VIHSMA_INT1_MSK |
 192                            COBALT_SYSSTAT_VOHSMA_INT1_MSK))
 193                 cobalt->irq_adv1++;
 194         if (edge & mask & (COBALT_SYSSTAT_VI0_INT2_MSK |
 195                            COBALT_SYSSTAT_VI1_INT2_MSK |
 196                            COBALT_SYSSTAT_VI2_INT2_MSK |
 197                            COBALT_SYSSTAT_VI3_INT2_MSK |
 198                            COBALT_SYSSTAT_VIHSMA_INT2_MSK))
 199                 cobalt->irq_adv2++;
 200         if (edge & mask & COBALT_SYSSTAT_VOHSMA_INT1_MSK)
 201                 cobalt->irq_advout++;
 202         if (dma_interrupt)
 203                 cobalt->irq_dma_tot++;
 204         if (!(edge & mask) && !dma_interrupt)
 205                 cobalt->irq_none++;
 206         dma_interrupt = cobalt_read_bar0(cobalt, DMA_INTERRUPT_STATUS_REG);
 207
 208         return IRQ_HANDLED;
 209 }
 210
 211 void cobalt_irq_work_handler(struct work_struct *work)
 212 {
 213         struct cobalt *cobalt =
 214                 container_of(work, struct cobalt, irq_work_queue);
 215         int i;
 216
 217         for (i = 0; i < COBALT_NUM_NODES; i++) {
 218                 struct cobalt_stream *s = &cobalt->streams[i];
 219
 220                 if (test_and_clear_bit(COBALT_STREAM_FL_ADV_IRQ, &s->flags)) {
 221                         u32 mask;
 222
 223                         v4l2_subdev_call(cobalt->streams[i].sd, core,
 224                                         interrupt_service_routine, 0, NULL);
 225                         mask = cobalt_read_bar1(cobalt, COBALT_SYS_STAT_MASK);
 226                         cobalt_write_bar1(cobalt, COBALT_SYS_STAT_MASK,
 227                                 mask | s->adv_irq_mask);
 228                 }
 229         }
 230 }
 231
 232 void cobalt_irq_log_status(struct cobalt *cobalt)
 233 {
 234         u32 mask;
 235         int i;
 236
 237         cobalt_info("irq: adv1=%u adv2=%u advout=%u none=%u full=%u\n",
 238                     cobalt->irq_adv1, cobalt->irq_adv2, cobalt->irq_advout,
 239                     cobalt->irq_none, cobalt->irq_full_fifo);
 240         cobalt_info("irq: dma_tot=%u (", cobalt->irq_dma_tot);
 241         for (i = 0; i < COBALT_NUM_STREAMS; i++)
 242                 pr_cont("%s%u", i ? "/" : "", cobalt->irq_dma[i]);
 243         pr_cont(")\n");
 244         cobalt->irq_dma_tot = cobalt->irq_adv1 = cobalt->irq_adv2 = 0;
 245         cobalt->irq_advout = cobalt->irq_none = cobalt->irq_full_fifo = 0;
 246         memset(cobalt->irq_dma, 0, sizeof(cobalt->irq_dma));
 247
 248         mask = cobalt_read_bar1(cobalt, COBALT_SYS_STAT_MASK);
 249         cobalt_write_bar1(cobalt, COBALT_SYS_STAT_MASK,
 250                         mask |
 251                         COBALT_SYSSTAT_VI0_LOST_DATA_MSK |
 252                         COBALT_SYSSTAT_VI1_LOST_DATA_MSK |
 253                         COBALT_SYSSTAT_VI2_LOST_DATA_MSK |
 254                         COBALT_SYSSTAT_VI3_LOST_DATA_MSK |
 255                         COBALT_SYSSTAT_VIHSMA_LOST_DATA_MSK |
 256                         COBALT_SYSSTAT_VOHSMA_LOST_DATA_MSK |
 257                         COBALT_SYSSTAT_AUD_IN_LOST_DATA_MSK |
 258                         COBALT_SYSSTAT_AUD_OUT_LOST_DATA_MSK);
 259 }