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 37static unsigned video_type; 38module_param(video_type, uint, 0644); 39MODULE_PARM_DESC(video_type, "video_type (0 = NTSC/Default, 1 = PAL)"); 40 41static 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 101static 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 149static 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 167void 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. */ 181static 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 213int 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 238void 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} 272