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