2 * Copyright (C) 2010 Bluecherry, LLC www.bluecherrydvr.com
3 * Copyright (C) 2010 Ben Collins <bcollins@bluecherry.net>
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.
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.
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.
20 #include <linux/kernel.h>
21 #include <linux/module.h>
22 #include <linux/videodev2.h>
23 #include <media/v4l2-ioctl.h>
27 #define SOLO_VCLK_DELAY 3
28 #define SOLO_PROGRESSIVE_VSIZE 1024
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)
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)");
41 static void solo_vin_config(struct solo6010_dev *solo_dev)
43 solo_dev->vin_hstart = 8;
44 solo_dev->vin_vstart = 2;
46 solo_reg_write(solo_dev, SOLO_SYS_VCLK,
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));
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));
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));
69 solo_reg_write(solo_dev, SOLO_VI_ACT_P,
72 SOLO_VI_V_STOP(SOLO_PROGRESSIVE_VSIZE));
74 solo_reg_write(solo_dev, SOLO_VI_CH_FORMAT,
75 SOLO_VI_FD_SEL_MASK(0) | SOLO_VI_PROG_MASK(0));
77 solo_reg_write(solo_dev, SOLO_VI_FMT_CFG, 0);
78 solo_reg_write(solo_dev, SOLO_VI_PAGE_SW, 2);
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));
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));
97 solo_reg_write(solo_dev, SOLO_VI_PB_ACT_H, SOLO_VI_PB_HSTART(16) |
98 SOLO_VI_PB_HSTOP(16 + 720));
101 static void solo_disp_config(struct solo6010_dev *solo_dev)
103 solo_dev->vout_hstart = 6;
104 solo_dev->vout_vstart = 8;
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);
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));
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));
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));
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));
134 solo_reg_write(solo_dev, SOLO_VI_WIN_SW, 5);
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));
140 solo_reg_write(solo_dev, SOLO_VO_DISP_ERASE, SOLO_VO_DISP_ERASE_ON);
142 /* Enable channels we support */
143 solo_reg_write(solo_dev, SOLO_VI_CH_ENA, (1 << solo_dev->nr_chans) - 1);
145 /* Disable the watchdog */
146 solo_reg_write(solo_dev, SOLO_WATCHDOG, 0);
149 static int solo_dma_vin_region(struct solo6010_dev *solo_dev, u32 off,
150 u16 val, int reg_size)
156 for (i = 0; i < sizeof(buf) >> 1; i++)
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,
167 void solo_set_motion_threshold(struct solo6010_dev *solo_dev, u8 ch, u16 val)
169 if (ch > solo_dev->nr_chans)
172 solo_dma_vin_region(solo_dev, SOLO_MOT_FLAG_AREA +
173 (ch * SOLO_MOT_THRESH_SIZE * 2),
174 val, SOLO_MOT_THRESH_REAL);
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)
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,
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);
196 /* Set default threshold table */
197 solo_set_motion_threshold(solo_dev, i, SOLO_DEF_MOT_THRESH);
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));
209 solo_reg_write(solo_dev, SOLO_VI_MOTION_BORDER, 0);
210 solo_reg_write(solo_dev, SOLO_VI_MOTION_BAR, 0);
213 int solo_disp_init(struct solo6010_dev *solo_dev)
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;
223 solo_dev->video_type = SOLO_VO_FMT_TYPE_PAL;
224 solo_dev->video_vsize = 288;
228 solo_vin_config(solo_dev);
229 solo_motion_config(solo_dev);
230 solo_disp_config(solo_dev);
232 for (i = 0; i < solo_dev->nr_chans; i++)
233 solo_reg_write(solo_dev, SOLO_VI_WIN_ON(i), 1);
238 void solo_disp_exit(struct solo6010_dev *solo_dev)
242 solo6010_irq_off(solo_dev, SOLO_IRQ_MOTION);
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);
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);
254 /* Set default border */
255 for (i = 0; i < 5; i++)
256 solo_reg_write(solo_dev, SOLO_VO_BORDER_X(i), 0);
258 for (i = 0; i < 5; i++)
259 solo_reg_write(solo_dev, SOLO_VO_BORDER_Y(i), 0);
261 solo_reg_write(solo_dev, SOLO_VO_BORDER_LINE_MASK, 0);
262 solo_reg_write(solo_dev, SOLO_VO_BORDER_FILL_MASK, 0);
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);
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);