1 /*
2 * Copyright (C) 2010-2013 Bluecherry, LLC <http://www.bluecherrydvr.com>
3 *
4 * Original author:
5 * Ben Collins <bcollins@ubuntu.com>
6 *
7 * Additional work by:
8 * John Brooks <john.brooks@bluecherry.net>
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
14 *
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
19 */
20
21 #include <linux/kernel.h>
22 #include <linux/delay.h>
23
24 #include "solo6x10.h"
25 #include "solo6x10-tw28.h"
26
27 #define DEFAULT_HDELAY_NTSC (32 - 8)
28 #define DEFAULT_HACTIVE_NTSC (720 + 16)
29 #define DEFAULT_VDELAY_NTSC (7 - 2)
30 #define DEFAULT_VACTIVE_NTSC (240 + 4)
31
32 #define DEFAULT_HDELAY_PAL (32 + 4)
33 #define DEFAULT_HACTIVE_PAL (864-DEFAULT_HDELAY_PAL)
34 #define DEFAULT_VDELAY_PAL (6)
35 #define DEFAULT_VACTIVE_PAL (312-DEFAULT_VDELAY_PAL)
36
37
38 static const u8 tbl_tw2864_ntsc_template[] = {
39 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x02, /* 0x00 */
40 0x12, 0xf5, 0x0c, 0xd0, 0x00, 0x00, 0x00, 0x7f,
41 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x02, /* 0x10 */
42 0x12, 0xf5, 0x0c, 0xd0, 0x00, 0x00, 0x00, 0x7f,
43 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x02, /* 0x20 */
44 0x12, 0xf5, 0x0c, 0xd0, 0x00, 0x00, 0x00, 0x7f,
45 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x02, /* 0x30 */
46 0x12, 0xf5, 0x0c, 0xd0, 0x00, 0x00, 0x00, 0x7f,
47 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x40 */
48 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
49 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x50 */
50 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
51 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x60 */
52 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
53 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x70 */
54 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xA3, 0x00,
55 0x00, 0x02, 0x00, 0xcc, 0x00, 0x80, 0x44, 0x50, /* 0x80 */
56 0x22, 0x01, 0xd8, 0xbc, 0xb8, 0x44, 0x38, 0x00,
57 0x00, 0x78, 0x72, 0x3e, 0x14, 0xa5, 0xe4, 0x05, /* 0x90 */
58 0x00, 0x28, 0x44, 0x44, 0xa0, 0x88, 0x5a, 0x01,
59 0x08, 0x08, 0x08, 0x08, 0x1a, 0x1a, 0x1a, 0x1a, /* 0xa0 */
60 0x00, 0x00, 0x00, 0xf0, 0xf0, 0xf0, 0xf0, 0x44,
61 0x44, 0x0a, 0x00, 0xff, 0xef, 0xef, 0xef, 0xef, /* 0xb0 */
62 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
63 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0xc0 */
64 0x00, 0x00, 0x55, 0x00, 0xb1, 0xe4, 0x40, 0x00,
65 0x77, 0x77, 0x01, 0x13, 0x57, 0x9b, 0xdf, 0x20, /* 0xd0 */
66 0x64, 0xa8, 0xec, 0xc1, 0x0f, 0x11, 0x11, 0x81,
67 0x00, 0xe0, 0xbb, 0xbb, 0x00, 0x11, 0x00, 0x00, /* 0xe0 */
68 0x11, 0x00, 0x00, 0x11, 0x00, 0x00, 0x11, 0x00,
69 0x83, 0xb5, 0x09, 0x78, 0x85, 0x00, 0x01, 0x20, /* 0xf0 */
70 0x64, 0x11, 0x40, 0xaf, 0xff, 0x00, 0x00, 0x00,
71 };
72
73 static const u8 tbl_tw2864_pal_template[] = {
74 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x12, /* 0x00 */
75 0x18, 0xf5, 0x0c, 0xd0, 0x00, 0x00, 0x01, 0x7f,
76 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x12, /* 0x10 */
77 0x18, 0xf5, 0x0c, 0xd0, 0x00, 0x00, 0x01, 0x7f,
78 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x12, /* 0x20 */
79 0x18, 0xf5, 0x0c, 0xd0, 0x00, 0x00, 0x01, 0x7f,
80 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x12, /* 0x30 */
81 0x18, 0xf5, 0x0c, 0xd0, 0x00, 0x00, 0x01, 0x7f,
82 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x40 */
83 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
84 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x50 */
85 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
86 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x60 */
87 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
88 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x70 */
89 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xA3, 0x00,
90 0x00, 0x02, 0x00, 0xcc, 0x00, 0x80, 0x44, 0x50, /* 0x80 */
91 0x22, 0x01, 0xd8, 0xbc, 0xb8, 0x44, 0x38, 0x00,
92 0x00, 0x78, 0x72, 0x3e, 0x14, 0xa5, 0xe4, 0x05, /* 0x90 */
93 0x00, 0x28, 0x44, 0x44, 0xa0, 0x90, 0x5a, 0x01,
94 0x0a, 0x0a, 0x0a, 0x0a, 0x1a, 0x1a, 0x1a, 0x1a, /* 0xa0 */
95 0x00, 0x00, 0x00, 0xf0, 0xf0, 0xf0, 0xf0, 0x44,
96 0x44, 0x0a, 0x00, 0xff, 0xef, 0xef, 0xef, 0xef, /* 0xb0 */
97 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
98 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0xc0 */
99 0x00, 0x00, 0x55, 0x00, 0xb1, 0xe4, 0x40, 0x00,
100 0x77, 0x77, 0x01, 0x13, 0x57, 0x9b, 0xdf, 0x20, /* 0xd0 */
101 0x64, 0xa8, 0xec, 0xc1, 0x0f, 0x11, 0x11, 0x81,
102 0x00, 0xe0, 0xbb, 0xbb, 0x00, 0x11, 0x00, 0x00, /* 0xe0 */
103 0x11, 0x00, 0x00, 0x11, 0x00, 0x00, 0x11, 0x00,
104 0x83, 0xb5, 0x09, 0x00, 0xa0, 0x00, 0x01, 0x20, /* 0xf0 */
105 0x64, 0x11, 0x40, 0xaf, 0xff, 0x00, 0x00, 0x00,
106 };
107
108 static const u8 tbl_tw2865_ntsc_template[] = {
109 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x02, /* 0x00 */
110 0x12, 0xff, 0x09, 0xd0, 0x00, 0x00, 0x00, 0x7f,
111 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x02, /* 0x10 */
112 0x12, 0xff, 0x09, 0xd0, 0x00, 0x00, 0x00, 0x7f,
113 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x02, /* 0x20 */
114 0x12, 0xff, 0x09, 0xd0, 0x00, 0x00, 0x00, 0x7f,
115 0x00, 0xf0, 0x70, 0x48, 0x80, 0x80, 0x00, 0x02, /* 0x30 */
116 0x12, 0xff, 0x09, 0xd0, 0x00, 0x00, 0x00, 0x7f,
117 0x00, 0x00, 0x90, 0x68, 0x00, 0x38, 0x80, 0x80, /* 0x40 */
118 0x80, 0x80, 0x77, 0x00, 0x00, 0x00, 0x00, 0x00,
119 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x50 */
120 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
121 0x45, 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x60 */
122 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x21, 0x43,
123 0x08, 0x00, 0x00, 0x01, 0xf1, 0x03, 0xEF, 0x03, /* 0x70 */
124 0xE9, 0x03, 0xD9, 0x15, 0x15, 0xE4, 0xA3, 0x80,
125 0x00, 0x02, 0x00, 0xCC, 0x00, 0x80, 0x44, 0x50, /* 0x80 */
126 0x22, 0x01, 0xD8, 0xBC, 0xB8, 0x44, 0x38, 0x00,
127 0x00, 0x78, 0x44, 0x3D, 0x14, 0xA5, 0xE0, 0x05, /* 0x90 */
128 0x00, 0x28, 0x44, 0x44, 0xA0, 0x90, 0x52, 0x13,
129 0x08, 0x08, 0x08, 0x08, 0x1A, 0x1A, 0x1B, 0x1A, /* 0xa0 */
130 0x00, 0x00, 0x00, 0xF0, 0xF0, 0xF0, 0xF0, 0x44,
131 0x44, 0x4A, 0x00, 0xFF, 0xEF, 0xEF, 0xEF, 0xEF, /* 0xb0 */
132 0xFF, 0xE7, 0xE9, 0xE9, 0xEB, 0xFF, 0xD6, 0xD8,
133 0xD8, 0xD7, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0xc0 */
134 0x00, 0x00, 0x55, 0x00, 0xE4, 0x39, 0x00, 0x80,
135 0x77, 0x77, 0x03, 0x20, 0x57, 0x9b, 0xdf, 0x31, /* 0xd0 */
136 0x64, 0xa8, 0xec, 0xd1, 0x0f, 0x11, 0x11, 0x81,
137 0x10, 0xC0, 0xAA, 0xAA, 0x00, 0x11, 0x00, 0x00, /* 0xe0 */
138 0x11, 0x00, 0x00, 0x11, 0x00, 0x00, 0x11, 0x00,
139 0x83, 0xB5, 0x09, 0x78, 0x85, 0x00, 0x01, 0x20, /* 0xf0 */
140 0x64, 0x51, 0x40, 0xaf, 0xFF, 0xF0, 0x00, 0xC0,
141 };
142
143 static const u8 tbl_tw2865_pal_template[] = {
144 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x12, /* 0x00 */
145 0x11, 0xff, 0x01, 0xc3, 0x00, 0x00, 0x01, 0x7f,
146 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x12, /* 0x10 */
147 0x11, 0xff, 0x01, 0xc3, 0x00, 0x00, 0x01, 0x7f,
148 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x12, /* 0x20 */
149 0x11, 0xff, 0x01, 0xc3, 0x00, 0x00, 0x01, 0x7f,
150 0x00, 0xf0, 0x70, 0x30, 0x80, 0x80, 0x00, 0x12, /* 0x30 */
151 0x11, 0xff, 0x01, 0xc3, 0x00, 0x00, 0x01, 0x7f,
152 0x00, 0x94, 0x90, 0x48, 0x00, 0x38, 0x7F, 0x80, /* 0x40 */
153 0x80, 0x80, 0x77, 0x00, 0x00, 0x00, 0x00, 0x00,
154 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x50 */
155 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
156 0x45, 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x60 */
157 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x21, 0x43,
158 0x08, 0x00, 0x00, 0x01, 0xf1, 0x03, 0xEF, 0x03, /* 0x70 */
159 0xEA, 0x03, 0xD9, 0x15, 0x15, 0xE4, 0xA3, 0x80,
160 0x00, 0x02, 0x00, 0xCC, 0x00, 0x80, 0x44, 0x50, /* 0x80 */
161 0x22, 0x01, 0xD8, 0xBC, 0xB8, 0x44, 0x38, 0x00,
162 0x00, 0x78, 0x44, 0x3D, 0x14, 0xA5, 0xE0, 0x05, /* 0x90 */
163 0x00, 0x28, 0x44, 0x44, 0xA0, 0x90, 0x52, 0x13,
164 0x08, 0x08, 0x08, 0x08, 0x1A, 0x1A, 0x1A, 0x1A, /* 0xa0 */
165 0x00, 0x00, 0x00, 0xF0, 0xF0, 0xF0, 0xF0, 0x44,
166 0x44, 0x4A, 0x00, 0xFF, 0xEF, 0xEF, 0xEF, 0xEF, /* 0xb0 */
167 0xFF, 0xE7, 0xE9, 0xE9, 0xE9, 0xFF, 0xD7, 0xD8,
168 0xD9, 0xD8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0xc0 */
169 0x00, 0x00, 0x55, 0x00, 0xE4, 0x39, 0x00, 0x80,
170 0x77, 0x77, 0x03, 0x20, 0x57, 0x9b, 0xdf, 0x31, /* 0xd0 */
171 0x64, 0xa8, 0xec, 0xd1, 0x0f, 0x11, 0x11, 0x81,
172 0x10, 0xC0, 0xAA, 0xAA, 0x00, 0x11, 0x00, 0x00, /* 0xe0 */
173 0x11, 0x00, 0x00, 0x11, 0x00, 0x00, 0x11, 0x00,
174 0x83, 0xB5, 0x09, 0x00, 0xA0, 0x00, 0x01, 0x20, /* 0xf0 */
175 0x64, 0x51, 0x40, 0xaf, 0xFF, 0xF0, 0x00, 0xC0,
176 };
177
178 #define is_tw286x(__solo, __id) (!(__solo->tw2815 & (1 << __id)))
179
tw_readbyte(struct solo_dev * solo_dev,int chip_id,u8 tw6x_off,u8 tw_off)180 static u8 tw_readbyte(struct solo_dev *solo_dev, int chip_id, u8 tw6x_off,
181 u8 tw_off)
182 {
183 if (is_tw286x(solo_dev, chip_id))
184 return solo_i2c_readbyte(solo_dev, SOLO_I2C_TW,
185 TW_CHIP_OFFSET_ADDR(chip_id),
186 tw6x_off);
187 else
188 return solo_i2c_readbyte(solo_dev, SOLO_I2C_TW,
189 TW_CHIP_OFFSET_ADDR(chip_id),
190 tw_off);
191 }
192
tw_writebyte(struct solo_dev * solo_dev,int chip_id,u8 tw6x_off,u8 tw_off,u8 val)193 static void tw_writebyte(struct solo_dev *solo_dev, int chip_id,
194 u8 tw6x_off, u8 tw_off, u8 val)
195 {
196 if (is_tw286x(solo_dev, chip_id))
197 solo_i2c_writebyte(solo_dev, SOLO_I2C_TW,
198 TW_CHIP_OFFSET_ADDR(chip_id),
199 tw6x_off, val);
200 else
201 solo_i2c_writebyte(solo_dev, SOLO_I2C_TW,
202 TW_CHIP_OFFSET_ADDR(chip_id),
203 tw_off, val);
204 }
205
tw_write_and_verify(struct solo_dev * solo_dev,u8 addr,u8 off,u8 val)206 static void tw_write_and_verify(struct solo_dev *solo_dev, u8 addr, u8 off,
207 u8 val)
208 {
209 int i;
210
211 for (i = 0; i < 5; i++) {
212 u8 rval = solo_i2c_readbyte(solo_dev, SOLO_I2C_TW, addr, off);
213
214 if (rval == val)
215 return;
216
217 solo_i2c_writebyte(solo_dev, SOLO_I2C_TW, addr, off, val);
218 msleep_interruptible(1);
219 }
220
221 /* printk("solo6x10/tw28: Error writing register: %02x->%02x [%02x]\n", */
222 /* addr, off, val); */
223 }
224
tw2865_setup(struct solo_dev * solo_dev,u8 dev_addr)225 static int tw2865_setup(struct solo_dev *solo_dev, u8 dev_addr)
226 {
227 u8 tbl_tw2865_common[256];
228 int i;
229
230 if (solo_dev->video_type == SOLO_VO_FMT_TYPE_PAL)
231 memcpy(tbl_tw2865_common, tbl_tw2865_pal_template,
232 sizeof(tbl_tw2865_common));
233 else
234 memcpy(tbl_tw2865_common, tbl_tw2865_ntsc_template,
235 sizeof(tbl_tw2865_common));
236
237 /* ALINK Mode */
238 if (solo_dev->nr_chans == 4) {
239 tbl_tw2865_common[0xd2] = 0x01;
240 tbl_tw2865_common[0xcf] = 0x00;
241 } else if (solo_dev->nr_chans == 8) {
242 tbl_tw2865_common[0xd2] = 0x02;
243 if (dev_addr == TW_CHIP_OFFSET_ADDR(1))
244 tbl_tw2865_common[0xcf] = 0x80;
245 } else if (solo_dev->nr_chans == 16) {
246 tbl_tw2865_common[0xd2] = 0x03;
247 if (dev_addr == TW_CHIP_OFFSET_ADDR(1))
248 tbl_tw2865_common[0xcf] = 0x83;
249 else if (dev_addr == TW_CHIP_OFFSET_ADDR(2))
250 tbl_tw2865_common[0xcf] = 0x83;
251 else if (dev_addr == TW_CHIP_OFFSET_ADDR(3))
252 tbl_tw2865_common[0xcf] = 0x80;
253 }
254
255 for (i = 0; i < 0xff; i++) {
256 /* Skip read only registers */
257 switch (i) {
258 case 0xb8 ... 0xc1:
259 case 0xc4 ... 0xc7:
260 case 0xfd:
261 continue;
262 }
263 switch (i & ~0x30) {
264 case 0x00:
265 case 0x0c ... 0x0d:
266 continue;
267 }
268
269 tw_write_and_verify(solo_dev, dev_addr, i,
270 tbl_tw2865_common[i]);
271 }
272
273 return 0;
274 }
275
tw2864_setup(struct solo_dev * solo_dev,u8 dev_addr)276 static int tw2864_setup(struct solo_dev *solo_dev, u8 dev_addr)
277 {
278 u8 tbl_tw2864_common[256];
279 int i;
280
281 if (solo_dev->video_type == SOLO_VO_FMT_TYPE_PAL)
282 memcpy(tbl_tw2864_common, tbl_tw2864_pal_template,
283 sizeof(tbl_tw2864_common));
284 else
285 memcpy(tbl_tw2864_common, tbl_tw2864_ntsc_template,
286 sizeof(tbl_tw2864_common));
287
288 if (solo_dev->tw2865 == 0) {
289 /* IRQ Mode */
290 if (solo_dev->nr_chans == 4) {
291 tbl_tw2864_common[0xd2] = 0x01;
292 tbl_tw2864_common[0xcf] = 0x00;
293 } else if (solo_dev->nr_chans == 8) {
294 tbl_tw2864_common[0xd2] = 0x02;
295 if (dev_addr == TW_CHIP_OFFSET_ADDR(0))
296 tbl_tw2864_common[0xcf] = 0x43;
297 else if (dev_addr == TW_CHIP_OFFSET_ADDR(1))
298 tbl_tw2864_common[0xcf] = 0x40;
299 } else if (solo_dev->nr_chans == 16) {
300 tbl_tw2864_common[0xd2] = 0x03;
301 if (dev_addr == TW_CHIP_OFFSET_ADDR(0))
302 tbl_tw2864_common[0xcf] = 0x43;
303 else if (dev_addr == TW_CHIP_OFFSET_ADDR(1))
304 tbl_tw2864_common[0xcf] = 0x43;
305 else if (dev_addr == TW_CHIP_OFFSET_ADDR(2))
306 tbl_tw2864_common[0xcf] = 0x43;
307 else if (dev_addr == TW_CHIP_OFFSET_ADDR(3))
308 tbl_tw2864_common[0xcf] = 0x40;
309 }
310 } else {
311 /* ALINK Mode. Assumes that the first tw28xx is a
312 * 2865 and these are in cascade. */
313 for (i = 0; i <= 4; i++)
314 tbl_tw2864_common[0x08 | i << 4] = 0x12;
315
316 if (solo_dev->nr_chans == 8) {
317 tbl_tw2864_common[0xd2] = 0x02;
318 if (dev_addr == TW_CHIP_OFFSET_ADDR(1))
319 tbl_tw2864_common[0xcf] = 0x80;
320 } else if (solo_dev->nr_chans == 16) {
321 tbl_tw2864_common[0xd2] = 0x03;
322 if (dev_addr == TW_CHIP_OFFSET_ADDR(1))
323 tbl_tw2864_common[0xcf] = 0x83;
324 else if (dev_addr == TW_CHIP_OFFSET_ADDR(2))
325 tbl_tw2864_common[0xcf] = 0x83;
326 else if (dev_addr == TW_CHIP_OFFSET_ADDR(3))
327 tbl_tw2864_common[0xcf] = 0x80;
328 }
329 }
330
331 for (i = 0; i < 0xff; i++) {
332 /* Skip read only registers */
333 switch (i) {
334 case 0xb8 ... 0xc1:
335 case 0xfd:
336 continue;
337 }
338 switch (i & ~0x30) {
339 case 0x00:
340 case 0x0c:
341 case 0x0d:
342 continue;
343 }
344
345 tw_write_and_verify(solo_dev, dev_addr, i,
346 tbl_tw2864_common[i]);
347 }
348
349 return 0;
350 }
351
tw2815_setup(struct solo_dev * solo_dev,u8 dev_addr)352 static int tw2815_setup(struct solo_dev *solo_dev, u8 dev_addr)
353 {
354 u8 tbl_ntsc_tw2815_common[] = {
355 0x00, 0xc8, 0x20, 0xd0, 0x06, 0xf0, 0x08, 0x80,
356 0x80, 0x80, 0x80, 0x02, 0x06, 0x00, 0x11,
357 };
358
359 u8 tbl_pal_tw2815_common[] = {
360 0x00, 0x88, 0x20, 0xd0, 0x05, 0x20, 0x28, 0x80,
361 0x80, 0x80, 0x80, 0x82, 0x06, 0x00, 0x11,
362 };
363
364 u8 tbl_tw2815_sfr[] = {
365 0x00, 0x00, 0x00, 0xc0, 0x45, 0xa0, 0xd0, 0x2f, /* 0x00 */
366 0x64, 0x80, 0x80, 0x82, 0x82, 0x00, 0x00, 0x00,
367 0x00, 0x0f, 0x05, 0x00, 0x00, 0x80, 0x06, 0x00, /* 0x10 */
368 0x00, 0x00, 0x00, 0xff, 0x8f, 0x00, 0x00, 0x00,
369 0x88, 0x88, 0xc0, 0x00, 0x20, 0x64, 0xa8, 0xec, /* 0x20 */
370 0x31, 0x75, 0xb9, 0xfd, 0x00, 0x00, 0x88, 0x88,
371 0x88, 0x11, 0x00, 0x88, 0x88, 0x00, /* 0x30 */
372 };
373 u8 *tbl_tw2815_common;
374 int i;
375 int ch;
376
377 tbl_ntsc_tw2815_common[0x06] = 0;
378
379 /* Horizontal Delay Control */
380 tbl_ntsc_tw2815_common[0x02] = DEFAULT_HDELAY_NTSC & 0xff;
381 tbl_ntsc_tw2815_common[0x06] |= 0x03 & (DEFAULT_HDELAY_NTSC >> 8);
382
383 /* Horizontal Active Control */
384 tbl_ntsc_tw2815_common[0x03] = DEFAULT_HACTIVE_NTSC & 0xff;
385 tbl_ntsc_tw2815_common[0x06] |=
386 ((0x03 & (DEFAULT_HACTIVE_NTSC >> 8)) << 2);
387
388 /* Vertical Delay Control */
389 tbl_ntsc_tw2815_common[0x04] = DEFAULT_VDELAY_NTSC & 0xff;
390 tbl_ntsc_tw2815_common[0x06] |=
391 ((0x01 & (DEFAULT_VDELAY_NTSC >> 8)) << 4);
392
393 /* Vertical Active Control */
394 tbl_ntsc_tw2815_common[0x05] = DEFAULT_VACTIVE_NTSC & 0xff;
395 tbl_ntsc_tw2815_common[0x06] |=
396 ((0x01 & (DEFAULT_VACTIVE_NTSC >> 8)) << 5);
397
398 tbl_pal_tw2815_common[0x06] = 0;
399
400 /* Horizontal Delay Control */
401 tbl_pal_tw2815_common[0x02] = DEFAULT_HDELAY_PAL & 0xff;
402 tbl_pal_tw2815_common[0x06] |= 0x03 & (DEFAULT_HDELAY_PAL >> 8);
403
404 /* Horizontal Active Control */
405 tbl_pal_tw2815_common[0x03] = DEFAULT_HACTIVE_PAL & 0xff;
406 tbl_pal_tw2815_common[0x06] |=
407 ((0x03 & (DEFAULT_HACTIVE_PAL >> 8)) << 2);
408
409 /* Vertical Delay Control */
410 tbl_pal_tw2815_common[0x04] = DEFAULT_VDELAY_PAL & 0xff;
411 tbl_pal_tw2815_common[0x06] |=
412 ((0x01 & (DEFAULT_VDELAY_PAL >> 8)) << 4);
413
414 /* Vertical Active Control */
415 tbl_pal_tw2815_common[0x05] = DEFAULT_VACTIVE_PAL & 0xff;
416 tbl_pal_tw2815_common[0x06] |=
417 ((0x01 & (DEFAULT_VACTIVE_PAL >> 8)) << 5);
418
419 tbl_tw2815_common =
420 (solo_dev->video_type == SOLO_VO_FMT_TYPE_NTSC) ?
421 tbl_ntsc_tw2815_common : tbl_pal_tw2815_common;
422
423 /* Dual ITU-R BT.656 format */
424 tbl_tw2815_common[0x0d] |= 0x04;
425
426 /* Audio configuration */
427 tbl_tw2815_sfr[0x62 - 0x40] &= ~(3 << 6);
428
429 if (solo_dev->nr_chans == 4) {
430 tbl_tw2815_sfr[0x63 - 0x40] |= 1;
431 tbl_tw2815_sfr[0x62 - 0x40] |= 3 << 6;
432 } else if (solo_dev->nr_chans == 8) {
433 tbl_tw2815_sfr[0x63 - 0x40] |= 2;
434 if (dev_addr == TW_CHIP_OFFSET_ADDR(0))
435 tbl_tw2815_sfr[0x62 - 0x40] |= 1 << 6;
436 else if (dev_addr == TW_CHIP_OFFSET_ADDR(1))
437 tbl_tw2815_sfr[0x62 - 0x40] |= 2 << 6;
438 } else if (solo_dev->nr_chans == 16) {
439 tbl_tw2815_sfr[0x63 - 0x40] |= 3;
440 if (dev_addr == TW_CHIP_OFFSET_ADDR(0))
441 tbl_tw2815_sfr[0x62 - 0x40] |= 1 << 6;
442 else if (dev_addr == TW_CHIP_OFFSET_ADDR(1))
443 tbl_tw2815_sfr[0x62 - 0x40] |= 0 << 6;
444 else if (dev_addr == TW_CHIP_OFFSET_ADDR(2))
445 tbl_tw2815_sfr[0x62 - 0x40] |= 0 << 6;
446 else if (dev_addr == TW_CHIP_OFFSET_ADDR(3))
447 tbl_tw2815_sfr[0x62 - 0x40] |= 2 << 6;
448 }
449
450 /* Output mode of R_ADATM pin (0 mixing, 1 record) */
451 /* tbl_tw2815_sfr[0x63 - 0x40] |= 0 << 2; */
452
453 /* 8KHz, used to be 16KHz, but changed for remote client compat */
454 tbl_tw2815_sfr[0x62 - 0x40] |= 0 << 2;
455 tbl_tw2815_sfr[0x6c - 0x40] |= 0 << 2;
456
457 /* Playback of right channel */
458 tbl_tw2815_sfr[0x6c - 0x40] |= 1 << 5;
459
460 /* Reserved value (XXX ??) */
461 tbl_tw2815_sfr[0x5c - 0x40] |= 1 << 5;
462
463 /* Analog output gain and mix ratio playback on full */
464 tbl_tw2815_sfr[0x70 - 0x40] |= 0xff;
465 /* Select playback audio and mute all except */
466 tbl_tw2815_sfr[0x71 - 0x40] |= 0x10;
467 tbl_tw2815_sfr[0x6d - 0x40] |= 0x0f;
468
469 /* End of audio configuration */
470
471 for (ch = 0; ch < 4; ch++) {
472 tbl_tw2815_common[0x0d] &= ~3;
473 switch (ch) {
474 case 0:
475 tbl_tw2815_common[0x0d] |= 0x21;
476 break;
477 case 1:
478 tbl_tw2815_common[0x0d] |= 0x20;
479 break;
480 case 2:
481 tbl_tw2815_common[0x0d] |= 0x23;
482 break;
483 case 3:
484 tbl_tw2815_common[0x0d] |= 0x22;
485 break;
486 }
487
488 for (i = 0; i < 0x0f; i++) {
489 if (i == 0x00)
490 continue; /* read-only */
491 solo_i2c_writebyte(solo_dev, SOLO_I2C_TW,
492 dev_addr, (ch * 0x10) + i,
493 tbl_tw2815_common[i]);
494 }
495 }
496
497 for (i = 0x40; i < 0x76; i++) {
498 /* Skip read-only and nop registers */
499 if (i == 0x40 || i == 0x59 || i == 0x5a ||
500 i == 0x5d || i == 0x5e || i == 0x5f)
501 continue;
502
503 solo_i2c_writebyte(solo_dev, SOLO_I2C_TW, dev_addr, i,
504 tbl_tw2815_sfr[i - 0x40]);
505 }
506
507 return 0;
508 }
509
510 #define FIRST_ACTIVE_LINE 0x0008
511 #define LAST_ACTIVE_LINE 0x0102
512
saa712x_write_regs(struct solo_dev * dev,const u8 * vals,int start,int n)513 static void saa712x_write_regs(struct solo_dev *dev, const u8 *vals,
514 int start, int n)
515 {
516 for (; start < n; start++, vals++) {
517 /* Skip read-only registers */
518 switch (start) {
519 /* case 0x00 ... 0x25: */
520 case 0x2e ... 0x37:
521 case 0x60:
522 case 0x7d:
523 continue;
524 }
525 solo_i2c_writebyte(dev, SOLO_I2C_SAA, 0x46, start, *vals);
526 }
527 }
528
529 #define SAA712x_reg7c (0x80 | ((LAST_ACTIVE_LINE & 0x100) >> 2) \
530 | ((FIRST_ACTIVE_LINE & 0x100) >> 4))
531
saa712x_setup(struct solo_dev * dev)532 static void saa712x_setup(struct solo_dev *dev)
533 {
534 const int reg_start = 0x26;
535 const u8 saa7128_regs_ntsc[] = {
536 /* :0x26 */
537 0x0d, 0x00,
538 /* :0x28 */
539 0x59, 0x1d, 0x75, 0x3f, 0x06, 0x3f,
540 /* :0x2e XXX: read-only */
541 0x00, 0x00,
542 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
543 /* :0x38 */
544 0x1a, 0x1a, 0x13, 0x00, 0x00, 0x00, 0x00, 0x00,
545 /* :0x40 */
546 0x00, 0x00, 0x00, 0x68, 0x10, 0x97, 0x4c, 0x18,
547 0x9b, 0x93, 0x9f, 0xff, 0x7c, 0x34, 0x3f, 0x3f,
548 /* :0x50 */
549 0x3f, 0x83, 0x83, 0x80, 0x0d, 0x0f, 0xc3, 0x06,
550 0x02, 0x80, 0x71, 0x77, 0xa7, 0x67, 0x66, 0x2e,
551 /* :0x60 */
552 0x7b, 0x11, 0x4f, 0x1f, 0x7c, 0xf0, 0x21, 0x77,
553 0x41, 0x88, 0x41, 0x52, 0xed, 0x10, 0x10, 0x00,
554 /* :0x70 */
555 0x41, 0xc3, 0x00, 0x3e, 0xb8, 0x02, 0x00, 0x00,
556 0x00, 0x00, FIRST_ACTIVE_LINE, LAST_ACTIVE_LINE & 0xff,
557 SAA712x_reg7c, 0x00, 0xff, 0xff,
558 }, saa7128_regs_pal[] = {
559 /* :0x26 */
560 0x0d, 0x00,
561 /* :0x28 */
562 0xe1, 0x1d, 0x75, 0x3f, 0x06, 0x3f,
563 /* :0x2e XXX: read-only */
564 0x00, 0x00,
565 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
566 /* :0x38 */
567 0x1a, 0x1a, 0x13, 0x00, 0x00, 0x00, 0x00, 0x00,
568 /* :0x40 */
569 0x00, 0x00, 0x00, 0x68, 0x10, 0x97, 0x4c, 0x18,
570 0x9b, 0x93, 0x9f, 0xff, 0x7c, 0x34, 0x3f, 0x3f,
571 /* :0x50 */
572 0x3f, 0x83, 0x83, 0x80, 0x0d, 0x0f, 0xc3, 0x06,
573 0x02, 0x80, 0x0f, 0x77, 0xa7, 0x67, 0x66, 0x2e,
574 /* :0x60 */
575 0x7b, 0x02, 0x35, 0xcb, 0x8a, 0x09, 0x2a, 0x77,
576 0x41, 0x88, 0x41, 0x52, 0xf1, 0x10, 0x20, 0x00,
577 /* :0x70 */
578 0x41, 0xc3, 0x00, 0x3e, 0xb8, 0x02, 0x00, 0x00,
579 0x00, 0x00, 0x12, 0x30,
580 SAA712x_reg7c | 0x40, 0x00, 0xff, 0xff,
581 };
582
583 if (dev->video_type == SOLO_VO_FMT_TYPE_PAL)
584 saa712x_write_regs(dev, saa7128_regs_pal, reg_start,
585 sizeof(saa7128_regs_pal));
586 else
587 saa712x_write_regs(dev, saa7128_regs_ntsc, reg_start,
588 sizeof(saa7128_regs_ntsc));
589 }
590
solo_tw28_init(struct solo_dev * solo_dev)591 int solo_tw28_init(struct solo_dev *solo_dev)
592 {
593 int i;
594 u8 value;
595
596 solo_dev->tw28_cnt = 0;
597
598 /* Detect techwell chip type(s) */
599 for (i = 0; i < solo_dev->nr_chans / 4; i++) {
600 value = solo_i2c_readbyte(solo_dev, SOLO_I2C_TW,
601 TW_CHIP_OFFSET_ADDR(i), 0xFF);
602
603 switch (value >> 3) {
604 case 0x18:
605 solo_dev->tw2865 |= 1 << i;
606 solo_dev->tw28_cnt++;
607 break;
608 case 0x0c:
609 solo_dev->tw2864 |= 1 << i;
610 solo_dev->tw28_cnt++;
611 break;
612 default:
613 value = solo_i2c_readbyte(solo_dev, SOLO_I2C_TW,
614 TW_CHIP_OFFSET_ADDR(i),
615 0x59);
616 if ((value >> 3) == 0x04) {
617 solo_dev->tw2815 |= 1 << i;
618 solo_dev->tw28_cnt++;
619 }
620 }
621 }
622
623 if (solo_dev->tw28_cnt != (solo_dev->nr_chans >> 2)) {
624 dev_err(&solo_dev->pdev->dev,
625 "Could not initialize any techwell chips\n");
626 return -EINVAL;
627 }
628
629 saa712x_setup(solo_dev);
630
631 for (i = 0; i < solo_dev->tw28_cnt; i++) {
632 if ((solo_dev->tw2865 & (1 << i)))
633 tw2865_setup(solo_dev, TW_CHIP_OFFSET_ADDR(i));
634 else if ((solo_dev->tw2864 & (1 << i)))
635 tw2864_setup(solo_dev, TW_CHIP_OFFSET_ADDR(i));
636 else
637 tw2815_setup(solo_dev, TW_CHIP_OFFSET_ADDR(i));
638 }
639
640 return 0;
641 }
642
643 /*
644 * We accessed the video status signal in the Techwell chip through
645 * iic/i2c because the video status reported by register REG_VI_STATUS1
646 * (address 0x012C) of the SOLO6010 chip doesn't give the correct video
647 * status signal values.
648 */
tw28_get_video_status(struct solo_dev * solo_dev,u8 ch)649 int tw28_get_video_status(struct solo_dev *solo_dev, u8 ch)
650 {
651 u8 val, chip_num;
652
653 /* Get the right chip and on-chip channel */
654 chip_num = ch / 4;
655 ch %= 4;
656
657 val = tw_readbyte(solo_dev, chip_num, TW286x_AV_STAT_ADDR,
658 TW_AV_STAT_ADDR) & 0x0f;
659
660 return val & (1 << ch) ? 1 : 0;
661 }
662
663 #if 0
664 /* Status of audio from up to 4 techwell chips are combined into 1 variable.
665 * See techwell datasheet for details. */
666 u16 tw28_get_audio_status(struct solo_dev *solo_dev)
667 {
668 u8 val;
669 u16 status = 0;
670 int i;
671
672 for (i = 0; i < solo_dev->tw28_cnt; i++) {
673 val = (tw_readbyte(solo_dev, i, TW286x_AV_STAT_ADDR,
674 TW_AV_STAT_ADDR) & 0xf0) >> 4;
675 status |= val << (i * 4);
676 }
677
678 return status;
679 }
680 #endif
681
tw28_has_sharpness(struct solo_dev * solo_dev,u8 ch)682 bool tw28_has_sharpness(struct solo_dev *solo_dev, u8 ch)
683 {
684 return is_tw286x(solo_dev, ch / 4);
685 }
686
tw28_set_ctrl_val(struct solo_dev * solo_dev,u32 ctrl,u8 ch,s32 val)687 int tw28_set_ctrl_val(struct solo_dev *solo_dev, u32 ctrl, u8 ch,
688 s32 val)
689 {
690 char sval;
691 u8 chip_num;
692
693 /* Get the right chip and on-chip channel */
694 chip_num = ch / 4;
695 ch %= 4;
696
697 if (val > 255 || val < 0)
698 return -ERANGE;
699
700 switch (ctrl) {
701 case V4L2_CID_SHARPNESS:
702 /* Only 286x has sharpness */
703 if (is_tw286x(solo_dev, chip_num)) {
704 u8 v = solo_i2c_readbyte(solo_dev, SOLO_I2C_TW,
705 TW_CHIP_OFFSET_ADDR(chip_num),
706 TW286x_SHARPNESS(chip_num));
707 v &= 0xf0;
708 v |= val;
709 solo_i2c_writebyte(solo_dev, SOLO_I2C_TW,
710 TW_CHIP_OFFSET_ADDR(chip_num),
711 TW286x_SHARPNESS(chip_num), v);
712 } else {
713 return -EINVAL;
714 }
715 break;
716
717 case V4L2_CID_HUE:
718 if (is_tw286x(solo_dev, chip_num))
719 sval = val - 128;
720 else
721 sval = (char)val;
722 tw_writebyte(solo_dev, chip_num, TW286x_HUE_ADDR(ch),
723 TW_HUE_ADDR(ch), sval);
724
725 break;
726
727 case V4L2_CID_SATURATION:
728 /* 286x chips have a U and V component for saturation */
729 if (is_tw286x(solo_dev, chip_num)) {
730 solo_i2c_writebyte(solo_dev, SOLO_I2C_TW,
731 TW_CHIP_OFFSET_ADDR(chip_num),
732 TW286x_SATURATIONU_ADDR(ch), val);
733 }
734 tw_writebyte(solo_dev, chip_num, TW286x_SATURATIONV_ADDR(ch),
735 TW_SATURATION_ADDR(ch), val);
736
737 break;
738
739 case V4L2_CID_CONTRAST:
740 tw_writebyte(solo_dev, chip_num, TW286x_CONTRAST_ADDR(ch),
741 TW_CONTRAST_ADDR(ch), val);
742 break;
743
744 case V4L2_CID_BRIGHTNESS:
745 if (is_tw286x(solo_dev, chip_num))
746 sval = val - 128;
747 else
748 sval = (char)val;
749 tw_writebyte(solo_dev, chip_num, TW286x_BRIGHTNESS_ADDR(ch),
750 TW_BRIGHTNESS_ADDR(ch), sval);
751
752 break;
753 default:
754 return -EINVAL;
755 }
756
757 return 0;
758 }
759
tw28_get_ctrl_val(struct solo_dev * solo_dev,u32 ctrl,u8 ch,s32 * val)760 int tw28_get_ctrl_val(struct solo_dev *solo_dev, u32 ctrl, u8 ch,
761 s32 *val)
762 {
763 u8 rval, chip_num;
764
765 /* Get the right chip and on-chip channel */
766 chip_num = ch / 4;
767 ch %= 4;
768
769 switch (ctrl) {
770 case V4L2_CID_SHARPNESS:
771 /* Only 286x has sharpness */
772 if (is_tw286x(solo_dev, chip_num)) {
773 rval = solo_i2c_readbyte(solo_dev, SOLO_I2C_TW,
774 TW_CHIP_OFFSET_ADDR(chip_num),
775 TW286x_SHARPNESS(chip_num));
776 *val = rval & 0x0f;
777 } else
778 *val = 0;
779 break;
780 case V4L2_CID_HUE:
781 rval = tw_readbyte(solo_dev, chip_num, TW286x_HUE_ADDR(ch),
782 TW_HUE_ADDR(ch));
783 if (is_tw286x(solo_dev, chip_num))
784 *val = (s32)((char)rval) + 128;
785 else
786 *val = rval;
787 break;
788 case V4L2_CID_SATURATION:
789 *val = tw_readbyte(solo_dev, chip_num,
790 TW286x_SATURATIONU_ADDR(ch),
791 TW_SATURATION_ADDR(ch));
792 break;
793 case V4L2_CID_CONTRAST:
794 *val = tw_readbyte(solo_dev, chip_num,
795 TW286x_CONTRAST_ADDR(ch),
796 TW_CONTRAST_ADDR(ch));
797 break;
798 case V4L2_CID_BRIGHTNESS:
799 rval = tw_readbyte(solo_dev, chip_num,
800 TW286x_BRIGHTNESS_ADDR(ch),
801 TW_BRIGHTNESS_ADDR(ch));
802 if (is_tw286x(solo_dev, chip_num))
803 *val = (s32)((char)rval) + 128;
804 else
805 *val = rval;
806 break;
807 default:
808 return -EINVAL;
809 }
810
811 return 0;
812 }
813
814 #if 0
815 /*
816 * For audio output volume, the output channel is only 1. In this case we
817 * don't need to offset TW_CHIP_OFFSET_ADDR. The TW_CHIP_OFFSET_ADDR used
818 * is the base address of the techwell chip.
819 */
820 void tw2815_Set_AudioOutVol(struct solo_dev *solo_dev, unsigned int u_val)
821 {
822 unsigned int val;
823 unsigned int chip_num;
824
825 chip_num = (solo_dev->nr_chans - 1) / 4;
826
827 val = tw_readbyte(solo_dev, chip_num, TW286x_AUDIO_OUTPUT_VOL_ADDR,
828 TW_AUDIO_OUTPUT_VOL_ADDR);
829
830 u_val = (val & 0x0f) | (u_val << 4);
831
832 tw_writebyte(solo_dev, chip_num, TW286x_AUDIO_OUTPUT_VOL_ADDR,
833 TW_AUDIO_OUTPUT_VOL_ADDR, u_val);
834 }
835 #endif
836
tw28_get_audio_gain(struct solo_dev * solo_dev,u8 ch)837 u8 tw28_get_audio_gain(struct solo_dev *solo_dev, u8 ch)
838 {
839 u8 val;
840 u8 chip_num;
841
842 /* Get the right chip and on-chip channel */
843 chip_num = ch / 4;
844 ch %= 4;
845
846 val = tw_readbyte(solo_dev, chip_num,
847 TW286x_AUDIO_INPUT_GAIN_ADDR(ch),
848 TW_AUDIO_INPUT_GAIN_ADDR(ch));
849
850 return (ch % 2) ? (val >> 4) : (val & 0x0f);
851 }
852
tw28_set_audio_gain(struct solo_dev * solo_dev,u8 ch,u8 val)853 void tw28_set_audio_gain(struct solo_dev *solo_dev, u8 ch, u8 val)
854 {
855 u8 old_val;
856 u8 chip_num;
857
858 /* Get the right chip and on-chip channel */
859 chip_num = ch / 4;
860 ch %= 4;
861
862 old_val = tw_readbyte(solo_dev, chip_num,
863 TW286x_AUDIO_INPUT_GAIN_ADDR(ch),
864 TW_AUDIO_INPUT_GAIN_ADDR(ch));
865
866 val = (old_val & ((ch % 2) ? 0x0f : 0xf0)) |
867 ((ch % 2) ? (val << 4) : val);
868
869 tw_writebyte(solo_dev, chip_num, TW286x_AUDIO_INPUT_GAIN_ADDR(ch),
870 TW_AUDIO_INPUT_GAIN_ADDR(ch), val);
871 }
872