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