Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
disp.c
Go to the documentation of this file.
1 /*
2  * Copyright (C) 2010 Bluecherry, LLC www.bluecherrydvr.com
3  * Copyright (C) 2010 Ben Collins <[email protected]>
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 
36 static unsigned video_type;
37 module_param(video_type, uint, 0644);
38 MODULE_PARM_DESC(video_type, "video_type (0 = NTSC/Default, 1 = PAL)");
39 
40 static 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 
100 static 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 
148 static 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 
166 void 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. */
180 static 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 
212 int 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 
237 void 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 }
Generated on Thu Jan 10 2013 14:29:40 for Linux Kernel by   doxygen 1.8.2