1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  *
4  *  Copyright (C) 2005 Mike Isely <isely@pobox.com>
5  */
6 
7 #include <linux/errno.h>
8 #include <linux/string.h>
9 #include <linux/slab.h>
10 #include <linux/module.h>
11 #include <linux/firmware.h>
12 #include <linux/videodev2.h>
13 #include <media/v4l2-common.h>
14 #include <media/tuner.h>
15 #include "pvrusb2.h"
16 #include "pvrusb2-std.h"
17 #include "pvrusb2-util.h"
18 #include "pvrusb2-hdw.h"
19 #include "pvrusb2-i2c-core.h"
20 #include "pvrusb2-eeprom.h"
21 #include "pvrusb2-hdw-internal.h"
22 #include "pvrusb2-encoder.h"
23 #include "pvrusb2-debug.h"
24 #include "pvrusb2-fx2-cmd.h"
25 #include "pvrusb2-wm8775.h"
26 #include "pvrusb2-video-v4l.h"
27 #include "pvrusb2-cx2584x-v4l.h"
28 #include "pvrusb2-cs53l32a.h"
29 #include "pvrusb2-audio.h"
30 
31 #define TV_MIN_FREQ     55250000L
32 #define TV_MAX_FREQ    850000000L
33 
34 /* This defines a minimum interval that the decoder must remain quiet
35    before we are allowed to start it running. */
36 #define TIME_MSEC_DECODER_WAIT 50
37 
38 /* This defines a minimum interval that the decoder must be allowed to run
39    before we can safely begin using its streaming output. */
40 #define TIME_MSEC_DECODER_STABILIZATION_WAIT 300
41 
42 /* This defines a minimum interval that the encoder must remain quiet
43    before we are allowed to configure it. */
44 #define TIME_MSEC_ENCODER_WAIT 50
45 
46 /* This defines the minimum interval that the encoder must successfully run
47    before we consider that the encoder has run at least once since its
48    firmware has been loaded.  This measurement is in important for cases
49    where we can't do something until we know that the encoder has been run
50    at least once. */
51 #define TIME_MSEC_ENCODER_OK 250
52 
53 static struct pvr2_hdw *unit_pointers[PVR_NUM] = {[ 0 ... PVR_NUM-1 ] = NULL};
54 static DEFINE_MUTEX(pvr2_unit_mtx);
55 
56 static int ctlchg;
57 static int procreload;
58 static int tuner[PVR_NUM] = { [0 ... PVR_NUM-1] = -1 };
59 static int tolerance[PVR_NUM] = { [0 ... PVR_NUM-1] = 0 };
60 static int video_std[PVR_NUM] = { [0 ... PVR_NUM-1] = 0 };
61 static int init_pause_msec;
62 
63 module_param(ctlchg, int, S_IRUGO|S_IWUSR);
64 MODULE_PARM_DESC(ctlchg, "0=optimize ctl change 1=always accept new ctl value");
65 module_param(init_pause_msec, int, S_IRUGO|S_IWUSR);
66 MODULE_PARM_DESC(init_pause_msec, "hardware initialization settling delay");
67 module_param(procreload, int, S_IRUGO|S_IWUSR);
68 MODULE_PARM_DESC(procreload,
69 		 "Attempt init failure recovery with firmware reload");
70 module_param_array(tuner,    int, NULL, 0444);
71 MODULE_PARM_DESC(tuner,"specify installed tuner type");
72 module_param_array(video_std,    int, NULL, 0444);
73 MODULE_PARM_DESC(video_std,"specify initial video standard");
74 module_param_array(tolerance,    int, NULL, 0444);
75 MODULE_PARM_DESC(tolerance,"specify stream error tolerance");
76 
77 /* US Broadcast channel 3 (61.25 MHz), to help with testing */
78 static int default_tv_freq    = 61250000L;
79 /* 104.3 MHz, a usable FM station for my area */
80 static int default_radio_freq = 104300000L;
81 
82 module_param_named(tv_freq, default_tv_freq, int, 0444);
83 MODULE_PARM_DESC(tv_freq, "specify initial television frequency");
84 module_param_named(radio_freq, default_radio_freq, int, 0444);
85 MODULE_PARM_DESC(radio_freq, "specify initial radio frequency");
86 
87 #define PVR2_CTL_WRITE_ENDPOINT  0x01
88 #define PVR2_CTL_READ_ENDPOINT   0x81
89 
90 #define PVR2_GPIO_IN 0x9008
91 #define PVR2_GPIO_OUT 0x900c
92 #define PVR2_GPIO_DIR 0x9020
93 
94 #define trace_firmware(...) pvr2_trace(PVR2_TRACE_FIRMWARE,__VA_ARGS__)
95 
96 #define PVR2_FIRMWARE_ENDPOINT   0x02
97 
98 /* size of a firmware chunk */
99 #define FIRMWARE_CHUNK_SIZE 0x2000
100 
101 typedef void (*pvr2_subdev_update_func)(struct pvr2_hdw *,
102 					struct v4l2_subdev *);
103 
104 static const pvr2_subdev_update_func pvr2_module_update_functions[] = {
105 	[PVR2_CLIENT_ID_WM8775] = pvr2_wm8775_subdev_update,
106 	[PVR2_CLIENT_ID_SAA7115] = pvr2_saa7115_subdev_update,
107 	[PVR2_CLIENT_ID_MSP3400] = pvr2_msp3400_subdev_update,
108 	[PVR2_CLIENT_ID_CX25840] = pvr2_cx25840_subdev_update,
109 	[PVR2_CLIENT_ID_CS53L32A] = pvr2_cs53l32a_subdev_update,
110 };
111 
112 static const char *module_names[] = {
113 	[PVR2_CLIENT_ID_MSP3400] = "msp3400",
114 	[PVR2_CLIENT_ID_CX25840] = "cx25840",
115 	[PVR2_CLIENT_ID_SAA7115] = "saa7115",
116 	[PVR2_CLIENT_ID_TUNER] = "tuner",
117 	[PVR2_CLIENT_ID_DEMOD] = "tuner",
118 	[PVR2_CLIENT_ID_CS53L32A] = "cs53l32a",
119 	[PVR2_CLIENT_ID_WM8775] = "wm8775",
120 };
121 
122 
123 static const unsigned char *module_i2c_addresses[] = {
124 	[PVR2_CLIENT_ID_TUNER] = "\x60\x61\x62\x63",
125 	[PVR2_CLIENT_ID_DEMOD] = "\x43",
126 	[PVR2_CLIENT_ID_MSP3400] = "\x40",
127 	[PVR2_CLIENT_ID_SAA7115] = "\x21",
128 	[PVR2_CLIENT_ID_WM8775] = "\x1b",
129 	[PVR2_CLIENT_ID_CX25840] = "\x44",
130 	[PVR2_CLIENT_ID_CS53L32A] = "\x11",
131 };
132 
133 
134 static const char *ir_scheme_names[] = {
135 	[PVR2_IR_SCHEME_NONE] = "none",
136 	[PVR2_IR_SCHEME_29XXX] = "29xxx",
137 	[PVR2_IR_SCHEME_24XXX] = "24xxx (29xxx emulation)",
138 	[PVR2_IR_SCHEME_24XXX_MCE] = "24xxx (MCE device)",
139 	[PVR2_IR_SCHEME_ZILOG] = "Zilog",
140 };
141 
142 
143 /* Define the list of additional controls we'll dynamically construct based
144    on query of the cx2341x module. */
145 struct pvr2_mpeg_ids {
146 	const char *strid;
147 	int id;
148 };
149 static const struct pvr2_mpeg_ids mpeg_ids[] = {
150 	{
151 		.strid = "audio_layer",
152 		.id = V4L2_CID_MPEG_AUDIO_ENCODING,
153 	},{
154 		.strid = "audio_bitrate",
155 		.id = V4L2_CID_MPEG_AUDIO_L2_BITRATE,
156 	},{
157 		/* Already using audio_mode elsewhere :-( */
158 		.strid = "mpeg_audio_mode",
159 		.id = V4L2_CID_MPEG_AUDIO_MODE,
160 	},{
161 		.strid = "mpeg_audio_mode_extension",
162 		.id = V4L2_CID_MPEG_AUDIO_MODE_EXTENSION,
163 	},{
164 		.strid = "audio_emphasis",
165 		.id = V4L2_CID_MPEG_AUDIO_EMPHASIS,
166 	},{
167 		.strid = "audio_crc",
168 		.id = V4L2_CID_MPEG_AUDIO_CRC,
169 	},{
170 		.strid = "video_aspect",
171 		.id = V4L2_CID_MPEG_VIDEO_ASPECT,
172 	},{
173 		.strid = "video_b_frames",
174 		.id = V4L2_CID_MPEG_VIDEO_B_FRAMES,
175 	},{
176 		.strid = "video_gop_size",
177 		.id = V4L2_CID_MPEG_VIDEO_GOP_SIZE,
178 	},{
179 		.strid = "video_gop_closure",
180 		.id = V4L2_CID_MPEG_VIDEO_GOP_CLOSURE,
181 	},{
182 		.strid = "video_bitrate_mode",
183 		.id = V4L2_CID_MPEG_VIDEO_BITRATE_MODE,
184 	},{
185 		.strid = "video_bitrate",
186 		.id = V4L2_CID_MPEG_VIDEO_BITRATE,
187 	},{
188 		.strid = "video_bitrate_peak",
189 		.id = V4L2_CID_MPEG_VIDEO_BITRATE_PEAK,
190 	},{
191 		.strid = "video_temporal_decimation",
192 		.id = V4L2_CID_MPEG_VIDEO_TEMPORAL_DECIMATION,
193 	},{
194 		.strid = "stream_type",
195 		.id = V4L2_CID_MPEG_STREAM_TYPE,
196 	},{
197 		.strid = "video_spatial_filter_mode",
198 		.id = V4L2_CID_MPEG_CX2341X_VIDEO_SPATIAL_FILTER_MODE,
199 	},{
200 		.strid = "video_spatial_filter",
201 		.id = V4L2_CID_MPEG_CX2341X_VIDEO_SPATIAL_FILTER,
202 	},{
203 		.strid = "video_luma_spatial_filter_type",
204 		.id = V4L2_CID_MPEG_CX2341X_VIDEO_LUMA_SPATIAL_FILTER_TYPE,
205 	},{
206 		.strid = "video_chroma_spatial_filter_type",
207 		.id = V4L2_CID_MPEG_CX2341X_VIDEO_CHROMA_SPATIAL_FILTER_TYPE,
208 	},{
209 		.strid = "video_temporal_filter_mode",
210 		.id = V4L2_CID_MPEG_CX2341X_VIDEO_TEMPORAL_FILTER_MODE,
211 	},{
212 		.strid = "video_temporal_filter",
213 		.id = V4L2_CID_MPEG_CX2341X_VIDEO_TEMPORAL_FILTER,
214 	},{
215 		.strid = "video_median_filter_type",
216 		.id = V4L2_CID_MPEG_CX2341X_VIDEO_MEDIAN_FILTER_TYPE,
217 	},{
218 		.strid = "video_luma_median_filter_top",
219 		.id = V4L2_CID_MPEG_CX2341X_VIDEO_LUMA_MEDIAN_FILTER_TOP,
220 	},{
221 		.strid = "video_luma_median_filter_bottom",
222 		.id = V4L2_CID_MPEG_CX2341X_VIDEO_LUMA_MEDIAN_FILTER_BOTTOM,
223 	},{
224 		.strid = "video_chroma_median_filter_top",
225 		.id = V4L2_CID_MPEG_CX2341X_VIDEO_CHROMA_MEDIAN_FILTER_TOP,
226 	},{
227 		.strid = "video_chroma_median_filter_bottom",
228 		.id = V4L2_CID_MPEG_CX2341X_VIDEO_CHROMA_MEDIAN_FILTER_BOTTOM,
229 	}
230 };
231 #define MPEGDEF_COUNT ARRAY_SIZE(mpeg_ids)
232 
233 
234 static const char *control_values_srate[] = {
235 	[V4L2_MPEG_AUDIO_SAMPLING_FREQ_44100]   = "44.1 kHz",
236 	[V4L2_MPEG_AUDIO_SAMPLING_FREQ_48000]   = "48 kHz",
237 	[V4L2_MPEG_AUDIO_SAMPLING_FREQ_32000]   = "32 kHz",
238 };
239 
240 
241 
242 static const char *control_values_input[] = {
243 	[PVR2_CVAL_INPUT_TV]        = "television",  /*xawtv needs this name*/
244 	[PVR2_CVAL_INPUT_DTV]       = "dtv",
245 	[PVR2_CVAL_INPUT_RADIO]     = "radio",
246 	[PVR2_CVAL_INPUT_SVIDEO]    = "s-video",
247 	[PVR2_CVAL_INPUT_COMPOSITE] = "composite",
248 };
249 
250 
251 static const char *control_values_audiomode[] = {
252 	[V4L2_TUNER_MODE_MONO]   = "Mono",
253 	[V4L2_TUNER_MODE_STEREO] = "Stereo",
254 	[V4L2_TUNER_MODE_LANG1]  = "Lang1",
255 	[V4L2_TUNER_MODE_LANG2]  = "Lang2",
256 	[V4L2_TUNER_MODE_LANG1_LANG2] = "Lang1+Lang2",
257 };
258 
259 
260 static const char *control_values_hsm[] = {
261 	[PVR2_CVAL_HSM_FAIL] = "Fail",
262 	[PVR2_CVAL_HSM_HIGH] = "High",
263 	[PVR2_CVAL_HSM_FULL] = "Full",
264 };
265 
266 
267 static const char *pvr2_state_names[] = {
268 	[PVR2_STATE_NONE] =    "none",
269 	[PVR2_STATE_DEAD] =    "dead",
270 	[PVR2_STATE_COLD] =    "cold",
271 	[PVR2_STATE_WARM] =    "warm",
272 	[PVR2_STATE_ERROR] =   "error",
273 	[PVR2_STATE_READY] =   "ready",
274 	[PVR2_STATE_RUN] =     "run",
275 };
276 
277 
278 struct pvr2_fx2cmd_descdef {
279 	unsigned char id;
280 	unsigned char *desc;
281 };
282 
283 static const struct pvr2_fx2cmd_descdef pvr2_fx2cmd_desc[] = {
284 	{FX2CMD_MEM_WRITE_DWORD, "write encoder dword"},
285 	{FX2CMD_MEM_READ_DWORD, "read encoder dword"},
286 	{FX2CMD_HCW_ZILOG_RESET, "zilog IR reset control"},
287 	{FX2CMD_MEM_READ_64BYTES, "read encoder 64bytes"},
288 	{FX2CMD_REG_WRITE, "write encoder register"},
289 	{FX2CMD_REG_READ, "read encoder register"},
290 	{FX2CMD_MEMSEL, "encoder memsel"},
291 	{FX2CMD_I2C_WRITE, "i2c write"},
292 	{FX2CMD_I2C_READ, "i2c read"},
293 	{FX2CMD_GET_USB_SPEED, "get USB speed"},
294 	{FX2CMD_STREAMING_ON, "stream on"},
295 	{FX2CMD_STREAMING_OFF, "stream off"},
296 	{FX2CMD_FWPOST1, "fwpost1"},
297 	{FX2CMD_POWER_OFF, "power off"},
298 	{FX2CMD_POWER_ON, "power on"},
299 	{FX2CMD_DEEP_RESET, "deep reset"},
300 	{FX2CMD_GET_EEPROM_ADDR, "get rom addr"},
301 	{FX2CMD_GET_IR_CODE, "get IR code"},
302 	{FX2CMD_HCW_DEMOD_RESETIN, "hcw demod resetin"},
303 	{FX2CMD_HCW_DTV_STREAMING_ON, "hcw dtv stream on"},
304 	{FX2CMD_HCW_DTV_STREAMING_OFF, "hcw dtv stream off"},
305 	{FX2CMD_ONAIR_DTV_STREAMING_ON, "onair dtv stream on"},
306 	{FX2CMD_ONAIR_DTV_STREAMING_OFF, "onair dtv stream off"},
307 	{FX2CMD_ONAIR_DTV_POWER_ON, "onair dtv power on"},
308 	{FX2CMD_ONAIR_DTV_POWER_OFF, "onair dtv power off"},
309 	{FX2CMD_HCW_DEMOD_RESET_PIN, "hcw demod reset pin"},
310 	{FX2CMD_HCW_MAKO_SLEEP_PIN, "hcw mako sleep pin"},
311 };
312 
313 
314 static int pvr2_hdw_set_input(struct pvr2_hdw *hdw,int v);
315 static void pvr2_hdw_state_sched(struct pvr2_hdw *);
316 static int pvr2_hdw_state_eval(struct pvr2_hdw *);
317 static void pvr2_hdw_set_cur_freq(struct pvr2_hdw *,unsigned long);
318 static void pvr2_hdw_worker_poll(struct work_struct *work);
319 static int pvr2_hdw_wait(struct pvr2_hdw *,int state);
320 static int pvr2_hdw_untrip_unlocked(struct pvr2_hdw *);
321 static void pvr2_hdw_state_log_state(struct pvr2_hdw *);
322 static int pvr2_hdw_cmd_usbstream(struct pvr2_hdw *hdw,int runFl);
323 static int pvr2_hdw_commit_setup(struct pvr2_hdw *hdw);
324 static int pvr2_hdw_get_eeprom_addr(struct pvr2_hdw *hdw);
325 static void pvr2_hdw_quiescent_timeout(struct timer_list *);
326 static void pvr2_hdw_decoder_stabilization_timeout(struct timer_list *);
327 static void pvr2_hdw_encoder_wait_timeout(struct timer_list *);
328 static void pvr2_hdw_encoder_run_timeout(struct timer_list *);
329 static int pvr2_issue_simple_cmd(struct pvr2_hdw *,u32);
330 static int pvr2_send_request_ex(struct pvr2_hdw *hdw,
331 				unsigned int timeout,int probe_fl,
332 				void *write_data,unsigned int write_len,
333 				void *read_data,unsigned int read_len);
334 static int pvr2_hdw_check_cropcap(struct pvr2_hdw *hdw);
335 static v4l2_std_id pvr2_hdw_get_detected_std(struct pvr2_hdw *hdw);
336 
trace_stbit(const char * name,int val)337 static void trace_stbit(const char *name,int val)
338 {
339 	pvr2_trace(PVR2_TRACE_STBITS,
340 		   "State bit %s <-- %s",
341 		   name,(val ? "true" : "false"));
342 }
343 
ctrl_channelfreq_get(struct pvr2_ctrl * cptr,int * vp)344 static int ctrl_channelfreq_get(struct pvr2_ctrl *cptr,int *vp)
345 {
346 	struct pvr2_hdw *hdw = cptr->hdw;
347 	if ((hdw->freqProgSlot > 0) && (hdw->freqProgSlot <= FREQTABLE_SIZE)) {
348 		*vp = hdw->freqTable[hdw->freqProgSlot-1];
349 	} else {
350 		*vp = 0;
351 	}
352 	return 0;
353 }
354 
ctrl_channelfreq_set(struct pvr2_ctrl * cptr,int m,int v)355 static int ctrl_channelfreq_set(struct pvr2_ctrl *cptr,int m,int v)
356 {
357 	struct pvr2_hdw *hdw = cptr->hdw;
358 	unsigned int slotId = hdw->freqProgSlot;
359 	if ((slotId > 0) && (slotId <= FREQTABLE_SIZE)) {
360 		hdw->freqTable[slotId-1] = v;
361 		/* Handle side effects correctly - if we're tuned to this
362 		   slot, then forgot the slot id relation since the stored
363 		   frequency has been changed. */
364 		if (hdw->freqSelector) {
365 			if (hdw->freqSlotRadio == slotId) {
366 				hdw->freqSlotRadio = 0;
367 			}
368 		} else {
369 			if (hdw->freqSlotTelevision == slotId) {
370 				hdw->freqSlotTelevision = 0;
371 			}
372 		}
373 	}
374 	return 0;
375 }
376 
ctrl_channelprog_get(struct pvr2_ctrl * cptr,int * vp)377 static int ctrl_channelprog_get(struct pvr2_ctrl *cptr,int *vp)
378 {
379 	*vp = cptr->hdw->freqProgSlot;
380 	return 0;
381 }
382 
ctrl_channelprog_set(struct pvr2_ctrl * cptr,int m,int v)383 static int ctrl_channelprog_set(struct pvr2_ctrl *cptr,int m,int v)
384 {
385 	struct pvr2_hdw *hdw = cptr->hdw;
386 	if ((v >= 0) && (v <= FREQTABLE_SIZE)) {
387 		hdw->freqProgSlot = v;
388 	}
389 	return 0;
390 }
391 
ctrl_channel_get(struct pvr2_ctrl * cptr,int * vp)392 static int ctrl_channel_get(struct pvr2_ctrl *cptr,int *vp)
393 {
394 	struct pvr2_hdw *hdw = cptr->hdw;
395 	*vp = hdw->freqSelector ? hdw->freqSlotRadio : hdw->freqSlotTelevision;
396 	return 0;
397 }
398 
ctrl_channel_set(struct pvr2_ctrl * cptr,int m,int slotId)399 static int ctrl_channel_set(struct pvr2_ctrl *cptr,int m,int slotId)
400 {
401 	unsigned freq = 0;
402 	struct pvr2_hdw *hdw = cptr->hdw;
403 	if ((slotId < 0) || (slotId > FREQTABLE_SIZE)) return 0;
404 	if (slotId > 0) {
405 		freq = hdw->freqTable[slotId-1];
406 		if (!freq) return 0;
407 		pvr2_hdw_set_cur_freq(hdw,freq);
408 	}
409 	if (hdw->freqSelector) {
410 		hdw->freqSlotRadio = slotId;
411 	} else {
412 		hdw->freqSlotTelevision = slotId;
413 	}
414 	return 0;
415 }
416 
ctrl_freq_get(struct pvr2_ctrl * cptr,int * vp)417 static int ctrl_freq_get(struct pvr2_ctrl *cptr,int *vp)
418 {
419 	*vp = pvr2_hdw_get_cur_freq(cptr->hdw);
420 	return 0;
421 }
422 
ctrl_freq_is_dirty(struct pvr2_ctrl * cptr)423 static int ctrl_freq_is_dirty(struct pvr2_ctrl *cptr)
424 {
425 	return cptr->hdw->freqDirty != 0;
426 }
427 
ctrl_freq_clear_dirty(struct pvr2_ctrl * cptr)428 static void ctrl_freq_clear_dirty(struct pvr2_ctrl *cptr)
429 {
430 	cptr->hdw->freqDirty = 0;
431 }
432 
ctrl_freq_set(struct pvr2_ctrl * cptr,int m,int v)433 static int ctrl_freq_set(struct pvr2_ctrl *cptr,int m,int v)
434 {
435 	pvr2_hdw_set_cur_freq(cptr->hdw,v);
436 	return 0;
437 }
438 
ctrl_cropl_min_get(struct pvr2_ctrl * cptr,int * left)439 static int ctrl_cropl_min_get(struct pvr2_ctrl *cptr, int *left)
440 {
441 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
442 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
443 	if (stat != 0) {
444 		return stat;
445 	}
446 	*left = cap->bounds.left;
447 	return 0;
448 }
449 
ctrl_cropl_max_get(struct pvr2_ctrl * cptr,int * left)450 static int ctrl_cropl_max_get(struct pvr2_ctrl *cptr, int *left)
451 {
452 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
453 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
454 	if (stat != 0) {
455 		return stat;
456 	}
457 	*left = cap->bounds.left;
458 	if (cap->bounds.width > cptr->hdw->cropw_val) {
459 		*left += cap->bounds.width - cptr->hdw->cropw_val;
460 	}
461 	return 0;
462 }
463 
ctrl_cropt_min_get(struct pvr2_ctrl * cptr,int * top)464 static int ctrl_cropt_min_get(struct pvr2_ctrl *cptr, int *top)
465 {
466 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
467 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
468 	if (stat != 0) {
469 		return stat;
470 	}
471 	*top = cap->bounds.top;
472 	return 0;
473 }
474 
ctrl_cropt_max_get(struct pvr2_ctrl * cptr,int * top)475 static int ctrl_cropt_max_get(struct pvr2_ctrl *cptr, int *top)
476 {
477 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
478 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
479 	if (stat != 0) {
480 		return stat;
481 	}
482 	*top = cap->bounds.top;
483 	if (cap->bounds.height > cptr->hdw->croph_val) {
484 		*top += cap->bounds.height - cptr->hdw->croph_val;
485 	}
486 	return 0;
487 }
488 
ctrl_cropw_max_get(struct pvr2_ctrl * cptr,int * width)489 static int ctrl_cropw_max_get(struct pvr2_ctrl *cptr, int *width)
490 {
491 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
492 	int stat, bleftend, cleft;
493 
494 	stat = pvr2_hdw_check_cropcap(cptr->hdw);
495 	if (stat != 0) {
496 		return stat;
497 	}
498 	bleftend = cap->bounds.left+cap->bounds.width;
499 	cleft = cptr->hdw->cropl_val;
500 
501 	*width = cleft < bleftend ? bleftend-cleft : 0;
502 	return 0;
503 }
504 
ctrl_croph_max_get(struct pvr2_ctrl * cptr,int * height)505 static int ctrl_croph_max_get(struct pvr2_ctrl *cptr, int *height)
506 {
507 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
508 	int stat, btopend, ctop;
509 
510 	stat = pvr2_hdw_check_cropcap(cptr->hdw);
511 	if (stat != 0) {
512 		return stat;
513 	}
514 	btopend = cap->bounds.top+cap->bounds.height;
515 	ctop = cptr->hdw->cropt_val;
516 
517 	*height = ctop < btopend ? btopend-ctop : 0;
518 	return 0;
519 }
520 
ctrl_get_cropcapbl(struct pvr2_ctrl * cptr,int * val)521 static int ctrl_get_cropcapbl(struct pvr2_ctrl *cptr, int *val)
522 {
523 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
524 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
525 	if (stat != 0) {
526 		return stat;
527 	}
528 	*val = cap->bounds.left;
529 	return 0;
530 }
531 
ctrl_get_cropcapbt(struct pvr2_ctrl * cptr,int * val)532 static int ctrl_get_cropcapbt(struct pvr2_ctrl *cptr, int *val)
533 {
534 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
535 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
536 	if (stat != 0) {
537 		return stat;
538 	}
539 	*val = cap->bounds.top;
540 	return 0;
541 }
542 
ctrl_get_cropcapbw(struct pvr2_ctrl * cptr,int * val)543 static int ctrl_get_cropcapbw(struct pvr2_ctrl *cptr, int *val)
544 {
545 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
546 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
547 	if (stat != 0) {
548 		return stat;
549 	}
550 	*val = cap->bounds.width;
551 	return 0;
552 }
553 
ctrl_get_cropcapbh(struct pvr2_ctrl * cptr,int * val)554 static int ctrl_get_cropcapbh(struct pvr2_ctrl *cptr, int *val)
555 {
556 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
557 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
558 	if (stat != 0) {
559 		return stat;
560 	}
561 	*val = cap->bounds.height;
562 	return 0;
563 }
564 
ctrl_get_cropcapdl(struct pvr2_ctrl * cptr,int * val)565 static int ctrl_get_cropcapdl(struct pvr2_ctrl *cptr, int *val)
566 {
567 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
568 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
569 	if (stat != 0) {
570 		return stat;
571 	}
572 	*val = cap->defrect.left;
573 	return 0;
574 }
575 
ctrl_get_cropcapdt(struct pvr2_ctrl * cptr,int * val)576 static int ctrl_get_cropcapdt(struct pvr2_ctrl *cptr, int *val)
577 {
578 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
579 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
580 	if (stat != 0) {
581 		return stat;
582 	}
583 	*val = cap->defrect.top;
584 	return 0;
585 }
586 
ctrl_get_cropcapdw(struct pvr2_ctrl * cptr,int * val)587 static int ctrl_get_cropcapdw(struct pvr2_ctrl *cptr, int *val)
588 {
589 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
590 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
591 	if (stat != 0) {
592 		return stat;
593 	}
594 	*val = cap->defrect.width;
595 	return 0;
596 }
597 
ctrl_get_cropcapdh(struct pvr2_ctrl * cptr,int * val)598 static int ctrl_get_cropcapdh(struct pvr2_ctrl *cptr, int *val)
599 {
600 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
601 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
602 	if (stat != 0) {
603 		return stat;
604 	}
605 	*val = cap->defrect.height;
606 	return 0;
607 }
608 
ctrl_get_cropcappan(struct pvr2_ctrl * cptr,int * val)609 static int ctrl_get_cropcappan(struct pvr2_ctrl *cptr, int *val)
610 {
611 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
612 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
613 	if (stat != 0) {
614 		return stat;
615 	}
616 	*val = cap->pixelaspect.numerator;
617 	return 0;
618 }
619 
ctrl_get_cropcappad(struct pvr2_ctrl * cptr,int * val)620 static int ctrl_get_cropcappad(struct pvr2_ctrl *cptr, int *val)
621 {
622 	struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
623 	int stat = pvr2_hdw_check_cropcap(cptr->hdw);
624 	if (stat != 0) {
625 		return stat;
626 	}
627 	*val = cap->pixelaspect.denominator;
628 	return 0;
629 }
630 
ctrl_vres_max_get(struct pvr2_ctrl * cptr,int * vp)631 static int ctrl_vres_max_get(struct pvr2_ctrl *cptr,int *vp)
632 {
633 	/* Actual maximum depends on the video standard in effect. */
634 	if (cptr->hdw->std_mask_cur & V4L2_STD_525_60) {
635 		*vp = 480;
636 	} else {
637 		*vp = 576;
638 	}
639 	return 0;
640 }
641 
ctrl_vres_min_get(struct pvr2_ctrl * cptr,int * vp)642 static int ctrl_vres_min_get(struct pvr2_ctrl *cptr,int *vp)
643 {
644 	/* Actual minimum depends on device digitizer type. */
645 	if (cptr->hdw->hdw_desc->flag_has_cx25840) {
646 		*vp = 75;
647 	} else {
648 		*vp = 17;
649 	}
650 	return 0;
651 }
652 
ctrl_get_input(struct pvr2_ctrl * cptr,int * vp)653 static int ctrl_get_input(struct pvr2_ctrl *cptr,int *vp)
654 {
655 	*vp = cptr->hdw->input_val;
656 	return 0;
657 }
658 
ctrl_check_input(struct pvr2_ctrl * cptr,int v)659 static int ctrl_check_input(struct pvr2_ctrl *cptr,int v)
660 {
661 	if (v < 0 || v > PVR2_CVAL_INPUT_MAX)
662 		return 0;
663 	return ((1UL << v) & cptr->hdw->input_allowed_mask) != 0;
664 }
665 
ctrl_set_input(struct pvr2_ctrl * cptr,int m,int v)666 static int ctrl_set_input(struct pvr2_ctrl *cptr,int m,int v)
667 {
668 	return pvr2_hdw_set_input(cptr->hdw,v);
669 }
670 
ctrl_isdirty_input(struct pvr2_ctrl * cptr)671 static int ctrl_isdirty_input(struct pvr2_ctrl *cptr)
672 {
673 	return cptr->hdw->input_dirty != 0;
674 }
675 
ctrl_cleardirty_input(struct pvr2_ctrl * cptr)676 static void ctrl_cleardirty_input(struct pvr2_ctrl *cptr)
677 {
678 	cptr->hdw->input_dirty = 0;
679 }
680 
681 
ctrl_freq_max_get(struct pvr2_ctrl * cptr,int * vp)682 static int ctrl_freq_max_get(struct pvr2_ctrl *cptr, int *vp)
683 {
684 	unsigned long fv;
685 	struct pvr2_hdw *hdw = cptr->hdw;
686 	if (hdw->tuner_signal_stale) {
687 		pvr2_hdw_status_poll(hdw);
688 	}
689 	fv = hdw->tuner_signal_info.rangehigh;
690 	if (!fv) {
691 		/* Safety fallback */
692 		*vp = TV_MAX_FREQ;
693 		return 0;
694 	}
695 	if (hdw->tuner_signal_info.capability & V4L2_TUNER_CAP_LOW) {
696 		fv = (fv * 125) / 2;
697 	} else {
698 		fv = fv * 62500;
699 	}
700 	*vp = fv;
701 	return 0;
702 }
703 
ctrl_freq_min_get(struct pvr2_ctrl * cptr,int * vp)704 static int ctrl_freq_min_get(struct pvr2_ctrl *cptr, int *vp)
705 {
706 	unsigned long fv;
707 	struct pvr2_hdw *hdw = cptr->hdw;
708 	if (hdw->tuner_signal_stale) {
709 		pvr2_hdw_status_poll(hdw);
710 	}
711 	fv = hdw->tuner_signal_info.rangelow;
712 	if (!fv) {
713 		/* Safety fallback */
714 		*vp = TV_MIN_FREQ;
715 		return 0;
716 	}
717 	if (hdw->tuner_signal_info.capability & V4L2_TUNER_CAP_LOW) {
718 		fv = (fv * 125) / 2;
719 	} else {
720 		fv = fv * 62500;
721 	}
722 	*vp = fv;
723 	return 0;
724 }
725 
ctrl_cx2341x_is_dirty(struct pvr2_ctrl * cptr)726 static int ctrl_cx2341x_is_dirty(struct pvr2_ctrl *cptr)
727 {
728 	return cptr->hdw->enc_stale != 0;
729 }
730 
ctrl_cx2341x_clear_dirty(struct pvr2_ctrl * cptr)731 static void ctrl_cx2341x_clear_dirty(struct pvr2_ctrl *cptr)
732 {
733 	cptr->hdw->enc_stale = 0;
734 	cptr->hdw->enc_unsafe_stale = 0;
735 }
736 
ctrl_cx2341x_get(struct pvr2_ctrl * cptr,int * vp)737 static int ctrl_cx2341x_get(struct pvr2_ctrl *cptr,int *vp)
738 {
739 	int ret;
740 	struct v4l2_ext_controls cs;
741 	struct v4l2_ext_control c1;
742 	memset(&cs,0,sizeof(cs));
743 	memset(&c1,0,sizeof(c1));
744 	cs.controls = &c1;
745 	cs.count = 1;
746 	c1.id = cptr->info->v4l_id;
747 	ret = cx2341x_ext_ctrls(&cptr->hdw->enc_ctl_state, 0, &cs,
748 				VIDIOC_G_EXT_CTRLS);
749 	if (ret) return ret;
750 	*vp = c1.value;
751 	return 0;
752 }
753 
ctrl_cx2341x_set(struct pvr2_ctrl * cptr,int m,int v)754 static int ctrl_cx2341x_set(struct pvr2_ctrl *cptr,int m,int v)
755 {
756 	int ret;
757 	struct pvr2_hdw *hdw = cptr->hdw;
758 	struct v4l2_ext_controls cs;
759 	struct v4l2_ext_control c1;
760 	memset(&cs,0,sizeof(cs));
761 	memset(&c1,0,sizeof(c1));
762 	cs.controls = &c1;
763 	cs.count = 1;
764 	c1.id = cptr->info->v4l_id;
765 	c1.value = v;
766 	ret = cx2341x_ext_ctrls(&hdw->enc_ctl_state,
767 				hdw->state_encoder_run, &cs,
768 				VIDIOC_S_EXT_CTRLS);
769 	if (ret == -EBUSY) {
770 		/* Oops.  cx2341x is telling us it's not safe to change
771 		   this control while we're capturing.  Make a note of this
772 		   fact so that the pipeline will be stopped the next time
773 		   controls are committed.  Then go on ahead and store this
774 		   change anyway. */
775 		ret = cx2341x_ext_ctrls(&hdw->enc_ctl_state,
776 					0, &cs,
777 					VIDIOC_S_EXT_CTRLS);
778 		if (!ret) hdw->enc_unsafe_stale = !0;
779 	}
780 	if (ret) return ret;
781 	hdw->enc_stale = !0;
782 	return 0;
783 }
784 
ctrl_cx2341x_getv4lflags(struct pvr2_ctrl * cptr)785 static unsigned int ctrl_cx2341x_getv4lflags(struct pvr2_ctrl *cptr)
786 {
787 	struct v4l2_queryctrl qctrl = {};
788 	struct pvr2_ctl_info *info;
789 	qctrl.id = cptr->info->v4l_id;
790 	cx2341x_ctrl_query(&cptr->hdw->enc_ctl_state,&qctrl);
791 	/* Strip out the const so we can adjust a function pointer.  It's
792 	   OK to do this here because we know this is a dynamically created
793 	   control, so the underlying storage for the info pointer is (a)
794 	   private to us, and (b) not in read-only storage.  Either we do
795 	   this or we significantly complicate the underlying control
796 	   implementation. */
797 	info = (struct pvr2_ctl_info *)(cptr->info);
798 	if (qctrl.flags & V4L2_CTRL_FLAG_READ_ONLY) {
799 		if (info->set_value) {
800 			info->set_value = NULL;
801 		}
802 	} else {
803 		if (!(info->set_value)) {
804 			info->set_value = ctrl_cx2341x_set;
805 		}
806 	}
807 	return qctrl.flags;
808 }
809 
ctrl_streamingenabled_get(struct pvr2_ctrl * cptr,int * vp)810 static int ctrl_streamingenabled_get(struct pvr2_ctrl *cptr,int *vp)
811 {
812 	*vp = cptr->hdw->state_pipeline_req;
813 	return 0;
814 }
815 
ctrl_masterstate_get(struct pvr2_ctrl * cptr,int * vp)816 static int ctrl_masterstate_get(struct pvr2_ctrl *cptr,int *vp)
817 {
818 	*vp = cptr->hdw->master_state;
819 	return 0;
820 }
821 
ctrl_hsm_get(struct pvr2_ctrl * cptr,int * vp)822 static int ctrl_hsm_get(struct pvr2_ctrl *cptr,int *vp)
823 {
824 	int result = pvr2_hdw_is_hsm(cptr->hdw);
825 	*vp = PVR2_CVAL_HSM_FULL;
826 	if (result < 0) *vp = PVR2_CVAL_HSM_FAIL;
827 	if (result) *vp = PVR2_CVAL_HSM_HIGH;
828 	return 0;
829 }
830 
ctrl_stddetect_get(struct pvr2_ctrl * cptr,int * vp)831 static int ctrl_stddetect_get(struct pvr2_ctrl *cptr, int *vp)
832 {
833 	*vp = pvr2_hdw_get_detected_std(cptr->hdw);
834 	return 0;
835 }
836 
ctrl_stdavail_get(struct pvr2_ctrl * cptr,int * vp)837 static int ctrl_stdavail_get(struct pvr2_ctrl *cptr,int *vp)
838 {
839 	*vp = cptr->hdw->std_mask_avail;
840 	return 0;
841 }
842 
ctrl_stdavail_set(struct pvr2_ctrl * cptr,int m,int v)843 static int ctrl_stdavail_set(struct pvr2_ctrl *cptr,int m,int v)
844 {
845 	struct pvr2_hdw *hdw = cptr->hdw;
846 	v4l2_std_id ns;
847 	ns = hdw->std_mask_avail;
848 	ns = (ns & ~m) | (v & m);
849 	if (ns == hdw->std_mask_avail) return 0;
850 	hdw->std_mask_avail = ns;
851 	hdw->std_info_cur.def.type_bitmask.valid_bits = hdw->std_mask_avail;
852 	return 0;
853 }
854 
ctrl_std_val_to_sym(struct pvr2_ctrl * cptr,int msk,int val,char * bufPtr,unsigned int bufSize,unsigned int * len)855 static int ctrl_std_val_to_sym(struct pvr2_ctrl *cptr,int msk,int val,
856 			       char *bufPtr,unsigned int bufSize,
857 			       unsigned int *len)
858 {
859 	*len = pvr2_std_id_to_str(bufPtr,bufSize,msk & val);
860 	return 0;
861 }
862 
ctrl_std_sym_to_val(struct pvr2_ctrl * cptr,const char * bufPtr,unsigned int bufSize,int * mskp,int * valp)863 static int ctrl_std_sym_to_val(struct pvr2_ctrl *cptr,
864 			       const char *bufPtr,unsigned int bufSize,
865 			       int *mskp,int *valp)
866 {
867 	int ret;
868 	v4l2_std_id id;
869 	ret = pvr2_std_str_to_id(&id,bufPtr,bufSize);
870 	if (ret < 0) return ret;
871 	if (mskp) *mskp = id;
872 	if (valp) *valp = id;
873 	return 0;
874 }
875 
ctrl_stdcur_get(struct pvr2_ctrl * cptr,int * vp)876 static int ctrl_stdcur_get(struct pvr2_ctrl *cptr,int *vp)
877 {
878 	*vp = cptr->hdw->std_mask_cur;
879 	return 0;
880 }
881 
ctrl_stdcur_set(struct pvr2_ctrl * cptr,int m,int v)882 static int ctrl_stdcur_set(struct pvr2_ctrl *cptr,int m,int v)
883 {
884 	struct pvr2_hdw *hdw = cptr->hdw;
885 	v4l2_std_id ns;
886 	ns = hdw->std_mask_cur;
887 	ns = (ns & ~m) | (v & m);
888 	if (ns == hdw->std_mask_cur) return 0;
889 	hdw->std_mask_cur = ns;
890 	hdw->std_dirty = !0;
891 	return 0;
892 }
893 
ctrl_stdcur_is_dirty(struct pvr2_ctrl * cptr)894 static int ctrl_stdcur_is_dirty(struct pvr2_ctrl *cptr)
895 {
896 	return cptr->hdw->std_dirty != 0;
897 }
898 
ctrl_stdcur_clear_dirty(struct pvr2_ctrl * cptr)899 static void ctrl_stdcur_clear_dirty(struct pvr2_ctrl *cptr)
900 {
901 	cptr->hdw->std_dirty = 0;
902 }
903 
ctrl_signal_get(struct pvr2_ctrl * cptr,int * vp)904 static int ctrl_signal_get(struct pvr2_ctrl *cptr,int *vp)
905 {
906 	struct pvr2_hdw *hdw = cptr->hdw;
907 	pvr2_hdw_status_poll(hdw);
908 	*vp = hdw->tuner_signal_info.signal;
909 	return 0;
910 }
911 
ctrl_audio_modes_present_get(struct pvr2_ctrl * cptr,int * vp)912 static int ctrl_audio_modes_present_get(struct pvr2_ctrl *cptr,int *vp)
913 {
914 	int val = 0;
915 	unsigned int subchan;
916 	struct pvr2_hdw *hdw = cptr->hdw;
917 	pvr2_hdw_status_poll(hdw);
918 	subchan = hdw->tuner_signal_info.rxsubchans;
919 	if (subchan & V4L2_TUNER_SUB_MONO) {
920 		val |= (1 << V4L2_TUNER_MODE_MONO);
921 	}
922 	if (subchan & V4L2_TUNER_SUB_STEREO) {
923 		val |= (1 << V4L2_TUNER_MODE_STEREO);
924 	}
925 	if (subchan & V4L2_TUNER_SUB_LANG1) {
926 		val |= (1 << V4L2_TUNER_MODE_LANG1);
927 	}
928 	if (subchan & V4L2_TUNER_SUB_LANG2) {
929 		val |= (1 << V4L2_TUNER_MODE_LANG2);
930 	}
931 	*vp = val;
932 	return 0;
933 }
934 
935 
936 #define DEFINT(vmin,vmax) \
937 	.type = pvr2_ctl_int, \
938 	.def.type_int.min_value = vmin, \
939 	.def.type_int.max_value = vmax
940 
941 #define DEFENUM(tab) \
942 	.type = pvr2_ctl_enum, \
943 	.def.type_enum.count = ARRAY_SIZE(tab), \
944 	.def.type_enum.value_names = tab
945 
946 #define DEFBOOL \
947 	.type = pvr2_ctl_bool
948 
949 #define DEFMASK(msk,tab) \
950 	.type = pvr2_ctl_bitmask, \
951 	.def.type_bitmask.valid_bits = msk, \
952 	.def.type_bitmask.bit_names = tab
953 
954 #define DEFREF(vname) \
955 	.set_value = ctrl_set_##vname, \
956 	.get_value = ctrl_get_##vname, \
957 	.is_dirty = ctrl_isdirty_##vname, \
958 	.clear_dirty = ctrl_cleardirty_##vname
959 
960 
961 #define VCREATE_FUNCS(vname) \
962 static int ctrl_get_##vname(struct pvr2_ctrl *cptr,int *vp) \
963 {*vp = cptr->hdw->vname##_val; return 0;} \
964 static int ctrl_set_##vname(struct pvr2_ctrl *cptr,int m,int v) \
965 {cptr->hdw->vname##_val = v; cptr->hdw->vname##_dirty = !0; return 0;} \
966 static int ctrl_isdirty_##vname(struct pvr2_ctrl *cptr) \
967 {return cptr->hdw->vname##_dirty != 0;} \
968 static void ctrl_cleardirty_##vname(struct pvr2_ctrl *cptr) \
969 {cptr->hdw->vname##_dirty = 0;}
970 
971 VCREATE_FUNCS(brightness)
972 VCREATE_FUNCS(contrast)
973 VCREATE_FUNCS(saturation)
974 VCREATE_FUNCS(hue)
975 VCREATE_FUNCS(volume)
976 VCREATE_FUNCS(balance)
977 VCREATE_FUNCS(bass)
978 VCREATE_FUNCS(treble)
979 VCREATE_FUNCS(mute)
980 VCREATE_FUNCS(cropl)
981 VCREATE_FUNCS(cropt)
982 VCREATE_FUNCS(cropw)
983 VCREATE_FUNCS(croph)
984 VCREATE_FUNCS(audiomode)
985 VCREATE_FUNCS(res_hor)
986 VCREATE_FUNCS(res_ver)
987 VCREATE_FUNCS(srate)
988 
989 /* Table definition of all controls which can be manipulated */
990 static const struct pvr2_ctl_info control_defs[] = {
991 	{
992 		.v4l_id = V4L2_CID_BRIGHTNESS,
993 		.desc = "Brightness",
994 		.name = "brightness",
995 		.default_value = 128,
996 		DEFREF(brightness),
997 		DEFINT(0,255),
998 	},{
999 		.v4l_id = V4L2_CID_CONTRAST,
1000 		.desc = "Contrast",
1001 		.name = "contrast",
1002 		.default_value = 68,
1003 		DEFREF(contrast),
1004 		DEFINT(0,127),
1005 	},{
1006 		.v4l_id = V4L2_CID_SATURATION,
1007 		.desc = "Saturation",
1008 		.name = "saturation",
1009 		.default_value = 64,
1010 		DEFREF(saturation),
1011 		DEFINT(0,127),
1012 	},{
1013 		.v4l_id = V4L2_CID_HUE,
1014 		.desc = "Hue",
1015 		.name = "hue",
1016 		.default_value = 0,
1017 		DEFREF(hue),
1018 		DEFINT(-128,127),
1019 	},{
1020 		.v4l_id = V4L2_CID_AUDIO_VOLUME,
1021 		.desc = "Volume",
1022 		.name = "volume",
1023 		.default_value = 62000,
1024 		DEFREF(volume),
1025 		DEFINT(0,65535),
1026 	},{
1027 		.v4l_id = V4L2_CID_AUDIO_BALANCE,
1028 		.desc = "Balance",
1029 		.name = "balance",
1030 		.default_value = 0,
1031 		DEFREF(balance),
1032 		DEFINT(-32768,32767),
1033 	},{
1034 		.v4l_id = V4L2_CID_AUDIO_BASS,
1035 		.desc = "Bass",
1036 		.name = "bass",
1037 		.default_value = 0,
1038 		DEFREF(bass),
1039 		DEFINT(-32768,32767),
1040 	},{
1041 		.v4l_id = V4L2_CID_AUDIO_TREBLE,
1042 		.desc = "Treble",
1043 		.name = "treble",
1044 		.default_value = 0,
1045 		DEFREF(treble),
1046 		DEFINT(-32768,32767),
1047 	},{
1048 		.v4l_id = V4L2_CID_AUDIO_MUTE,
1049 		.desc = "Mute",
1050 		.name = "mute",
1051 		.default_value = 0,
1052 		DEFREF(mute),
1053 		DEFBOOL,
1054 	}, {
1055 		.desc = "Capture crop left margin",
1056 		.name = "crop_left",
1057 		.internal_id = PVR2_CID_CROPL,
1058 		.default_value = 0,
1059 		DEFREF(cropl),
1060 		DEFINT(-129, 340),
1061 		.get_min_value = ctrl_cropl_min_get,
1062 		.get_max_value = ctrl_cropl_max_get,
1063 		.get_def_value = ctrl_get_cropcapdl,
1064 	}, {
1065 		.desc = "Capture crop top margin",
1066 		.name = "crop_top",
1067 		.internal_id = PVR2_CID_CROPT,
1068 		.default_value = 0,
1069 		DEFREF(cropt),
1070 		DEFINT(-35, 544),
1071 		.get_min_value = ctrl_cropt_min_get,
1072 		.get_max_value = ctrl_cropt_max_get,
1073 		.get_def_value = ctrl_get_cropcapdt,
1074 	}, {
1075 		.desc = "Capture crop width",
1076 		.name = "crop_width",
1077 		.internal_id = PVR2_CID_CROPW,
1078 		.default_value = 720,
1079 		DEFREF(cropw),
1080 		DEFINT(0, 864),
1081 		.get_max_value = ctrl_cropw_max_get,
1082 		.get_def_value = ctrl_get_cropcapdw,
1083 	}, {
1084 		.desc = "Capture crop height",
1085 		.name = "crop_height",
1086 		.internal_id = PVR2_CID_CROPH,
1087 		.default_value = 480,
1088 		DEFREF(croph),
1089 		DEFINT(0, 576),
1090 		.get_max_value = ctrl_croph_max_get,
1091 		.get_def_value = ctrl_get_cropcapdh,
1092 	}, {
1093 		.desc = "Capture capability pixel aspect numerator",
1094 		.name = "cropcap_pixel_numerator",
1095 		.internal_id = PVR2_CID_CROPCAPPAN,
1096 		.get_value = ctrl_get_cropcappan,
1097 	}, {
1098 		.desc = "Capture capability pixel aspect denominator",
1099 		.name = "cropcap_pixel_denominator",
1100 		.internal_id = PVR2_CID_CROPCAPPAD,
1101 		.get_value = ctrl_get_cropcappad,
1102 	}, {
1103 		.desc = "Capture capability bounds top",
1104 		.name = "cropcap_bounds_top",
1105 		.internal_id = PVR2_CID_CROPCAPBT,
1106 		.get_value = ctrl_get_cropcapbt,
1107 	}, {
1108 		.desc = "Capture capability bounds left",
1109 		.name = "cropcap_bounds_left",
1110 		.internal_id = PVR2_CID_CROPCAPBL,
1111 		.get_value = ctrl_get_cropcapbl,
1112 	}, {
1113 		.desc = "Capture capability bounds width",
1114 		.name = "cropcap_bounds_width",
1115 		.internal_id = PVR2_CID_CROPCAPBW,
1116 		.get_value = ctrl_get_cropcapbw,
1117 	}, {
1118 		.desc = "Capture capability bounds height",
1119 		.name = "cropcap_bounds_height",
1120 		.internal_id = PVR2_CID_CROPCAPBH,
1121 		.get_value = ctrl_get_cropcapbh,
1122 	},{
1123 		.desc = "Video Source",
1124 		.name = "input",
1125 		.internal_id = PVR2_CID_INPUT,
1126 		.default_value = PVR2_CVAL_INPUT_TV,
1127 		.check_value = ctrl_check_input,
1128 		DEFREF(input),
1129 		DEFENUM(control_values_input),
1130 	},{
1131 		.desc = "Audio Mode",
1132 		.name = "audio_mode",
1133 		.internal_id = PVR2_CID_AUDIOMODE,
1134 		.default_value = V4L2_TUNER_MODE_STEREO,
1135 		DEFREF(audiomode),
1136 		DEFENUM(control_values_audiomode),
1137 	},{
1138 		.desc = "Horizontal capture resolution",
1139 		.name = "resolution_hor",
1140 		.internal_id = PVR2_CID_HRES,
1141 		.default_value = 720,
1142 		DEFREF(res_hor),
1143 		DEFINT(19,720),
1144 	},{
1145 		.desc = "Vertical capture resolution",
1146 		.name = "resolution_ver",
1147 		.internal_id = PVR2_CID_VRES,
1148 		.default_value = 480,
1149 		DEFREF(res_ver),
1150 		DEFINT(17,576),
1151 		/* Hook in check for video standard and adjust maximum
1152 		   depending on the standard. */
1153 		.get_max_value = ctrl_vres_max_get,
1154 		.get_min_value = ctrl_vres_min_get,
1155 	},{
1156 		.v4l_id = V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ,
1157 		.default_value = V4L2_MPEG_AUDIO_SAMPLING_FREQ_48000,
1158 		.desc = "Audio Sampling Frequency",
1159 		.name = "srate",
1160 		DEFREF(srate),
1161 		DEFENUM(control_values_srate),
1162 	},{
1163 		.desc = "Tuner Frequency (Hz)",
1164 		.name = "frequency",
1165 		.internal_id = PVR2_CID_FREQUENCY,
1166 		.default_value = 0,
1167 		.set_value = ctrl_freq_set,
1168 		.get_value = ctrl_freq_get,
1169 		.is_dirty = ctrl_freq_is_dirty,
1170 		.clear_dirty = ctrl_freq_clear_dirty,
1171 		DEFINT(0,0),
1172 		/* Hook in check for input value (tv/radio) and adjust
1173 		   max/min values accordingly */
1174 		.get_max_value = ctrl_freq_max_get,
1175 		.get_min_value = ctrl_freq_min_get,
1176 	},{
1177 		.desc = "Channel",
1178 		.name = "channel",
1179 		.set_value = ctrl_channel_set,
1180 		.get_value = ctrl_channel_get,
1181 		DEFINT(0,FREQTABLE_SIZE),
1182 	},{
1183 		.desc = "Channel Program Frequency",
1184 		.name = "freq_table_value",
1185 		.set_value = ctrl_channelfreq_set,
1186 		.get_value = ctrl_channelfreq_get,
1187 		DEFINT(0,0),
1188 		/* Hook in check for input value (tv/radio) and adjust
1189 		   max/min values accordingly */
1190 		.get_max_value = ctrl_freq_max_get,
1191 		.get_min_value = ctrl_freq_min_get,
1192 	},{
1193 		.desc = "Channel Program ID",
1194 		.name = "freq_table_channel",
1195 		.set_value = ctrl_channelprog_set,
1196 		.get_value = ctrl_channelprog_get,
1197 		DEFINT(0,FREQTABLE_SIZE),
1198 	},{
1199 		.desc = "Streaming Enabled",
1200 		.name = "streaming_enabled",
1201 		.get_value = ctrl_streamingenabled_get,
1202 		DEFBOOL,
1203 	},{
1204 		.desc = "USB Speed",
1205 		.name = "usb_speed",
1206 		.get_value = ctrl_hsm_get,
1207 		DEFENUM(control_values_hsm),
1208 	},{
1209 		.desc = "Master State",
1210 		.name = "master_state",
1211 		.get_value = ctrl_masterstate_get,
1212 		DEFENUM(pvr2_state_names),
1213 	},{
1214 		.desc = "Signal Present",
1215 		.name = "signal_present",
1216 		.get_value = ctrl_signal_get,
1217 		DEFINT(0,65535),
1218 	},{
1219 		.desc = "Audio Modes Present",
1220 		.name = "audio_modes_present",
1221 		.get_value = ctrl_audio_modes_present_get,
1222 		/* For this type we "borrow" the V4L2_TUNER_MODE enum from
1223 		   v4l.  Nothing outside of this module cares about this,
1224 		   but I reuse it in order to also reuse the
1225 		   control_values_audiomode string table. */
1226 		DEFMASK(((1 << V4L2_TUNER_MODE_MONO)|
1227 			 (1 << V4L2_TUNER_MODE_STEREO)|
1228 			 (1 << V4L2_TUNER_MODE_LANG1)|
1229 			 (1 << V4L2_TUNER_MODE_LANG2)),
1230 			control_values_audiomode),
1231 	},{
1232 		.desc = "Video Standards Available Mask",
1233 		.name = "video_standard_mask_available",
1234 		.internal_id = PVR2_CID_STDAVAIL,
1235 		.skip_init = !0,
1236 		.get_value = ctrl_stdavail_get,
1237 		.set_value = ctrl_stdavail_set,
1238 		.val_to_sym = ctrl_std_val_to_sym,
1239 		.sym_to_val = ctrl_std_sym_to_val,
1240 		.type = pvr2_ctl_bitmask,
1241 	},{
1242 		.desc = "Video Standards In Use Mask",
1243 		.name = "video_standard_mask_active",
1244 		.internal_id = PVR2_CID_STDCUR,
1245 		.skip_init = !0,
1246 		.get_value = ctrl_stdcur_get,
1247 		.set_value = ctrl_stdcur_set,
1248 		.is_dirty = ctrl_stdcur_is_dirty,
1249 		.clear_dirty = ctrl_stdcur_clear_dirty,
1250 		.val_to_sym = ctrl_std_val_to_sym,
1251 		.sym_to_val = ctrl_std_sym_to_val,
1252 		.type = pvr2_ctl_bitmask,
1253 	},{
1254 		.desc = "Video Standards Detected Mask",
1255 		.name = "video_standard_mask_detected",
1256 		.internal_id = PVR2_CID_STDDETECT,
1257 		.skip_init = !0,
1258 		.get_value = ctrl_stddetect_get,
1259 		.val_to_sym = ctrl_std_val_to_sym,
1260 		.sym_to_val = ctrl_std_sym_to_val,
1261 		.type = pvr2_ctl_bitmask,
1262 	}
1263 };
1264 
1265 #define CTRLDEF_COUNT ARRAY_SIZE(control_defs)
1266 
1267 
pvr2_config_get_name(enum pvr2_config cfg)1268 const char *pvr2_config_get_name(enum pvr2_config cfg)
1269 {
1270 	switch (cfg) {
1271 	case pvr2_config_empty: return "empty";
1272 	case pvr2_config_mpeg: return "mpeg";
1273 	case pvr2_config_vbi: return "vbi";
1274 	case pvr2_config_pcm: return "pcm";
1275 	case pvr2_config_rawvideo: return "raw video";
1276 	}
1277 	return "<unknown>";
1278 }
1279 
1280 
pvr2_hdw_get_dev(struct pvr2_hdw * hdw)1281 struct usb_device *pvr2_hdw_get_dev(struct pvr2_hdw *hdw)
1282 {
1283 	return hdw->usb_dev;
1284 }
1285 
1286 
pvr2_hdw_get_sn(struct pvr2_hdw * hdw)1287 unsigned long pvr2_hdw_get_sn(struct pvr2_hdw *hdw)
1288 {
1289 	return hdw->serial_number;
1290 }
1291 
1292 
pvr2_hdw_get_bus_info(struct pvr2_hdw * hdw)1293 const char *pvr2_hdw_get_bus_info(struct pvr2_hdw *hdw)
1294 {
1295 	return hdw->bus_info;
1296 }
1297 
1298 
pvr2_hdw_get_device_identifier(struct pvr2_hdw * hdw)1299 const char *pvr2_hdw_get_device_identifier(struct pvr2_hdw *hdw)
1300 {
1301 	return hdw->identifier;
1302 }
1303 
1304 
pvr2_hdw_get_cur_freq(struct pvr2_hdw * hdw)1305 unsigned long pvr2_hdw_get_cur_freq(struct pvr2_hdw *hdw)
1306 {
1307 	return hdw->freqSelector ? hdw->freqValTelevision : hdw->freqValRadio;
1308 }
1309 
1310 /* Set the currently tuned frequency and account for all possible
1311    driver-core side effects of this action. */
pvr2_hdw_set_cur_freq(struct pvr2_hdw * hdw,unsigned long val)1312 static void pvr2_hdw_set_cur_freq(struct pvr2_hdw *hdw,unsigned long val)
1313 {
1314 	if (hdw->input_val == PVR2_CVAL_INPUT_RADIO) {
1315 		if (hdw->freqSelector) {
1316 			/* Swing over to radio frequency selection */
1317 			hdw->freqSelector = 0;
1318 			hdw->freqDirty = !0;
1319 		}
1320 		if (hdw->freqValRadio != val) {
1321 			hdw->freqValRadio = val;
1322 			hdw->freqSlotRadio = 0;
1323 			hdw->freqDirty = !0;
1324 		}
1325 	} else {
1326 		if (!(hdw->freqSelector)) {
1327 			/* Swing over to television frequency selection */
1328 			hdw->freqSelector = 1;
1329 			hdw->freqDirty = !0;
1330 		}
1331 		if (hdw->freqValTelevision != val) {
1332 			hdw->freqValTelevision = val;
1333 			hdw->freqSlotTelevision = 0;
1334 			hdw->freqDirty = !0;
1335 		}
1336 	}
1337 }
1338 
pvr2_hdw_get_unit_number(struct pvr2_hdw * hdw)1339 int pvr2_hdw_get_unit_number(struct pvr2_hdw *hdw)
1340 {
1341 	return hdw->unit_number;
1342 }
1343 
1344 
1345 /* Attempt to locate one of the given set of files.  Messages are logged
1346    appropriate to what has been found.  The return value will be 0 or
1347    greater on success (it will be the index of the file name found) and
1348    fw_entry will be filled in.  Otherwise a negative error is returned on
1349    failure.  If the return value is -ENOENT then no viable firmware file
1350    could be located. */
pvr2_locate_firmware(struct pvr2_hdw * hdw,const struct firmware ** fw_entry,const char * fwtypename,unsigned int fwcount,const char * fwnames[])1351 static int pvr2_locate_firmware(struct pvr2_hdw *hdw,
1352 				const struct firmware **fw_entry,
1353 				const char *fwtypename,
1354 				unsigned int fwcount,
1355 				const char *fwnames[])
1356 {
1357 	unsigned int idx;
1358 	int ret = -EINVAL;
1359 	for (idx = 0; idx < fwcount; idx++) {
1360 		ret = request_firmware(fw_entry,
1361 				       fwnames[idx],
1362 				       &hdw->usb_dev->dev);
1363 		if (!ret) {
1364 			trace_firmware("Located %s firmware: %s; uploading...",
1365 				       fwtypename,
1366 				       fwnames[idx]);
1367 			return idx;
1368 		}
1369 		if (ret == -ENOENT) continue;
1370 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1371 			   "request_firmware fatal error with code=%d",ret);
1372 		return ret;
1373 	}
1374 	pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1375 		   "***WARNING*** Device %s firmware seems to be missing.",
1376 		   fwtypename);
1377 	pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1378 		   "Did you install the pvrusb2 firmware files in their proper location?");
1379 	if (fwcount == 1) {
1380 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1381 			   "request_firmware unable to locate %s file %s",
1382 			   fwtypename,fwnames[0]);
1383 	} else {
1384 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1385 			   "request_firmware unable to locate one of the following %s files:",
1386 			   fwtypename);
1387 		for (idx = 0; idx < fwcount; idx++) {
1388 			pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1389 				   "request_firmware: Failed to find %s",
1390 				   fwnames[idx]);
1391 		}
1392 	}
1393 	return ret;
1394 }
1395 
1396 
1397 /*
1398  * pvr2_upload_firmware1().
1399  *
1400  * Send the 8051 firmware to the device.  After the upload, arrange for
1401  * device to re-enumerate.
1402  *
1403  * NOTE : the pointer to the firmware data given by request_firmware()
1404  * is not suitable for an usb transaction.
1405  *
1406  */
pvr2_upload_firmware1(struct pvr2_hdw * hdw)1407 static int pvr2_upload_firmware1(struct pvr2_hdw *hdw)
1408 {
1409 	const struct firmware *fw_entry = NULL;
1410 	void  *fw_ptr;
1411 	unsigned int pipe;
1412 	unsigned int fwsize;
1413 	int ret;
1414 	u16 address;
1415 
1416 	if (!hdw->hdw_desc->fx2_firmware.cnt) {
1417 		hdw->fw1_state = FW1_STATE_OK;
1418 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1419 			   "Connected device type defines no firmware to upload; ignoring firmware");
1420 		return -ENOTTY;
1421 	}
1422 
1423 	hdw->fw1_state = FW1_STATE_FAILED; // default result
1424 
1425 	trace_firmware("pvr2_upload_firmware1");
1426 
1427 	ret = pvr2_locate_firmware(hdw,&fw_entry,"fx2 controller",
1428 				   hdw->hdw_desc->fx2_firmware.cnt,
1429 				   hdw->hdw_desc->fx2_firmware.lst);
1430 	if (ret < 0) {
1431 		if (ret == -ENOENT) hdw->fw1_state = FW1_STATE_MISSING;
1432 		return ret;
1433 	}
1434 
1435 	usb_clear_halt(hdw->usb_dev, usb_sndbulkpipe(hdw->usb_dev, 0 & 0x7f));
1436 
1437 	pipe = usb_sndctrlpipe(hdw->usb_dev, 0);
1438 	fwsize = fw_entry->size;
1439 
1440 	if ((fwsize != 0x2000) &&
1441 	    (!(hdw->hdw_desc->flag_fx2_16kb && (fwsize == 0x4000)))) {
1442 		if (hdw->hdw_desc->flag_fx2_16kb) {
1443 			pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1444 				   "Wrong fx2 firmware size (expected 8192 or 16384, got %u)",
1445 				   fwsize);
1446 		} else {
1447 			pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1448 				   "Wrong fx2 firmware size (expected 8192, got %u)",
1449 				   fwsize);
1450 		}
1451 		release_firmware(fw_entry);
1452 		return -ENOMEM;
1453 	}
1454 
1455 	fw_ptr = kmalloc(0x800, GFP_KERNEL);
1456 	if (fw_ptr == NULL){
1457 		release_firmware(fw_entry);
1458 		return -ENOMEM;
1459 	}
1460 
1461 	/* We have to hold the CPU during firmware upload. */
1462 	pvr2_hdw_cpureset_assert(hdw,1);
1463 
1464 	/* upload the firmware to address 0000-1fff in 2048 (=0x800) bytes
1465 	   chunk. */
1466 
1467 	ret = 0;
1468 	for (address = 0; address < fwsize; address += 0x800) {
1469 		memcpy(fw_ptr, fw_entry->data + address, 0x800);
1470 		ret += usb_control_msg(hdw->usb_dev, pipe, 0xa0, 0x40, address,
1471 				       0, fw_ptr, 0x800, HZ);
1472 	}
1473 
1474 	trace_firmware("Upload done, releasing device's CPU");
1475 
1476 	/* Now release the CPU.  It will disconnect and reconnect later. */
1477 	pvr2_hdw_cpureset_assert(hdw,0);
1478 
1479 	kfree(fw_ptr);
1480 	release_firmware(fw_entry);
1481 
1482 	trace_firmware("Upload done (%d bytes sent)",ret);
1483 
1484 	/* We should have written fwsize bytes */
1485 	if (ret == fwsize) {
1486 		hdw->fw1_state = FW1_STATE_RELOAD;
1487 		return 0;
1488 	}
1489 
1490 	return -EIO;
1491 }
1492 
1493 
1494 /*
1495  * pvr2_upload_firmware2()
1496  *
1497  * This uploads encoder firmware on endpoint 2.
1498  *
1499  */
1500 
pvr2_upload_firmware2(struct pvr2_hdw * hdw)1501 int pvr2_upload_firmware2(struct pvr2_hdw *hdw)
1502 {
1503 	const struct firmware *fw_entry = NULL;
1504 	void  *fw_ptr;
1505 	unsigned int pipe, fw_len, fw_done, bcnt, icnt;
1506 	int actual_length;
1507 	int ret = 0;
1508 	int fwidx;
1509 	static const char *fw_files[] = {
1510 		CX2341X_FIRM_ENC_FILENAME,
1511 	};
1512 
1513 	if (hdw->hdw_desc->flag_skip_cx23416_firmware) {
1514 		return 0;
1515 	}
1516 
1517 	trace_firmware("pvr2_upload_firmware2");
1518 
1519 	ret = pvr2_locate_firmware(hdw,&fw_entry,"encoder",
1520 				   ARRAY_SIZE(fw_files), fw_files);
1521 	if (ret < 0) return ret;
1522 	fwidx = ret;
1523 	ret = 0;
1524 	/* Since we're about to completely reinitialize the encoder,
1525 	   invalidate our cached copy of its configuration state.  Next
1526 	   time we configure the encoder, then we'll fully configure it. */
1527 	hdw->enc_cur_valid = 0;
1528 
1529 	/* Encoder is about to be reset so note that as far as we're
1530 	   concerned now, the encoder has never been run. */
1531 	del_timer_sync(&hdw->encoder_run_timer);
1532 	if (hdw->state_encoder_runok) {
1533 		hdw->state_encoder_runok = 0;
1534 		trace_stbit("state_encoder_runok",hdw->state_encoder_runok);
1535 	}
1536 
1537 	/* First prepare firmware loading */
1538 	ret |= pvr2_write_register(hdw, 0x0048, 0xffffffff); /*interrupt mask*/
1539 	ret |= pvr2_hdw_gpio_chg_dir(hdw,0xffffffff,0x00000088); /*gpio dir*/
1540 	ret |= pvr2_hdw_gpio_chg_out(hdw,0xffffffff,0x00000008); /*gpio output state*/
1541 	ret |= pvr2_hdw_cmd_deep_reset(hdw);
1542 	ret |= pvr2_write_register(hdw, 0xa064, 0x00000000); /*APU command*/
1543 	ret |= pvr2_hdw_gpio_chg_dir(hdw,0xffffffff,0x00000408); /*gpio dir*/
1544 	ret |= pvr2_hdw_gpio_chg_out(hdw,0xffffffff,0x00000008); /*gpio output state*/
1545 	ret |= pvr2_write_register(hdw, 0x9058, 0xffffffed); /*VPU ctrl*/
1546 	ret |= pvr2_write_register(hdw, 0x9054, 0xfffffffd); /*reset hw blocks*/
1547 	ret |= pvr2_write_register(hdw, 0x07f8, 0x80000800); /*encoder SDRAM refresh*/
1548 	ret |= pvr2_write_register(hdw, 0x07fc, 0x0000001a); /*encoder SDRAM pre-charge*/
1549 	ret |= pvr2_write_register(hdw, 0x0700, 0x00000000); /*I2C clock*/
1550 	ret |= pvr2_write_register(hdw, 0xaa00, 0x00000000); /*unknown*/
1551 	ret |= pvr2_write_register(hdw, 0xaa04, 0x00057810); /*unknown*/
1552 	ret |= pvr2_write_register(hdw, 0xaa10, 0x00148500); /*unknown*/
1553 	ret |= pvr2_write_register(hdw, 0xaa18, 0x00840000); /*unknown*/
1554 	ret |= pvr2_issue_simple_cmd(hdw,FX2CMD_FWPOST1);
1555 	ret |= pvr2_issue_simple_cmd(hdw,FX2CMD_MEMSEL | (1 << 8) | (0 << 16));
1556 
1557 	if (ret) {
1558 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1559 			   "firmware2 upload prep failed, ret=%d",ret);
1560 		release_firmware(fw_entry);
1561 		goto done;
1562 	}
1563 
1564 	/* Now send firmware */
1565 
1566 	fw_len = fw_entry->size;
1567 
1568 	if (fw_len % sizeof(u32)) {
1569 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1570 			   "size of %s firmware must be a multiple of %zu bytes",
1571 			   fw_files[fwidx],sizeof(u32));
1572 		release_firmware(fw_entry);
1573 		ret = -EINVAL;
1574 		goto done;
1575 	}
1576 
1577 	fw_ptr = kmalloc(FIRMWARE_CHUNK_SIZE, GFP_KERNEL);
1578 	if (fw_ptr == NULL){
1579 		release_firmware(fw_entry);
1580 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1581 			   "failed to allocate memory for firmware2 upload");
1582 		ret = -ENOMEM;
1583 		goto done;
1584 	}
1585 
1586 	pipe = usb_sndbulkpipe(hdw->usb_dev, PVR2_FIRMWARE_ENDPOINT);
1587 
1588 	fw_done = 0;
1589 	for (fw_done = 0; fw_done < fw_len;) {
1590 		bcnt = fw_len - fw_done;
1591 		if (bcnt > FIRMWARE_CHUNK_SIZE) bcnt = FIRMWARE_CHUNK_SIZE;
1592 		memcpy(fw_ptr, fw_entry->data + fw_done, bcnt);
1593 		/* Usbsnoop log shows that we must swap bytes... */
1594 		/* Some background info: The data being swapped here is a
1595 		   firmware image destined for the mpeg encoder chip that
1596 		   lives at the other end of a USB endpoint.  The encoder
1597 		   chip always talks in 32 bit chunks and its storage is
1598 		   organized into 32 bit words.  However from the file
1599 		   system to the encoder chip everything is purely a byte
1600 		   stream.  The firmware file's contents are always 32 bit
1601 		   swapped from what the encoder expects.  Thus the need
1602 		   always exists to swap the bytes regardless of the endian
1603 		   type of the host processor and therefore swab32() makes
1604 		   the most sense. */
1605 		for (icnt = 0; icnt < bcnt/4 ; icnt++)
1606 			((u32 *)fw_ptr)[icnt] = swab32(((u32 *)fw_ptr)[icnt]);
1607 
1608 		ret |= usb_bulk_msg(hdw->usb_dev, pipe, fw_ptr,bcnt,
1609 				    &actual_length, HZ);
1610 		ret |= (actual_length != bcnt);
1611 		if (ret) break;
1612 		fw_done += bcnt;
1613 	}
1614 
1615 	trace_firmware("upload of %s : %i / %i ",
1616 		       fw_files[fwidx],fw_done,fw_len);
1617 
1618 	kfree(fw_ptr);
1619 	release_firmware(fw_entry);
1620 
1621 	if (ret) {
1622 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1623 			   "firmware2 upload transfer failure");
1624 		goto done;
1625 	}
1626 
1627 	/* Finish upload */
1628 
1629 	ret |= pvr2_write_register(hdw, 0x9054, 0xffffffff); /*reset hw blocks*/
1630 	ret |= pvr2_write_register(hdw, 0x9058, 0xffffffe8); /*VPU ctrl*/
1631 	ret |= pvr2_issue_simple_cmd(hdw,FX2CMD_MEMSEL | (1 << 8) | (0 << 16));
1632 
1633 	if (ret) {
1634 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1635 			   "firmware2 upload post-proc failure");
1636 	}
1637 
1638  done:
1639 	if (hdw->hdw_desc->signal_routing_scheme ==
1640 	    PVR2_ROUTING_SCHEME_GOTVIEW) {
1641 		/* Ensure that GPIO 11 is set to output for GOTVIEW
1642 		   hardware. */
1643 		pvr2_hdw_gpio_chg_dir(hdw,(1 << 11),~0);
1644 	}
1645 	return ret;
1646 }
1647 
1648 
pvr2_get_state_name(unsigned int st)1649 static const char *pvr2_get_state_name(unsigned int st)
1650 {
1651 	if (st < ARRAY_SIZE(pvr2_state_names)) {
1652 		return pvr2_state_names[st];
1653 	}
1654 	return "???";
1655 }
1656 
pvr2_decoder_enable(struct pvr2_hdw * hdw,int enablefl)1657 static int pvr2_decoder_enable(struct pvr2_hdw *hdw,int enablefl)
1658 {
1659 	/* Even though we really only care about the video decoder chip at
1660 	   this point, we'll broadcast stream on/off to all sub-devices
1661 	   anyway, just in case somebody else wants to hear the
1662 	   command... */
1663 	pvr2_trace(PVR2_TRACE_CHIPS, "subdev v4l2 stream=%s",
1664 		   (enablefl ? "on" : "off"));
1665 	v4l2_device_call_all(&hdw->v4l2_dev, 0, video, s_stream, enablefl);
1666 	v4l2_device_call_all(&hdw->v4l2_dev, 0, audio, s_stream, enablefl);
1667 	if (hdw->decoder_client_id) {
1668 		/* We get here if the encoder has been noticed.  Otherwise
1669 		   we'll issue a warning to the user (which should
1670 		   normally never happen). */
1671 		return 0;
1672 	}
1673 	if (!hdw->flag_decoder_missed) {
1674 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1675 			   "***WARNING*** No decoder present");
1676 		hdw->flag_decoder_missed = !0;
1677 		trace_stbit("flag_decoder_missed",
1678 			    hdw->flag_decoder_missed);
1679 	}
1680 	return -EIO;
1681 }
1682 
1683 
pvr2_hdw_get_state(struct pvr2_hdw * hdw)1684 int pvr2_hdw_get_state(struct pvr2_hdw *hdw)
1685 {
1686 	return hdw->master_state;
1687 }
1688 
1689 
pvr2_hdw_untrip_unlocked(struct pvr2_hdw * hdw)1690 static int pvr2_hdw_untrip_unlocked(struct pvr2_hdw *hdw)
1691 {
1692 	if (!hdw->flag_tripped) return 0;
1693 	hdw->flag_tripped = 0;
1694 	pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1695 		   "Clearing driver error status");
1696 	return !0;
1697 }
1698 
1699 
pvr2_hdw_untrip(struct pvr2_hdw * hdw)1700 int pvr2_hdw_untrip(struct pvr2_hdw *hdw)
1701 {
1702 	int fl;
1703 	LOCK_TAKE(hdw->big_lock); do {
1704 		fl = pvr2_hdw_untrip_unlocked(hdw);
1705 	} while (0); LOCK_GIVE(hdw->big_lock);
1706 	if (fl) pvr2_hdw_state_sched(hdw);
1707 	return 0;
1708 }
1709 
1710 
1711 
1712 
pvr2_hdw_get_streaming(struct pvr2_hdw * hdw)1713 int pvr2_hdw_get_streaming(struct pvr2_hdw *hdw)
1714 {
1715 	return hdw->state_pipeline_req != 0;
1716 }
1717 
1718 
pvr2_hdw_set_streaming(struct pvr2_hdw * hdw,int enable_flag)1719 int pvr2_hdw_set_streaming(struct pvr2_hdw *hdw,int enable_flag)
1720 {
1721 	int ret,st;
1722 	LOCK_TAKE(hdw->big_lock); do {
1723 		pvr2_hdw_untrip_unlocked(hdw);
1724 		if ((!enable_flag) != !(hdw->state_pipeline_req)) {
1725 			hdw->state_pipeline_req = enable_flag != 0;
1726 			pvr2_trace(PVR2_TRACE_START_STOP,
1727 				   "/*--TRACE_STREAM--*/ %s",
1728 				   enable_flag ? "enable" : "disable");
1729 		}
1730 		pvr2_hdw_state_sched(hdw);
1731 	} while (0); LOCK_GIVE(hdw->big_lock);
1732 	if ((ret = pvr2_hdw_wait(hdw,0)) < 0) return ret;
1733 	if (enable_flag) {
1734 		while ((st = hdw->master_state) != PVR2_STATE_RUN) {
1735 			if (st != PVR2_STATE_READY) return -EIO;
1736 			if ((ret = pvr2_hdw_wait(hdw,st)) < 0) return ret;
1737 		}
1738 	}
1739 	return 0;
1740 }
1741 
1742 
pvr2_hdw_set_stream_type(struct pvr2_hdw * hdw,enum pvr2_config config)1743 int pvr2_hdw_set_stream_type(struct pvr2_hdw *hdw,enum pvr2_config config)
1744 {
1745 	int fl;
1746 	LOCK_TAKE(hdw->big_lock);
1747 	if ((fl = (hdw->desired_stream_type != config)) != 0) {
1748 		hdw->desired_stream_type = config;
1749 		hdw->state_pipeline_config = 0;
1750 		trace_stbit("state_pipeline_config",
1751 			    hdw->state_pipeline_config);
1752 		pvr2_hdw_state_sched(hdw);
1753 	}
1754 	LOCK_GIVE(hdw->big_lock);
1755 	if (fl) return 0;
1756 	return pvr2_hdw_wait(hdw,0);
1757 }
1758 
1759 
get_default_tuner_type(struct pvr2_hdw * hdw)1760 static int get_default_tuner_type(struct pvr2_hdw *hdw)
1761 {
1762 	int unit_number = hdw->unit_number;
1763 	int tp = -1;
1764 	if ((unit_number >= 0) && (unit_number < PVR_NUM)) {
1765 		tp = tuner[unit_number];
1766 	}
1767 	if (tp < 0) return -EINVAL;
1768 	hdw->tuner_type = tp;
1769 	hdw->tuner_updated = !0;
1770 	return 0;
1771 }
1772 
1773 
get_default_standard(struct pvr2_hdw * hdw)1774 static v4l2_std_id get_default_standard(struct pvr2_hdw *hdw)
1775 {
1776 	int unit_number = hdw->unit_number;
1777 	int tp = 0;
1778 	if ((unit_number >= 0) && (unit_number < PVR_NUM)) {
1779 		tp = video_std[unit_number];
1780 		if (tp) return tp;
1781 	}
1782 	return 0;
1783 }
1784 
1785 
get_default_error_tolerance(struct pvr2_hdw * hdw)1786 static unsigned int get_default_error_tolerance(struct pvr2_hdw *hdw)
1787 {
1788 	int unit_number = hdw->unit_number;
1789 	int tp = 0;
1790 	if ((unit_number >= 0) && (unit_number < PVR_NUM)) {
1791 		tp = tolerance[unit_number];
1792 	}
1793 	return tp;
1794 }
1795 
1796 
pvr2_hdw_check_firmware(struct pvr2_hdw * hdw)1797 static int pvr2_hdw_check_firmware(struct pvr2_hdw *hdw)
1798 {
1799 	/* Try a harmless request to fetch the eeprom's address over
1800 	   endpoint 1.  See what happens.  Only the full FX2 image can
1801 	   respond to this.  If this probe fails then likely the FX2
1802 	   firmware needs be loaded. */
1803 	int result;
1804 	LOCK_TAKE(hdw->ctl_lock); do {
1805 		hdw->cmd_buffer[0] = FX2CMD_GET_EEPROM_ADDR;
1806 		result = pvr2_send_request_ex(hdw,HZ*1,!0,
1807 					   hdw->cmd_buffer,1,
1808 					   hdw->cmd_buffer,1);
1809 		if (result < 0) break;
1810 	} while(0); LOCK_GIVE(hdw->ctl_lock);
1811 	if (result) {
1812 		pvr2_trace(PVR2_TRACE_INIT,
1813 			   "Probe of device endpoint 1 result status %d",
1814 			   result);
1815 	} else {
1816 		pvr2_trace(PVR2_TRACE_INIT,
1817 			   "Probe of device endpoint 1 succeeded");
1818 	}
1819 	return result == 0;
1820 }
1821 
1822 struct pvr2_std_hack {
1823 	v4l2_std_id pat;  /* Pattern to match */
1824 	v4l2_std_id msk;  /* Which bits we care about */
1825 	v4l2_std_id std;  /* What additional standards or default to set */
1826 };
1827 
1828 /* This data structure labels specific combinations of standards from
1829    tveeprom that we'll try to recognize.  If we recognize one, then assume
1830    a specified default standard to use.  This is here because tveeprom only
1831    tells us about available standards not the intended default standard (if
1832    any) for the device in question.  We guess the default based on what has
1833    been reported as available.  Note that this is only for guessing a
1834    default - which can always be overridden explicitly - and if the user
1835    has otherwise named a default then that default will always be used in
1836    place of this table. */
1837 static const struct pvr2_std_hack std_eeprom_maps[] = {
1838 	{	/* PAL(B/G) */
1839 		.pat = V4L2_STD_B|V4L2_STD_GH,
1840 		.std = V4L2_STD_PAL_B|V4L2_STD_PAL_B1|V4L2_STD_PAL_G,
1841 	},
1842 	{	/* NTSC(M) */
1843 		.pat = V4L2_STD_MN,
1844 		.std = V4L2_STD_NTSC_M,
1845 	},
1846 	{	/* PAL(I) */
1847 		.pat = V4L2_STD_PAL_I,
1848 		.std = V4L2_STD_PAL_I,
1849 	},
1850 	{	/* SECAM(L/L') */
1851 		.pat = V4L2_STD_SECAM_L|V4L2_STD_SECAM_LC,
1852 		.std = V4L2_STD_SECAM_L|V4L2_STD_SECAM_LC,
1853 	},
1854 	{	/* PAL(D/D1/K) */
1855 		.pat = V4L2_STD_DK,
1856 		.std = V4L2_STD_PAL_D|V4L2_STD_PAL_D1|V4L2_STD_PAL_K,
1857 	},
1858 };
1859 
pvr2_hdw_setup_std(struct pvr2_hdw * hdw)1860 static void pvr2_hdw_setup_std(struct pvr2_hdw *hdw)
1861 {
1862 	char buf[40];
1863 	unsigned int bcnt;
1864 	v4l2_std_id std1,std2,std3;
1865 
1866 	std1 = get_default_standard(hdw);
1867 	std3 = std1 ? 0 : hdw->hdw_desc->default_std_mask;
1868 
1869 	bcnt = pvr2_std_id_to_str(buf,sizeof(buf),hdw->std_mask_eeprom);
1870 	pvr2_trace(PVR2_TRACE_STD,
1871 		   "Supported video standard(s) reported available in hardware: %.*s",
1872 		   bcnt,buf);
1873 
1874 	hdw->std_mask_avail = hdw->std_mask_eeprom;
1875 
1876 	std2 = (std1|std3) & ~hdw->std_mask_avail;
1877 	if (std2) {
1878 		bcnt = pvr2_std_id_to_str(buf,sizeof(buf),std2);
1879 		pvr2_trace(PVR2_TRACE_STD,
1880 			   "Expanding supported video standards to include: %.*s",
1881 			   bcnt,buf);
1882 		hdw->std_mask_avail |= std2;
1883 	}
1884 
1885 	hdw->std_info_cur.def.type_bitmask.valid_bits = hdw->std_mask_avail;
1886 
1887 	if (std1) {
1888 		bcnt = pvr2_std_id_to_str(buf,sizeof(buf),std1);
1889 		pvr2_trace(PVR2_TRACE_STD,
1890 			   "Initial video standard forced to %.*s",
1891 			   bcnt,buf);
1892 		hdw->std_mask_cur = std1;
1893 		hdw->std_dirty = !0;
1894 		return;
1895 	}
1896 	if (std3) {
1897 		bcnt = pvr2_std_id_to_str(buf,sizeof(buf),std3);
1898 		pvr2_trace(PVR2_TRACE_STD,
1899 			   "Initial video standard (determined by device type): %.*s",
1900 			   bcnt, buf);
1901 		hdw->std_mask_cur = std3;
1902 		hdw->std_dirty = !0;
1903 		return;
1904 	}
1905 
1906 	{
1907 		unsigned int idx;
1908 		for (idx = 0; idx < ARRAY_SIZE(std_eeprom_maps); idx++) {
1909 			if (std_eeprom_maps[idx].msk ?
1910 			    ((std_eeprom_maps[idx].pat ^
1911 			     hdw->std_mask_eeprom) &
1912 			     std_eeprom_maps[idx].msk) :
1913 			    (std_eeprom_maps[idx].pat !=
1914 			     hdw->std_mask_eeprom)) continue;
1915 			bcnt = pvr2_std_id_to_str(buf,sizeof(buf),
1916 						  std_eeprom_maps[idx].std);
1917 			pvr2_trace(PVR2_TRACE_STD,
1918 				   "Initial video standard guessed as %.*s",
1919 				   bcnt,buf);
1920 			hdw->std_mask_cur = std_eeprom_maps[idx].std;
1921 			hdw->std_dirty = !0;
1922 			return;
1923 		}
1924 	}
1925 
1926 }
1927 
1928 
pvr2_copy_i2c_addr_list(unsigned short * dst,const unsigned char * src,unsigned int dst_max)1929 static unsigned int pvr2_copy_i2c_addr_list(
1930 	unsigned short *dst, const unsigned char *src,
1931 	unsigned int dst_max)
1932 {
1933 	unsigned int cnt = 0;
1934 	if (!src) return 0;
1935 	while (src[cnt] && (cnt + 1) < dst_max) {
1936 		dst[cnt] = src[cnt];
1937 		cnt++;
1938 	}
1939 	dst[cnt] = I2C_CLIENT_END;
1940 	return cnt;
1941 }
1942 
1943 
pvr2_hdw_cx25840_vbi_hack(struct pvr2_hdw * hdw)1944 static void pvr2_hdw_cx25840_vbi_hack(struct pvr2_hdw *hdw)
1945 {
1946 	/*
1947 	  Mike Isely <isely@pobox.com> 19-Nov-2006 - This bit of nuttiness
1948 	  for cx25840 causes that module to correctly set up its video
1949 	  scaling.  This is really a problem in the cx25840 module itself,
1950 	  but we work around it here.  The problem has not been seen in
1951 	  ivtv because there VBI is supported and set up.  We don't do VBI
1952 	  here (at least not yet) and thus we never attempted to even set
1953 	  it up.
1954 	*/
1955 	struct v4l2_format fmt;
1956 	if (hdw->decoder_client_id != PVR2_CLIENT_ID_CX25840) {
1957 		/* We're not using a cx25840 so don't enable the hack */
1958 		return;
1959 	}
1960 
1961 	pvr2_trace(PVR2_TRACE_INIT,
1962 		   "Module ID %u: Executing cx25840 VBI hack",
1963 		   hdw->decoder_client_id);
1964 	memset(&fmt, 0, sizeof(fmt));
1965 	fmt.type = V4L2_BUF_TYPE_SLICED_VBI_CAPTURE;
1966 	fmt.fmt.sliced.service_lines[0][21] = V4L2_SLICED_CAPTION_525;
1967 	fmt.fmt.sliced.service_lines[1][21] = V4L2_SLICED_CAPTION_525;
1968 	v4l2_device_call_all(&hdw->v4l2_dev, hdw->decoder_client_id,
1969 			     vbi, s_sliced_fmt, &fmt.fmt.sliced);
1970 }
1971 
1972 
pvr2_hdw_load_subdev(struct pvr2_hdw * hdw,const struct pvr2_device_client_desc * cd)1973 static int pvr2_hdw_load_subdev(struct pvr2_hdw *hdw,
1974 				const struct pvr2_device_client_desc *cd)
1975 {
1976 	const char *fname;
1977 	unsigned char mid;
1978 	struct v4l2_subdev *sd;
1979 	unsigned int i2ccnt;
1980 	const unsigned char *p;
1981 	/* Arbitrary count - max # i2c addresses we will probe */
1982 	unsigned short i2caddr[25];
1983 
1984 	mid = cd->module_id;
1985 	fname = (mid < ARRAY_SIZE(module_names)) ? module_names[mid] : NULL;
1986 	if (!fname) {
1987 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1988 			   "Module ID %u for device %s has no name?  The driver might have a configuration problem.",
1989 			   mid,
1990 			   hdw->hdw_desc->description);
1991 		return -EINVAL;
1992 	}
1993 	pvr2_trace(PVR2_TRACE_INIT,
1994 		   "Module ID %u (%s) for device %s being loaded...",
1995 		   mid, fname,
1996 		   hdw->hdw_desc->description);
1997 
1998 	i2ccnt = pvr2_copy_i2c_addr_list(i2caddr, cd->i2c_address_list,
1999 					 ARRAY_SIZE(i2caddr));
2000 	if (!i2ccnt && ((p = (mid < ARRAY_SIZE(module_i2c_addresses)) ?
2001 			 module_i2c_addresses[mid] : NULL) != NULL)) {
2002 		/* Second chance: Try default i2c address list */
2003 		i2ccnt = pvr2_copy_i2c_addr_list(i2caddr, p,
2004 						 ARRAY_SIZE(i2caddr));
2005 		if (i2ccnt) {
2006 			pvr2_trace(PVR2_TRACE_INIT,
2007 				   "Module ID %u: Using default i2c address list",
2008 				   mid);
2009 		}
2010 	}
2011 
2012 	if (!i2ccnt) {
2013 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
2014 			   "Module ID %u (%s) for device %s: No i2c addresses.	The driver might have a configuration problem.",
2015 			   mid, fname, hdw->hdw_desc->description);
2016 		return -EINVAL;
2017 	}
2018 
2019 	if (i2ccnt == 1) {
2020 		pvr2_trace(PVR2_TRACE_INIT,
2021 			   "Module ID %u: Setting up with specified i2c address 0x%x",
2022 			   mid, i2caddr[0]);
2023 		sd = v4l2_i2c_new_subdev(&hdw->v4l2_dev, &hdw->i2c_adap,
2024 					 fname, i2caddr[0], NULL);
2025 	} else {
2026 		pvr2_trace(PVR2_TRACE_INIT,
2027 			   "Module ID %u: Setting up with address probe list",
2028 			   mid);
2029 		sd = v4l2_i2c_new_subdev(&hdw->v4l2_dev, &hdw->i2c_adap,
2030 					 fname, 0, i2caddr);
2031 	}
2032 
2033 	if (!sd) {
2034 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
2035 			   "Module ID %u (%s) for device %s failed to load.  Possible missing sub-device kernel module or initialization failure within module.",
2036 			   mid, fname, hdw->hdw_desc->description);
2037 		return -EIO;
2038 	}
2039 
2040 	/* Tag this sub-device instance with the module ID we know about.
2041 	   In other places we'll use that tag to determine if the instance
2042 	   requires special handling. */
2043 	sd->grp_id = mid;
2044 
2045 	pvr2_trace(PVR2_TRACE_INFO, "Attached sub-driver %s", fname);
2046 
2047 
2048 	/* client-specific setup... */
2049 	switch (mid) {
2050 	case PVR2_CLIENT_ID_CX25840:
2051 	case PVR2_CLIENT_ID_SAA7115:
2052 		hdw->decoder_client_id = mid;
2053 		break;
2054 	default: break;
2055 	}
2056 
2057 	return 0;
2058 }
2059 
2060 
pvr2_hdw_load_modules(struct pvr2_hdw * hdw)2061 static void pvr2_hdw_load_modules(struct pvr2_hdw *hdw)
2062 {
2063 	unsigned int idx;
2064 	const struct pvr2_string_table *cm;
2065 	const struct pvr2_device_client_table *ct;
2066 	int okFl = !0;
2067 
2068 	cm = &hdw->hdw_desc->client_modules;
2069 	for (idx = 0; idx < cm->cnt; idx++) {
2070 		request_module(cm->lst[idx]);
2071 	}
2072 
2073 	ct = &hdw->hdw_desc->client_table;
2074 	for (idx = 0; idx < ct->cnt; idx++) {
2075 		if (pvr2_hdw_load_subdev(hdw, &ct->lst[idx]) < 0) okFl = 0;
2076 	}
2077 	if (!okFl) {
2078 		hdw->flag_modulefail = !0;
2079 		pvr2_hdw_render_useless(hdw);
2080 	}
2081 }
2082 
2083 
pvr2_hdw_setup_low(struct pvr2_hdw * hdw)2084 static void pvr2_hdw_setup_low(struct pvr2_hdw *hdw)
2085 {
2086 	int ret;
2087 	unsigned int idx;
2088 	struct pvr2_ctrl *cptr;
2089 	int reloadFl = 0;
2090 	if (hdw->hdw_desc->fx2_firmware.cnt) {
2091 		if (!reloadFl) {
2092 			reloadFl =
2093 				(hdw->usb_intf->cur_altsetting->desc.bNumEndpoints
2094 				 == 0);
2095 			if (reloadFl) {
2096 				pvr2_trace(PVR2_TRACE_INIT,
2097 					   "USB endpoint config looks strange; possibly firmware needs to be loaded");
2098 			}
2099 		}
2100 		if (!reloadFl) {
2101 			reloadFl = !pvr2_hdw_check_firmware(hdw);
2102 			if (reloadFl) {
2103 				pvr2_trace(PVR2_TRACE_INIT,
2104 					   "Check for FX2 firmware failed; possibly firmware needs to be loaded");
2105 			}
2106 		}
2107 		if (reloadFl) {
2108 			if (pvr2_upload_firmware1(hdw) != 0) {
2109 				pvr2_trace(PVR2_TRACE_ERROR_LEGS,
2110 					   "Failure uploading firmware1");
2111 			}
2112 			return;
2113 		}
2114 	}
2115 	hdw->fw1_state = FW1_STATE_OK;
2116 
2117 	if (!pvr2_hdw_dev_ok(hdw)) return;
2118 
2119 	hdw->force_dirty = !0;
2120 
2121 	if (!hdw->hdw_desc->flag_no_powerup) {
2122 		pvr2_hdw_cmd_powerup(hdw);
2123 		if (!pvr2_hdw_dev_ok(hdw)) return;
2124 	}
2125 
2126 	/* Take the IR chip out of reset, if appropriate */
2127 	if (hdw->ir_scheme_active == PVR2_IR_SCHEME_ZILOG) {
2128 		pvr2_issue_simple_cmd(hdw,
2129 				      FX2CMD_HCW_ZILOG_RESET |
2130 				      (1 << 8) |
2131 				      ((0) << 16));
2132 	}
2133 
2134 	/* This step MUST happen after the earlier powerup step */
2135 	pvr2_i2c_core_init(hdw);
2136 	if (!pvr2_hdw_dev_ok(hdw)) return;
2137 
2138 	/* Reset demod only on Hauppauge 160xxx platform */
2139 	if (le16_to_cpu(hdw->usb_dev->descriptor.idVendor) == 0x2040 &&
2140 	    (le16_to_cpu(hdw->usb_dev->descriptor.idProduct) == 0x7502 ||
2141 	     le16_to_cpu(hdw->usb_dev->descriptor.idProduct) == 0x7510)) {
2142 		pr_info("%s(): resetting 160xxx demod\n", __func__);
2143 		/* TODO: not sure this is proper place to reset once only */
2144 		pvr2_issue_simple_cmd(hdw,
2145 				      FX2CMD_HCW_DEMOD_RESET_PIN |
2146 				      (1 << 8) |
2147 				      ((0) << 16));
2148 		usleep_range(10000, 10500);
2149 		pvr2_issue_simple_cmd(hdw,
2150 				      FX2CMD_HCW_DEMOD_RESET_PIN |
2151 				      (1 << 8) |
2152 				      ((1) << 16));
2153 		usleep_range(10000, 10500);
2154 	}
2155 
2156 	pvr2_hdw_load_modules(hdw);
2157 	if (!pvr2_hdw_dev_ok(hdw)) return;
2158 
2159 	v4l2_device_call_all(&hdw->v4l2_dev, 0, core, load_fw);
2160 
2161 	for (idx = 0; idx < CTRLDEF_COUNT; idx++) {
2162 		cptr = hdw->controls + idx;
2163 		if (cptr->info->skip_init) continue;
2164 		if (!cptr->info->set_value) continue;
2165 		cptr->info->set_value(cptr,~0,cptr->info->default_value);
2166 	}
2167 
2168 	pvr2_hdw_cx25840_vbi_hack(hdw);
2169 
2170 	/* Set up special default values for the television and radio
2171 	   frequencies here.  It's not really important what these defaults
2172 	   are, but I set them to something usable in the Chicago area just
2173 	   to make driver testing a little easier. */
2174 
2175 	hdw->freqValTelevision = default_tv_freq;
2176 	hdw->freqValRadio = default_radio_freq;
2177 
2178 	// Do not use pvr2_reset_ctl_endpoints() here.  It is not
2179 	// thread-safe against the normal pvr2_send_request() mechanism.
2180 	// (We should make it thread safe).
2181 
2182 	if (hdw->hdw_desc->flag_has_hauppauge_rom) {
2183 		ret = pvr2_hdw_get_eeprom_addr(hdw);
2184 		if (!pvr2_hdw_dev_ok(hdw)) return;
2185 		if (ret < 0) {
2186 			pvr2_trace(PVR2_TRACE_ERROR_LEGS,
2187 				   "Unable to determine location of eeprom, skipping");
2188 		} else {
2189 			hdw->eeprom_addr = ret;
2190 			pvr2_eeprom_analyze(hdw);
2191 			if (!pvr2_hdw_dev_ok(hdw)) return;
2192 		}
2193 	} else {
2194 		hdw->tuner_type = hdw->hdw_desc->default_tuner_type;
2195 		hdw->tuner_updated = !0;
2196 		hdw->std_mask_eeprom = V4L2_STD_ALL;
2197 	}
2198 
2199 	if (hdw->serial_number) {
2200 		idx = scnprintf(hdw->identifier, sizeof(hdw->identifier) - 1,
2201 				"sn-%lu", hdw->serial_number);
2202 	} else if (hdw->unit_number >= 0) {
2203 		idx = scnprintf(hdw->identifier, sizeof(hdw->identifier) - 1,
2204 				"unit-%c",
2205 				hdw->unit_number + 'a');
2206 	} else {
2207 		idx = scnprintf(hdw->identifier, sizeof(hdw->identifier) - 1,
2208 				"unit-??");
2209 	}
2210 	hdw->identifier[idx] = 0;
2211 
2212 	pvr2_hdw_setup_std(hdw);
2213 
2214 	if (!get_default_tuner_type(hdw)) {
2215 		pvr2_trace(PVR2_TRACE_INIT,
2216 			   "pvr2_hdw_setup: Tuner type overridden to %d",
2217 			   hdw->tuner_type);
2218 	}
2219 
2220 
2221 	if (!pvr2_hdw_dev_ok(hdw)) return;
2222 
2223 	if (hdw->hdw_desc->signal_routing_scheme ==
2224 	    PVR2_ROUTING_SCHEME_GOTVIEW) {
2225 		/* Ensure that GPIO 11 is set to output for GOTVIEW
2226 		   hardware. */
2227 		pvr2_hdw_gpio_chg_dir(hdw,(1 << 11),~0);
2228 	}
2229 
2230 	pvr2_hdw_commit_setup(hdw);
2231 
2232 	hdw->vid_stream = pvr2_stream_create();
2233 	if (!pvr2_hdw_dev_ok(hdw)) return;
2234 	pvr2_trace(PVR2_TRACE_INIT,
2235 		   "pvr2_hdw_setup: video stream is %p",hdw->vid_stream);
2236 	if (hdw->vid_stream) {
2237 		idx = get_default_error_tolerance(hdw);
2238 		if (idx) {
2239 			pvr2_trace(PVR2_TRACE_INIT,
2240 				   "pvr2_hdw_setup: video stream %p setting tolerance %u",
2241 				   hdw->vid_stream,idx);
2242 		}
2243 		pvr2_stream_setup(hdw->vid_stream,hdw->usb_dev,
2244 				  PVR2_VID_ENDPOINT,idx);
2245 	}
2246 
2247 	if (!pvr2_hdw_dev_ok(hdw)) return;
2248 
2249 	hdw->flag_init_ok = !0;
2250 
2251 	pvr2_hdw_state_sched(hdw);
2252 }
2253 
2254 
2255 /* Set up the structure and attempt to put the device into a usable state.
2256    This can be a time-consuming operation, which is why it is not done
2257    internally as part of the create() step. */
pvr2_hdw_setup(struct pvr2_hdw * hdw)2258 static void pvr2_hdw_setup(struct pvr2_hdw *hdw)
2259 {
2260 	pvr2_trace(PVR2_TRACE_INIT,"pvr2_hdw_setup(hdw=%p) begin",hdw);
2261 	do {
2262 		pvr2_hdw_setup_low(hdw);
2263 		pvr2_trace(PVR2_TRACE_INIT,
2264 			   "pvr2_hdw_setup(hdw=%p) done, ok=%d init_ok=%d",
2265 			   hdw,pvr2_hdw_dev_ok(hdw),hdw->flag_init_ok);
2266 		if (pvr2_hdw_dev_ok(hdw)) {
2267 			if (hdw->flag_init_ok) {
2268 				pvr2_trace(
2269 					PVR2_TRACE_INFO,
2270 					"Device initialization completed successfully.");
2271 				break;
2272 			}
2273 			if (hdw->fw1_state == FW1_STATE_RELOAD) {
2274 				pvr2_trace(
2275 					PVR2_TRACE_INFO,
2276 					"Device microcontroller firmware (re)loaded; it should now reset and reconnect.");
2277 				break;
2278 			}
2279 			pvr2_trace(
2280 				PVR2_TRACE_ERROR_LEGS,
2281 				"Device initialization was not successful.");
2282 			if (hdw->fw1_state == FW1_STATE_MISSING) {
2283 				pvr2_trace(
2284 					PVR2_TRACE_ERROR_LEGS,
2285 					"Giving up since device microcontroller firmware appears to be missing.");
2286 				break;
2287 			}
2288 		}
2289 		if (hdw->flag_modulefail) {
2290 			pvr2_trace(
2291 				PVR2_TRACE_ERROR_LEGS,
2292 				"***WARNING*** pvrusb2 driver initialization failed due to the failure of one or more sub-device kernel modules.");
2293 			pvr2_trace(
2294 				PVR2_TRACE_ERROR_LEGS,
2295 				"You need to resolve the failing condition before this driver can function.  There should be some earlier messages giving more information about the problem.");
2296 			break;
2297 		}
2298 		if (procreload) {
2299 			pvr2_trace(
2300 				PVR2_TRACE_ERROR_LEGS,
2301 				"Attempting pvrusb2 recovery by reloading primary firmware.");
2302 			pvr2_trace(
2303 				PVR2_TRACE_ERROR_LEGS,
2304 				"If this works, device should disconnect and reconnect in a sane state.");
2305 			hdw->fw1_state = FW1_STATE_UNKNOWN;
2306 			pvr2_upload_firmware1(hdw);
2307 		} else {
2308 			pvr2_trace(
2309 				PVR2_TRACE_ERROR_LEGS,
2310 				"***WARNING*** pvrusb2 device hardware appears to be jammed and I can't clear it.");
2311 			pvr2_trace(
2312 				PVR2_TRACE_ERROR_LEGS,
2313 				"You might need to power cycle the pvrusb2 device in order to recover.");
2314 		}
2315 	} while (0);
2316 	pvr2_trace(PVR2_TRACE_INIT,"pvr2_hdw_setup(hdw=%p) end",hdw);
2317 }
2318 
2319 
2320 /* Perform second stage initialization.  Set callback pointer first so that
2321    we can avoid a possible initialization race (if the kernel thread runs
2322    before the callback has been set). */
pvr2_hdw_initialize(struct pvr2_hdw * hdw,void (* callback_func)(void *),void * callback_data)2323 int pvr2_hdw_initialize(struct pvr2_hdw *hdw,
2324 			void (*callback_func)(void *),
2325 			void *callback_data)
2326 {
2327 	LOCK_TAKE(hdw->big_lock); do {
2328 		if (hdw->flag_disconnected) {
2329 			/* Handle a race here: If we're already
2330 			   disconnected by this point, then give up.  If we
2331 			   get past this then we'll remain connected for
2332 			   the duration of initialization since the entire
2333 			   initialization sequence is now protected by the
2334 			   big_lock. */
2335 			break;
2336 		}
2337 		hdw->state_data = callback_data;
2338 		hdw->state_func = callback_func;
2339 		pvr2_hdw_setup(hdw);
2340 	} while (0); LOCK_GIVE(hdw->big_lock);
2341 	return hdw->flag_init_ok;
2342 }
2343 
2344 
2345 /* Create, set up, and return a structure for interacting with the
2346    underlying hardware.  */
pvr2_hdw_create(struct usb_interface * intf,const struct usb_device_id * devid)2347 struct pvr2_hdw *pvr2_hdw_create(struct usb_interface *intf,
2348 				 const struct usb_device_id *devid)
2349 {
2350 	unsigned int idx,cnt1,cnt2,m;
2351 	struct pvr2_hdw *hdw = NULL;
2352 	int valid_std_mask;
2353 	struct pvr2_ctrl *cptr;
2354 	struct usb_device *usb_dev;
2355 	const struct pvr2_device_desc *hdw_desc;
2356 	__u8 ifnum;
2357 	struct v4l2_queryctrl qctrl;
2358 	struct pvr2_ctl_info *ciptr;
2359 
2360 	usb_dev = interface_to_usbdev(intf);
2361 
2362 	hdw_desc = (const struct pvr2_device_desc *)(devid->driver_info);
2363 
2364 	if (hdw_desc == NULL) {
2365 		pvr2_trace(PVR2_TRACE_INIT, "pvr2_hdw_create: No device description pointer, unable to continue.");
2366 		pvr2_trace(PVR2_TRACE_INIT,
2367 			   "If you have a new device type, please contact Mike Isely <isely@pobox.com> to get it included in the driver");
2368 		goto fail;
2369 	}
2370 
2371 	hdw = kzalloc(sizeof(*hdw),GFP_KERNEL);
2372 	pvr2_trace(PVR2_TRACE_INIT,"pvr2_hdw_create: hdw=%p, type \"%s\"",
2373 		   hdw,hdw_desc->description);
2374 	pvr2_trace(PVR2_TRACE_INFO, "Hardware description: %s",
2375 		hdw_desc->description);
2376 	if (hdw_desc->flag_is_experimental) {
2377 		pvr2_trace(PVR2_TRACE_INFO, "**********");
2378 		pvr2_trace(PVR2_TRACE_INFO,
2379 			   "***WARNING*** Support for this device (%s) is experimental.",
2380 							      hdw_desc->description);
2381 		pvr2_trace(PVR2_TRACE_INFO,
2382 			   "Important functionality might not be entirely working.");
2383 		pvr2_trace(PVR2_TRACE_INFO,
2384 			   "Please consider contacting the driver author to help with further stabilization of the driver.");
2385 		pvr2_trace(PVR2_TRACE_INFO, "**********");
2386 	}
2387 	if (!hdw) goto fail;
2388 
2389 	timer_setup(&hdw->quiescent_timer, pvr2_hdw_quiescent_timeout, 0);
2390 
2391 	timer_setup(&hdw->decoder_stabilization_timer,
2392 		    pvr2_hdw_decoder_stabilization_timeout, 0);
2393 
2394 	timer_setup(&hdw->encoder_wait_timer, pvr2_hdw_encoder_wait_timeout,
2395 		    0);
2396 
2397 	timer_setup(&hdw->encoder_run_timer, pvr2_hdw_encoder_run_timeout, 0);
2398 
2399 	hdw->master_state = PVR2_STATE_DEAD;
2400 
2401 	init_waitqueue_head(&hdw->state_wait_data);
2402 
2403 	hdw->tuner_signal_stale = !0;
2404 	cx2341x_fill_defaults(&hdw->enc_ctl_state);
2405 
2406 	/* Calculate which inputs are OK */
2407 	m = 0;
2408 	if (hdw_desc->flag_has_analogtuner) m |= 1 << PVR2_CVAL_INPUT_TV;
2409 	if (hdw_desc->digital_control_scheme != PVR2_DIGITAL_SCHEME_NONE) {
2410 		m |= 1 << PVR2_CVAL_INPUT_DTV;
2411 	}
2412 	if (hdw_desc->flag_has_svideo) m |= 1 << PVR2_CVAL_INPUT_SVIDEO;
2413 	if (hdw_desc->flag_has_composite) m |= 1 << PVR2_CVAL_INPUT_COMPOSITE;
2414 	if (hdw_desc->flag_has_fmradio) m |= 1 << PVR2_CVAL_INPUT_RADIO;
2415 	hdw->input_avail_mask = m;
2416 	hdw->input_allowed_mask = hdw->input_avail_mask;
2417 
2418 	/* If not a hybrid device, pathway_state never changes.  So
2419 	   initialize it here to what it should forever be. */
2420 	if (!(hdw->input_avail_mask & (1 << PVR2_CVAL_INPUT_DTV))) {
2421 		hdw->pathway_state = PVR2_PATHWAY_ANALOG;
2422 	} else if (!(hdw->input_avail_mask & (1 << PVR2_CVAL_INPUT_TV))) {
2423 		hdw->pathway_state = PVR2_PATHWAY_DIGITAL;
2424 	}
2425 
2426 	hdw->control_cnt = CTRLDEF_COUNT;
2427 	hdw->control_cnt += MPEGDEF_COUNT;
2428 	hdw->controls = kcalloc(hdw->control_cnt, sizeof(struct pvr2_ctrl),
2429 				GFP_KERNEL);
2430 	if (!hdw->controls) goto fail;
2431 	hdw->hdw_desc = hdw_desc;
2432 	hdw->ir_scheme_active = hdw->hdw_desc->ir_scheme;
2433 	for (idx = 0; idx < hdw->control_cnt; idx++) {
2434 		cptr = hdw->controls + idx;
2435 		cptr->hdw = hdw;
2436 	}
2437 	for (idx = 0; idx < 32; idx++) {
2438 		hdw->std_mask_ptrs[idx] = hdw->std_mask_names[idx];
2439 	}
2440 	for (idx = 0; idx < CTRLDEF_COUNT; idx++) {
2441 		cptr = hdw->controls + idx;
2442 		cptr->info = control_defs+idx;
2443 	}
2444 
2445 	/* Ensure that default input choice is a valid one. */
2446 	m = hdw->input_avail_mask;
2447 	if (m) for (idx = 0; idx < (sizeof(m) << 3); idx++) {
2448 		if (!((1UL << idx) & m)) continue;
2449 		hdw->input_val = idx;
2450 		break;
2451 	}
2452 
2453 	/* Define and configure additional controls from cx2341x module. */
2454 	hdw->mpeg_ctrl_info = kcalloc(MPEGDEF_COUNT,
2455 				      sizeof(*(hdw->mpeg_ctrl_info)),
2456 				      GFP_KERNEL);
2457 	if (!hdw->mpeg_ctrl_info) goto fail;
2458 	for (idx = 0; idx < MPEGDEF_COUNT; idx++) {
2459 		cptr = hdw->controls + idx + CTRLDEF_COUNT;
2460 		ciptr = &(hdw->mpeg_ctrl_info[idx].info);
2461 		ciptr->desc = hdw->mpeg_ctrl_info[idx].desc;
2462 		ciptr->name = mpeg_ids[idx].strid;
2463 		ciptr->v4l_id = mpeg_ids[idx].id;
2464 		ciptr->skip_init = !0;
2465 		ciptr->get_value = ctrl_cx2341x_get;
2466 		ciptr->get_v4lflags = ctrl_cx2341x_getv4lflags;
2467 		ciptr->is_dirty = ctrl_cx2341x_is_dirty;
2468 		if (!idx) ciptr->clear_dirty = ctrl_cx2341x_clear_dirty;
2469 		qctrl.id = ciptr->v4l_id;
2470 		cx2341x_ctrl_query(&hdw->enc_ctl_state,&qctrl);
2471 		if (!(qctrl.flags & V4L2_CTRL_FLAG_READ_ONLY)) {
2472 			ciptr->set_value = ctrl_cx2341x_set;
2473 		}
2474 		strscpy(hdw->mpeg_ctrl_info[idx].desc, qctrl.name,
2475 			sizeof(hdw->mpeg_ctrl_info[idx].desc));
2476 		ciptr->default_value = qctrl.default_value;
2477 		switch (qctrl.type) {
2478 		default:
2479 		case V4L2_CTRL_TYPE_INTEGER:
2480 			ciptr->type = pvr2_ctl_int;
2481 			ciptr->def.type_int.min_value = qctrl.minimum;
2482 			ciptr->def.type_int.max_value = qctrl.maximum;
2483 			break;
2484 		case V4L2_CTRL_TYPE_BOOLEAN:
2485 			ciptr->type = pvr2_ctl_bool;
2486 			break;
2487 		case V4L2_CTRL_TYPE_MENU:
2488 			ciptr->type = pvr2_ctl_enum;
2489 			ciptr->def.type_enum.value_names =
2490 				cx2341x_ctrl_get_menu(&hdw->enc_ctl_state,
2491 								ciptr->v4l_id);
2492 			for (cnt1 = 0;
2493 			     ciptr->def.type_enum.value_names[cnt1] != NULL;
2494 			     cnt1++) { }
2495 			ciptr->def.type_enum.count = cnt1;
2496 			break;
2497 		}
2498 		cptr->info = ciptr;
2499 	}
2500 
2501 	// Initialize control data regarding video standard masks
2502 	valid_std_mask = pvr2_std_get_usable();
2503 	for (idx = 0; idx < 32; idx++) {
2504 		if (!(valid_std_mask & (1UL << idx))) continue;
2505 		cnt1 = pvr2_std_id_to_str(
2506 			hdw->std_mask_names[idx],
2507 			sizeof(hdw->std_mask_names[idx])-1,
2508 			1UL << idx);
2509 		hdw->std_mask_names[idx][cnt1] = 0;
2510 	}
2511 	cptr = pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_STDAVAIL);
2512 	if (cptr) {
2513 		memcpy(&hdw->std_info_avail,cptr->info,
2514 		       sizeof(hdw->std_info_avail));
2515 		cptr->info = &hdw->std_info_avail;
2516 		hdw->std_info_avail.def.type_bitmask.bit_names =
2517 			hdw->std_mask_ptrs;
2518 		hdw->std_info_avail.def.type_bitmask.valid_bits =
2519 			valid_std_mask;
2520 	}
2521 	cptr = pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_STDCUR);
2522 	if (cptr) {
2523 		memcpy(&hdw->std_info_cur,cptr->info,
2524 		       sizeof(hdw->std_info_cur));
2525 		cptr->info = &hdw->std_info_cur;
2526 		hdw->std_info_cur.def.type_bitmask.bit_names =
2527 			hdw->std_mask_ptrs;
2528 		hdw->std_info_cur.def.type_bitmask.valid_bits =
2529 			valid_std_mask;
2530 	}
2531 	cptr = pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_STDDETECT);
2532 	if (cptr) {
2533 		memcpy(&hdw->std_info_detect,cptr->info,
2534 		       sizeof(hdw->std_info_detect));
2535 		cptr->info = &hdw->std_info_detect;
2536 		hdw->std_info_detect.def.type_bitmask.bit_names =
2537 			hdw->std_mask_ptrs;
2538 		hdw->std_info_detect.def.type_bitmask.valid_bits =
2539 			valid_std_mask;
2540 	}
2541 
2542 	hdw->cropcap_stale = !0;
2543 	hdw->eeprom_addr = -1;
2544 	hdw->unit_number = -1;
2545 	hdw->v4l_minor_number_video = -1;
2546 	hdw->v4l_minor_number_vbi = -1;
2547 	hdw->v4l_minor_number_radio = -1;
2548 	hdw->ctl_write_buffer = kmalloc(PVR2_CTL_BUFFSIZE,GFP_KERNEL);
2549 	if (!hdw->ctl_write_buffer) goto fail;
2550 	hdw->ctl_read_buffer = kmalloc(PVR2_CTL_BUFFSIZE,GFP_KERNEL);
2551 	if (!hdw->ctl_read_buffer) goto fail;
2552 	hdw->ctl_write_urb = usb_alloc_urb(0,GFP_KERNEL);
2553 	if (!hdw->ctl_write_urb) goto fail;
2554 	hdw->ctl_read_urb = usb_alloc_urb(0,GFP_KERNEL);
2555 	if (!hdw->ctl_read_urb) goto fail;
2556 
2557 	if (v4l2_device_register(&intf->dev, &hdw->v4l2_dev) != 0) {
2558 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
2559 			   "Error registering with v4l core, giving up");
2560 		goto fail;
2561 	}
2562 	mutex_lock(&pvr2_unit_mtx);
2563 	do {
2564 		for (idx = 0; idx < PVR_NUM; idx++) {
2565 			if (unit_pointers[idx]) continue;
2566 			hdw->unit_number = idx;
2567 			unit_pointers[idx] = hdw;
2568 			break;
2569 		}
2570 	} while (0);
2571 	mutex_unlock(&pvr2_unit_mtx);
2572 
2573 	cnt1 = 0;
2574 	cnt2 = scnprintf(hdw->name+cnt1,sizeof(hdw->name)-cnt1,"pvrusb2");
2575 	cnt1 += cnt2;
2576 	if (hdw->unit_number >= 0) {
2577 		cnt2 = scnprintf(hdw->name+cnt1,sizeof(hdw->name)-cnt1,"_%c",
2578 				 ('a' + hdw->unit_number));
2579 		cnt1 += cnt2;
2580 	}
2581 	if (cnt1 >= sizeof(hdw->name)) cnt1 = sizeof(hdw->name)-1;
2582 	hdw->name[cnt1] = 0;
2583 
2584 	INIT_WORK(&hdw->workpoll,pvr2_hdw_worker_poll);
2585 
2586 	pvr2_trace(PVR2_TRACE_INIT,"Driver unit number is %d, name is %s",
2587 		   hdw->unit_number,hdw->name);
2588 
2589 	hdw->tuner_type = -1;
2590 	hdw->flag_ok = !0;
2591 
2592 	hdw->usb_intf = intf;
2593 	hdw->usb_dev = usb_dev;
2594 
2595 	usb_make_path(hdw->usb_dev, hdw->bus_info, sizeof(hdw->bus_info));
2596 
2597 	ifnum = hdw->usb_intf->cur_altsetting->desc.bInterfaceNumber;
2598 	usb_set_interface(hdw->usb_dev,ifnum,0);
2599 
2600 	mutex_init(&hdw->ctl_lock_mutex);
2601 	mutex_init(&hdw->big_lock_mutex);
2602 
2603 	return hdw;
2604  fail:
2605 	if (hdw) {
2606 		del_timer_sync(&hdw->quiescent_timer);
2607 		del_timer_sync(&hdw->decoder_stabilization_timer);
2608 		del_timer_sync(&hdw->encoder_run_timer);
2609 		del_timer_sync(&hdw->encoder_wait_timer);
2610 		flush_work(&hdw->workpoll);
2611 		usb_free_urb(hdw->ctl_read_urb);
2612 		usb_free_urb(hdw->ctl_write_urb);
2613 		kfree(hdw->ctl_read_buffer);
2614 		kfree(hdw->ctl_write_buffer);
2615 		kfree(hdw->controls);
2616 		kfree(hdw->mpeg_ctrl_info);
2617 		kfree(hdw);
2618 	}
2619 	return NULL;
2620 }
2621 
2622 
2623 /* Remove _all_ associations between this driver and the underlying USB
2624    layer. */
pvr2_hdw_remove_usb_stuff(struct pvr2_hdw * hdw)2625 static void pvr2_hdw_remove_usb_stuff(struct pvr2_hdw *hdw)
2626 {
2627 	if (hdw->flag_disconnected) return;
2628 	pvr2_trace(PVR2_TRACE_INIT,"pvr2_hdw_remove_usb_stuff: hdw=%p",hdw);
2629 	if (hdw->ctl_read_urb) {
2630 		usb_kill_urb(hdw->ctl_read_urb);
2631 		usb_free_urb(hdw->ctl_read_urb);
2632 		hdw->ctl_read_urb = NULL;
2633 	}
2634 	if (hdw->ctl_write_urb) {
2635 		usb_kill_urb(hdw->ctl_write_urb);
2636 		usb_free_urb(hdw->ctl_write_urb);
2637 		hdw->ctl_write_urb = NULL;
2638 	}
2639 	if (hdw->ctl_read_buffer) {
2640 		kfree(hdw->ctl_read_buffer);
2641 		hdw->ctl_read_buffer = NULL;
2642 	}
2643 	if (hdw->ctl_write_buffer) {
2644 		kfree(hdw->ctl_write_buffer);
2645 		hdw->ctl_write_buffer = NULL;
2646 	}
2647 	hdw->flag_disconnected = !0;
2648 	/* If we don't do this, then there will be a dangling struct device
2649 	   reference to our disappearing device persisting inside the V4L
2650 	   core... */
2651 	v4l2_device_disconnect(&hdw->v4l2_dev);
2652 	hdw->usb_dev = NULL;
2653 	hdw->usb_intf = NULL;
2654 	pvr2_hdw_render_useless(hdw);
2655 }
2656 
pvr2_hdw_set_v4l2_dev(struct pvr2_hdw * hdw,struct video_device * vdev)2657 void pvr2_hdw_set_v4l2_dev(struct pvr2_hdw *hdw, struct video_device *vdev)
2658 {
2659 	vdev->v4l2_dev = &hdw->v4l2_dev;
2660 }
2661 
2662 /* Destroy hardware interaction structure */
pvr2_hdw_destroy(struct pvr2_hdw * hdw)2663 void pvr2_hdw_destroy(struct pvr2_hdw *hdw)
2664 {
2665 	if (!hdw) return;
2666 	pvr2_trace(PVR2_TRACE_INIT,"pvr2_hdw_destroy: hdw=%p",hdw);
2667 	flush_work(&hdw->workpoll);
2668 	del_timer_sync(&hdw->quiescent_timer);
2669 	del_timer_sync(&hdw->decoder_stabilization_timer);
2670 	del_timer_sync(&hdw->encoder_run_timer);
2671 	del_timer_sync(&hdw->encoder_wait_timer);
2672 	if (hdw->fw_buffer) {
2673 		kfree(hdw->fw_buffer);
2674 		hdw->fw_buffer = NULL;
2675 	}
2676 	if (hdw->vid_stream) {
2677 		pvr2_stream_destroy(hdw->vid_stream);
2678 		hdw->vid_stream = NULL;
2679 	}
2680 	pvr2_i2c_core_done(hdw);
2681 	v4l2_device_unregister(&hdw->v4l2_dev);
2682 	pvr2_hdw_remove_usb_stuff(hdw);
2683 	mutex_lock(&pvr2_unit_mtx);
2684 	do {
2685 		if ((hdw->unit_number >= 0) &&
2686 		    (hdw->unit_number < PVR_NUM) &&
2687 		    (unit_pointers[hdw->unit_number] == hdw)) {
2688 			unit_pointers[hdw->unit_number] = NULL;
2689 		}
2690 	} while (0);
2691 	mutex_unlock(&pvr2_unit_mtx);
2692 	kfree(hdw->controls);
2693 	kfree(hdw->mpeg_ctrl_info);
2694 	kfree(hdw);
2695 }
2696 
2697 
pvr2_hdw_dev_ok(struct pvr2_hdw * hdw)2698 int pvr2_hdw_dev_ok(struct pvr2_hdw *hdw)
2699 {
2700 	return (hdw && hdw->flag_ok);
2701 }
2702 
2703 
2704 /* Called when hardware has been unplugged */
pvr2_hdw_disconnect(struct pvr2_hdw * hdw)2705 void pvr2_hdw_disconnect(struct pvr2_hdw *hdw)
2706 {
2707 	pvr2_trace(PVR2_TRACE_INIT,"pvr2_hdw_disconnect(hdw=%p)",hdw);
2708 	LOCK_TAKE(hdw->big_lock);
2709 	LOCK_TAKE(hdw->ctl_lock);
2710 	pvr2_hdw_remove_usb_stuff(hdw);
2711 	LOCK_GIVE(hdw->ctl_lock);
2712 	LOCK_GIVE(hdw->big_lock);
2713 }
2714 
2715 
2716 /* Get the number of defined controls */
pvr2_hdw_get_ctrl_count(struct pvr2_hdw * hdw)2717 unsigned int pvr2_hdw_get_ctrl_count(struct pvr2_hdw *hdw)
2718 {
2719 	return hdw->control_cnt;
2720 }
2721 
2722 
2723 /* Retrieve a control handle given its index (0..count-1) */
pvr2_hdw_get_ctrl_by_index(struct pvr2_hdw * hdw,unsigned int idx)2724 struct pvr2_ctrl *pvr2_hdw_get_ctrl_by_index(struct pvr2_hdw *hdw,
2725 					     unsigned int idx)
2726 {
2727 	if (idx >= hdw->control_cnt) return NULL;
2728 	return hdw->controls + idx;
2729 }
2730 
2731 
2732 /* Retrieve a control handle given its index (0..count-1) */
pvr2_hdw_get_ctrl_by_id(struct pvr2_hdw * hdw,unsigned int ctl_id)2733 struct pvr2_ctrl *pvr2_hdw_get_ctrl_by_id(struct pvr2_hdw *hdw,
2734 					  unsigned int ctl_id)
2735 {
2736 	struct pvr2_ctrl *cptr;
2737 	unsigned int idx;
2738 	int i;
2739 
2740 	/* This could be made a lot more efficient, but for now... */
2741 	for (idx = 0; idx < hdw->control_cnt; idx++) {
2742 		cptr = hdw->controls + idx;
2743 		i = cptr->info->internal_id;
2744 		if (i && (i == ctl_id)) return cptr;
2745 	}
2746 	return NULL;
2747 }
2748 
2749 
2750 /* Given a V4L ID, retrieve the control structure associated with it. */
pvr2_hdw_get_ctrl_v4l(struct pvr2_hdw * hdw,unsigned int ctl_id)2751 struct pvr2_ctrl *pvr2_hdw_get_ctrl_v4l(struct pvr2_hdw *hdw,unsigned int ctl_id)
2752 {
2753 	struct pvr2_ctrl *cptr;
2754 	unsigned int idx;
2755 	int i;
2756 
2757 	/* This could be made a lot more efficient, but for now... */
2758 	for (idx = 0; idx < hdw->control_cnt; idx++) {
2759 		cptr = hdw->controls + idx;
2760 		i = cptr->info->v4l_id;
2761 		if (i && (i == ctl_id)) return cptr;
2762 	}
2763 	return NULL;
2764 }
2765 
2766 
2767 /* Given a V4L ID for its immediate predecessor, retrieve the control
2768    structure associated with it. */
pvr2_hdw_get_ctrl_nextv4l(struct pvr2_hdw * hdw,unsigned int ctl_id)2769 struct pvr2_ctrl *pvr2_hdw_get_ctrl_nextv4l(struct pvr2_hdw *hdw,
2770 					    unsigned int ctl_id)
2771 {
2772 	struct pvr2_ctrl *cptr,*cp2;
2773 	unsigned int idx;
2774 	int i;
2775 
2776 	/* This could be made a lot more efficient, but for now... */
2777 	cp2 = NULL;
2778 	for (idx = 0; idx < hdw->control_cnt; idx++) {
2779 		cptr = hdw->controls + idx;
2780 		i = cptr->info->v4l_id;
2781 		if (!i) continue;
2782 		if (i <= ctl_id) continue;
2783 		if (cp2 && (cp2->info->v4l_id < i)) continue;
2784 		cp2 = cptr;
2785 	}
2786 	return cp2;
2787 	return NULL;
2788 }
2789 
2790 
get_ctrl_typename(enum pvr2_ctl_type tp)2791 static const char *get_ctrl_typename(enum pvr2_ctl_type tp)
2792 {
2793 	switch (tp) {
2794 	case pvr2_ctl_int: return "integer";
2795 	case pvr2_ctl_enum: return "enum";
2796 	case pvr2_ctl_bool: return "boolean";
2797 	case pvr2_ctl_bitmask: return "bitmask";
2798 	}
2799 	return "";
2800 }
2801 
2802 
pvr2_subdev_set_control(struct pvr2_hdw * hdw,int id,const char * name,int val)2803 static void pvr2_subdev_set_control(struct pvr2_hdw *hdw, int id,
2804 				    const char *name, int val)
2805 {
2806 	struct v4l2_control ctrl;
2807 	struct v4l2_subdev *sd;
2808 
2809 	pvr2_trace(PVR2_TRACE_CHIPS, "subdev v4l2 %s=%d", name, val);
2810 	memset(&ctrl, 0, sizeof(ctrl));
2811 	ctrl.id = id;
2812 	ctrl.value = val;
2813 
2814 	v4l2_device_for_each_subdev(sd, &hdw->v4l2_dev)
2815 		v4l2_s_ctrl(NULL, sd->ctrl_handler, &ctrl);
2816 }
2817 
2818 #define PVR2_SUBDEV_SET_CONTROL(hdw, id, lab) \
2819 	if ((hdw)->lab##_dirty || (hdw)->force_dirty) {		\
2820 		pvr2_subdev_set_control(hdw, id, #lab, (hdw)->lab##_val); \
2821 	}
2822 
pvr2_hdw_get_detected_std(struct pvr2_hdw * hdw)2823 static v4l2_std_id pvr2_hdw_get_detected_std(struct pvr2_hdw *hdw)
2824 {
2825 	v4l2_std_id std;
2826 	std = (v4l2_std_id)hdw->std_mask_avail;
2827 	v4l2_device_call_all(&hdw->v4l2_dev, 0,
2828 			     video, querystd, &std);
2829 	return std;
2830 }
2831 
2832 /* Execute whatever commands are required to update the state of all the
2833    sub-devices so that they match our current control values. */
pvr2_subdev_update(struct pvr2_hdw * hdw)2834 static void pvr2_subdev_update(struct pvr2_hdw *hdw)
2835 {
2836 	struct v4l2_subdev *sd;
2837 	unsigned int id;
2838 	pvr2_subdev_update_func fp;
2839 
2840 	pvr2_trace(PVR2_TRACE_CHIPS, "subdev update...");
2841 
2842 	if (hdw->tuner_updated || hdw->force_dirty) {
2843 		struct tuner_setup setup;
2844 		pvr2_trace(PVR2_TRACE_CHIPS, "subdev tuner set_type(%d)",
2845 			   hdw->tuner_type);
2846 		if (((int)(hdw->tuner_type)) >= 0) {
2847 			memset(&setup, 0, sizeof(setup));
2848 			setup.addr = ADDR_UNSET;
2849 			setup.type = hdw->tuner_type;
2850 			setup.mode_mask = T_RADIO | T_ANALOG_TV;
2851 			v4l2_device_call_all(&hdw->v4l2_dev, 0,
2852 					     tuner, s_type_addr, &setup);
2853 		}
2854 	}
2855 
2856 	if (hdw->input_dirty || hdw->std_dirty || hdw->force_dirty) {
2857 		pvr2_trace(PVR2_TRACE_CHIPS, "subdev v4l2 set_standard");
2858 		if (hdw->input_val == PVR2_CVAL_INPUT_RADIO) {
2859 			v4l2_device_call_all(&hdw->v4l2_dev, 0,
2860 					     tuner, s_radio);
2861 		} else {
2862 			v4l2_std_id vs;
2863 			vs = hdw->std_mask_cur;
2864 			v4l2_device_call_all(&hdw->v4l2_dev, 0,
2865 					     video, s_std, vs);
2866 			pvr2_hdw_cx25840_vbi_hack(hdw);
2867 		}
2868 		hdw->tuner_signal_stale = !0;
2869 		hdw->cropcap_stale = !0;
2870 	}
2871 
2872 	PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_BRIGHTNESS, brightness);
2873 	PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_CONTRAST, contrast);
2874 	PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_SATURATION, saturation);
2875 	PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_HUE, hue);
2876 	PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_AUDIO_MUTE, mute);
2877 	PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_AUDIO_VOLUME, volume);
2878 	PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_AUDIO_BALANCE, balance);
2879 	PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_AUDIO_BASS, bass);
2880 	PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_AUDIO_TREBLE, treble);
2881 
2882 	if (hdw->input_dirty || hdw->audiomode_dirty || hdw->force_dirty) {
2883 		struct v4l2_tuner vt;
2884 		memset(&vt, 0, sizeof(vt));
2885 		vt.type = (hdw->input_val == PVR2_CVAL_INPUT_RADIO) ?
2886 			V4L2_TUNER_RADIO : V4L2_TUNER_ANALOG_TV;
2887 		vt.audmode = hdw->audiomode_val;
2888 		v4l2_device_call_all(&hdw->v4l2_dev, 0, tuner, s_tuner, &vt);
2889 	}
2890 
2891 	if (hdw->freqDirty || hdw->force_dirty) {
2892 		unsigned long fv;
2893 		struct v4l2_frequency freq;
2894 		fv = pvr2_hdw_get_cur_freq(hdw);
2895 		pvr2_trace(PVR2_TRACE_CHIPS, "subdev v4l2 set_freq(%lu)", fv);
2896 		if (hdw->tuner_signal_stale) pvr2_hdw_status_poll(hdw);
2897 		memset(&freq, 0, sizeof(freq));
2898 		if (hdw->tuner_signal_info.capability & V4L2_TUNER_CAP_LOW) {
2899 			/* ((fv * 1000) / 62500) */
2900 			freq.frequency = (fv * 2) / 125;
2901 		} else {
2902 			freq.frequency = fv / 62500;
2903 		}
2904 		/* tuner-core currently doesn't seem to care about this, but
2905 		   let's set it anyway for completeness. */
2906 		if (hdw->input_val == PVR2_CVAL_INPUT_RADIO) {
2907 			freq.type = V4L2_TUNER_RADIO;
2908 		} else {
2909 			freq.type = V4L2_TUNER_ANALOG_TV;
2910 		}
2911 		freq.tuner = 0;
2912 		v4l2_device_call_all(&hdw->v4l2_dev, 0, tuner,
2913 				     s_frequency, &freq);
2914 	}
2915 
2916 	if (hdw->res_hor_dirty || hdw->res_ver_dirty || hdw->force_dirty) {
2917 		struct v4l2_subdev_format format = {
2918 			.which = V4L2_SUBDEV_FORMAT_ACTIVE,
2919 		};
2920 
2921 		format.format.width = hdw->res_hor_val;
2922 		format.format.height = hdw->res_ver_val;
2923 		format.format.code = MEDIA_BUS_FMT_FIXED;
2924 		pvr2_trace(PVR2_TRACE_CHIPS, "subdev v4l2 set_size(%dx%d)",
2925 			   format.format.width, format.format.height);
2926 		v4l2_device_call_all(&hdw->v4l2_dev, 0, pad, set_fmt,
2927 				     NULL, &format);
2928 	}
2929 
2930 	if (hdw->srate_dirty || hdw->force_dirty) {
2931 		u32 val;
2932 		pvr2_trace(PVR2_TRACE_CHIPS, "subdev v4l2 set_audio %d",
2933 			   hdw->srate_val);
2934 		switch (hdw->srate_val) {
2935 		default:
2936 		case V4L2_MPEG_AUDIO_SAMPLING_FREQ_48000:
2937 			val = 48000;
2938 			break;
2939 		case V4L2_MPEG_AUDIO_SAMPLING_FREQ_44100:
2940 			val = 44100;
2941 			break;
2942 		case V4L2_MPEG_AUDIO_SAMPLING_FREQ_32000:
2943 			val = 32000;
2944 			break;
2945 		}
2946 		v4l2_device_call_all(&hdw->v4l2_dev, 0,
2947 				     audio, s_clock_freq, val);
2948 	}
2949 
2950 	/* Unable to set crop parameters; there is apparently no equivalent
2951 	   for VIDIOC_S_CROP */
2952 
2953 	v4l2_device_for_each_subdev(sd, &hdw->v4l2_dev) {
2954 		id = sd->grp_id;
2955 		if (id >= ARRAY_SIZE(pvr2_module_update_functions)) continue;
2956 		fp = pvr2_module_update_functions[id];
2957 		if (!fp) continue;
2958 		(*fp)(hdw, sd);
2959 	}
2960 
2961 	if (hdw->tuner_signal_stale || hdw->cropcap_stale) {
2962 		pvr2_hdw_status_poll(hdw);
2963 	}
2964 }
2965 
2966 
2967 /* Figure out if we need to commit control changes.  If so, mark internal
2968    state flags to indicate this fact and return true.  Otherwise do nothing
2969    else and return false. */
pvr2_hdw_commit_setup(struct pvr2_hdw * hdw)2970 static int pvr2_hdw_commit_setup(struct pvr2_hdw *hdw)
2971 {
2972 	unsigned int idx;
2973 	struct pvr2_ctrl *cptr;
2974 	int value;
2975 	int commit_flag = hdw->force_dirty;
2976 	char buf[100];
2977 	unsigned int bcnt,ccnt;
2978 
2979 	for (idx = 0; idx < hdw->control_cnt; idx++) {
2980 		cptr = hdw->controls + idx;
2981 		if (!cptr->info->is_dirty) continue;
2982 		if (!cptr->info->is_dirty(cptr)) continue;
2983 		commit_flag = !0;
2984 
2985 		if (!(pvrusb2_debug & PVR2_TRACE_CTL)) continue;
2986 		bcnt = scnprintf(buf,sizeof(buf),"\"%s\" <-- ",
2987 				 cptr->info->name);
2988 		value = 0;
2989 		cptr->info->get_value(cptr,&value);
2990 		pvr2_ctrl_value_to_sym_internal(cptr,~0,value,
2991 						buf+bcnt,
2992 						sizeof(buf)-bcnt,&ccnt);
2993 		bcnt += ccnt;
2994 		bcnt += scnprintf(buf+bcnt,sizeof(buf)-bcnt," <%s>",
2995 				  get_ctrl_typename(cptr->info->type));
2996 		pvr2_trace(PVR2_TRACE_CTL,
2997 			   "/*--TRACE_COMMIT--*/ %.*s",
2998 			   bcnt,buf);
2999 	}
3000 
3001 	if (!commit_flag) {
3002 		/* Nothing has changed */
3003 		return 0;
3004 	}
3005 
3006 	hdw->state_pipeline_config = 0;
3007 	trace_stbit("state_pipeline_config",hdw->state_pipeline_config);
3008 	pvr2_hdw_state_sched(hdw);
3009 
3010 	return !0;
3011 }
3012 
3013 
3014 /* Perform all operations needed to commit all control changes.  This must
3015    be performed in synchronization with the pipeline state and is thus
3016    expected to be called as part of the driver's worker thread.  Return
3017    true if commit successful, otherwise return false to indicate that
3018    commit isn't possible at this time. */
pvr2_hdw_commit_execute(struct pvr2_hdw * hdw)3019 static int pvr2_hdw_commit_execute(struct pvr2_hdw *hdw)
3020 {
3021 	unsigned int idx;
3022 	struct pvr2_ctrl *cptr;
3023 	int disruptive_change;
3024 
3025 	if (hdw->input_dirty && hdw->state_pathway_ok &&
3026 	    (((hdw->input_val == PVR2_CVAL_INPUT_DTV) ?
3027 	      PVR2_PATHWAY_DIGITAL : PVR2_PATHWAY_ANALOG) !=
3028 	     hdw->pathway_state)) {
3029 		/* Change of mode being asked for... */
3030 		hdw->state_pathway_ok = 0;
3031 		trace_stbit("state_pathway_ok", hdw->state_pathway_ok);
3032 	}
3033 	if (!hdw->state_pathway_ok) {
3034 		/* Can't commit anything until pathway is ok. */
3035 		return 0;
3036 	}
3037 
3038 	/* Handle some required side effects when the video standard is
3039 	   changed.... */
3040 	if (hdw->std_dirty) {
3041 		int nvres;
3042 		int gop_size;
3043 		if (hdw->std_mask_cur & V4L2_STD_525_60) {
3044 			nvres = 480;
3045 			gop_size = 15;
3046 		} else {
3047 			nvres = 576;
3048 			gop_size = 12;
3049 		}
3050 		/* Rewrite the vertical resolution to be appropriate to the
3051 		   video standard that has been selected. */
3052 		if (nvres != hdw->res_ver_val) {
3053 			hdw->res_ver_val = nvres;
3054 			hdw->res_ver_dirty = !0;
3055 		}
3056 		/* Rewrite the GOP size to be appropriate to the video
3057 		   standard that has been selected. */
3058 		if (gop_size != hdw->enc_ctl_state.video_gop_size) {
3059 			struct v4l2_ext_controls cs;
3060 			struct v4l2_ext_control c1;
3061 			memset(&cs, 0, sizeof(cs));
3062 			memset(&c1, 0, sizeof(c1));
3063 			cs.controls = &c1;
3064 			cs.count = 1;
3065 			c1.id = V4L2_CID_MPEG_VIDEO_GOP_SIZE;
3066 			c1.value = gop_size;
3067 			cx2341x_ext_ctrls(&hdw->enc_ctl_state, 0, &cs,
3068 					  VIDIOC_S_EXT_CTRLS);
3069 		}
3070 	}
3071 
3072 	/* The broadcast decoder can only scale down, so if
3073 	 * res_*_dirty && crop window < output format ==> enlarge crop.
3074 	 *
3075 	 * The mpeg encoder receives fields of res_hor_val dots and
3076 	 * res_ver_val halflines.  Limits: hor<=720, ver<=576.
3077 	 */
3078 	if (hdw->res_hor_dirty && hdw->cropw_val < hdw->res_hor_val) {
3079 		hdw->cropw_val = hdw->res_hor_val;
3080 		hdw->cropw_dirty = !0;
3081 	} else if (hdw->cropw_dirty) {
3082 		hdw->res_hor_dirty = !0;           /* must rescale */
3083 		hdw->res_hor_val = min(720, hdw->cropw_val);
3084 	}
3085 	if (hdw->res_ver_dirty && hdw->croph_val < hdw->res_ver_val) {
3086 		hdw->croph_val = hdw->res_ver_val;
3087 		hdw->croph_dirty = !0;
3088 	} else if (hdw->croph_dirty) {
3089 		int nvres = hdw->std_mask_cur & V4L2_STD_525_60 ? 480 : 576;
3090 		hdw->res_ver_dirty = !0;
3091 		hdw->res_ver_val = min(nvres, hdw->croph_val);
3092 	}
3093 
3094 	/* If any of the below has changed, then we can't do the update
3095 	   while the pipeline is running.  Pipeline must be paused first
3096 	   and decoder -> encoder connection be made quiescent before we
3097 	   can proceed. */
3098 	disruptive_change =
3099 		(hdw->std_dirty ||
3100 		 hdw->enc_unsafe_stale ||
3101 		 hdw->srate_dirty ||
3102 		 hdw->res_ver_dirty ||
3103 		 hdw->res_hor_dirty ||
3104 		 hdw->cropw_dirty ||
3105 		 hdw->croph_dirty ||
3106 		 hdw->input_dirty ||
3107 		 (hdw->active_stream_type != hdw->desired_stream_type));
3108 	if (disruptive_change && !hdw->state_pipeline_idle) {
3109 		/* Pipeline is not idle; we can't proceed.  Arrange to
3110 		   cause pipeline to stop so that we can try this again
3111 		   later.... */
3112 		hdw->state_pipeline_pause = !0;
3113 		return 0;
3114 	}
3115 
3116 	if (hdw->srate_dirty) {
3117 		/* Write new sample rate into control structure since
3118 		 * the master copy is stale.  We must track srate
3119 		 * separate from the mpeg control structure because
3120 		 * other logic also uses this value. */
3121 		struct v4l2_ext_controls cs;
3122 		struct v4l2_ext_control c1;
3123 		memset(&cs,0,sizeof(cs));
3124 		memset(&c1,0,sizeof(c1));
3125 		cs.controls = &c1;
3126 		cs.count = 1;
3127 		c1.id = V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ;
3128 		c1.value = hdw->srate_val;
3129 		cx2341x_ext_ctrls(&hdw->enc_ctl_state, 0, &cs,VIDIOC_S_EXT_CTRLS);
3130 	}
3131 
3132 	if (hdw->active_stream_type != hdw->desired_stream_type) {
3133 		/* Handle any side effects of stream config here */
3134 		hdw->active_stream_type = hdw->desired_stream_type;
3135 	}
3136 
3137 	if (hdw->hdw_desc->signal_routing_scheme ==
3138 	    PVR2_ROUTING_SCHEME_GOTVIEW) {
3139 		u32 b;
3140 		/* Handle GOTVIEW audio switching */
3141 		pvr2_hdw_gpio_get_out(hdw,&b);
3142 		if (hdw->input_val == PVR2_CVAL_INPUT_RADIO) {
3143 			/* Set GPIO 11 */
3144 			pvr2_hdw_gpio_chg_out(hdw,(1 << 11),~0);
3145 		} else {
3146 			/* Clear GPIO 11 */
3147 			pvr2_hdw_gpio_chg_out(hdw,(1 << 11),0);
3148 		}
3149 	}
3150 
3151 	/* Check and update state for all sub-devices. */
3152 	pvr2_subdev_update(hdw);
3153 
3154 	hdw->tuner_updated = 0;
3155 	hdw->force_dirty = 0;
3156 	for (idx = 0; idx < hdw->control_cnt; idx++) {
3157 		cptr = hdw->controls + idx;
3158 		if (!cptr->info->clear_dirty) continue;
3159 		cptr->info->clear_dirty(cptr);
3160 	}
3161 
3162 	if ((hdw->pathway_state == PVR2_PATHWAY_ANALOG) &&
3163 	    hdw->state_encoder_run) {
3164 		/* If encoder isn't running or it can't be touched, then
3165 		   this will get worked out later when we start the
3166 		   encoder. */
3167 		if (pvr2_encoder_adjust(hdw) < 0) return !0;
3168 	}
3169 
3170 	hdw->state_pipeline_config = !0;
3171 	/* Hardware state may have changed in a way to cause the cropping
3172 	   capabilities to have changed.  So mark it stale, which will
3173 	   cause a later re-fetch. */
3174 	trace_stbit("state_pipeline_config",hdw->state_pipeline_config);
3175 	return !0;
3176 }
3177 
3178 
pvr2_hdw_commit_ctl(struct pvr2_hdw * hdw)3179 int pvr2_hdw_commit_ctl(struct pvr2_hdw *hdw)
3180 {
3181 	int fl;
3182 	LOCK_TAKE(hdw->big_lock);
3183 	fl = pvr2_hdw_commit_setup(hdw);
3184 	LOCK_GIVE(hdw->big_lock);
3185 	if (!fl) return 0;
3186 	return pvr2_hdw_wait(hdw,0);
3187 }
3188 
3189 
pvr2_hdw_worker_poll(struct work_struct * work)3190 static void pvr2_hdw_worker_poll(struct work_struct *work)
3191 {
3192 	int fl = 0;
3193 	struct pvr2_hdw *hdw = container_of(work,struct pvr2_hdw,workpoll);
3194 	LOCK_TAKE(hdw->big_lock); do {
3195 		fl = pvr2_hdw_state_eval(hdw);
3196 	} while (0); LOCK_GIVE(hdw->big_lock);
3197 	if (fl && hdw->state_func) {
3198 		hdw->state_func(hdw->state_data);
3199 	}
3200 }
3201 
3202 
pvr2_hdw_wait(struct pvr2_hdw * hdw,int state)3203 static int pvr2_hdw_wait(struct pvr2_hdw *hdw,int state)
3204 {
3205 	return wait_event_interruptible(
3206 		hdw->state_wait_data,
3207 		(hdw->state_stale == 0) &&
3208 		(!state || (hdw->master_state != state)));
3209 }
3210 
3211 
3212 /* Return name for this driver instance */
pvr2_hdw_get_driver_name(struct pvr2_hdw * hdw)3213 const char *pvr2_hdw_get_driver_name(struct pvr2_hdw *hdw)
3214 {
3215 	return hdw->name;
3216 }
3217 
3218 
pvr2_hdw_get_desc(struct pvr2_hdw * hdw)3219 const char *pvr2_hdw_get_desc(struct pvr2_hdw *hdw)
3220 {
3221 	return hdw->hdw_desc->description;
3222 }
3223 
3224 
pvr2_hdw_get_type(struct pvr2_hdw * hdw)3225 const char *pvr2_hdw_get_type(struct pvr2_hdw *hdw)
3226 {
3227 	return hdw->hdw_desc->shortname;
3228 }
3229 
3230 
pvr2_hdw_is_hsm(struct pvr2_hdw * hdw)3231 int pvr2_hdw_is_hsm(struct pvr2_hdw *hdw)
3232 {
3233 	int result;
3234 	LOCK_TAKE(hdw->ctl_lock); do {
3235 		hdw->cmd_buffer[0] = FX2CMD_GET_USB_SPEED;
3236 		result = pvr2_send_request(hdw,
3237 					   hdw->cmd_buffer,1,
3238 					   hdw->cmd_buffer,1);
3239 		if (result < 0) break;
3240 		result = (hdw->cmd_buffer[0] != 0);
3241 	} while(0); LOCK_GIVE(hdw->ctl_lock);
3242 	return result;
3243 }
3244 
3245 
3246 /* Execute poll of tuner status */
pvr2_hdw_execute_tuner_poll(struct pvr2_hdw * hdw)3247 void pvr2_hdw_execute_tuner_poll(struct pvr2_hdw *hdw)
3248 {
3249 	LOCK_TAKE(hdw->big_lock); do {
3250 		pvr2_hdw_status_poll(hdw);
3251 	} while (0); LOCK_GIVE(hdw->big_lock);
3252 }
3253 
3254 
pvr2_hdw_check_cropcap(struct pvr2_hdw * hdw)3255 static int pvr2_hdw_check_cropcap(struct pvr2_hdw *hdw)
3256 {
3257 	if (!hdw->cropcap_stale) {
3258 		return 0;
3259 	}
3260 	pvr2_hdw_status_poll(hdw);
3261 	if (hdw->cropcap_stale) {
3262 		return -EIO;
3263 	}
3264 	return 0;
3265 }
3266 
3267 
3268 /* Return information about cropping capabilities */
pvr2_hdw_get_cropcap(struct pvr2_hdw * hdw,struct v4l2_cropcap * pp)3269 int pvr2_hdw_get_cropcap(struct pvr2_hdw *hdw, struct v4l2_cropcap *pp)
3270 {
3271 	int stat = 0;
3272 	LOCK_TAKE(hdw->big_lock);
3273 	stat = pvr2_hdw_check_cropcap(hdw);
3274 	if (!stat) {
3275 		memcpy(pp, &hdw->cropcap_info, sizeof(hdw->cropcap_info));
3276 	}
3277 	LOCK_GIVE(hdw->big_lock);
3278 	return stat;
3279 }
3280 
3281 
3282 /* Return information about the tuner */
pvr2_hdw_get_tuner_status(struct pvr2_hdw * hdw,struct v4l2_tuner * vtp)3283 int pvr2_hdw_get_tuner_status(struct pvr2_hdw *hdw,struct v4l2_tuner *vtp)
3284 {
3285 	LOCK_TAKE(hdw->big_lock); do {
3286 		if (hdw->tuner_signal_stale) {
3287 			pvr2_hdw_status_poll(hdw);
3288 		}
3289 		memcpy(vtp,&hdw->tuner_signal_info,sizeof(struct v4l2_tuner));
3290 	} while (0); LOCK_GIVE(hdw->big_lock);
3291 	return 0;
3292 }
3293 
3294 
3295 /* Get handle to video output stream */
pvr2_hdw_get_video_stream(struct pvr2_hdw * hp)3296 struct pvr2_stream *pvr2_hdw_get_video_stream(struct pvr2_hdw *hp)
3297 {
3298 	return hp->vid_stream;
3299 }
3300 
3301 
pvr2_hdw_trigger_module_log(struct pvr2_hdw * hdw)3302 void pvr2_hdw_trigger_module_log(struct pvr2_hdw *hdw)
3303 {
3304 	int nr = pvr2_hdw_get_unit_number(hdw);
3305 	LOCK_TAKE(hdw->big_lock);
3306 	do {
3307 		pr_info("pvrusb2: =================  START STATUS CARD #%d  =================\n", nr);
3308 		v4l2_device_call_all(&hdw->v4l2_dev, 0, core, log_status);
3309 		pvr2_trace(PVR2_TRACE_INFO,"cx2341x config:");
3310 		cx2341x_log_status(&hdw->enc_ctl_state, "pvrusb2");
3311 		pvr2_hdw_state_log_state(hdw);
3312 		pr_info("pvrusb2: ==================  END STATUS CARD #%d  ==================\n", nr);
3313 	} while (0);
3314 	LOCK_GIVE(hdw->big_lock);
3315 }
3316 
3317 
3318 /* Grab EEPROM contents, needed for direct method. */
3319 #define EEPROM_SIZE 8192
3320 #define trace_eeprom(...) pvr2_trace(PVR2_TRACE_EEPROM,__VA_ARGS__)
pvr2_full_eeprom_fetch(struct pvr2_hdw * hdw)3321 static u8 *pvr2_full_eeprom_fetch(struct pvr2_hdw *hdw)
3322 {
3323 	struct i2c_msg msg[2];
3324 	u8 *eeprom;
3325 	u8 iadd[2];
3326 	u8 addr;
3327 	u16 eepromSize;
3328 	unsigned int offs;
3329 	int ret;
3330 	int mode16 = 0;
3331 	unsigned pcnt,tcnt;
3332 	eeprom = kzalloc(EEPROM_SIZE, GFP_KERNEL);
3333 	if (!eeprom) {
3334 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3335 			   "Failed to allocate memory required to read eeprom");
3336 		return NULL;
3337 	}
3338 
3339 	trace_eeprom("Value for eeprom addr from controller was 0x%x",
3340 		     hdw->eeprom_addr);
3341 	addr = hdw->eeprom_addr;
3342 	/* Seems that if the high bit is set, then the *real* eeprom
3343 	   address is shifted right now bit position (noticed this in
3344 	   newer PVR USB2 hardware) */
3345 	if (addr & 0x80) addr >>= 1;
3346 
3347 	/* FX2 documentation states that a 16bit-addressed eeprom is
3348 	   expected if the I2C address is an odd number (yeah, this is
3349 	   strange but it's what they do) */
3350 	mode16 = (addr & 1);
3351 	eepromSize = (mode16 ? EEPROM_SIZE : 256);
3352 	trace_eeprom("Examining %d byte eeprom at location 0x%x using %d bit addressing",
3353 		     eepromSize, addr,
3354 		     mode16 ? 16 : 8);
3355 
3356 	msg[0].addr = addr;
3357 	msg[0].flags = 0;
3358 	msg[0].len = mode16 ? 2 : 1;
3359 	msg[0].buf = iadd;
3360 	msg[1].addr = addr;
3361 	msg[1].flags = I2C_M_RD;
3362 
3363 	/* We have to do the actual eeprom data fetch ourselves, because
3364 	   (1) we're only fetching part of the eeprom, and (2) if we were
3365 	   getting the whole thing our I2C driver can't grab it in one
3366 	   pass - which is what tveeprom is otherwise going to attempt */
3367 	for (tcnt = 0; tcnt < EEPROM_SIZE; tcnt += pcnt) {
3368 		pcnt = 16;
3369 		if (pcnt + tcnt > EEPROM_SIZE) pcnt = EEPROM_SIZE-tcnt;
3370 		offs = tcnt + (eepromSize - EEPROM_SIZE);
3371 		if (mode16) {
3372 			iadd[0] = offs >> 8;
3373 			iadd[1] = offs;
3374 		} else {
3375 			iadd[0] = offs;
3376 		}
3377 		msg[1].len = pcnt;
3378 		msg[1].buf = eeprom+tcnt;
3379 		if ((ret = i2c_transfer(&hdw->i2c_adap,
3380 					msg,ARRAY_SIZE(msg))) != 2) {
3381 			pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3382 				   "eeprom fetch set offs err=%d",ret);
3383 			kfree(eeprom);
3384 			return NULL;
3385 		}
3386 	}
3387 	return eeprom;
3388 }
3389 
3390 
pvr2_hdw_cpufw_set_enabled(struct pvr2_hdw * hdw,int mode,int enable_flag)3391 void pvr2_hdw_cpufw_set_enabled(struct pvr2_hdw *hdw,
3392 				int mode,
3393 				int enable_flag)
3394 {
3395 	int ret;
3396 	u16 address;
3397 	unsigned int pipe;
3398 	LOCK_TAKE(hdw->big_lock); do {
3399 		if ((hdw->fw_buffer == NULL) == !enable_flag) break;
3400 
3401 		if (!enable_flag) {
3402 			pvr2_trace(PVR2_TRACE_FIRMWARE,
3403 				   "Cleaning up after CPU firmware fetch");
3404 			kfree(hdw->fw_buffer);
3405 			hdw->fw_buffer = NULL;
3406 			hdw->fw_size = 0;
3407 			if (hdw->fw_cpu_flag) {
3408 				/* Now release the CPU.  It will disconnect
3409 				   and reconnect later. */
3410 				pvr2_hdw_cpureset_assert(hdw,0);
3411 			}
3412 			break;
3413 		}
3414 
3415 		hdw->fw_cpu_flag = (mode != 2);
3416 		if (hdw->fw_cpu_flag) {
3417 			hdw->fw_size = (mode == 1) ? 0x4000 : 0x2000;
3418 			pvr2_trace(PVR2_TRACE_FIRMWARE,
3419 				   "Preparing to suck out CPU firmware (size=%u)",
3420 				   hdw->fw_size);
3421 			hdw->fw_buffer = kzalloc(hdw->fw_size,GFP_KERNEL);
3422 			if (!hdw->fw_buffer) {
3423 				hdw->fw_size = 0;
3424 				break;
3425 			}
3426 
3427 			/* We have to hold the CPU during firmware upload. */
3428 			pvr2_hdw_cpureset_assert(hdw,1);
3429 
3430 			/* download the firmware from address 0000-1fff in 2048
3431 			   (=0x800) bytes chunk. */
3432 
3433 			pvr2_trace(PVR2_TRACE_FIRMWARE,
3434 				   "Grabbing CPU firmware");
3435 			pipe = usb_rcvctrlpipe(hdw->usb_dev, 0);
3436 			for(address = 0; address < hdw->fw_size;
3437 			    address += 0x800) {
3438 				ret = usb_control_msg(hdw->usb_dev,pipe,
3439 						      0xa0,0xc0,
3440 						      address,0,
3441 						      hdw->fw_buffer+address,
3442 						      0x800,HZ);
3443 				if (ret < 0) break;
3444 			}
3445 
3446 			pvr2_trace(PVR2_TRACE_FIRMWARE,
3447 				   "Done grabbing CPU firmware");
3448 		} else {
3449 			pvr2_trace(PVR2_TRACE_FIRMWARE,
3450 				   "Sucking down EEPROM contents");
3451 			hdw->fw_buffer = pvr2_full_eeprom_fetch(hdw);
3452 			if (!hdw->fw_buffer) {
3453 				pvr2_trace(PVR2_TRACE_FIRMWARE,
3454 					   "EEPROM content suck failed.");
3455 				break;
3456 			}
3457 			hdw->fw_size = EEPROM_SIZE;
3458 			pvr2_trace(PVR2_TRACE_FIRMWARE,
3459 				   "Done sucking down EEPROM contents");
3460 		}
3461 
3462 	} while (0); LOCK_GIVE(hdw->big_lock);
3463 }
3464 
3465 
3466 /* Return true if we're in a mode for retrieval CPU firmware */
pvr2_hdw_cpufw_get_enabled(struct pvr2_hdw * hdw)3467 int pvr2_hdw_cpufw_get_enabled(struct pvr2_hdw *hdw)
3468 {
3469 	return hdw->fw_buffer != NULL;
3470 }
3471 
3472 
pvr2_hdw_cpufw_get(struct pvr2_hdw * hdw,unsigned int offs,char * buf,unsigned int cnt)3473 int pvr2_hdw_cpufw_get(struct pvr2_hdw *hdw,unsigned int offs,
3474 		       char *buf,unsigned int cnt)
3475 {
3476 	int ret = -EINVAL;
3477 	LOCK_TAKE(hdw->big_lock); do {
3478 		if (!buf) break;
3479 		if (!cnt) break;
3480 
3481 		if (!hdw->fw_buffer) {
3482 			ret = -EIO;
3483 			break;
3484 		}
3485 
3486 		if (offs >= hdw->fw_size) {
3487 			pvr2_trace(PVR2_TRACE_FIRMWARE,
3488 				   "Read firmware data offs=%d EOF",
3489 				   offs);
3490 			ret = 0;
3491 			break;
3492 		}
3493 
3494 		if (offs + cnt > hdw->fw_size) cnt = hdw->fw_size - offs;
3495 
3496 		memcpy(buf,hdw->fw_buffer+offs,cnt);
3497 
3498 		pvr2_trace(PVR2_TRACE_FIRMWARE,
3499 			   "Read firmware data offs=%d cnt=%d",
3500 			   offs,cnt);
3501 		ret = cnt;
3502 	} while (0); LOCK_GIVE(hdw->big_lock);
3503 
3504 	return ret;
3505 }
3506 
3507 
pvr2_hdw_v4l_get_minor_number(struct pvr2_hdw * hdw,enum pvr2_v4l_type index)3508 int pvr2_hdw_v4l_get_minor_number(struct pvr2_hdw *hdw,
3509 				  enum pvr2_v4l_type index)
3510 {
3511 	switch (index) {
3512 	case pvr2_v4l_type_video: return hdw->v4l_minor_number_video;
3513 	case pvr2_v4l_type_vbi: return hdw->v4l_minor_number_vbi;
3514 	case pvr2_v4l_type_radio: return hdw->v4l_minor_number_radio;
3515 	default: return -1;
3516 	}
3517 }
3518 
3519 
3520 /* Store a v4l minor device number */
pvr2_hdw_v4l_store_minor_number(struct pvr2_hdw * hdw,enum pvr2_v4l_type index,int v)3521 void pvr2_hdw_v4l_store_minor_number(struct pvr2_hdw *hdw,
3522 				     enum pvr2_v4l_type index,int v)
3523 {
3524 	switch (index) {
3525 	case pvr2_v4l_type_video: hdw->v4l_minor_number_video = v;break;
3526 	case pvr2_v4l_type_vbi: hdw->v4l_minor_number_vbi = v;break;
3527 	case pvr2_v4l_type_radio: hdw->v4l_minor_number_radio = v;break;
3528 	default: break;
3529 	}
3530 }
3531 
3532 
pvr2_ctl_write_complete(struct urb * urb)3533 static void pvr2_ctl_write_complete(struct urb *urb)
3534 {
3535 	struct pvr2_hdw *hdw = urb->context;
3536 	hdw->ctl_write_pend_flag = 0;
3537 	if (hdw->ctl_read_pend_flag) return;
3538 	complete(&hdw->ctl_done);
3539 }
3540 
3541 
pvr2_ctl_read_complete(struct urb * urb)3542 static void pvr2_ctl_read_complete(struct urb *urb)
3543 {
3544 	struct pvr2_hdw *hdw = urb->context;
3545 	hdw->ctl_read_pend_flag = 0;
3546 	if (hdw->ctl_write_pend_flag) return;
3547 	complete(&hdw->ctl_done);
3548 }
3549 
3550 struct hdw_timer {
3551 	struct timer_list timer;
3552 	struct pvr2_hdw *hdw;
3553 };
3554 
pvr2_ctl_timeout(struct timer_list * t)3555 static void pvr2_ctl_timeout(struct timer_list *t)
3556 {
3557 	struct hdw_timer *timer = from_timer(timer, t, timer);
3558 	struct pvr2_hdw *hdw = timer->hdw;
3559 
3560 	if (hdw->ctl_write_pend_flag || hdw->ctl_read_pend_flag) {
3561 		hdw->ctl_timeout_flag = !0;
3562 		if (hdw->ctl_write_pend_flag)
3563 			usb_unlink_urb(hdw->ctl_write_urb);
3564 		if (hdw->ctl_read_pend_flag)
3565 			usb_unlink_urb(hdw->ctl_read_urb);
3566 	}
3567 }
3568 
3569 
3570 /* Issue a command and get a response from the device.  This extended
3571    version includes a probe flag (which if set means that device errors
3572    should not be logged or treated as fatal) and a timeout in jiffies.
3573    This can be used to non-lethally probe the health of endpoint 1. */
pvr2_send_request_ex(struct pvr2_hdw * hdw,unsigned int timeout,int probe_fl,void * write_data,unsigned int write_len,void * read_data,unsigned int read_len)3574 static int pvr2_send_request_ex(struct pvr2_hdw *hdw,
3575 				unsigned int timeout,int probe_fl,
3576 				void *write_data,unsigned int write_len,
3577 				void *read_data,unsigned int read_len)
3578 {
3579 	unsigned int idx;
3580 	int status = 0;
3581 	struct hdw_timer timer = {
3582 		.hdw = hdw,
3583 	};
3584 
3585 	if (!hdw->ctl_lock_held) {
3586 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3587 			   "Attempted to execute control transfer without lock!!");
3588 		return -EDEADLK;
3589 	}
3590 	if (!hdw->flag_ok && !probe_fl) {
3591 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3592 			   "Attempted to execute control transfer when device not ok");
3593 		return -EIO;
3594 	}
3595 	if (!(hdw->ctl_read_urb && hdw->ctl_write_urb)) {
3596 		if (!probe_fl) {
3597 			pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3598 				   "Attempted to execute control transfer when USB is disconnected");
3599 		}
3600 		return -ENOTTY;
3601 	}
3602 
3603 	/* Ensure that we have sane parameters */
3604 	if (!write_data) write_len = 0;
3605 	if (!read_data) read_len = 0;
3606 	if (write_len > PVR2_CTL_BUFFSIZE) {
3607 		pvr2_trace(
3608 			PVR2_TRACE_ERROR_LEGS,
3609 			"Attempted to execute %d byte control-write transfer (limit=%d)",
3610 			write_len,PVR2_CTL_BUFFSIZE);
3611 		return -EINVAL;
3612 	}
3613 	if (read_len > PVR2_CTL_BUFFSIZE) {
3614 		pvr2_trace(
3615 			PVR2_TRACE_ERROR_LEGS,
3616 			"Attempted to execute %d byte control-read transfer (limit=%d)",
3617 			write_len,PVR2_CTL_BUFFSIZE);
3618 		return -EINVAL;
3619 	}
3620 	if ((!write_len) && (!read_len)) {
3621 		pvr2_trace(
3622 			PVR2_TRACE_ERROR_LEGS,
3623 			"Attempted to execute null control transfer?");
3624 		return -EINVAL;
3625 	}
3626 
3627 
3628 	hdw->cmd_debug_state = 1;
3629 	if (write_len && write_data)
3630 		hdw->cmd_debug_code = ((unsigned char *)write_data)[0];
3631 	else
3632 		hdw->cmd_debug_code = 0;
3633 	hdw->cmd_debug_write_len = write_len;
3634 	hdw->cmd_debug_read_len = read_len;
3635 
3636 	/* Initialize common stuff */
3637 	init_completion(&hdw->ctl_done);
3638 	hdw->ctl_timeout_flag = 0;
3639 	hdw->ctl_write_pend_flag = 0;
3640 	hdw->ctl_read_pend_flag = 0;
3641 	timer_setup_on_stack(&timer.timer, pvr2_ctl_timeout, 0);
3642 	timer.timer.expires = jiffies + timeout;
3643 
3644 	if (write_len && write_data) {
3645 		hdw->cmd_debug_state = 2;
3646 		/* Transfer write data to internal buffer */
3647 		for (idx = 0; idx < write_len; idx++) {
3648 			hdw->ctl_write_buffer[idx] =
3649 				((unsigned char *)write_data)[idx];
3650 		}
3651 		/* Initiate a write request */
3652 		usb_fill_bulk_urb(hdw->ctl_write_urb,
3653 				  hdw->usb_dev,
3654 				  usb_sndbulkpipe(hdw->usb_dev,
3655 						  PVR2_CTL_WRITE_ENDPOINT),
3656 				  hdw->ctl_write_buffer,
3657 				  write_len,
3658 				  pvr2_ctl_write_complete,
3659 				  hdw);
3660 		hdw->ctl_write_urb->actual_length = 0;
3661 		hdw->ctl_write_pend_flag = !0;
3662 		if (usb_urb_ep_type_check(hdw->ctl_write_urb)) {
3663 			pvr2_trace(
3664 				PVR2_TRACE_ERROR_LEGS,
3665 				"Invalid write control endpoint");
3666 			return -EINVAL;
3667 		}
3668 		status = usb_submit_urb(hdw->ctl_write_urb,GFP_KERNEL);
3669 		if (status < 0) {
3670 			pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3671 				   "Failed to submit write-control URB status=%d",
3672 status);
3673 			hdw->ctl_write_pend_flag = 0;
3674 			goto done;
3675 		}
3676 	}
3677 
3678 	if (read_len) {
3679 		hdw->cmd_debug_state = 3;
3680 		memset(hdw->ctl_read_buffer,0x43,read_len);
3681 		/* Initiate a read request */
3682 		usb_fill_bulk_urb(hdw->ctl_read_urb,
3683 				  hdw->usb_dev,
3684 				  usb_rcvbulkpipe(hdw->usb_dev,
3685 						  PVR2_CTL_READ_ENDPOINT),
3686 				  hdw->ctl_read_buffer,
3687 				  read_len,
3688 				  pvr2_ctl_read_complete,
3689 				  hdw);
3690 		hdw->ctl_read_urb->actual_length = 0;
3691 		hdw->ctl_read_pend_flag = !0;
3692 		if (usb_urb_ep_type_check(hdw->ctl_read_urb)) {
3693 			pvr2_trace(
3694 				PVR2_TRACE_ERROR_LEGS,
3695 				"Invalid read control endpoint");
3696 			return -EINVAL;
3697 		}
3698 		status = usb_submit_urb(hdw->ctl_read_urb,GFP_KERNEL);
3699 		if (status < 0) {
3700 			pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3701 				   "Failed to submit read-control URB status=%d",
3702 status);
3703 			hdw->ctl_read_pend_flag = 0;
3704 			goto done;
3705 		}
3706 	}
3707 
3708 	/* Start timer */
3709 	add_timer(&timer.timer);
3710 
3711 	/* Now wait for all I/O to complete */
3712 	hdw->cmd_debug_state = 4;
3713 	while (hdw->ctl_write_pend_flag || hdw->ctl_read_pend_flag) {
3714 		wait_for_completion(&hdw->ctl_done);
3715 	}
3716 	hdw->cmd_debug_state = 5;
3717 
3718 	/* Stop timer */
3719 	del_timer_sync(&timer.timer);
3720 
3721 	hdw->cmd_debug_state = 6;
3722 	status = 0;
3723 
3724 	if (hdw->ctl_timeout_flag) {
3725 		status = -ETIMEDOUT;
3726 		if (!probe_fl) {
3727 			pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3728 				   "Timed out control-write");
3729 		}
3730 		goto done;
3731 	}
3732 
3733 	if (write_len) {
3734 		/* Validate results of write request */
3735 		if ((hdw->ctl_write_urb->status != 0) &&
3736 		    (hdw->ctl_write_urb->status != -ENOENT) &&
3737 		    (hdw->ctl_write_urb->status != -ESHUTDOWN) &&
3738 		    (hdw->ctl_write_urb->status != -ECONNRESET)) {
3739 			/* USB subsystem is reporting some kind of failure
3740 			   on the write */
3741 			status = hdw->ctl_write_urb->status;
3742 			if (!probe_fl) {
3743 				pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3744 					   "control-write URB failure, status=%d",
3745 					   status);
3746 			}
3747 			goto done;
3748 		}
3749 		if (hdw->ctl_write_urb->actual_length < write_len) {
3750 			/* Failed to write enough data */
3751 			status = -EIO;
3752 			if (!probe_fl) {
3753 				pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3754 					   "control-write URB short, expected=%d got=%d",
3755 					   write_len,
3756 					   hdw->ctl_write_urb->actual_length);
3757 			}
3758 			goto done;
3759 		}
3760 	}
3761 	if (read_len && read_data) {
3762 		/* Validate results of read request */
3763 		if ((hdw->ctl_read_urb->status != 0) &&
3764 		    (hdw->ctl_read_urb->status != -ENOENT) &&
3765 		    (hdw->ctl_read_urb->status != -ESHUTDOWN) &&
3766 		    (hdw->ctl_read_urb->status != -ECONNRESET)) {
3767 			/* USB subsystem is reporting some kind of failure
3768 			   on the read */
3769 			status = hdw->ctl_read_urb->status;
3770 			if (!probe_fl) {
3771 				pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3772 					   "control-read URB failure, status=%d",
3773 					   status);
3774 			}
3775 			goto done;
3776 		}
3777 		if (hdw->ctl_read_urb->actual_length < read_len) {
3778 			/* Failed to read enough data */
3779 			status = -EIO;
3780 			if (!probe_fl) {
3781 				pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3782 					   "control-read URB short, expected=%d got=%d",
3783 					   read_len,
3784 					   hdw->ctl_read_urb->actual_length);
3785 			}
3786 			goto done;
3787 		}
3788 		/* Transfer retrieved data out from internal buffer */
3789 		for (idx = 0; idx < read_len; idx++) {
3790 			((unsigned char *)read_data)[idx] =
3791 				hdw->ctl_read_buffer[idx];
3792 		}
3793 	}
3794 
3795  done:
3796 
3797 	hdw->cmd_debug_state = 0;
3798 	if ((status < 0) && (!probe_fl)) {
3799 		pvr2_hdw_render_useless(hdw);
3800 	}
3801 	destroy_timer_on_stack(&timer.timer);
3802 
3803 	return status;
3804 }
3805 
3806 
pvr2_send_request(struct pvr2_hdw * hdw,void * write_data,unsigned int write_len,void * read_data,unsigned int read_len)3807 int pvr2_send_request(struct pvr2_hdw *hdw,
3808 		      void *write_data,unsigned int write_len,
3809 		      void *read_data,unsigned int read_len)
3810 {
3811 	return pvr2_send_request_ex(hdw,HZ*4,0,
3812 				    write_data,write_len,
3813 				    read_data,read_len);
3814 }
3815 
3816 
pvr2_issue_simple_cmd(struct pvr2_hdw * hdw,u32 cmdcode)3817 static int pvr2_issue_simple_cmd(struct pvr2_hdw *hdw,u32 cmdcode)
3818 {
3819 	int ret;
3820 	unsigned int cnt = 1;
3821 	unsigned int args = 0;
3822 	LOCK_TAKE(hdw->ctl_lock);
3823 	hdw->cmd_buffer[0] = cmdcode & 0xffu;
3824 	args = (cmdcode >> 8) & 0xffu;
3825 	args = (args > 2) ? 2 : args;
3826 	if (args) {
3827 		cnt += args;
3828 		hdw->cmd_buffer[1] = (cmdcode >> 16) & 0xffu;
3829 		if (args > 1) {
3830 			hdw->cmd_buffer[2] = (cmdcode >> 24) & 0xffu;
3831 		}
3832 	}
3833 	if (pvrusb2_debug & PVR2_TRACE_INIT) {
3834 		unsigned int idx;
3835 		unsigned int ccnt,bcnt;
3836 		char tbuf[50];
3837 		cmdcode &= 0xffu;
3838 		bcnt = 0;
3839 		ccnt = scnprintf(tbuf+bcnt,
3840 				 sizeof(tbuf)-bcnt,
3841 				 "Sending FX2 command 0x%x",cmdcode);
3842 		bcnt += ccnt;
3843 		for (idx = 0; idx < ARRAY_SIZE(pvr2_fx2cmd_desc); idx++) {
3844 			if (pvr2_fx2cmd_desc[idx].id == cmdcode) {
3845 				ccnt = scnprintf(tbuf+bcnt,
3846 						 sizeof(tbuf)-bcnt,
3847 						 " \"%s\"",
3848 						 pvr2_fx2cmd_desc[idx].desc);
3849 				bcnt += ccnt;
3850 				break;
3851 			}
3852 		}
3853 		if (args) {
3854 			ccnt = scnprintf(tbuf+bcnt,
3855 					 sizeof(tbuf)-bcnt,
3856 					 " (%u",hdw->cmd_buffer[1]);
3857 			bcnt += ccnt;
3858 			if (args > 1) {
3859 				ccnt = scnprintf(tbuf+bcnt,
3860 						 sizeof(tbuf)-bcnt,
3861 						 ",%u",hdw->cmd_buffer[2]);
3862 				bcnt += ccnt;
3863 			}
3864 			ccnt = scnprintf(tbuf+bcnt,
3865 					 sizeof(tbuf)-bcnt,
3866 					 ")");
3867 			bcnt += ccnt;
3868 		}
3869 		pvr2_trace(PVR2_TRACE_INIT,"%.*s",bcnt,tbuf);
3870 	}
3871 	ret = pvr2_send_request(hdw,hdw->cmd_buffer,cnt,NULL,0);
3872 	LOCK_GIVE(hdw->ctl_lock);
3873 	return ret;
3874 }
3875 
3876 
pvr2_write_register(struct pvr2_hdw * hdw,u16 reg,u32 data)3877 int pvr2_write_register(struct pvr2_hdw *hdw, u16 reg, u32 data)
3878 {
3879 	int ret;
3880 
3881 	LOCK_TAKE(hdw->ctl_lock);
3882 
3883 	hdw->cmd_buffer[0] = FX2CMD_REG_WRITE;  /* write register prefix */
3884 	PVR2_DECOMPOSE_LE(hdw->cmd_buffer,1,data);
3885 	hdw->cmd_buffer[5] = 0;
3886 	hdw->cmd_buffer[6] = (reg >> 8) & 0xff;
3887 	hdw->cmd_buffer[7] = reg & 0xff;
3888 
3889 
3890 	ret = pvr2_send_request(hdw, hdw->cmd_buffer, 8, hdw->cmd_buffer, 0);
3891 
3892 	LOCK_GIVE(hdw->ctl_lock);
3893 
3894 	return ret;
3895 }
3896 
3897 
pvr2_read_register(struct pvr2_hdw * hdw,u16 reg,u32 * data)3898 static int pvr2_read_register(struct pvr2_hdw *hdw, u16 reg, u32 *data)
3899 {
3900 	int ret = 0;
3901 
3902 	LOCK_TAKE(hdw->ctl_lock);
3903 
3904 	hdw->cmd_buffer[0] = FX2CMD_REG_READ;  /* read register prefix */
3905 	hdw->cmd_buffer[1] = 0;
3906 	hdw->cmd_buffer[2] = 0;
3907 	hdw->cmd_buffer[3] = 0;
3908 	hdw->cmd_buffer[4] = 0;
3909 	hdw->cmd_buffer[5] = 0;
3910 	hdw->cmd_buffer[6] = (reg >> 8) & 0xff;
3911 	hdw->cmd_buffer[7] = reg & 0xff;
3912 
3913 	ret |= pvr2_send_request(hdw, hdw->cmd_buffer, 8, hdw->cmd_buffer, 4);
3914 	*data = PVR2_COMPOSE_LE(hdw->cmd_buffer,0);
3915 
3916 	LOCK_GIVE(hdw->ctl_lock);
3917 
3918 	return ret;
3919 }
3920 
3921 
pvr2_hdw_render_useless(struct pvr2_hdw * hdw)3922 void pvr2_hdw_render_useless(struct pvr2_hdw *hdw)
3923 {
3924 	if (!hdw->flag_ok) return;
3925 	pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3926 		   "Device being rendered inoperable");
3927 	if (hdw->vid_stream) {
3928 		pvr2_stream_setup(hdw->vid_stream,NULL,0,0);
3929 	}
3930 	hdw->flag_ok = 0;
3931 	trace_stbit("flag_ok",hdw->flag_ok);
3932 	pvr2_hdw_state_sched(hdw);
3933 }
3934 
3935 
pvr2_hdw_device_reset(struct pvr2_hdw * hdw)3936 void pvr2_hdw_device_reset(struct pvr2_hdw *hdw)
3937 {
3938 	int ret;
3939 	pvr2_trace(PVR2_TRACE_INIT,"Performing a device reset...");
3940 	ret = usb_lock_device_for_reset(hdw->usb_dev,NULL);
3941 	if (ret == 0) {
3942 		ret = usb_reset_device(hdw->usb_dev);
3943 		usb_unlock_device(hdw->usb_dev);
3944 	} else {
3945 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3946 			   "Failed to lock USB device ret=%d",ret);
3947 	}
3948 	if (init_pause_msec) {
3949 		pvr2_trace(PVR2_TRACE_INFO,
3950 			   "Waiting %u msec for hardware to settle",
3951 			   init_pause_msec);
3952 		msleep(init_pause_msec);
3953 	}
3954 
3955 }
3956 
3957 
pvr2_hdw_cpureset_assert(struct pvr2_hdw * hdw,int val)3958 void pvr2_hdw_cpureset_assert(struct pvr2_hdw *hdw,int val)
3959 {
3960 	char *da;
3961 	unsigned int pipe;
3962 	int ret;
3963 
3964 	if (!hdw->usb_dev) return;
3965 
3966 	da = kmalloc(16, GFP_KERNEL);
3967 
3968 	if (da == NULL) {
3969 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3970 			   "Unable to allocate memory to control CPU reset");
3971 		return;
3972 	}
3973 
3974 	pvr2_trace(PVR2_TRACE_INIT,"cpureset_assert(%d)",val);
3975 
3976 	da[0] = val ? 0x01 : 0x00;
3977 
3978 	/* Write the CPUCS register on the 8051.  The lsb of the register
3979 	   is the reset bit; a 1 asserts reset while a 0 clears it. */
3980 	pipe = usb_sndctrlpipe(hdw->usb_dev, 0);
3981 	ret = usb_control_msg(hdw->usb_dev,pipe,0xa0,0x40,0xe600,0,da,1,HZ);
3982 	if (ret < 0) {
3983 		pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3984 			   "cpureset_assert(%d) error=%d",val,ret);
3985 		pvr2_hdw_render_useless(hdw);
3986 	}
3987 
3988 	kfree(da);
3989 }
3990 
3991 
pvr2_hdw_cmd_deep_reset(struct pvr2_hdw * hdw)3992 int pvr2_hdw_cmd_deep_reset(struct pvr2_hdw *hdw)
3993 {
3994 	return pvr2_issue_simple_cmd(hdw,FX2CMD_DEEP_RESET);
3995 }
3996 
3997 
pvr2_hdw_cmd_powerup(struct pvr2_hdw * hdw)3998 int pvr2_hdw_cmd_powerup(struct pvr2_hdw *hdw)
3999 {
4000 	return pvr2_issue_simple_cmd(hdw,FX2CMD_POWER_ON);
4001 }
4002 
4003 
4004 
pvr2_hdw_cmd_decoder_reset(struct pvr2_hdw * hdw)4005 int pvr2_hdw_cmd_decoder_reset(struct pvr2_hdw *hdw)
4006 {
4007 	pvr2_trace(PVR2_TRACE_INIT,
4008 		   "Requesting decoder reset");
4009 	if (hdw->decoder_client_id) {
4010 		v4l2_device_call_all(&hdw->v4l2_dev, hdw->decoder_client_id,
4011 				     core, reset, 0);
4012 		pvr2_hdw_cx25840_vbi_hack(hdw);
4013 		return 0;
4014 	}
4015 	pvr2_trace(PVR2_TRACE_INIT,
4016 		   "Unable to reset decoder: nothing attached");
4017 	return -ENOTTY;
4018 }
4019 
4020 
pvr2_hdw_cmd_hcw_demod_reset(struct pvr2_hdw * hdw,int onoff)4021 static int pvr2_hdw_cmd_hcw_demod_reset(struct pvr2_hdw *hdw, int onoff)
4022 {
4023 	hdw->flag_ok = !0;
4024 
4025 	/* Use this for Hauppauge 160xxx only */
4026 	if (le16_to_cpu(hdw->usb_dev->descriptor.idVendor) == 0x2040 &&
4027 	    (le16_to_cpu(hdw->usb_dev->descriptor.idProduct) == 0x7502 ||
4028 	     le16_to_cpu(hdw->usb_dev->descriptor.idProduct) == 0x7510)) {
4029 		pr_debug("%s(): resetting demod on Hauppauge 160xxx platform skipped\n",
4030 			 __func__);
4031 		/* Can't reset 160xxx or it will trash Demod tristate */
4032 		return pvr2_issue_simple_cmd(hdw,
4033 					     FX2CMD_HCW_MAKO_SLEEP_PIN |
4034 					     (1 << 8) |
4035 					     ((onoff ? 1 : 0) << 16));
4036 	}
4037 
4038 	return pvr2_issue_simple_cmd(hdw,
4039 				     FX2CMD_HCW_DEMOD_RESETIN |
4040 				     (1 << 8) |
4041 				     ((onoff ? 1 : 0) << 16));
4042 }
4043 
4044 
pvr2_hdw_cmd_onair_fe_power_ctrl(struct pvr2_hdw * hdw,int onoff)4045 static int pvr2_hdw_cmd_onair_fe_power_ctrl(struct pvr2_hdw *hdw, int onoff)
4046 {
4047 	hdw->flag_ok = !0;
4048 	return pvr2_issue_simple_cmd(hdw,(onoff ?
4049 					  FX2CMD_ONAIR_DTV_POWER_ON :
4050 					  FX2CMD_ONAIR_DTV_POWER_OFF));
4051 }
4052 
4053 
pvr2_hdw_cmd_onair_digital_path_ctrl(struct pvr2_hdw * hdw,int onoff)4054 static int pvr2_hdw_cmd_onair_digital_path_ctrl(struct pvr2_hdw *hdw,
4055 						int onoff)
4056 {
4057 	return pvr2_issue_simple_cmd(hdw,(onoff ?
4058 					  FX2CMD_ONAIR_DTV_STREAMING_ON :
4059 					  FX2CMD_ONAIR_DTV_STREAMING_OFF));
4060 }
4061 
4062 
pvr2_hdw_cmd_modeswitch(struct pvr2_hdw * hdw,int digitalFl)4063 static void pvr2_hdw_cmd_modeswitch(struct pvr2_hdw *hdw,int digitalFl)
4064 {
4065 	int cmode;
4066 	/* Compare digital/analog desired setting with current setting.  If
4067 	   they don't match, fix it... */
4068 	cmode = (digitalFl ? PVR2_PATHWAY_DIGITAL : PVR2_PATHWAY_ANALOG);
4069 	if (cmode == hdw->pathway_state) {
4070 		/* They match; nothing to do */
4071 		return;
4072 	}
4073 
4074 	switch (hdw->hdw_desc->digital_control_scheme) {
4075 	case PVR2_DIGITAL_SCHEME_HAUPPAUGE:
4076 		pvr2_hdw_cmd_hcw_demod_reset(hdw,digitalFl);
4077 		if (cmode == PVR2_PATHWAY_ANALOG) {
4078 			/* If moving to analog mode, also force the decoder
4079 			   to reset.  If no decoder is attached, then it's
4080 			   ok to ignore this because if/when the decoder
4081 			   attaches, it will reset itself at that time. */
4082 			pvr2_hdw_cmd_decoder_reset(hdw);
4083 		}
4084 		break;
4085 	case PVR2_DIGITAL_SCHEME_ONAIR:
4086 		/* Supposedly we should always have the power on whether in
4087 		   digital or analog mode.  But for now do what appears to
4088 		   work... */
4089 		pvr2_hdw_cmd_onair_fe_power_ctrl(hdw,digitalFl);
4090 		break;
4091 	default: break;
4092 	}
4093 
4094 	pvr2_hdw_untrip_unlocked(hdw);
4095 	hdw->pathway_state = cmode;
4096 }
4097 
4098 
pvr2_led_ctrl_hauppauge(struct pvr2_hdw * hdw,int onoff)4099 static void pvr2_led_ctrl_hauppauge(struct pvr2_hdw *hdw, int onoff)
4100 {
4101 	/* change some GPIO data
4102 	 *
4103 	 * note: bit d7 of dir appears to control the LED,
4104 	 * so we shut it off here.
4105 	 *
4106 	 */
4107 	if (onoff) {
4108 		pvr2_hdw_gpio_chg_dir(hdw, 0xffffffff, 0x00000481);
4109 	} else {
4110 		pvr2_hdw_gpio_chg_dir(hdw, 0xffffffff, 0x00000401);
4111 	}
4112 	pvr2_hdw_gpio_chg_out(hdw, 0xffffffff, 0x00000000);
4113 }
4114 
4115 
4116 typedef void (*led_method_func)(struct pvr2_hdw *,int);
4117 
4118 static led_method_func led_methods[] = {
4119 	[PVR2_LED_SCHEME_HAUPPAUGE] = pvr2_led_ctrl_hauppauge,
4120 };
4121 
4122 
4123 /* Toggle LED */
pvr2_led_ctrl(struct pvr2_hdw * hdw,int onoff)4124 static void pvr2_led_ctrl(struct pvr2_hdw *hdw,int onoff)
4125 {
4126 	unsigned int scheme_id;
4127 	led_method_func fp;
4128 
4129 	if ((!onoff) == (!hdw->led_on)) return;
4130 
4131 	hdw->led_on = onoff != 0;
4132 
4133 	scheme_id = hdw->hdw_desc->led_scheme;
4134 	if (scheme_id < ARRAY_SIZE(led_methods)) {
4135 		fp = led_methods[scheme_id];
4136 	} else {
4137 		fp = NULL;
4138 	}
4139 
4140 	if (fp) (*fp)(hdw,onoff);
4141 }
4142 
4143 
4144 /* Stop / start video stream transport */
pvr2_hdw_cmd_usbstream(struct pvr2_hdw * hdw,int runFl)4145 static int pvr2_hdw_cmd_usbstream(struct pvr2_hdw *hdw,int runFl)
4146 {
4147 	int ret;
4148 
4149 	/* If we're in analog mode, then just issue the usual analog
4150 	   command. */
4151 	if (hdw->pathway_state == PVR2_PATHWAY_ANALOG) {
4152 		return pvr2_issue_simple_cmd(hdw,
4153 					     (runFl ?
4154 					      FX2CMD_STREAMING_ON :
4155 					      FX2CMD_STREAMING_OFF));
4156 		/*Note: Not reached */
4157 	}
4158 
4159 	if (hdw->pathway_state != PVR2_PATHWAY_DIGITAL) {
4160 		/* Whoops, we don't know what mode we're in... */
4161 		return -EINVAL;
4162 	}
4163 
4164 	/* To get here we have to be in digital mode.  The mechanism here
4165 	   is unfortunately different for different vendors.  So we switch
4166 	   on the device's digital scheme attribute in order to figure out
4167 	   what to do. */
4168 	switch (hdw->hdw_desc->digital_control_scheme) {
4169 	case PVR2_DIGITAL_SCHEME_HAUPPAUGE:
4170 		return pvr2_issue_simple_cmd(hdw,
4171 					     (runFl ?
4172 					      FX2CMD_HCW_DTV_STREAMING_ON :
4173 					      FX2CMD_HCW_DTV_STREAMING_OFF));
4174 	case PVR2_DIGITAL_SCHEME_ONAIR:
4175 		ret = pvr2_issue_simple_cmd(hdw,
4176 					    (runFl ?
4177 					     FX2CMD_STREAMING_ON :
4178 					     FX2CMD_STREAMING_OFF));
4179 		if (ret) return ret;
4180 		return pvr2_hdw_cmd_onair_digital_path_ctrl(hdw,runFl);
4181 	default:
4182 		return -EINVAL;
4183 	}
4184 }
4185 
4186 
4187 /* Evaluate whether or not state_pathway_ok can change */
state_eval_pathway_ok(struct pvr2_hdw * hdw)4188 static int state_eval_pathway_ok(struct pvr2_hdw *hdw)
4189 {
4190 	if (hdw->state_pathway_ok) {
4191 		/* Nothing to do if pathway is already ok */
4192 		return 0;
4193 	}
4194 	if (!hdw->state_pipeline_idle) {
4195 		/* Not allowed to change anything if pipeline is not idle */
4196 		return 0;
4197 	}
4198 	pvr2_hdw_cmd_modeswitch(hdw,hdw->input_val == PVR2_CVAL_INPUT_DTV);
4199 	hdw->state_pathway_ok = !0;
4200 	trace_stbit("state_pathway_ok",hdw->state_pathway_ok);
4201 	return !0;
4202 }
4203 
4204 
4205 /* Evaluate whether or not state_encoder_ok can change */
state_eval_encoder_ok(struct pvr2_hdw * hdw)4206 static int state_eval_encoder_ok(struct pvr2_hdw *hdw)
4207 {
4208 	if (hdw->state_encoder_ok) return 0;
4209 	if (hdw->flag_tripped) return 0;
4210 	if (hdw->state_encoder_run) return 0;
4211 	if (hdw->state_encoder_config) return 0;
4212 	if (hdw->state_decoder_run) return 0;
4213 	if (hdw->state_usbstream_run) return 0;
4214 	if (hdw->pathway_state == PVR2_PATHWAY_DIGITAL) {
4215 		if (!hdw->hdw_desc->flag_digital_requires_cx23416) return 0;
4216 	} else if (hdw->pathway_state != PVR2_PATHWAY_ANALOG) {
4217 		return 0;
4218 	}
4219 
4220 	if (pvr2_upload_firmware2(hdw) < 0) {
4221 		hdw->flag_tripped = !0;
4222 		trace_stbit("flag_tripped",hdw->flag_tripped);
4223 		return !0;
4224 	}
4225 	hdw->state_encoder_ok = !0;
4226 	trace_stbit("state_encoder_ok",hdw->state_encoder_ok);
4227 	return !0;
4228 }
4229 
4230 
4231 /* Evaluate whether or not state_encoder_config can change */
state_eval_encoder_config(struct pvr2_hdw * hdw)4232 static int state_eval_encoder_config(struct pvr2_hdw *hdw)
4233 {
4234 	if (hdw->state_encoder_config) {
4235 		if (hdw->state_encoder_ok) {
4236 			if (hdw->state_pipeline_req &&
4237 			    !hdw->state_pipeline_pause) return 0;
4238 		}
4239 		hdw->state_encoder_config = 0;
4240 		hdw->state_encoder_waitok = 0;
4241 		trace_stbit("state_encoder_waitok",hdw->state_encoder_waitok);
4242 		/* paranoia - solve race if timer just completed */
4243 		del_timer_sync(&hdw->encoder_wait_timer);
4244 	} else {
4245 		if (!hdw->state_pathway_ok ||
4246 		    (hdw->pathway_state != PVR2_PATHWAY_ANALOG) ||
4247 		    !hdw->state_encoder_ok ||
4248 		    !hdw->state_pipeline_idle ||
4249 		    hdw->state_pipeline_pause ||
4250 		    !hdw->state_pipeline_req ||
4251 		    !hdw->state_pipeline_config) {
4252 			/* We must reset the enforced wait interval if
4253 			   anything has happened that might have disturbed
4254 			   the encoder.  This should be a rare case. */
4255 			if (timer_pending(&hdw->encoder_wait_timer)) {
4256 				del_timer_sync(&hdw->encoder_wait_timer);
4257 			}
4258 			if (hdw->state_encoder_waitok) {
4259 				/* Must clear the state - therefore we did
4260 				   something to a state bit and must also
4261 				   return true. */
4262 				hdw->state_encoder_waitok = 0;
4263 				trace_stbit("state_encoder_waitok",
4264 					    hdw->state_encoder_waitok);
4265 				return !0;
4266 			}
4267 			return 0;
4268 		}
4269 		if (!hdw->state_encoder_waitok) {
4270 			if (!timer_pending(&hdw->encoder_wait_timer)) {
4271 				/* waitok flag wasn't set and timer isn't
4272 				   running.  Check flag once more to avoid
4273 				   a race then start the timer.  This is
4274 				   the point when we measure out a minimal
4275 				   quiet interval before doing something to
4276 				   the encoder. */
4277 				if (!hdw->state_encoder_waitok) {
4278 					hdw->encoder_wait_timer.expires =
4279 						jiffies + msecs_to_jiffies(
4280 						TIME_MSEC_ENCODER_WAIT);
4281 					add_timer(&hdw->encoder_wait_timer);
4282 				}
4283 			}
4284 			/* We can't continue until we know we have been
4285 			   quiet for the interval measured by this
4286 			   timer. */
4287 			return 0;
4288 		}
4289 		pvr2_encoder_configure(hdw);
4290 		if (hdw->state_encoder_ok) hdw->state_encoder_config = !0;
4291 	}
4292 	trace_stbit("state_encoder_config",hdw->state_encoder_config);
4293 	return !0;
4294 }
4295 
4296 
4297 /* Return true if the encoder should not be running. */
state_check_disable_encoder_run(struct pvr2_hdw * hdw)4298 static int state_check_disable_encoder_run(struct pvr2_hdw *hdw)
4299 {
4300 	if (!hdw->state_encoder_ok) {
4301 		/* Encoder isn't healthy at the moment, so stop it. */
4302 		return !0;
4303 	}
4304 	if (!hdw->state_pathway_ok) {
4305 		/* Mode is not understood at the moment (i.e. it wants to
4306 		   change), so encoder must be stopped. */
4307 		return !0;
4308 	}
4309 
4310 	switch (hdw->pathway_state) {
4311 	case PVR2_PATHWAY_ANALOG:
4312 		if (!hdw->state_decoder_run) {
4313 			/* We're in analog mode and the decoder is not
4314 			   running; thus the encoder should be stopped as
4315 			   well. */
4316 			return !0;
4317 		}
4318 		break;
4319 	case PVR2_PATHWAY_DIGITAL:
4320 		if (hdw->state_encoder_runok) {
4321 			/* This is a funny case.  We're in digital mode so
4322 			   really the encoder should be stopped.  However
4323 			   if it really is running, only kill it after
4324 			   runok has been set.  This gives a chance for the
4325 			   onair quirk to function (encoder must run
4326 			   briefly first, at least once, before onair
4327 			   digital streaming can work). */
4328 			return !0;
4329 		}
4330 		break;
4331 	default:
4332 		/* Unknown mode; so encoder should be stopped. */
4333 		return !0;
4334 	}
4335 
4336 	/* If we get here, we haven't found a reason to stop the
4337 	   encoder. */
4338 	return 0;
4339 }
4340 
4341 
4342 /* Return true if the encoder should be running. */
state_check_enable_encoder_run(struct pvr2_hdw * hdw)4343 static int state_check_enable_encoder_run(struct pvr2_hdw *hdw)
4344 {
4345 	if (!hdw->state_encoder_ok) {
4346 		/* Don't run the encoder if it isn't healthy... */
4347 		return 0;
4348 	}
4349 	if (!hdw->state_pathway_ok) {
4350 		/* Don't run the encoder if we don't (yet) know what mode
4351 		   we need to be in... */
4352 		return 0;
4353 	}
4354 
4355 	switch (hdw->pathway_state) {
4356 	case PVR2_PATHWAY_ANALOG:
4357 		if (hdw->state_decoder_run && hdw->state_decoder_ready) {
4358 			/* In analog mode, if the decoder is running, then
4359 			   run the encoder. */
4360 			return !0;
4361 		}
4362 		break;
4363 	case PVR2_PATHWAY_DIGITAL:
4364 		if ((hdw->hdw_desc->digital_control_scheme ==
4365 		     PVR2_DIGITAL_SCHEME_ONAIR) &&
4366 		    !hdw->state_encoder_runok) {
4367 			/* This is a quirk.  OnAir hardware won't stream
4368 			   digital until the encoder has been run at least
4369 			   once, for a minimal period of time (empiricially
4370 			   measured to be 1/4 second).  So if we're on
4371 			   OnAir hardware and the encoder has never been
4372 			   run at all, then start the encoder.  Normal
4373 			   state machine logic in the driver will
4374 			   automatically handle the remaining bits. */
4375 			return !0;
4376 		}
4377 		break;
4378 	default:
4379 		/* For completeness (unknown mode; encoder won't run ever) */
4380 		break;
4381 	}
4382 	/* If we get here, then we haven't found any reason to run the
4383 	   encoder, so don't run it. */
4384 	return 0;
4385 }
4386 
4387 
4388 /* Evaluate whether or not state_encoder_run can change */
state_eval_encoder_run(struct pvr2_hdw * hdw)4389 static int state_eval_encoder_run(struct pvr2_hdw *hdw)
4390 {
4391 	if (hdw->state_encoder_run) {
4392 		if (!state_check_disable_encoder_run(hdw)) return 0;
4393 		if (hdw->state_encoder_ok) {
4394 			del_timer_sync(&hdw->encoder_run_timer);
4395 			if (pvr2_encoder_stop(hdw) < 0) return !0;
4396 		}
4397 		hdw->state_encoder_run = 0;
4398 	} else {
4399 		if (!state_check_enable_encoder_run(hdw)) return 0;
4400 		if (pvr2_encoder_start(hdw) < 0) return !0;
4401 		hdw->state_encoder_run = !0;
4402 		if (!hdw->state_encoder_runok) {
4403 			hdw->encoder_run_timer.expires = jiffies +
4404 				 msecs_to_jiffies(TIME_MSEC_ENCODER_OK);
4405 			add_timer(&hdw->encoder_run_timer);
4406 		}
4407 	}
4408 	trace_stbit("state_encoder_run",hdw->state_encoder_run);
4409 	return !0;
4410 }
4411 
4412 
4413 /* Timeout function for quiescent timer. */
pvr2_hdw_quiescent_timeout(struct timer_list * t)4414 static void pvr2_hdw_quiescent_timeout(struct timer_list *t)
4415 {
4416 	struct pvr2_hdw *hdw = from_timer(hdw, t, quiescent_timer);
4417 	hdw->state_decoder_quiescent = !0;
4418 	trace_stbit("state_decoder_quiescent",hdw->state_decoder_quiescent);
4419 	hdw->state_stale = !0;
4420 	schedule_work(&hdw->workpoll);
4421 }
4422 
4423 
4424 /* Timeout function for decoder stabilization timer. */
pvr2_hdw_decoder_stabilization_timeout(struct timer_list * t)4425 static void pvr2_hdw_decoder_stabilization_timeout(struct timer_list *t)
4426 {
4427 	struct pvr2_hdw *hdw = from_timer(hdw, t, decoder_stabilization_timer);
4428 	hdw->state_decoder_ready = !0;
4429 	trace_stbit("state_decoder_ready", hdw->state_decoder_ready);
4430 	hdw->state_stale = !0;
4431 	schedule_work(&hdw->workpoll);
4432 }
4433 
4434 
4435 /* Timeout function for encoder wait timer. */
pvr2_hdw_encoder_wait_timeout(struct timer_list * t)4436 static void pvr2_hdw_encoder_wait_timeout(struct timer_list *t)
4437 {
4438 	struct pvr2_hdw *hdw = from_timer(hdw, t, encoder_wait_timer);
4439 	hdw->state_encoder_waitok = !0;
4440 	trace_stbit("state_encoder_waitok",hdw->state_encoder_waitok);
4441 	hdw->state_stale = !0;
4442 	schedule_work(&hdw->workpoll);
4443 }
4444 
4445 
4446 /* Timeout function for encoder run timer. */
pvr2_hdw_encoder_run_timeout(struct timer_list * t)4447 static void pvr2_hdw_encoder_run_timeout(struct timer_list *t)
4448 {
4449 	struct pvr2_hdw *hdw = from_timer(hdw, t, encoder_run_timer);
4450 	if (!hdw->state_encoder_runok) {
4451 		hdw->state_encoder_runok = !0;
4452 		trace_stbit("state_encoder_runok",hdw->state_encoder_runok);
4453 		hdw->state_stale = !0;
4454 		schedule_work(&hdw->workpoll);
4455 	}
4456 }
4457 
4458 
4459 /* Evaluate whether or not state_decoder_run can change */
state_eval_decoder_run(struct pvr2_hdw * hdw)4460 static int state_eval_decoder_run(struct pvr2_hdw *hdw)
4461 {
4462 	if (hdw->state_decoder_run) {
4463 		if (hdw->state_encoder_ok) {
4464 			if (hdw->state_pipeline_req &&
4465 			    !hdw->state_pipeline_pause &&
4466 			    hdw->state_pathway_ok) return 0;
4467 		}
4468 		if (!hdw->flag_decoder_missed) {
4469 			pvr2_decoder_enable(hdw,0);
4470 		}
4471 		hdw->state_decoder_quiescent = 0;
4472 		hdw->state_decoder_run = 0;
4473 		/* paranoia - solve race if timer(s) just completed */
4474 		del_timer_sync(&hdw->quiescent_timer);
4475 		/* Kill the stabilization timer, in case we're killing the
4476 		   encoder before the previous stabilization interval has
4477 		   been properly timed. */
4478 		del_timer_sync(&hdw->decoder_stabilization_timer);
4479 		hdw->state_decoder_ready = 0;
4480 	} else {
4481 		if (!hdw->state_decoder_quiescent) {
4482 			if (!timer_pending(&hdw->quiescent_timer)) {
4483 				/* We don't do something about the
4484 				   quiescent timer until right here because
4485 				   we also want to catch cases where the
4486 				   decoder was already not running (like
4487 				   after initialization) as opposed to
4488 				   knowing that we had just stopped it.
4489 				   The second flag check is here to cover a
4490 				   race - the timer could have run and set
4491 				   this flag just after the previous check
4492 				   but before we did the pending check. */
4493 				if (!hdw->state_decoder_quiescent) {
4494 					hdw->quiescent_timer.expires =
4495 						jiffies + msecs_to_jiffies(
4496 						TIME_MSEC_DECODER_WAIT);
4497 					add_timer(&hdw->quiescent_timer);
4498 				}
4499 			}
4500 			/* Don't allow decoder to start again until it has
4501 			   been quiesced first.  This little detail should
4502 			   hopefully further stabilize the encoder. */
4503 			return 0;
4504 		}
4505 		if (!hdw->state_pathway_ok ||
4506 		    (hdw->pathway_state != PVR2_PATHWAY_ANALOG) ||
4507 		    !hdw->state_pipeline_req ||
4508 		    hdw->state_pipeline_pause ||
4509 		    !hdw->state_pipeline_config ||
4510 		    !hdw->state_encoder_config ||
4511 		    !hdw->state_encoder_ok) return 0;
4512 		del_timer_sync(&hdw->quiescent_timer);
4513 		if (hdw->flag_decoder_missed) return 0;
4514 		if (pvr2_decoder_enable(hdw,!0) < 0) return 0;
4515 		hdw->state_decoder_quiescent = 0;
4516 		hdw->state_decoder_ready = 0;
4517 		hdw->state_decoder_run = !0;
4518 		if (hdw->decoder_client_id == PVR2_CLIENT_ID_SAA7115) {
4519 			hdw->decoder_stabilization_timer.expires =
4520 				jiffies + msecs_to_jiffies(
4521 				TIME_MSEC_DECODER_STABILIZATION_WAIT);
4522 			add_timer(&hdw->decoder_stabilization_timer);
4523 		} else {
4524 			hdw->state_decoder_ready = !0;
4525 		}
4526 	}
4527 	trace_stbit("state_decoder_quiescent",hdw->state_decoder_quiescent);
4528 	trace_stbit("state_decoder_run",hdw->state_decoder_run);
4529 	trace_stbit("state_decoder_ready", hdw->state_decoder_ready);
4530 	return !0;
4531 }
4532 
4533 
4534 /* Evaluate whether or not state_usbstream_run can change */
state_eval_usbstream_run(struct pvr2_hdw * hdw)4535 static int state_eval_usbstream_run(struct pvr2_hdw *hdw)
4536 {
4537 	if (hdw->state_usbstream_run) {
4538 		int fl = !0;
4539 		if (hdw->pathway_state == PVR2_PATHWAY_ANALOG) {
4540 			fl = (hdw->state_encoder_ok &&
4541 			      hdw->state_encoder_run);
4542 		} else if ((hdw->pathway_state == PVR2_PATHWAY_DIGITAL) &&
4543 			   (hdw->hdw_desc->flag_digital_requires_cx23416)) {
4544 			fl = hdw->state_encoder_ok;
4545 		}
4546 		if (fl &&
4547 		    hdw->state_pipeline_req &&
4548 		    !hdw->state_pipeline_pause &&
4549 		    hdw->state_pathway_ok) {
4550 			return 0;
4551 		}
4552 		pvr2_hdw_cmd_usbstream(hdw,0);
4553 		hdw->state_usbstream_run = 0;
4554 	} else {
4555 		if (!hdw->state_pipeline_req ||
4556 		    hdw->state_pipeline_pause ||
4557 		    !hdw->state_pathway_ok) return 0;
4558 		if (hdw->pathway_state == PVR2_PATHWAY_ANALOG) {
4559 			if (!hdw->state_encoder_ok ||
4560 			    !hdw->state_encoder_run) return 0;
4561 		} else if ((hdw->pathway_state == PVR2_PATHWAY_DIGITAL) &&
4562 			   (hdw->hdw_desc->flag_digital_requires_cx23416)) {
4563 			if (!hdw->state_encoder_ok) return 0;
4564 			if (hdw->state_encoder_run) return 0;
4565 			if (hdw->hdw_desc->digital_control_scheme ==
4566 			    PVR2_DIGITAL_SCHEME_ONAIR) {
4567 				/* OnAir digital receivers won't stream
4568 				   unless the analog encoder has run first.
4569 				   Why?  I have no idea.  But don't even
4570 				   try until we know the analog side is
4571 				   known to have run. */
4572 				if (!hdw->state_encoder_runok) return 0;
4573 			}
4574 		}
4575 		if (pvr2_hdw_cmd_usbstream(hdw,!0) < 0) return 0;
4576 		hdw->state_usbstream_run = !0;
4577 	}
4578 	trace_stbit("state_usbstream_run",hdw->state_usbstream_run);
4579 	return !0;
4580 }
4581 
4582 
4583 /* Attempt to configure pipeline, if needed */
state_eval_pipeline_config(struct pvr2_hdw * hdw)4584 static int state_eval_pipeline_config(struct pvr2_hdw *hdw)
4585 {
4586 	if (hdw->state_pipeline_config ||
4587 	    hdw->state_pipeline_pause) return 0;
4588 	pvr2_hdw_commit_execute(hdw);
4589 	return !0;
4590 }
4591 
4592 
4593 /* Update pipeline idle and pipeline pause tracking states based on other
4594    inputs.  This must be called whenever the other relevant inputs have
4595    changed. */
state_update_pipeline_state(struct pvr2_hdw * hdw)4596 static int state_update_pipeline_state(struct pvr2_hdw *hdw)
4597 {
4598 	unsigned int st;
4599 	int updatedFl = 0;
4600 	/* Update pipeline state */
4601 	st = !(hdw->state_encoder_run ||
4602 	       hdw->state_decoder_run ||
4603 	       hdw->state_usbstream_run ||
4604 	       (!hdw->state_decoder_quiescent));
4605 	if (!st != !hdw->state_pipeline_idle) {
4606 		hdw->state_pipeline_idle = st;
4607 		updatedFl = !0;
4608 	}
4609 	if (hdw->state_pipeline_idle && hdw->state_pipeline_pause) {
4610 		hdw->state_pipeline_pause = 0;
4611 		updatedFl = !0;
4612 	}
4613 	return updatedFl;
4614 }
4615 
4616 
4617 typedef int (*state_eval_func)(struct pvr2_hdw *);
4618 
4619 /* Set of functions to be run to evaluate various states in the driver. */
4620 static const state_eval_func eval_funcs[] = {
4621 	state_eval_pathway_ok,
4622 	state_eval_pipeline_config,
4623 	state_eval_encoder_ok,
4624 	state_eval_encoder_config,
4625 	state_eval_decoder_run,
4626 	state_eval_encoder_run,
4627 	state_eval_usbstream_run,
4628 };
4629 
4630 
4631 /* Process various states and return true if we did anything interesting. */
pvr2_hdw_state_update(struct pvr2_hdw * hdw)4632 static int pvr2_hdw_state_update(struct pvr2_hdw *hdw)
4633 {
4634 	unsigned int i;
4635 	int state_updated = 0;
4636 	int check_flag;
4637 
4638 	if (!hdw->state_stale) return 0;
4639 	if ((hdw->fw1_state != FW1_STATE_OK) ||
4640 	    !hdw->flag_ok) {
4641 		hdw->state_stale = 0;
4642 		return !0;
4643 	}
4644 	/* This loop is the heart of the entire driver.  It keeps trying to
4645 	   evaluate various bits of driver state until nothing changes for
4646 	   one full iteration.  Each "bit of state" tracks some global
4647 	   aspect of the driver, e.g. whether decoder should run, if
4648 	   pipeline is configured, usb streaming is on, etc.  We separately
4649 	   evaluate each of those questions based on other driver state to
4650 	   arrive at the correct running configuration. */
4651 	do {
4652 		check_flag = 0;
4653 		state_update_pipeline_state(hdw);
4654 		/* Iterate over each bit of state */
4655 		for (i = 0; (i<ARRAY_SIZE(eval_funcs)) && hdw->flag_ok; i++) {
4656 			if ((*eval_funcs[i])(hdw)) {
4657 				check_flag = !0;
4658 				state_updated = !0;
4659 				state_update_pipeline_state(hdw);
4660 			}
4661 		}
4662 	} while (check_flag && hdw->flag_ok);
4663 	hdw->state_stale = 0;
4664 	trace_stbit("state_stale",hdw->state_stale);
4665 	return state_updated;
4666 }
4667 
4668 
print_input_mask(unsigned int msk,char * buf,unsigned int acnt)4669 static unsigned int print_input_mask(unsigned int msk,
4670 				     char *buf,unsigned int acnt)
4671 {
4672 	unsigned int idx,ccnt;
4673 	unsigned int tcnt = 0;
4674 	for (idx = 0; idx < ARRAY_SIZE(control_values_input); idx++) {
4675 		if (!((1UL << idx) & msk)) continue;
4676 		ccnt = scnprintf(buf+tcnt,
4677 				 acnt-tcnt,
4678 				 "%s%s",
4679 				 (tcnt ? ", " : ""),
4680 				 control_values_input[idx]);
4681 		tcnt += ccnt;
4682 	}
4683 	return tcnt;
4684 }
4685 
4686 
pvr2_pathway_state_name(int id)4687 static const char *pvr2_pathway_state_name(int id)
4688 {
4689 	switch (id) {
4690 	case PVR2_PATHWAY_ANALOG: return "analog";
4691 	case PVR2_PATHWAY_DIGITAL: return "digital";
4692 	default: return "unknown";
4693 	}
4694 }
4695 
4696 
pvr2_hdw_report_unlocked(struct pvr2_hdw * hdw,int which,char * buf,unsigned int acnt)4697 static unsigned int pvr2_hdw_report_unlocked(struct pvr2_hdw *hdw,int which,
4698 					     char *buf,unsigned int acnt)
4699 {
4700 	switch (which) {
4701 	case 0:
4702 		return scnprintf(
4703 			buf,acnt,
4704 			"driver:%s%s%s%s%s <mode=%s>",
4705 			(hdw->flag_ok ? " <ok>" : " <fail>"),
4706 			(hdw->flag_init_ok ? " <init>" : " <uninitialized>"),
4707 			(hdw->flag_disconnected ? " <disconnected>" :
4708 			 " <connected>"),
4709 			(hdw->flag_tripped ? " <tripped>" : ""),
4710 			(hdw->flag_decoder_missed ? " <no decoder>" : ""),
4711 			pvr2_pathway_state_name(hdw->pathway_state));
4712 
4713 	case 1:
4714 		return scnprintf(
4715 			buf,acnt,
4716 			"pipeline:%s%s%s%s",
4717 			(hdw->state_pipeline_idle ? " <idle>" : ""),
4718 			(hdw->state_pipeline_config ?
4719 			 " <configok>" : " <stale>"),
4720 			(hdw->state_pipeline_req ? " <req>" : ""),
4721 			(hdw->state_pipeline_pause ? " <pause>" : ""));
4722 	case 2:
4723 		return scnprintf(
4724 			buf,acnt,
4725 			"worker:%s%s%s%s%s%s%s",
4726 			(hdw->state_decoder_run ?
4727 			 (hdw->state_decoder_ready ?
4728 			  "<decode:run>" : " <decode:start>") :
4729 			 (hdw->state_decoder_quiescent ?
4730 			  "" : " <decode:stop>")),
4731 			(hdw->state_decoder_quiescent ?
4732 			 " <decode:quiescent>" : ""),
4733 			(hdw->state_encoder_ok ?
4734 			 "" : " <encode:init>"),
4735 			(hdw->state_encoder_run ?
4736 			 (hdw->state_encoder_runok ?
4737 			  " <encode:run>" :
4738 			  " <encode:firstrun>") :
4739 			 (hdw->state_encoder_runok ?
4740 			  " <encode:stop>" :
4741 			  " <encode:virgin>")),
4742 			(hdw->state_encoder_config ?
4743 			 " <encode:configok>" :
4744 			 (hdw->state_encoder_waitok ?
4745 			  "" : " <encode:waitok>")),
4746 			(hdw->state_usbstream_run ?
4747 			 " <usb:run>" : " <usb:stop>"),
4748 			(hdw->state_pathway_ok ?
4749 			 " <pathway:ok>" : ""));
4750 	case 3:
4751 		return scnprintf(
4752 			buf,acnt,
4753 			"state: %s",
4754 			pvr2_get_state_name(hdw->master_state));
4755 	case 4: {
4756 		unsigned int tcnt = 0;
4757 		unsigned int ccnt;
4758 
4759 		ccnt = scnprintf(buf,
4760 				 acnt,
4761 				 "Hardware supported inputs: ");
4762 		tcnt += ccnt;
4763 		tcnt += print_input_mask(hdw->input_avail_mask,
4764 					 buf+tcnt,
4765 					 acnt-tcnt);
4766 		if (hdw->input_avail_mask != hdw->input_allowed_mask) {
4767 			ccnt = scnprintf(buf+tcnt,
4768 					 acnt-tcnt,
4769 					 "; allowed inputs: ");
4770 			tcnt += ccnt;
4771 			tcnt += print_input_mask(hdw->input_allowed_mask,
4772 						 buf+tcnt,
4773 						 acnt-tcnt);
4774 		}
4775 		return tcnt;
4776 	}
4777 	case 5: {
4778 		struct pvr2_stream_stats stats;
4779 		if (!hdw->vid_stream) break;
4780 		pvr2_stream_get_stats(hdw->vid_stream,
4781 				      &stats,
4782 				      0);
4783 		return scnprintf(
4784 			buf,acnt,
4785 			"Bytes streamed=%u URBs: queued=%u idle=%u ready=%u processed=%u failed=%u",
4786 			stats.bytes_processed,
4787 			stats.buffers_in_queue,
4788 			stats.buffers_in_idle,
4789 			stats.buffers_in_ready,
4790 			stats.buffers_processed,
4791 			stats.buffers_failed);
4792 	}
4793 	case 6: {
4794 		unsigned int id = hdw->ir_scheme_active;
4795 		return scnprintf(buf, acnt, "ir scheme: id=%d %s", id,
4796 				 (id >= ARRAY_SIZE(ir_scheme_names) ?
4797 				  "?" : ir_scheme_names[id]));
4798 	}
4799 	default: break;
4800 	}
4801 	return 0;
4802 }
4803 
4804 
4805 /* Generate report containing info about attached sub-devices and attached
4806    i2c clients, including an indication of which attached i2c clients are
4807    actually sub-devices. */
pvr2_hdw_report_clients(struct pvr2_hdw * hdw,char * buf,unsigned int acnt)4808 static unsigned int pvr2_hdw_report_clients(struct pvr2_hdw *hdw,
4809 					    char *buf, unsigned int acnt)
4810 {
4811 	struct v4l2_subdev *sd;
4812 	unsigned int tcnt = 0;
4813 	unsigned int ccnt;
4814 	struct i2c_client *client;
4815 	const char *p;
4816 	unsigned int id;
4817 
4818 	ccnt = scnprintf(buf, acnt, "Associated v4l2-subdev drivers and I2C clients:\n");
4819 	tcnt += ccnt;
4820 	v4l2_device_for_each_subdev(sd, &hdw->v4l2_dev) {
4821 		id = sd->grp_id;
4822 		p = NULL;
4823 		if (id < ARRAY_SIZE(module_names)) p = module_names[id];
4824 		if (p) {
4825 			ccnt = scnprintf(buf + tcnt, acnt - tcnt, "  %s:", p);
4826 			tcnt += ccnt;
4827 		} else {
4828 			ccnt = scnprintf(buf + tcnt, acnt - tcnt,
4829 					 "  (unknown id=%u):", id);
4830 			tcnt += ccnt;
4831 		}
4832 		client = v4l2_get_subdevdata(sd);
4833 		if (client) {
4834 			ccnt = scnprintf(buf + tcnt, acnt - tcnt,
4835 					 " %s @ %02x\n", client->name,
4836 					 client->addr);
4837 			tcnt += ccnt;
4838 		} else {
4839 			ccnt = scnprintf(buf + tcnt, acnt - tcnt,
4840 					 " no i2c client\n");
4841 			tcnt += ccnt;
4842 		}
4843 	}
4844 	return tcnt;
4845 }
4846 
4847 
pvr2_hdw_state_report(struct pvr2_hdw * hdw,char * buf,unsigned int acnt)4848 unsigned int pvr2_hdw_state_report(struct pvr2_hdw *hdw,
4849 				   char *buf,unsigned int acnt)
4850 {
4851 	unsigned int bcnt,ccnt,idx;
4852 	bcnt = 0;
4853 	LOCK_TAKE(hdw->big_lock);
4854 	for (idx = 0; ; idx++) {
4855 		ccnt = pvr2_hdw_report_unlocked(hdw,idx,buf,acnt);
4856 		if (!ccnt) break;
4857 		bcnt += ccnt; acnt -= ccnt; buf += ccnt;
4858 		if (!acnt) break;
4859 		buf[0] = '\n'; ccnt = 1;
4860 		bcnt += ccnt; acnt -= ccnt; buf += ccnt;
4861 	}
4862 	ccnt = pvr2_hdw_report_clients(hdw, buf, acnt);
4863 	bcnt += ccnt; acnt -= ccnt; buf += ccnt;
4864 	LOCK_GIVE(hdw->big_lock);
4865 	return bcnt;
4866 }
4867 
4868 
pvr2_hdw_state_log_state(struct pvr2_hdw * hdw)4869 static void pvr2_hdw_state_log_state(struct pvr2_hdw *hdw)
4870 {
4871 	char buf[256];
4872 	unsigned int idx, ccnt;
4873 	unsigned int lcnt, ucnt;
4874 
4875 	for (idx = 0; ; idx++) {
4876 		ccnt = pvr2_hdw_report_unlocked(hdw,idx,buf,sizeof(buf));
4877 		if (!ccnt) break;
4878 		pr_info("%s %.*s\n", hdw->name, ccnt, buf);
4879 	}
4880 	ccnt = pvr2_hdw_report_clients(hdw, buf, sizeof(buf));
4881 	if (ccnt >= sizeof(buf))
4882 		ccnt = sizeof(buf);
4883 
4884 	ucnt = 0;
4885 	while (ucnt < ccnt) {
4886 		lcnt = 0;
4887 		while ((lcnt + ucnt < ccnt) && (buf[lcnt + ucnt] != '\n')) {
4888 			lcnt++;
4889 		}
4890 		pr_info("%s %.*s\n", hdw->name, lcnt, buf + ucnt);
4891 		ucnt += lcnt + 1;
4892 	}
4893 }
4894 
4895 
4896 /* Evaluate and update the driver's current state, taking various actions
4897    as appropriate for the update. */
pvr2_hdw_state_eval(struct pvr2_hdw * hdw)4898 static int pvr2_hdw_state_eval(struct pvr2_hdw *hdw)
4899 {
4900 	unsigned int st;
4901 	int state_updated = 0;
4902 	int callback_flag = 0;
4903 	int analog_mode;
4904 
4905 	pvr2_trace(PVR2_TRACE_STBITS,
4906 		   "Drive state check START");
4907 	if (pvrusb2_debug & PVR2_TRACE_STBITS) {
4908 		pvr2_hdw_state_log_state(hdw);
4909 	}
4910 
4911 	/* Process all state and get back over disposition */
4912 	state_updated = pvr2_hdw_state_update(hdw);
4913 
4914 	analog_mode = (hdw->pathway_state != PVR2_PATHWAY_DIGITAL);
4915 
4916 	/* Update master state based upon all other states. */
4917 	if (!hdw->flag_ok) {
4918 		st = PVR2_STATE_DEAD;
4919 	} else if (hdw->fw1_state != FW1_STATE_OK) {
4920 		st = PVR2_STATE_COLD;
4921 	} else if ((analog_mode ||
4922 		    hdw->hdw_desc->flag_digital_requires_cx23416) &&
4923 		   !hdw->state_encoder_ok) {
4924 		st = PVR2_STATE_WARM;
4925 	} else if (hdw->flag_tripped ||
4926 		   (analog_mode && hdw->flag_decoder_missed)) {
4927 		st = PVR2_STATE_ERROR;
4928 	} else if (hdw->state_usbstream_run &&
4929 		   (!analog_mode ||
4930 		    (hdw->state_encoder_run && hdw->state_decoder_run))) {
4931 		st = PVR2_STATE_RUN;
4932 	} else {
4933 		st = PVR2_STATE_READY;
4934 	}
4935 	if (hdw->master_state != st) {
4936 		pvr2_trace(PVR2_TRACE_STATE,
4937 			   "Device state change from %s to %s",
4938 			   pvr2_get_state_name(hdw->master_state),
4939 			   pvr2_get_state_name(st));
4940 		pvr2_led_ctrl(hdw,st == PVR2_STATE_RUN);
4941 		hdw->master_state = st;
4942 		state_updated = !0;
4943 		callback_flag = !0;
4944 	}
4945 	if (state_updated) {
4946 		/* Trigger anyone waiting on any state changes here. */
4947 		wake_up(&hdw->state_wait_data);
4948 	}
4949 
4950 	if (pvrusb2_debug & PVR2_TRACE_STBITS) {
4951 		pvr2_hdw_state_log_state(hdw);
4952 	}
4953 	pvr2_trace(PVR2_TRACE_STBITS,
4954 		   "Drive state check DONE callback=%d",callback_flag);
4955 
4956 	return callback_flag;
4957 }
4958 
4959 
4960 /* Cause kernel thread to check / update driver state */
pvr2_hdw_state_sched(struct pvr2_hdw * hdw)4961 static void pvr2_hdw_state_sched(struct pvr2_hdw *hdw)
4962 {
4963 	if (hdw->state_stale) return;
4964 	hdw->state_stale = !0;
4965 	trace_stbit("state_stale",hdw->state_stale);
4966 	schedule_work(&hdw->workpoll);
4967 }
4968 
4969 
pvr2_hdw_gpio_get_dir(struct pvr2_hdw * hdw,u32 * dp)4970 int pvr2_hdw_gpio_get_dir(struct pvr2_hdw *hdw,u32 *dp)
4971 {
4972 	return pvr2_read_register(hdw,PVR2_GPIO_DIR,dp);
4973 }
4974 
4975 
pvr2_hdw_gpio_get_out(struct pvr2_hdw * hdw,u32 * dp)4976 int pvr2_hdw_gpio_get_out(struct pvr2_hdw *hdw,u32 *dp)
4977 {
4978 	return pvr2_read_register(hdw,PVR2_GPIO_OUT,dp);
4979 }
4980 
4981 
pvr2_hdw_gpio_get_in(struct pvr2_hdw * hdw,u32 * dp)4982 int pvr2_hdw_gpio_get_in(struct pvr2_hdw *hdw,u32 *dp)
4983 {
4984 	return pvr2_read_register(hdw,PVR2_GPIO_IN,dp);
4985 }
4986 
4987 
pvr2_hdw_gpio_chg_dir(struct pvr2_hdw * hdw,u32 msk,u32 val)4988 int pvr2_hdw_gpio_chg_dir(struct pvr2_hdw *hdw,u32 msk,u32 val)
4989 {
4990 	u32 cval,nval;
4991 	int ret;
4992 	if (~msk) {
4993 		ret = pvr2_read_register(hdw,PVR2_GPIO_DIR,&cval);
4994 		if (ret) return ret;
4995 		nval = (cval & ~msk) | (val & msk);
4996 		pvr2_trace(PVR2_TRACE_GPIO,
4997 			   "GPIO direction changing 0x%x:0x%x from 0x%x to 0x%x",
4998 			   msk,val,cval,nval);
4999 	} else {
5000 		nval = val;
5001 		pvr2_trace(PVR2_TRACE_GPIO,
5002 			   "GPIO direction changing to 0x%x",nval);
5003 	}
5004 	return pvr2_write_register(hdw,PVR2_GPIO_DIR,nval);
5005 }
5006 
5007 
pvr2_hdw_gpio_chg_out(struct pvr2_hdw * hdw,u32 msk,u32 val)5008 int pvr2_hdw_gpio_chg_out(struct pvr2_hdw *hdw,u32 msk,u32 val)
5009 {
5010 	u32 cval,nval;
5011 	int ret;
5012 	if (~msk) {
5013 		ret = pvr2_read_register(hdw,PVR2_GPIO_OUT,&cval);
5014 		if (ret) return ret;
5015 		nval = (cval & ~msk) | (val & msk);
5016 		pvr2_trace(PVR2_TRACE_GPIO,
5017 			   "GPIO output changing 0x%x:0x%x from 0x%x to 0x%x",
5018 			   msk,val,cval,nval);
5019 	} else {
5020 		nval = val;
5021 		pvr2_trace(PVR2_TRACE_GPIO,
5022 			   "GPIO output changing to 0x%x",nval);
5023 	}
5024 	return pvr2_write_register(hdw,PVR2_GPIO_OUT,nval);
5025 }
5026 
5027 
pvr2_hdw_status_poll(struct pvr2_hdw * hdw)5028 void pvr2_hdw_status_poll(struct pvr2_hdw *hdw)
5029 {
5030 	struct v4l2_tuner *vtp = &hdw->tuner_signal_info;
5031 	memset(vtp, 0, sizeof(*vtp));
5032 	vtp->type = (hdw->input_val == PVR2_CVAL_INPUT_RADIO) ?
5033 		V4L2_TUNER_RADIO : V4L2_TUNER_ANALOG_TV;
5034 	hdw->tuner_signal_stale = 0;
5035 	/* Note: There apparently is no replacement for VIDIOC_CROPCAP
5036 	   using v4l2-subdev - therefore we can't support that AT ALL right
5037 	   now.  (Of course, no sub-drivers seem to implement it either.
5038 	   But now it's a a chicken and egg problem...) */
5039 	v4l2_device_call_all(&hdw->v4l2_dev, 0, tuner, g_tuner, vtp);
5040 	pvr2_trace(PVR2_TRACE_CHIPS, "subdev status poll type=%u strength=%u audio=0x%x cap=0x%x low=%u hi=%u",
5041 		   vtp->type,
5042 		   vtp->signal, vtp->rxsubchans, vtp->capability,
5043 		   vtp->rangelow, vtp->rangehigh);
5044 
5045 	/* We have to do this to avoid getting into constant polling if
5046 	   there's nobody to answer a poll of cropcap info. */
5047 	hdw->cropcap_stale = 0;
5048 }
5049 
5050 
pvr2_hdw_get_input_available(struct pvr2_hdw * hdw)5051 unsigned int pvr2_hdw_get_input_available(struct pvr2_hdw *hdw)
5052 {
5053 	return hdw->input_avail_mask;
5054 }
5055 
5056 
pvr2_hdw_get_input_allowed(struct pvr2_hdw * hdw)5057 unsigned int pvr2_hdw_get_input_allowed(struct pvr2_hdw *hdw)
5058 {
5059 	return hdw->input_allowed_mask;
5060 }
5061 
5062 
pvr2_hdw_set_input(struct pvr2_hdw * hdw,int v)5063 static int pvr2_hdw_set_input(struct pvr2_hdw *hdw,int v)
5064 {
5065 	if (hdw->input_val != v) {
5066 		hdw->input_val = v;
5067 		hdw->input_dirty = !0;
5068 	}
5069 
5070 	/* Handle side effects - if we switch to a mode that needs the RF
5071 	   tuner, then select the right frequency choice as well and mark
5072 	   it dirty. */
5073 	if (hdw->input_val == PVR2_CVAL_INPUT_RADIO) {
5074 		hdw->freqSelector = 0;
5075 		hdw->freqDirty = !0;
5076 	} else if ((hdw->input_val == PVR2_CVAL_INPUT_TV) ||
5077 		   (hdw->input_val == PVR2_CVAL_INPUT_DTV)) {
5078 		hdw->freqSelector = 1;
5079 		hdw->freqDirty = !0;
5080 	}
5081 	return 0;
5082 }
5083 
5084 
pvr2_hdw_set_input_allowed(struct pvr2_hdw * hdw,unsigned int change_mask,unsigned int change_val)5085 int pvr2_hdw_set_input_allowed(struct pvr2_hdw *hdw,
5086 			       unsigned int change_mask,
5087 			       unsigned int change_val)
5088 {
5089 	int ret = 0;
5090 	unsigned int nv,m,idx;
5091 	LOCK_TAKE(hdw->big_lock);
5092 	do {
5093 		nv = hdw->input_allowed_mask & ~change_mask;
5094 		nv |= (change_val & change_mask);
5095 		nv &= hdw->input_avail_mask;
5096 		if (!nv) {
5097 			/* No legal modes left; return error instead. */
5098 			ret = -EPERM;
5099 			break;
5100 		}
5101 		hdw->input_allowed_mask = nv;
5102 		if ((1UL << hdw->input_val) & hdw->input_allowed_mask) {
5103 			/* Current mode is still in the allowed mask, so
5104 			   we're done. */
5105 			break;
5106 		}
5107 		/* Select and switch to a mode that is still in the allowed
5108 		   mask */
5109 		if (!hdw->input_allowed_mask) {
5110 			/* Nothing legal; give up */
5111 			break;
5112 		}
5113 		m = hdw->input_allowed_mask;
5114 		for (idx = 0; idx < (sizeof(m) << 3); idx++) {
5115 			if (!((1UL << idx) & m)) continue;
5116 			pvr2_hdw_set_input(hdw,idx);
5117 			break;
5118 		}
5119 	} while (0);
5120 	LOCK_GIVE(hdw->big_lock);
5121 	return ret;
5122 }
5123 
5124 
5125 /* Find I2C address of eeprom */
pvr2_hdw_get_eeprom_addr(struct pvr2_hdw * hdw)5126 static int pvr2_hdw_get_eeprom_addr(struct pvr2_hdw *hdw)
5127 {
5128 	int result;
5129 	LOCK_TAKE(hdw->ctl_lock); do {
5130 		hdw->cmd_buffer[0] = FX2CMD_GET_EEPROM_ADDR;
5131 		result = pvr2_send_request(hdw,
5132 					   hdw->cmd_buffer,1,
5133 					   hdw->cmd_buffer,1);
5134 		if (result < 0) break;
5135 		result = hdw->cmd_buffer[0];
5136 	} while(0); LOCK_GIVE(hdw->ctl_lock);
5137 	return result;
5138 }
5139