drivers/staging/solo6x10/solo6010-disp.c

   1 /*
   2  * Copyright (C) 2010 Bluecherry, LLC www.bluecherrydvr.com
   3  * Copyright (C) 2010 Ben Collins <bcollins@bluecherry.net>
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License as published by
   7  * the Free Software Foundation; either version 2 of the License, or
   8  * (at your option) any later version.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program; if not, write to the Free Software
  17  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  18  */
  19
  20 #include <linux/kernel.h>
  21 #include <linux/module.h>
  22 #include <linux/videodev2.h>
  23 #include <media/v4l2-ioctl.h>
  24
  25 #include "solo6010.h"
  26
  27 #define SOLO_VCLK_DELAY                 3
  28 #define SOLO_PROGRESSIVE_VSIZE          1024
  29
  30 #define SOLO_MOT_THRESH_W               64
  31 #define SOLO_MOT_THRESH_H               64
  32 #define SOLO_MOT_THRESH_SIZE            8192
  33 #define SOLO_MOT_THRESH_REAL            (SOLO_MOT_THRESH_W * SOLO_MOT_THRESH_H)
  34 #define SOLO_MOT_FLAG_SIZE              512
  35 #define SOLO_MOT_FLAG_AREA              (SOLO_MOT_FLAG_SIZE * 32)
  36
  37 static unsigned video_type;
  38 module_param(video_type, uint, 0644);
  39 MODULE_PARM_DESC(video_type, "video_type (0 = NTSC/Default, 1 = PAL)");
  40
  41 static void solo_vin_config(struct solo6010_dev *solo_dev)
  42 {
  43         solo_dev->vin_hstart = 8;
  44         solo_dev->vin_vstart = 2;
  45
  46         solo_reg_write(solo_dev, SOLO_SYS_VCLK,
  47                        SOLO_VCLK_SELECT(2) |
  48                        SOLO_VCLK_VIN1415_DELAY(SOLO_VCLK_DELAY) |
  49                        SOLO_VCLK_VIN1213_DELAY(SOLO_VCLK_DELAY) |
  50                        SOLO_VCLK_VIN1011_DELAY(SOLO_VCLK_DELAY) |
  51                        SOLO_VCLK_VIN0809_DELAY(SOLO_VCLK_DELAY) |
  52                        SOLO_VCLK_VIN0607_DELAY(SOLO_VCLK_DELAY) |
  53                        SOLO_VCLK_VIN0405_DELAY(SOLO_VCLK_DELAY) |
  54                        SOLO_VCLK_VIN0203_DELAY(SOLO_VCLK_DELAY) |
  55                        SOLO_VCLK_VIN0001_DELAY(SOLO_VCLK_DELAY));
  56
  57         solo_reg_write(solo_dev, SOLO_VI_ACT_I_P,
  58                        SOLO_VI_H_START(solo_dev->vin_hstart) |
  59                        SOLO_VI_V_START(solo_dev->vin_vstart) |
  60                        SOLO_VI_V_STOP(solo_dev->vin_vstart +
  61                                       solo_dev->video_vsize));
  62
  63         solo_reg_write(solo_dev, SOLO_VI_ACT_I_S,
  64                        SOLO_VI_H_START(solo_dev->vout_hstart) |
  65                        SOLO_VI_V_START(solo_dev->vout_vstart) |
  66                        SOLO_VI_V_STOP(solo_dev->vout_vstart +
  67                                       solo_dev->video_vsize));
  68
  69         solo_reg_write(solo_dev, SOLO_VI_ACT_P,
  70                        SOLO_VI_H_START(0) |
  71                        SOLO_VI_V_START(1) |
  72                        SOLO_VI_V_STOP(SOLO_PROGRESSIVE_VSIZE));
  73
  74         solo_reg_write(solo_dev, SOLO_VI_CH_FORMAT,
  75                        SOLO_VI_FD_SEL_MASK(0) | SOLO_VI_PROG_MASK(0));
  76
  77         solo_reg_write(solo_dev, SOLO_VI_FMT_CFG, 0);
  78         solo_reg_write(solo_dev, SOLO_VI_PAGE_SW, 2);
  79
  80         if (solo_dev->video_type == SOLO_VO_FMT_TYPE_NTSC) {
  81                 solo_reg_write(solo_dev, SOLO_VI_PB_CONFIG,
  82                                SOLO_VI_PB_USER_MODE);
  83                 solo_reg_write(solo_dev, SOLO_VI_PB_RANGE_HV,
  84                                SOLO_VI_PB_HSIZE(858) | SOLO_VI_PB_VSIZE(246));
  85                 solo_reg_write(solo_dev, SOLO_VI_PB_ACT_V,
  86                                SOLO_VI_PB_VSTART(4) |
  87                                SOLO_VI_PB_VSTOP(4 + 240));
  88         } else {
  89                 solo_reg_write(solo_dev, SOLO_VI_PB_CONFIG,
  90                                SOLO_VI_PB_USER_MODE | SOLO_VI_PB_PAL);
  91                 solo_reg_write(solo_dev, SOLO_VI_PB_RANGE_HV,
  92                                SOLO_VI_PB_HSIZE(864) | SOLO_VI_PB_VSIZE(294));
  93                 solo_reg_write(solo_dev, SOLO_VI_PB_ACT_V,
  94                                SOLO_VI_PB_VSTART(4) |
  95                                SOLO_VI_PB_VSTOP(4 + 288));
  96         }
  97         solo_reg_write(solo_dev, SOLO_VI_PB_ACT_H, SOLO_VI_PB_HSTART(16) |
  98                        SOLO_VI_PB_HSTOP(16 + 720));
  99 }
 100
 101 static void solo_disp_config(struct solo6010_dev *solo_dev)
 102 {
 103         solo_dev->vout_hstart = 6;
 104         solo_dev->vout_vstart = 8;
 105
 106         solo_reg_write(solo_dev, SOLO_VO_BORDER_LINE_COLOR,
 107                        (0xa0 << 24) | (0x88 << 16) | (0xa0 << 8) | 0x88);
 108         solo_reg_write(solo_dev, SOLO_VO_BORDER_FILL_COLOR,
 109                        (0x10 << 24) | (0x8f << 16) | (0x10 << 8) | 0x8f);
 110         solo_reg_write(solo_dev, SOLO_VO_BKG_COLOR,
 111                        (16 << 24) | (128 << 16) | (16 << 8) | 128);
 112
 113         solo_reg_write(solo_dev, SOLO_VO_FMT_ENC,
 114                        solo_dev->video_type |
 115                        SOLO_VO_USER_COLOR_SET_NAV |
 116                        SOLO_VO_NA_COLOR_Y(0) |
 117                        SOLO_VO_NA_COLOR_CB(0) |
 118                        SOLO_VO_NA_COLOR_CR(0));
 119
 120         solo_reg_write(solo_dev, SOLO_VO_ACT_H,
 121                        SOLO_VO_H_START(solo_dev->vout_hstart) |
 122                        SOLO_VO_H_STOP(solo_dev->vout_hstart +
 123                                       solo_dev->video_hsize));
 124
 125         solo_reg_write(solo_dev, SOLO_VO_ACT_V,
 126                        SOLO_VO_V_START(solo_dev->vout_vstart) |
 127                        SOLO_VO_V_STOP(solo_dev->vout_vstart +
 128                                       solo_dev->video_vsize));
 129
 130         solo_reg_write(solo_dev, SOLO_VO_RANGE_HV,
 131                        SOLO_VO_H_LEN(solo_dev->video_hsize) |
 132                        SOLO_VO_V_LEN(solo_dev->video_vsize));
 133
 134         solo_reg_write(solo_dev, SOLO_VI_WIN_SW, 5);
 135
 136         solo_reg_write(solo_dev, SOLO_VO_DISP_CTRL, SOLO_VO_DISP_ON |
 137                        SOLO_VO_DISP_ERASE_COUNT(8) |
 138                        SOLO_VO_DISP_BASE(SOLO_DISP_EXT_ADDR(solo_dev)));
 139
 140         solo_reg_write(solo_dev, SOLO_VO_DISP_ERASE, SOLO_VO_DISP_ERASE_ON);
 141
 142         /* Enable channels we support */
 143         solo_reg_write(solo_dev, SOLO_VI_CH_ENA, (1 << solo_dev->nr_chans) - 1);
 144
 145         /* Disable the watchdog */
 146         solo_reg_write(solo_dev, SOLO_WATCHDOG, 0);
 147 }
 148
 149 static int solo_dma_vin_region(struct solo6010_dev *solo_dev, u32 off,
 150                                u16 val, int reg_size)
 151 {
 152         u16 buf[64];
 153         int i;
 154         int ret = 0;
 155
 156         for (i = 0; i < sizeof(buf) >> 1; i++)
 157                 buf[i] = val;
 158
 159         for (i = 0; i < reg_size; i += sizeof(buf))
 160                 ret |= solo_p2m_dma(solo_dev, SOLO_P2M_DMA_ID_VIN, 1, buf,
 161                                     SOLO_MOTION_EXT_ADDR(solo_dev) + off + i,
 162                                     sizeof(buf));
 163
 164         return ret;
 165 }
 166
 167 void solo_set_motion_threshold(struct solo6010_dev *solo_dev, u8 ch, u16 val)
 168 {
 169         if (ch > solo_dev->nr_chans)
 170                 return;
 171
 172         solo_dma_vin_region(solo_dev, SOLO_MOT_FLAG_AREA +
 173                             (ch * SOLO_MOT_THRESH_SIZE * 2),
 174                             val, SOLO_MOT_THRESH_REAL);
 175 }
 176
 177 /* First 8k is motion flag (512 bytes * 16). Following that is an 8k+8k
 178  * threshold and working table for each channel. Atleast that's what the
 179  * spec says. However, this code (take from rdk) has some mystery 8k
 180  * block right after the flag area, before the first thresh table. */
 181 static void solo_motion_config(struct solo6010_dev *solo_dev)
 182 {
 183         int i;
 184
 185         for (i = 0; i < solo_dev->nr_chans; i++) {
 186                 /* Clear motion flag area */
 187                 solo_dma_vin_region(solo_dev, i * SOLO_MOT_FLAG_SIZE, 0x0000,
 188                                     SOLO_MOT_FLAG_SIZE);
 189
 190                 /* Clear working cache table */
 191                 solo_dma_vin_region(solo_dev, SOLO_MOT_FLAG_AREA +
 192                                     SOLO_MOT_THRESH_SIZE +
 193                                     (i * SOLO_MOT_THRESH_SIZE * 2),
 194                                     0x0000, SOLO_MOT_THRESH_REAL);
 195
 196                 /* Set default threshold table */
 197                 solo_set_motion_threshold(solo_dev, i, SOLO_DEF_MOT_THRESH);
 198         }
 199
 200         /* Default motion settings */
 201         solo_reg_write(solo_dev, SOLO_VI_MOT_ADR, SOLO_VI_MOTION_EN(0) |
 202                        (SOLO_MOTION_EXT_ADDR(solo_dev) >> 16));
 203         solo_reg_write(solo_dev, SOLO_VI_MOT_CTRL,
 204                        SOLO_VI_MOTION_FRAME_COUNT(3) |
 205                        SOLO_VI_MOTION_SAMPLE_LENGTH(solo_dev->video_hsize / 16)
 206                        | /* SOLO_VI_MOTION_INTR_START_STOP | */
 207                        SOLO_VI_MOTION_SAMPLE_COUNT(10));
 208
 209         solo_reg_write(solo_dev, SOLO_VI_MOTION_BORDER, 0);
 210         solo_reg_write(solo_dev, SOLO_VI_MOTION_BAR, 0);
 211 }
 212
 213 int solo_disp_init(struct solo6010_dev *solo_dev)
 214 {
 215         int i;
 216
 217         solo_dev->video_hsize = 704;
 218         if (video_type == 0) {
 219                 solo_dev->video_type = SOLO_VO_FMT_TYPE_NTSC;
 220                 solo_dev->video_vsize = 240;
 221                 solo_dev->fps = 30;
 222         } else {
 223                 solo_dev->video_type = SOLO_VO_FMT_TYPE_PAL;
 224                 solo_dev->video_vsize = 288;
 225                 solo_dev->fps = 25;
 226         }
 227
 228         solo_vin_config(solo_dev);
 229         solo_motion_config(solo_dev);
 230         solo_disp_config(solo_dev);
 231
 232         for (i = 0; i < solo_dev->nr_chans; i++)
 233                 solo_reg_write(solo_dev, SOLO_VI_WIN_ON(i), 1);
 234
 235         return 0;
 236 }
 237
 238 void solo_disp_exit(struct solo6010_dev *solo_dev)
 239 {
 240         int i;
 241
 242         solo6010_irq_off(solo_dev, SOLO_IRQ_MOTION);
 243
 244         solo_reg_write(solo_dev, SOLO_VO_DISP_CTRL, 0);
 245         solo_reg_write(solo_dev, SOLO_VO_ZOOM_CTRL, 0);
 246         solo_reg_write(solo_dev, SOLO_VO_FREEZE_CTRL, 0);
 247
 248         for (i = 0; i < solo_dev->nr_chans; i++) {
 249                 solo_reg_write(solo_dev, SOLO_VI_WIN_CTRL0(i), 0);
 250                 solo_reg_write(solo_dev, SOLO_VI_WIN_CTRL1(i), 0);
 251                 solo_reg_write(solo_dev, SOLO_VI_WIN_ON(i), 0);
 252         }
 253
 254         /* Set default border */
 255         for (i = 0; i < 5; i++)
 256                 solo_reg_write(solo_dev, SOLO_VO_BORDER_X(i), 0);
 257
 258         for (i = 0; i < 5; i++)
 259                 solo_reg_write(solo_dev, SOLO_VO_BORDER_Y(i), 0);
 260
 261         solo_reg_write(solo_dev, SOLO_VO_BORDER_LINE_MASK, 0);
 262         solo_reg_write(solo_dev, SOLO_VO_BORDER_FILL_MASK, 0);
 263
 264         solo_reg_write(solo_dev, SOLO_VO_RECTANGLE_CTRL(0), 0);
 265         solo_reg_write(solo_dev, SOLO_VO_RECTANGLE_START(0), 0);
 266         solo_reg_write(solo_dev, SOLO_VO_RECTANGLE_STOP(0), 0);
 267
 268         solo_reg_write(solo_dev, SOLO_VO_RECTANGLE_CTRL(1), 0);
 269         solo_reg_write(solo_dev, SOLO_VO_RECTANGLE_START(1), 0);
 270         solo_reg_write(solo_dev, SOLO_VO_RECTANGLE_STOP(1), 0);
 271 }