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