blob: b8a2d332c6d01dd06cdc4d8ca868091fa057ca4a [file] [log] [blame]
Mike Iselyd8554972006-06-26 20:58:46 -03001/*
2 *
Mike Iselyd8554972006-06-26 20:58:46 -03003 *
4 * Copyright (C) 2005 Mike Isely <isely@pobox.com>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
18 *
19 */
20
21#include <linux/errno.h>
22#include <linux/string.h>
23#include <linux/slab.h>
24#include <linux/firmware.h>
Mike Iselyd8554972006-06-26 20:58:46 -030025#include <linux/videodev2.h>
Mike Isely32ffa9a2006-09-23 22:26:52 -030026#include <media/v4l2-common.h>
Mike Isely75212a02009-03-07 01:48:42 -030027#include <media/tuner.h>
Mike Iselyd8554972006-06-26 20:58:46 -030028#include "pvrusb2.h"
29#include "pvrusb2-std.h"
30#include "pvrusb2-util.h"
31#include "pvrusb2-hdw.h"
32#include "pvrusb2-i2c-core.h"
Mike Iselyd8554972006-06-26 20:58:46 -030033#include "pvrusb2-eeprom.h"
34#include "pvrusb2-hdw-internal.h"
35#include "pvrusb2-encoder.h"
36#include "pvrusb2-debug.h"
Michael Krufky8d364362007-01-22 02:17:55 -030037#include "pvrusb2-fx2-cmd.h"
Mike Isely5f6dae82009-03-07 00:39:34 -030038#include "pvrusb2-wm8775.h"
Mike Isely6f956512009-03-07 00:43:26 -030039#include "pvrusb2-video-v4l.h"
Mike Isely634ba262009-03-07 00:54:02 -030040#include "pvrusb2-cx2584x-v4l.h"
Mike Isely76891d62009-03-07 00:52:06 -030041#include "pvrusb2-audio.h"
Mike Iselyd8554972006-06-26 20:58:46 -030042
Mike Isely1bde0282006-12-27 23:30:13 -030043#define TV_MIN_FREQ 55250000L
44#define TV_MAX_FREQ 850000000L
Pantelis Koukousoulas25d85272006-12-27 23:06:04 -030045
Mike Isely83ce57a2008-05-26 05:51:57 -030046/* This defines a minimum interval that the decoder must remain quiet
47 before we are allowed to start it running. */
48#define TIME_MSEC_DECODER_WAIT 50
49
50/* This defines a minimum interval that the encoder must remain quiet
Mike Iselyfa98e592008-05-26 05:54:24 -030051 before we are allowed to configure it. I had this originally set to
52 50msec, but Martin Dauskardt <martin.dauskardt@gmx.de> reports that
53 things work better when it's set to 100msec. */
54#define TIME_MSEC_ENCODER_WAIT 100
Mike Isely83ce57a2008-05-26 05:51:57 -030055
56/* This defines the minimum interval that the encoder must successfully run
57 before we consider that the encoder has run at least once since its
58 firmware has been loaded. This measurement is in important for cases
59 where we can't do something until we know that the encoder has been run
60 at least once. */
61#define TIME_MSEC_ENCODER_OK 250
62
Mike Iselya0fd1cb2006-06-30 11:35:28 -030063static struct pvr2_hdw *unit_pointers[PVR_NUM] = {[ 0 ... PVR_NUM-1 ] = NULL};
Matthias Kaehlcke8df0c872007-04-28 20:00:18 -030064static DEFINE_MUTEX(pvr2_unit_mtx);
Mike Iselyd8554972006-06-26 20:58:46 -030065
Douglas Schilling Landgrafff699e62008-04-22 14:41:48 -030066static int ctlchg;
Douglas Schilling Landgrafff699e62008-04-22 14:41:48 -030067static int procreload;
Mike Iselyd8554972006-06-26 20:58:46 -030068static int tuner[PVR_NUM] = { [0 ... PVR_NUM-1] = -1 };
69static int tolerance[PVR_NUM] = { [0 ... PVR_NUM-1] = 0 };
70static int video_std[PVR_NUM] = { [0 ... PVR_NUM-1] = 0 };
Douglas Schilling Landgrafff699e62008-04-22 14:41:48 -030071static int init_pause_msec;
Mike Iselyd8554972006-06-26 20:58:46 -030072
73module_param(ctlchg, int, S_IRUGO|S_IWUSR);
74MODULE_PARM_DESC(ctlchg, "0=optimize ctl change 1=always accept new ctl value");
75module_param(init_pause_msec, int, S_IRUGO|S_IWUSR);
76MODULE_PARM_DESC(init_pause_msec, "hardware initialization settling delay");
Mike Iselyd8554972006-06-26 20:58:46 -030077module_param(procreload, int, S_IRUGO|S_IWUSR);
78MODULE_PARM_DESC(procreload,
79 "Attempt init failure recovery with firmware reload");
80module_param_array(tuner, int, NULL, 0444);
81MODULE_PARM_DESC(tuner,"specify installed tuner type");
82module_param_array(video_std, int, NULL, 0444);
83MODULE_PARM_DESC(video_std,"specify initial video standard");
84module_param_array(tolerance, int, NULL, 0444);
85MODULE_PARM_DESC(tolerance,"specify stream error tolerance");
86
Michael Krufky5a4f5da62008-05-11 16:37:50 -030087/* US Broadcast channel 7 (175.25 MHz) */
88static int default_tv_freq = 175250000L;
89/* 104.3 MHz, a usable FM station for my area */
90static int default_radio_freq = 104300000L;
91
92module_param_named(tv_freq, default_tv_freq, int, 0444);
93MODULE_PARM_DESC(tv_freq, "specify initial television frequency");
94module_param_named(radio_freq, default_radio_freq, int, 0444);
95MODULE_PARM_DESC(radio_freq, "specify initial radio frequency");
96
Mike Iselyd8554972006-06-26 20:58:46 -030097#define PVR2_CTL_WRITE_ENDPOINT 0x01
98#define PVR2_CTL_READ_ENDPOINT 0x81
99
100#define PVR2_GPIO_IN 0x9008
101#define PVR2_GPIO_OUT 0x900c
102#define PVR2_GPIO_DIR 0x9020
103
104#define trace_firmware(...) pvr2_trace(PVR2_TRACE_FIRMWARE,__VA_ARGS__)
105
106#define PVR2_FIRMWARE_ENDPOINT 0x02
107
108/* size of a firmware chunk */
109#define FIRMWARE_CHUNK_SIZE 0x2000
110
Mike Iselyedb9dcb2009-03-07 00:37:10 -0300111typedef void (*pvr2_subdev_update_func)(struct pvr2_hdw *,
112 struct v4l2_subdev *);
113
114static const pvr2_subdev_update_func pvr2_module_update_functions[] = {
Mike Isely4ecbc282009-03-07 00:49:19 -0300115 [PVR2_CLIENT_ID_WM8775] = pvr2_wm8775_subdev_update,
Mike Isely6f956512009-03-07 00:43:26 -0300116 [PVR2_CLIENT_ID_SAA7115] = pvr2_saa7115_subdev_update,
Mike Isely76891d62009-03-07 00:52:06 -0300117 [PVR2_CLIENT_ID_MSP3400] = pvr2_msp3400_subdev_update,
Mike Isely634ba262009-03-07 00:54:02 -0300118 [PVR2_CLIENT_ID_CX25840] = pvr2_cx25840_subdev_update,
Mike Iselyedb9dcb2009-03-07 00:37:10 -0300119};
120
Mike Iselye9c64a72009-03-06 23:42:20 -0300121static const char *module_names[] = {
122 [PVR2_CLIENT_ID_MSP3400] = "msp3400",
123 [PVR2_CLIENT_ID_CX25840] = "cx25840",
124 [PVR2_CLIENT_ID_SAA7115] = "saa7115",
125 [PVR2_CLIENT_ID_TUNER] = "tuner",
Mike Iselybb652422009-03-14 14:09:04 -0300126 [PVR2_CLIENT_ID_DEMOD] = "tuner",
Mike Isely851981a2009-03-07 02:02:32 -0300127 [PVR2_CLIENT_ID_CS53L32A] = "cs53l32a",
Mike Isely5f6dae82009-03-07 00:39:34 -0300128 [PVR2_CLIENT_ID_WM8775] = "wm8775",
Mike Iselye9c64a72009-03-06 23:42:20 -0300129};
130
131
132static const unsigned char *module_i2c_addresses[] = {
133 [PVR2_CLIENT_ID_TUNER] = "\x60\x61\x62\x63",
Mike Iselybb652422009-03-14 14:09:04 -0300134 [PVR2_CLIENT_ID_DEMOD] = "\x43",
Mike Isely1dfe6c72009-03-07 02:00:21 -0300135 [PVR2_CLIENT_ID_MSP3400] = "\x40",
136 [PVR2_CLIENT_ID_SAA7115] = "\x21",
Mike Iselyae111f72009-03-07 00:57:42 -0300137 [PVR2_CLIENT_ID_WM8775] = "\x1b",
Mike Isely0b467012009-03-07 01:49:37 -0300138 [PVR2_CLIENT_ID_CX25840] = "\x44",
Mike Isely23334a22009-03-07 02:03:28 -0300139 [PVR2_CLIENT_ID_CS53L32A] = "\x11",
Mike Iselye9c64a72009-03-06 23:42:20 -0300140};
141
142
Mike Iselyb30d2442006-06-25 20:05:01 -0300143/* Define the list of additional controls we'll dynamically construct based
144 on query of the cx2341x module. */
145struct pvr2_mpeg_ids {
146 const char *strid;
147 int id;
148};
149static const struct pvr2_mpeg_ids mpeg_ids[] = {
150 {
151 .strid = "audio_layer",
152 .id = V4L2_CID_MPEG_AUDIO_ENCODING,
153 },{
154 .strid = "audio_bitrate",
155 .id = V4L2_CID_MPEG_AUDIO_L2_BITRATE,
156 },{
157 /* Already using audio_mode elsewhere :-( */
158 .strid = "mpeg_audio_mode",
159 .id = V4L2_CID_MPEG_AUDIO_MODE,
160 },{
161 .strid = "mpeg_audio_mode_extension",
162 .id = V4L2_CID_MPEG_AUDIO_MODE_EXTENSION,
163 },{
164 .strid = "audio_emphasis",
165 .id = V4L2_CID_MPEG_AUDIO_EMPHASIS,
166 },{
167 .strid = "audio_crc",
168 .id = V4L2_CID_MPEG_AUDIO_CRC,
169 },{
170 .strid = "video_aspect",
171 .id = V4L2_CID_MPEG_VIDEO_ASPECT,
172 },{
173 .strid = "video_b_frames",
174 .id = V4L2_CID_MPEG_VIDEO_B_FRAMES,
175 },{
176 .strid = "video_gop_size",
177 .id = V4L2_CID_MPEG_VIDEO_GOP_SIZE,
178 },{
179 .strid = "video_gop_closure",
180 .id = V4L2_CID_MPEG_VIDEO_GOP_CLOSURE,
181 },{
Mike Iselyb30d2442006-06-25 20:05:01 -0300182 .strid = "video_bitrate_mode",
183 .id = V4L2_CID_MPEG_VIDEO_BITRATE_MODE,
184 },{
185 .strid = "video_bitrate",
186 .id = V4L2_CID_MPEG_VIDEO_BITRATE,
187 },{
188 .strid = "video_bitrate_peak",
189 .id = V4L2_CID_MPEG_VIDEO_BITRATE_PEAK,
190 },{
191 .strid = "video_temporal_decimation",
192 .id = V4L2_CID_MPEG_VIDEO_TEMPORAL_DECIMATION,
193 },{
194 .strid = "stream_type",
195 .id = V4L2_CID_MPEG_STREAM_TYPE,
196 },{
197 .strid = "video_spatial_filter_mode",
198 .id = V4L2_CID_MPEG_CX2341X_VIDEO_SPATIAL_FILTER_MODE,
199 },{
200 .strid = "video_spatial_filter",
201 .id = V4L2_CID_MPEG_CX2341X_VIDEO_SPATIAL_FILTER,
202 },{
203 .strid = "video_luma_spatial_filter_type",
204 .id = V4L2_CID_MPEG_CX2341X_VIDEO_LUMA_SPATIAL_FILTER_TYPE,
205 },{
206 .strid = "video_chroma_spatial_filter_type",
207 .id = V4L2_CID_MPEG_CX2341X_VIDEO_CHROMA_SPATIAL_FILTER_TYPE,
208 },{
209 .strid = "video_temporal_filter_mode",
210 .id = V4L2_CID_MPEG_CX2341X_VIDEO_TEMPORAL_FILTER_MODE,
211 },{
212 .strid = "video_temporal_filter",
213 .id = V4L2_CID_MPEG_CX2341X_VIDEO_TEMPORAL_FILTER,
214 },{
215 .strid = "video_median_filter_type",
216 .id = V4L2_CID_MPEG_CX2341X_VIDEO_MEDIAN_FILTER_TYPE,
217 },{
218 .strid = "video_luma_median_filter_top",
219 .id = V4L2_CID_MPEG_CX2341X_VIDEO_LUMA_MEDIAN_FILTER_TOP,
220 },{
221 .strid = "video_luma_median_filter_bottom",
222 .id = V4L2_CID_MPEG_CX2341X_VIDEO_LUMA_MEDIAN_FILTER_BOTTOM,
223 },{
224 .strid = "video_chroma_median_filter_top",
225 .id = V4L2_CID_MPEG_CX2341X_VIDEO_CHROMA_MEDIAN_FILTER_TOP,
226 },{
227 .strid = "video_chroma_median_filter_bottom",
228 .id = V4L2_CID_MPEG_CX2341X_VIDEO_CHROMA_MEDIAN_FILTER_BOTTOM,
229 }
230};
Ahmed S. Darwisheca8ebf2007-01-20 00:35:03 -0300231#define MPEGDEF_COUNT ARRAY_SIZE(mpeg_ids)
Mike Iselyc05c0462006-06-25 20:04:25 -0300232
Mike Iselyd8554972006-06-26 20:58:46 -0300233
Mike Isely434449f2006-08-08 09:10:06 -0300234static const char *control_values_srate[] = {
235 [V4L2_MPEG_AUDIO_SAMPLING_FREQ_44100] = "44.1 kHz",
236 [V4L2_MPEG_AUDIO_SAMPLING_FREQ_48000] = "48 kHz",
237 [V4L2_MPEG_AUDIO_SAMPLING_FREQ_32000] = "32 kHz",
238};
Mike Iselyd8554972006-06-26 20:58:46 -0300239
Mike Iselyd8554972006-06-26 20:58:46 -0300240
241
242static const char *control_values_input[] = {
243 [PVR2_CVAL_INPUT_TV] = "television", /*xawtv needs this name*/
Mike Isely29bf5b12008-04-22 14:45:37 -0300244 [PVR2_CVAL_INPUT_DTV] = "dtv",
Mike Iselyd8554972006-06-26 20:58:46 -0300245 [PVR2_CVAL_INPUT_RADIO] = "radio",
246 [PVR2_CVAL_INPUT_SVIDEO] = "s-video",
247 [PVR2_CVAL_INPUT_COMPOSITE] = "composite",
248};
249
250
251static const char *control_values_audiomode[] = {
252 [V4L2_TUNER_MODE_MONO] = "Mono",
253 [V4L2_TUNER_MODE_STEREO] = "Stereo",
254 [V4L2_TUNER_MODE_LANG1] = "Lang1",
255 [V4L2_TUNER_MODE_LANG2] = "Lang2",
256 [V4L2_TUNER_MODE_LANG1_LANG2] = "Lang1+Lang2",
257};
258
259
260static const char *control_values_hsm[] = {
261 [PVR2_CVAL_HSM_FAIL] = "Fail",
262 [PVR2_CVAL_HSM_HIGH] = "High",
263 [PVR2_CVAL_HSM_FULL] = "Full",
264};
265
266
Mike Isely681c7392007-11-26 01:48:52 -0300267static const char *pvr2_state_names[] = {
268 [PVR2_STATE_NONE] = "none",
269 [PVR2_STATE_DEAD] = "dead",
270 [PVR2_STATE_COLD] = "cold",
271 [PVR2_STATE_WARM] = "warm",
272 [PVR2_STATE_ERROR] = "error",
273 [PVR2_STATE_READY] = "ready",
274 [PVR2_STATE_RUN] = "run",
Mike Iselyd8554972006-06-26 20:58:46 -0300275};
276
Mike Isely681c7392007-11-26 01:48:52 -0300277
Mike Isely694dca2b2008-03-28 05:42:10 -0300278struct pvr2_fx2cmd_descdef {
Mike Isely1c9d10d2008-03-28 05:38:54 -0300279 unsigned char id;
280 unsigned char *desc;
281};
282
Mike Isely694dca2b2008-03-28 05:42:10 -0300283static const struct pvr2_fx2cmd_descdef pvr2_fx2cmd_desc[] = {
Mike Isely1c9d10d2008-03-28 05:38:54 -0300284 {FX2CMD_MEM_WRITE_DWORD, "write encoder dword"},
285 {FX2CMD_MEM_READ_DWORD, "read encoder dword"},
Mike Isely31335b12008-07-25 19:35:31 -0300286 {FX2CMD_HCW_ZILOG_RESET, "zilog IR reset control"},
Mike Isely1c9d10d2008-03-28 05:38:54 -0300287 {FX2CMD_MEM_READ_64BYTES, "read encoder 64bytes"},
288 {FX2CMD_REG_WRITE, "write encoder register"},
289 {FX2CMD_REG_READ, "read encoder register"},
290 {FX2CMD_MEMSEL, "encoder memsel"},
291 {FX2CMD_I2C_WRITE, "i2c write"},
292 {FX2CMD_I2C_READ, "i2c read"},
293 {FX2CMD_GET_USB_SPEED, "get USB speed"},
294 {FX2CMD_STREAMING_ON, "stream on"},
295 {FX2CMD_STREAMING_OFF, "stream off"},
296 {FX2CMD_FWPOST1, "fwpost1"},
297 {FX2CMD_POWER_OFF, "power off"},
298 {FX2CMD_POWER_ON, "power on"},
299 {FX2CMD_DEEP_RESET, "deep reset"},
300 {FX2CMD_GET_EEPROM_ADDR, "get rom addr"},
301 {FX2CMD_GET_IR_CODE, "get IR code"},
302 {FX2CMD_HCW_DEMOD_RESETIN, "hcw demod resetin"},
303 {FX2CMD_HCW_DTV_STREAMING_ON, "hcw dtv stream on"},
304 {FX2CMD_HCW_DTV_STREAMING_OFF, "hcw dtv stream off"},
305 {FX2CMD_ONAIR_DTV_STREAMING_ON, "onair dtv stream on"},
306 {FX2CMD_ONAIR_DTV_STREAMING_OFF, "onair dtv stream off"},
307 {FX2CMD_ONAIR_DTV_POWER_ON, "onair dtv power on"},
308 {FX2CMD_ONAIR_DTV_POWER_OFF, "onair dtv power off"},
309};
310
311
Mike Isely1cb03b72008-04-21 03:47:43 -0300312static int pvr2_hdw_set_input(struct pvr2_hdw *hdw,int v);
Mike Isely681c7392007-11-26 01:48:52 -0300313static void pvr2_hdw_state_sched(struct pvr2_hdw *);
314static int pvr2_hdw_state_eval(struct pvr2_hdw *);
Mike Isely1bde0282006-12-27 23:30:13 -0300315static void pvr2_hdw_set_cur_freq(struct pvr2_hdw *,unsigned long);
Mike Isely681c7392007-11-26 01:48:52 -0300316static void pvr2_hdw_worker_poll(struct work_struct *work);
Mike Isely681c7392007-11-26 01:48:52 -0300317static int pvr2_hdw_wait(struct pvr2_hdw *,int state);
318static int pvr2_hdw_untrip_unlocked(struct pvr2_hdw *);
319static void pvr2_hdw_state_log_state(struct pvr2_hdw *);
Adrian Bunk07e337e2006-06-30 11:30:20 -0300320static int pvr2_hdw_cmd_usbstream(struct pvr2_hdw *hdw,int runFl);
Mike Isely681c7392007-11-26 01:48:52 -0300321static int pvr2_hdw_commit_setup(struct pvr2_hdw *hdw);
Adrian Bunk07e337e2006-06-30 11:30:20 -0300322static int pvr2_hdw_get_eeprom_addr(struct pvr2_hdw *hdw);
Adrian Bunk07e337e2006-06-30 11:30:20 -0300323static void pvr2_hdw_internal_find_stdenum(struct pvr2_hdw *hdw);
324static void pvr2_hdw_internal_set_std_avail(struct pvr2_hdw *hdw);
Mike Isely681c7392007-11-26 01:48:52 -0300325static void pvr2_hdw_quiescent_timeout(unsigned long);
326static void pvr2_hdw_encoder_wait_timeout(unsigned long);
Mike Iselyd913d632008-04-06 04:04:35 -0300327static void pvr2_hdw_encoder_run_timeout(unsigned long);
Mike Isely1c9d10d2008-03-28 05:38:54 -0300328static int pvr2_issue_simple_cmd(struct pvr2_hdw *,u32);
Adrian Bunk07e337e2006-06-30 11:30:20 -0300329static int pvr2_send_request_ex(struct pvr2_hdw *hdw,
330 unsigned int timeout,int probe_fl,
331 void *write_data,unsigned int write_len,
332 void *read_data,unsigned int read_len);
Mike Isely432907f2008-08-31 21:02:20 -0300333static int pvr2_hdw_check_cropcap(struct pvr2_hdw *hdw);
Mike Iselyd8554972006-06-26 20:58:46 -0300334
Mike Isely681c7392007-11-26 01:48:52 -0300335
336static void trace_stbit(const char *name,int val)
337{
338 pvr2_trace(PVR2_TRACE_STBITS,
339 "State bit %s <-- %s",
340 name,(val ? "true" : "false"));
341}
342
Mike Iselyd8554972006-06-26 20:58:46 -0300343static int ctrl_channelfreq_get(struct pvr2_ctrl *cptr,int *vp)
344{
345 struct pvr2_hdw *hdw = cptr->hdw;
346 if ((hdw->freqProgSlot > 0) && (hdw->freqProgSlot <= FREQTABLE_SIZE)) {
347 *vp = hdw->freqTable[hdw->freqProgSlot-1];
348 } else {
349 *vp = 0;
350 }
351 return 0;
352}
353
354static int ctrl_channelfreq_set(struct pvr2_ctrl *cptr,int m,int v)
355{
356 struct pvr2_hdw *hdw = cptr->hdw;
Mike Isely1bde0282006-12-27 23:30:13 -0300357 unsigned int slotId = hdw->freqProgSlot;
358 if ((slotId > 0) && (slotId <= FREQTABLE_SIZE)) {
359 hdw->freqTable[slotId-1] = v;
360 /* Handle side effects correctly - if we're tuned to this
361 slot, then forgot the slot id relation since the stored
362 frequency has been changed. */
363 if (hdw->freqSelector) {
364 if (hdw->freqSlotRadio == slotId) {
365 hdw->freqSlotRadio = 0;
366 }
367 } else {
368 if (hdw->freqSlotTelevision == slotId) {
369 hdw->freqSlotTelevision = 0;
370 }
371 }
Mike Iselyd8554972006-06-26 20:58:46 -0300372 }
373 return 0;
374}
375
376static int ctrl_channelprog_get(struct pvr2_ctrl *cptr,int *vp)
377{
378 *vp = cptr->hdw->freqProgSlot;
379 return 0;
380}
381
382static int ctrl_channelprog_set(struct pvr2_ctrl *cptr,int m,int v)
383{
384 struct pvr2_hdw *hdw = cptr->hdw;
385 if ((v >= 0) && (v <= FREQTABLE_SIZE)) {
386 hdw->freqProgSlot = v;
387 }
388 return 0;
389}
390
391static int ctrl_channel_get(struct pvr2_ctrl *cptr,int *vp)
392{
Mike Isely1bde0282006-12-27 23:30:13 -0300393 struct pvr2_hdw *hdw = cptr->hdw;
394 *vp = hdw->freqSelector ? hdw->freqSlotRadio : hdw->freqSlotTelevision;
Mike Iselyd8554972006-06-26 20:58:46 -0300395 return 0;
396}
397
Mike Isely1bde0282006-12-27 23:30:13 -0300398static int ctrl_channel_set(struct pvr2_ctrl *cptr,int m,int slotId)
Mike Iselyd8554972006-06-26 20:58:46 -0300399{
400 unsigned freq = 0;
401 struct pvr2_hdw *hdw = cptr->hdw;
Mike Isely1bde0282006-12-27 23:30:13 -0300402 if ((slotId < 0) || (slotId > FREQTABLE_SIZE)) return 0;
403 if (slotId > 0) {
404 freq = hdw->freqTable[slotId-1];
405 if (!freq) return 0;
406 pvr2_hdw_set_cur_freq(hdw,freq);
Mike Iselyd8554972006-06-26 20:58:46 -0300407 }
Mike Isely1bde0282006-12-27 23:30:13 -0300408 if (hdw->freqSelector) {
409 hdw->freqSlotRadio = slotId;
410 } else {
411 hdw->freqSlotTelevision = slotId;
Mike Iselyd8554972006-06-26 20:58:46 -0300412 }
413 return 0;
414}
415
416static int ctrl_freq_get(struct pvr2_ctrl *cptr,int *vp)
417{
Mike Isely1bde0282006-12-27 23:30:13 -0300418 *vp = pvr2_hdw_get_cur_freq(cptr->hdw);
Mike Iselyd8554972006-06-26 20:58:46 -0300419 return 0;
420}
421
422static int ctrl_freq_is_dirty(struct pvr2_ctrl *cptr)
423{
424 return cptr->hdw->freqDirty != 0;
425}
426
427static void ctrl_freq_clear_dirty(struct pvr2_ctrl *cptr)
428{
429 cptr->hdw->freqDirty = 0;
430}
431
432static int ctrl_freq_set(struct pvr2_ctrl *cptr,int m,int v)
433{
Mike Isely1bde0282006-12-27 23:30:13 -0300434 pvr2_hdw_set_cur_freq(cptr->hdw,v);
Mike Iselyd8554972006-06-26 20:58:46 -0300435 return 0;
436}
437
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -0300438static int ctrl_cropl_min_get(struct pvr2_ctrl *cptr, int *left)
439{
Mike Isely432907f2008-08-31 21:02:20 -0300440 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
441 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
442 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300443 return stat;
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -0300444 }
Mike Isely432907f2008-08-31 21:02:20 -0300445 *left = cap->bounds.left;
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -0300446 return 0;
447}
448
449static int ctrl_cropl_max_get(struct pvr2_ctrl *cptr, int *left)
450{
Mike Isely432907f2008-08-31 21:02:20 -0300451 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
452 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
453 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300454 return stat;
455 }
456 *left = cap->bounds.left;
457 if (cap->bounds.width > cptr->hdw->cropw_val) {
Mike Isely432907f2008-08-31 21:02:20 -0300458 *left += cap->bounds.width - cptr->hdw->cropw_val;
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -0300459 }
460 return 0;
461}
462
463static int ctrl_cropt_min_get(struct pvr2_ctrl *cptr, int *top)
464{
Mike Isely432907f2008-08-31 21:02:20 -0300465 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
466 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
467 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300468 return stat;
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -0300469 }
Mike Isely432907f2008-08-31 21:02:20 -0300470 *top = cap->bounds.top;
471 return 0;
472}
473
474static int ctrl_cropt_max_get(struct pvr2_ctrl *cptr, int *top)
475{
476 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
477 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
478 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300479 return stat;
480 }
481 *top = cap->bounds.top;
482 if (cap->bounds.height > cptr->hdw->croph_val) {
Mike Isely432907f2008-08-31 21:02:20 -0300483 *top += cap->bounds.height - cptr->hdw->croph_val;
484 }
485 return 0;
486}
487
488static int ctrl_cropw_max_get(struct pvr2_ctrl *cptr, int *val)
489{
490 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
491 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
492 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300493 return stat;
494 }
495 *val = 0;
496 if (cap->bounds.width > cptr->hdw->cropl_val) {
Mike Isely432907f2008-08-31 21:02:20 -0300497 *val = cap->bounds.width - cptr->hdw->cropl_val;
498 }
499 return 0;
500}
501
502static int ctrl_croph_max_get(struct pvr2_ctrl *cptr, int *val)
503{
504 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
505 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
506 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300507 return stat;
508 }
509 *val = 0;
510 if (cap->bounds.height > cptr->hdw->cropt_val) {
Mike Isely432907f2008-08-31 21:02:20 -0300511 *val = cap->bounds.height - cptr->hdw->cropt_val;
512 }
513 return 0;
514}
515
516static int ctrl_get_cropcapbl(struct pvr2_ctrl *cptr, int *val)
517{
518 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
519 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
520 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300521 return stat;
522 }
523 *val = cap->bounds.left;
524 return 0;
525}
526
527static int ctrl_get_cropcapbt(struct pvr2_ctrl *cptr, int *val)
528{
529 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
530 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
531 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300532 return stat;
533 }
534 *val = cap->bounds.top;
535 return 0;
536}
537
538static int ctrl_get_cropcapbw(struct pvr2_ctrl *cptr, int *val)
539{
540 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
541 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
542 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300543 return stat;
544 }
545 *val = cap->bounds.width;
546 return 0;
547}
548
549static int ctrl_get_cropcapbh(struct pvr2_ctrl *cptr, int *val)
550{
551 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
552 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
553 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300554 return stat;
555 }
556 *val = cap->bounds.height;
557 return 0;
558}
559
560static int ctrl_get_cropcapdl(struct pvr2_ctrl *cptr, int *val)
561{
562 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
563 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
564 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300565 return stat;
566 }
567 *val = cap->defrect.left;
568 return 0;
569}
570
571static int ctrl_get_cropcapdt(struct pvr2_ctrl *cptr, int *val)
572{
573 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
574 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
575 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300576 return stat;
577 }
578 *val = cap->defrect.top;
579 return 0;
580}
581
582static int ctrl_get_cropcapdw(struct pvr2_ctrl *cptr, int *val)
583{
584 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
585 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
586 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300587 return stat;
588 }
589 *val = cap->defrect.width;
590 return 0;
591}
592
593static int ctrl_get_cropcapdh(struct pvr2_ctrl *cptr, int *val)
594{
595 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
596 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
597 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300598 return stat;
599 }
600 *val = cap->defrect.height;
601 return 0;
602}
603
604static int ctrl_get_cropcappan(struct pvr2_ctrl *cptr, int *val)
605{
606 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
607 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
608 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300609 return stat;
610 }
611 *val = cap->pixelaspect.numerator;
612 return 0;
613}
614
615static int ctrl_get_cropcappad(struct pvr2_ctrl *cptr, int *val)
616{
617 struct v4l2_cropcap *cap = &cptr->hdw->cropcap_info;
618 int stat = pvr2_hdw_check_cropcap(cptr->hdw);
619 if (stat != 0) {
Mike Isely432907f2008-08-31 21:02:20 -0300620 return stat;
621 }
622 *val = cap->pixelaspect.denominator;
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -0300623 return 0;
624}
625
Mike Isely3ad9fc32006-09-02 22:37:52 -0300626static int ctrl_vres_max_get(struct pvr2_ctrl *cptr,int *vp)
627{
628 /* Actual maximum depends on the video standard in effect. */
629 if (cptr->hdw->std_mask_cur & V4L2_STD_525_60) {
630 *vp = 480;
631 } else {
632 *vp = 576;
633 }
634 return 0;
635}
636
637static int ctrl_vres_min_get(struct pvr2_ctrl *cptr,int *vp)
638{
Mike Isely989eb152007-11-26 01:53:12 -0300639 /* Actual minimum depends on device digitizer type. */
640 if (cptr->hdw->hdw_desc->flag_has_cx25840) {
Mike Isely3ad9fc32006-09-02 22:37:52 -0300641 *vp = 75;
642 } else {
643 *vp = 17;
644 }
645 return 0;
646}
647
Mike Isely1bde0282006-12-27 23:30:13 -0300648static int ctrl_get_input(struct pvr2_ctrl *cptr,int *vp)
649{
650 *vp = cptr->hdw->input_val;
651 return 0;
652}
653
Mike Isely29bf5b12008-04-22 14:45:37 -0300654static int ctrl_check_input(struct pvr2_ctrl *cptr,int v)
655{
Mike Isely1cb03b72008-04-21 03:47:43 -0300656 return ((1 << v) & cptr->hdw->input_allowed_mask) != 0;
Mike Isely29bf5b12008-04-22 14:45:37 -0300657}
658
Mike Isely1bde0282006-12-27 23:30:13 -0300659static int ctrl_set_input(struct pvr2_ctrl *cptr,int m,int v)
660{
Mike Isely1cb03b72008-04-21 03:47:43 -0300661 return pvr2_hdw_set_input(cptr->hdw,v);
Mike Isely1bde0282006-12-27 23:30:13 -0300662}
663
664static int ctrl_isdirty_input(struct pvr2_ctrl *cptr)
665{
666 return cptr->hdw->input_dirty != 0;
667}
668
669static void ctrl_cleardirty_input(struct pvr2_ctrl *cptr)
670{
671 cptr->hdw->input_dirty = 0;
672}
673
Mike Isely5549f542006-12-27 23:28:54 -0300674
Pantelis Koukousoulas25d85272006-12-27 23:06:04 -0300675static int ctrl_freq_max_get(struct pvr2_ctrl *cptr, int *vp)
676{
Mike Isely644afdb2007-01-20 00:19:23 -0300677 unsigned long fv;
678 struct pvr2_hdw *hdw = cptr->hdw;
679 if (hdw->tuner_signal_stale) {
Mike Iselya51f5002009-03-06 23:30:37 -0300680 pvr2_hdw_status_poll(hdw);
Pantelis Koukousoulas25d85272006-12-27 23:06:04 -0300681 }
Mike Isely644afdb2007-01-20 00:19:23 -0300682 fv = hdw->tuner_signal_info.rangehigh;
683 if (!fv) {
684 /* Safety fallback */
685 *vp = TV_MAX_FREQ;
686 return 0;
687 }
688 if (hdw->tuner_signal_info.capability & V4L2_TUNER_CAP_LOW) {
689 fv = (fv * 125) / 2;
690 } else {
691 fv = fv * 62500;
692 }
693 *vp = fv;
Pantelis Koukousoulas25d85272006-12-27 23:06:04 -0300694 return 0;
695}
696
697static int ctrl_freq_min_get(struct pvr2_ctrl *cptr, int *vp)
698{
Mike Isely644afdb2007-01-20 00:19:23 -0300699 unsigned long fv;
700 struct pvr2_hdw *hdw = cptr->hdw;
701 if (hdw->tuner_signal_stale) {
Mike Iselya51f5002009-03-06 23:30:37 -0300702 pvr2_hdw_status_poll(hdw);
Pantelis Koukousoulas25d85272006-12-27 23:06:04 -0300703 }
Mike Isely644afdb2007-01-20 00:19:23 -0300704 fv = hdw->tuner_signal_info.rangelow;
705 if (!fv) {
706 /* Safety fallback */
707 *vp = TV_MIN_FREQ;
708 return 0;
709 }
710 if (hdw->tuner_signal_info.capability & V4L2_TUNER_CAP_LOW) {
711 fv = (fv * 125) / 2;
712 } else {
713 fv = fv * 62500;
714 }
715 *vp = fv;
Pantelis Koukousoulas25d85272006-12-27 23:06:04 -0300716 return 0;
717}
718
Mike Iselyb30d2442006-06-25 20:05:01 -0300719static int ctrl_cx2341x_is_dirty(struct pvr2_ctrl *cptr)
720{
721 return cptr->hdw->enc_stale != 0;
722}
723
724static void ctrl_cx2341x_clear_dirty(struct pvr2_ctrl *cptr)
725{
726 cptr->hdw->enc_stale = 0;
Mike Isely681c7392007-11-26 01:48:52 -0300727 cptr->hdw->enc_unsafe_stale = 0;
Mike Iselyb30d2442006-06-25 20:05:01 -0300728}
729
730static int ctrl_cx2341x_get(struct pvr2_ctrl *cptr,int *vp)
731{
732 int ret;
733 struct v4l2_ext_controls cs;
734 struct v4l2_ext_control c1;
735 memset(&cs,0,sizeof(cs));
736 memset(&c1,0,sizeof(c1));
737 cs.controls = &c1;
738 cs.count = 1;
739 c1.id = cptr->info->v4l_id;
Hans Verkuil01f1e442007-08-21 18:32:42 -0300740 ret = cx2341x_ext_ctrls(&cptr->hdw->enc_ctl_state, 0, &cs,
Mike Iselyb30d2442006-06-25 20:05:01 -0300741 VIDIOC_G_EXT_CTRLS);
742 if (ret) return ret;
743 *vp = c1.value;
744 return 0;
745}
746
747static int ctrl_cx2341x_set(struct pvr2_ctrl *cptr,int m,int v)
748{
749 int ret;
Mike Isely681c7392007-11-26 01:48:52 -0300750 struct pvr2_hdw *hdw = cptr->hdw;
Mike Iselyb30d2442006-06-25 20:05:01 -0300751 struct v4l2_ext_controls cs;
752 struct v4l2_ext_control c1;
753 memset(&cs,0,sizeof(cs));
754 memset(&c1,0,sizeof(c1));
755 cs.controls = &c1;
756 cs.count = 1;
757 c1.id = cptr->info->v4l_id;
758 c1.value = v;
Mike Isely681c7392007-11-26 01:48:52 -0300759 ret = cx2341x_ext_ctrls(&hdw->enc_ctl_state,
760 hdw->state_encoder_run, &cs,
Mike Iselyb30d2442006-06-25 20:05:01 -0300761 VIDIOC_S_EXT_CTRLS);
Mike Isely681c7392007-11-26 01:48:52 -0300762 if (ret == -EBUSY) {
763 /* Oops. cx2341x is telling us it's not safe to change
764 this control while we're capturing. Make a note of this
765 fact so that the pipeline will be stopped the next time
766 controls are committed. Then go on ahead and store this
767 change anyway. */
768 ret = cx2341x_ext_ctrls(&hdw->enc_ctl_state,
769 0, &cs,
770 VIDIOC_S_EXT_CTRLS);
771 if (!ret) hdw->enc_unsafe_stale = !0;
772 }
Mike Iselyb30d2442006-06-25 20:05:01 -0300773 if (ret) return ret;
Mike Isely681c7392007-11-26 01:48:52 -0300774 hdw->enc_stale = !0;
Mike Iselyb30d2442006-06-25 20:05:01 -0300775 return 0;
776}
777
778static unsigned int ctrl_cx2341x_getv4lflags(struct pvr2_ctrl *cptr)
779{
780 struct v4l2_queryctrl qctrl;
781 struct pvr2_ctl_info *info;
782 qctrl.id = cptr->info->v4l_id;
783 cx2341x_ctrl_query(&cptr->hdw->enc_ctl_state,&qctrl);
784 /* Strip out the const so we can adjust a function pointer. It's
785 OK to do this here because we know this is a dynamically created
786 control, so the underlying storage for the info pointer is (a)
787 private to us, and (b) not in read-only storage. Either we do
788 this or we significantly complicate the underlying control
789 implementation. */
790 info = (struct pvr2_ctl_info *)(cptr->info);
791 if (qctrl.flags & V4L2_CTRL_FLAG_READ_ONLY) {
792 if (info->set_value) {
Mike Iselya0fd1cb2006-06-30 11:35:28 -0300793 info->set_value = NULL;
Mike Iselyb30d2442006-06-25 20:05:01 -0300794 }
795 } else {
796 if (!(info->set_value)) {
797 info->set_value = ctrl_cx2341x_set;
798 }
799 }
800 return qctrl.flags;
801}
802
Mike Iselyd8554972006-06-26 20:58:46 -0300803static int ctrl_streamingenabled_get(struct pvr2_ctrl *cptr,int *vp)
804{
Mike Isely681c7392007-11-26 01:48:52 -0300805 *vp = cptr->hdw->state_pipeline_req;
806 return 0;
807}
808
809static int ctrl_masterstate_get(struct pvr2_ctrl *cptr,int *vp)
810{
811 *vp = cptr->hdw->master_state;
Mike Iselyd8554972006-06-26 20:58:46 -0300812 return 0;
813}
814
815static int ctrl_hsm_get(struct pvr2_ctrl *cptr,int *vp)
816{
817 int result = pvr2_hdw_is_hsm(cptr->hdw);
818 *vp = PVR2_CVAL_HSM_FULL;
819 if (result < 0) *vp = PVR2_CVAL_HSM_FAIL;
820 if (result) *vp = PVR2_CVAL_HSM_HIGH;
821 return 0;
822}
823
824static int ctrl_stdavail_get(struct pvr2_ctrl *cptr,int *vp)
825{
826 *vp = cptr->hdw->std_mask_avail;
827 return 0;
828}
829
830static int ctrl_stdavail_set(struct pvr2_ctrl *cptr,int m,int v)
831{
832 struct pvr2_hdw *hdw = cptr->hdw;
833 v4l2_std_id ns;
834 ns = hdw->std_mask_avail;
835 ns = (ns & ~m) | (v & m);
836 if (ns == hdw->std_mask_avail) return 0;
837 hdw->std_mask_avail = ns;
838 pvr2_hdw_internal_set_std_avail(hdw);
839 pvr2_hdw_internal_find_stdenum(hdw);
840 return 0;
841}
842
843static int ctrl_std_val_to_sym(struct pvr2_ctrl *cptr,int msk,int val,
844 char *bufPtr,unsigned int bufSize,
845 unsigned int *len)
846{
847 *len = pvr2_std_id_to_str(bufPtr,bufSize,msk & val);
848 return 0;
849}
850
851static int ctrl_std_sym_to_val(struct pvr2_ctrl *cptr,
852 const char *bufPtr,unsigned int bufSize,
853 int *mskp,int *valp)
854{
855 int ret;
856 v4l2_std_id id;
857 ret = pvr2_std_str_to_id(&id,bufPtr,bufSize);
858 if (ret < 0) return ret;
859 if (mskp) *mskp = id;
860 if (valp) *valp = id;
861 return 0;
862}
863
864static int ctrl_stdcur_get(struct pvr2_ctrl *cptr,int *vp)
865{
866 *vp = cptr->hdw->std_mask_cur;
867 return 0;
868}
869
870static int ctrl_stdcur_set(struct pvr2_ctrl *cptr,int m,int v)
871{
872 struct pvr2_hdw *hdw = cptr->hdw;
873 v4l2_std_id ns;
874 ns = hdw->std_mask_cur;
875 ns = (ns & ~m) | (v & m);
876 if (ns == hdw->std_mask_cur) return 0;
877 hdw->std_mask_cur = ns;
878 hdw->std_dirty = !0;
879 pvr2_hdw_internal_find_stdenum(hdw);
880 return 0;
881}
882
883static int ctrl_stdcur_is_dirty(struct pvr2_ctrl *cptr)
884{
885 return cptr->hdw->std_dirty != 0;
886}
887
888static void ctrl_stdcur_clear_dirty(struct pvr2_ctrl *cptr)
889{
890 cptr->hdw->std_dirty = 0;
891}
892
893static int ctrl_signal_get(struct pvr2_ctrl *cptr,int *vp)
894{
Mike Isely18103c572007-01-20 00:09:47 -0300895 struct pvr2_hdw *hdw = cptr->hdw;
Mike Iselya51f5002009-03-06 23:30:37 -0300896 pvr2_hdw_status_poll(hdw);
Mike Isely18103c572007-01-20 00:09:47 -0300897 *vp = hdw->tuner_signal_info.signal;
898 return 0;
899}
900
901static int ctrl_audio_modes_present_get(struct pvr2_ctrl *cptr,int *vp)
902{
903 int val = 0;
904 unsigned int subchan;
905 struct pvr2_hdw *hdw = cptr->hdw;
Mike Iselya51f5002009-03-06 23:30:37 -0300906 pvr2_hdw_status_poll(hdw);
Mike Isely18103c572007-01-20 00:09:47 -0300907 subchan = hdw->tuner_signal_info.rxsubchans;
908 if (subchan & V4L2_TUNER_SUB_MONO) {
909 val |= (1 << V4L2_TUNER_MODE_MONO);
910 }
911 if (subchan & V4L2_TUNER_SUB_STEREO) {
912 val |= (1 << V4L2_TUNER_MODE_STEREO);
913 }
914 if (subchan & V4L2_TUNER_SUB_LANG1) {
915 val |= (1 << V4L2_TUNER_MODE_LANG1);
916 }
917 if (subchan & V4L2_TUNER_SUB_LANG2) {
918 val |= (1 << V4L2_TUNER_MODE_LANG2);
919 }
920 *vp = val;
Mike Iselyd8554972006-06-26 20:58:46 -0300921 return 0;
922}
923
Mike Iselyd8554972006-06-26 20:58:46 -0300924
925static int ctrl_stdenumcur_set(struct pvr2_ctrl *cptr,int m,int v)
926{
927 struct pvr2_hdw *hdw = cptr->hdw;
928 if (v < 0) return -EINVAL;
929 if (v > hdw->std_enum_cnt) return -EINVAL;
930 hdw->std_enum_cur = v;
931 if (!v) return 0;
932 v--;
933 if (hdw->std_mask_cur == hdw->std_defs[v].id) return 0;
934 hdw->std_mask_cur = hdw->std_defs[v].id;
935 hdw->std_dirty = !0;
936 return 0;
937}
938
939
940static int ctrl_stdenumcur_get(struct pvr2_ctrl *cptr,int *vp)
941{
942 *vp = cptr->hdw->std_enum_cur;
943 return 0;
944}
945
946
947static int ctrl_stdenumcur_is_dirty(struct pvr2_ctrl *cptr)
948{
949 return cptr->hdw->std_dirty != 0;
950}
951
952
953static void ctrl_stdenumcur_clear_dirty(struct pvr2_ctrl *cptr)
954{
955 cptr->hdw->std_dirty = 0;
956}
957
958
959#define DEFINT(vmin,vmax) \
960 .type = pvr2_ctl_int, \
961 .def.type_int.min_value = vmin, \
962 .def.type_int.max_value = vmax
963
964#define DEFENUM(tab) \
965 .type = pvr2_ctl_enum, \
Mike Isely27c7b712007-01-20 00:39:17 -0300966 .def.type_enum.count = ARRAY_SIZE(tab), \
Mike Iselyd8554972006-06-26 20:58:46 -0300967 .def.type_enum.value_names = tab
968
Mike Isely33213962006-06-25 20:04:40 -0300969#define DEFBOOL \
970 .type = pvr2_ctl_bool
971
Mike Iselyd8554972006-06-26 20:58:46 -0300972#define DEFMASK(msk,tab) \
973 .type = pvr2_ctl_bitmask, \
974 .def.type_bitmask.valid_bits = msk, \
975 .def.type_bitmask.bit_names = tab
976
977#define DEFREF(vname) \
978 .set_value = ctrl_set_##vname, \
979 .get_value = ctrl_get_##vname, \
980 .is_dirty = ctrl_isdirty_##vname, \
981 .clear_dirty = ctrl_cleardirty_##vname
982
983
984#define VCREATE_FUNCS(vname) \
985static int ctrl_get_##vname(struct pvr2_ctrl *cptr,int *vp) \
986{*vp = cptr->hdw->vname##_val; return 0;} \
987static int ctrl_set_##vname(struct pvr2_ctrl *cptr,int m,int v) \
988{cptr->hdw->vname##_val = v; cptr->hdw->vname##_dirty = !0; return 0;} \
989static int ctrl_isdirty_##vname(struct pvr2_ctrl *cptr) \
990{return cptr->hdw->vname##_dirty != 0;} \
991static void ctrl_cleardirty_##vname(struct pvr2_ctrl *cptr) \
992{cptr->hdw->vname##_dirty = 0;}
993
994VCREATE_FUNCS(brightness)
995VCREATE_FUNCS(contrast)
996VCREATE_FUNCS(saturation)
997VCREATE_FUNCS(hue)
998VCREATE_FUNCS(volume)
999VCREATE_FUNCS(balance)
1000VCREATE_FUNCS(bass)
1001VCREATE_FUNCS(treble)
1002VCREATE_FUNCS(mute)
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -03001003VCREATE_FUNCS(cropl)
1004VCREATE_FUNCS(cropt)
1005VCREATE_FUNCS(cropw)
1006VCREATE_FUNCS(croph)
Mike Iselyc05c0462006-06-25 20:04:25 -03001007VCREATE_FUNCS(audiomode)
1008VCREATE_FUNCS(res_hor)
1009VCREATE_FUNCS(res_ver)
Mike Iselyd8554972006-06-26 20:58:46 -03001010VCREATE_FUNCS(srate)
Mike Iselyd8554972006-06-26 20:58:46 -03001011
Mike Iselyd8554972006-06-26 20:58:46 -03001012/* Table definition of all controls which can be manipulated */
1013static const struct pvr2_ctl_info control_defs[] = {
1014 {
1015 .v4l_id = V4L2_CID_BRIGHTNESS,
1016 .desc = "Brightness",
1017 .name = "brightness",
1018 .default_value = 128,
1019 DEFREF(brightness),
1020 DEFINT(0,255),
1021 },{
1022 .v4l_id = V4L2_CID_CONTRAST,
1023 .desc = "Contrast",
1024 .name = "contrast",
1025 .default_value = 68,
1026 DEFREF(contrast),
1027 DEFINT(0,127),
1028 },{
1029 .v4l_id = V4L2_CID_SATURATION,
1030 .desc = "Saturation",
1031 .name = "saturation",
1032 .default_value = 64,
1033 DEFREF(saturation),
1034 DEFINT(0,127),
1035 },{
1036 .v4l_id = V4L2_CID_HUE,
1037 .desc = "Hue",
1038 .name = "hue",
1039 .default_value = 0,
1040 DEFREF(hue),
1041 DEFINT(-128,127),
1042 },{
1043 .v4l_id = V4L2_CID_AUDIO_VOLUME,
1044 .desc = "Volume",
1045 .name = "volume",
Mike Isely139eecf2006-12-27 23:36:33 -03001046 .default_value = 62000,
Mike Iselyd8554972006-06-26 20:58:46 -03001047 DEFREF(volume),
1048 DEFINT(0,65535),
1049 },{
1050 .v4l_id = V4L2_CID_AUDIO_BALANCE,
1051 .desc = "Balance",
1052 .name = "balance",
1053 .default_value = 0,
1054 DEFREF(balance),
1055 DEFINT(-32768,32767),
1056 },{
1057 .v4l_id = V4L2_CID_AUDIO_BASS,
1058 .desc = "Bass",
1059 .name = "bass",
1060 .default_value = 0,
1061 DEFREF(bass),
1062 DEFINT(-32768,32767),
1063 },{
1064 .v4l_id = V4L2_CID_AUDIO_TREBLE,
1065 .desc = "Treble",
1066 .name = "treble",
1067 .default_value = 0,
1068 DEFREF(treble),
1069 DEFINT(-32768,32767),
1070 },{
1071 .v4l_id = V4L2_CID_AUDIO_MUTE,
1072 .desc = "Mute",
1073 .name = "mute",
1074 .default_value = 0,
1075 DEFREF(mute),
Mike Isely33213962006-06-25 20:04:40 -03001076 DEFBOOL,
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -03001077 }, {
Mike Isely432907f2008-08-31 21:02:20 -03001078 .desc = "Capture crop left margin",
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -03001079 .name = "crop_left",
1080 .internal_id = PVR2_CID_CROPL,
1081 .default_value = 0,
1082 DEFREF(cropl),
1083 DEFINT(-129, 340),
1084 .get_min_value = ctrl_cropl_min_get,
1085 .get_max_value = ctrl_cropl_max_get,
Mike Isely432907f2008-08-31 21:02:20 -03001086 .get_def_value = ctrl_get_cropcapdl,
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -03001087 }, {
Mike Isely432907f2008-08-31 21:02:20 -03001088 .desc = "Capture crop top margin",
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -03001089 .name = "crop_top",
1090 .internal_id = PVR2_CID_CROPT,
1091 .default_value = 0,
1092 DEFREF(cropt),
1093 DEFINT(-35, 544),
1094 .get_min_value = ctrl_cropt_min_get,
1095 .get_max_value = ctrl_cropt_max_get,
Mike Isely432907f2008-08-31 21:02:20 -03001096 .get_def_value = ctrl_get_cropcapdt,
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -03001097 }, {
Mike Isely432907f2008-08-31 21:02:20 -03001098 .desc = "Capture crop width",
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -03001099 .name = "crop_width",
1100 .internal_id = PVR2_CID_CROPW,
1101 .default_value = 720,
1102 DEFREF(cropw),
Mike Isely432907f2008-08-31 21:02:20 -03001103 .get_max_value = ctrl_cropw_max_get,
1104 .get_def_value = ctrl_get_cropcapdw,
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -03001105 }, {
Mike Isely432907f2008-08-31 21:02:20 -03001106 .desc = "Capture crop height",
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -03001107 .name = "crop_height",
1108 .internal_id = PVR2_CID_CROPH,
1109 .default_value = 480,
1110 DEFREF(croph),
Mike Isely432907f2008-08-31 21:02:20 -03001111 .get_max_value = ctrl_croph_max_get,
1112 .get_def_value = ctrl_get_cropcapdh,
1113 }, {
1114 .desc = "Capture capability pixel aspect numerator",
1115 .name = "cropcap_pixel_numerator",
1116 .internal_id = PVR2_CID_CROPCAPPAN,
1117 .get_value = ctrl_get_cropcappan,
1118 }, {
1119 .desc = "Capture capability pixel aspect denominator",
1120 .name = "cropcap_pixel_denominator",
1121 .internal_id = PVR2_CID_CROPCAPPAD,
1122 .get_value = ctrl_get_cropcappad,
1123 }, {
1124 .desc = "Capture capability bounds top",
1125 .name = "cropcap_bounds_top",
1126 .internal_id = PVR2_CID_CROPCAPBT,
1127 .get_value = ctrl_get_cropcapbt,
1128 }, {
1129 .desc = "Capture capability bounds left",
1130 .name = "cropcap_bounds_left",
1131 .internal_id = PVR2_CID_CROPCAPBL,
1132 .get_value = ctrl_get_cropcapbl,
1133 }, {
1134 .desc = "Capture capability bounds width",
1135 .name = "cropcap_bounds_width",
1136 .internal_id = PVR2_CID_CROPCAPBW,
1137 .get_value = ctrl_get_cropcapbw,
1138 }, {
1139 .desc = "Capture capability bounds height",
1140 .name = "cropcap_bounds_height",
1141 .internal_id = PVR2_CID_CROPCAPBH,
1142 .get_value = ctrl_get_cropcapbh,
Mike Iselyd8554972006-06-26 20:58:46 -03001143 },{
Mike Iselyc05c0462006-06-25 20:04:25 -03001144 .desc = "Video Source",
1145 .name = "input",
1146 .internal_id = PVR2_CID_INPUT,
1147 .default_value = PVR2_CVAL_INPUT_TV,
Mike Isely29bf5b12008-04-22 14:45:37 -03001148 .check_value = ctrl_check_input,
Mike Iselyc05c0462006-06-25 20:04:25 -03001149 DEFREF(input),
1150 DEFENUM(control_values_input),
1151 },{
1152 .desc = "Audio Mode",
1153 .name = "audio_mode",
1154 .internal_id = PVR2_CID_AUDIOMODE,
1155 .default_value = V4L2_TUNER_MODE_STEREO,
1156 DEFREF(audiomode),
1157 DEFENUM(control_values_audiomode),
1158 },{
1159 .desc = "Horizontal capture resolution",
1160 .name = "resolution_hor",
1161 .internal_id = PVR2_CID_HRES,
1162 .default_value = 720,
1163 DEFREF(res_hor),
Mike Isely3ad9fc32006-09-02 22:37:52 -03001164 DEFINT(19,720),
Mike Iselyc05c0462006-06-25 20:04:25 -03001165 },{
1166 .desc = "Vertical capture resolution",
1167 .name = "resolution_ver",
1168 .internal_id = PVR2_CID_VRES,
1169 .default_value = 480,
1170 DEFREF(res_ver),
Mike Isely3ad9fc32006-09-02 22:37:52 -03001171 DEFINT(17,576),
1172 /* Hook in check for video standard and adjust maximum
1173 depending on the standard. */
1174 .get_max_value = ctrl_vres_max_get,
1175 .get_min_value = ctrl_vres_min_get,
Mike Iselyc05c0462006-06-25 20:04:25 -03001176 },{
Mike Iselyb30d2442006-06-25 20:05:01 -03001177 .v4l_id = V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ,
Mike Isely434449f2006-08-08 09:10:06 -03001178 .default_value = V4L2_MPEG_AUDIO_SAMPLING_FREQ_48000,
1179 .desc = "Audio Sampling Frequency",
Mike Iselyd8554972006-06-26 20:58:46 -03001180 .name = "srate",
Mike Iselyd8554972006-06-26 20:58:46 -03001181 DEFREF(srate),
1182 DEFENUM(control_values_srate),
1183 },{
Mike Iselyd8554972006-06-26 20:58:46 -03001184 .desc = "Tuner Frequency (Hz)",
1185 .name = "frequency",
1186 .internal_id = PVR2_CID_FREQUENCY,
Mike Isely1bde0282006-12-27 23:30:13 -03001187 .default_value = 0,
Mike Iselyd8554972006-06-26 20:58:46 -03001188 .set_value = ctrl_freq_set,
1189 .get_value = ctrl_freq_get,
1190 .is_dirty = ctrl_freq_is_dirty,
1191 .clear_dirty = ctrl_freq_clear_dirty,
Mike Isely644afdb2007-01-20 00:19:23 -03001192 DEFINT(0,0),
Pantelis Koukousoulas25d85272006-12-27 23:06:04 -03001193 /* Hook in check for input value (tv/radio) and adjust
1194 max/min values accordingly */
1195 .get_max_value = ctrl_freq_max_get,
1196 .get_min_value = ctrl_freq_min_get,
Mike Iselyd8554972006-06-26 20:58:46 -03001197 },{
1198 .desc = "Channel",
1199 .name = "channel",
1200 .set_value = ctrl_channel_set,
1201 .get_value = ctrl_channel_get,
1202 DEFINT(0,FREQTABLE_SIZE),
1203 },{
1204 .desc = "Channel Program Frequency",
1205 .name = "freq_table_value",
1206 .set_value = ctrl_channelfreq_set,
1207 .get_value = ctrl_channelfreq_get,
Mike Isely644afdb2007-01-20 00:19:23 -03001208 DEFINT(0,0),
Mike Isely1bde0282006-12-27 23:30:13 -03001209 /* Hook in check for input value (tv/radio) and adjust
1210 max/min values accordingly */
Mike Isely1bde0282006-12-27 23:30:13 -03001211 .get_max_value = ctrl_freq_max_get,
1212 .get_min_value = ctrl_freq_min_get,
Mike Iselyd8554972006-06-26 20:58:46 -03001213 },{
1214 .desc = "Channel Program ID",
1215 .name = "freq_table_channel",
1216 .set_value = ctrl_channelprog_set,
1217 .get_value = ctrl_channelprog_get,
1218 DEFINT(0,FREQTABLE_SIZE),
1219 },{
Mike Iselyd8554972006-06-26 20:58:46 -03001220 .desc = "Streaming Enabled",
1221 .name = "streaming_enabled",
1222 .get_value = ctrl_streamingenabled_get,
Mike Isely33213962006-06-25 20:04:40 -03001223 DEFBOOL,
Mike Iselyd8554972006-06-26 20:58:46 -03001224 },{
1225 .desc = "USB Speed",
1226 .name = "usb_speed",
1227 .get_value = ctrl_hsm_get,
1228 DEFENUM(control_values_hsm),
1229 },{
Mike Isely681c7392007-11-26 01:48:52 -03001230 .desc = "Master State",
1231 .name = "master_state",
1232 .get_value = ctrl_masterstate_get,
1233 DEFENUM(pvr2_state_names),
1234 },{
Mike Iselyd8554972006-06-26 20:58:46 -03001235 .desc = "Signal Present",
1236 .name = "signal_present",
1237 .get_value = ctrl_signal_get,
Mike Isely18103c572007-01-20 00:09:47 -03001238 DEFINT(0,65535),
1239 },{
1240 .desc = "Audio Modes Present",
1241 .name = "audio_modes_present",
1242 .get_value = ctrl_audio_modes_present_get,
1243 /* For this type we "borrow" the V4L2_TUNER_MODE enum from
1244 v4l. Nothing outside of this module cares about this,
1245 but I reuse it in order to also reuse the
1246 control_values_audiomode string table. */
1247 DEFMASK(((1 << V4L2_TUNER_MODE_MONO)|
1248 (1 << V4L2_TUNER_MODE_STEREO)|
1249 (1 << V4L2_TUNER_MODE_LANG1)|
1250 (1 << V4L2_TUNER_MODE_LANG2)),
1251 control_values_audiomode),
Mike Iselyd8554972006-06-26 20:58:46 -03001252 },{
1253 .desc = "Video Standards Available Mask",
1254 .name = "video_standard_mask_available",
1255 .internal_id = PVR2_CID_STDAVAIL,
1256 .skip_init = !0,
1257 .get_value = ctrl_stdavail_get,
1258 .set_value = ctrl_stdavail_set,
1259 .val_to_sym = ctrl_std_val_to_sym,
1260 .sym_to_val = ctrl_std_sym_to_val,
1261 .type = pvr2_ctl_bitmask,
1262 },{
1263 .desc = "Video Standards In Use Mask",
1264 .name = "video_standard_mask_active",
1265 .internal_id = PVR2_CID_STDCUR,
1266 .skip_init = !0,
1267 .get_value = ctrl_stdcur_get,
1268 .set_value = ctrl_stdcur_set,
1269 .is_dirty = ctrl_stdcur_is_dirty,
1270 .clear_dirty = ctrl_stdcur_clear_dirty,
1271 .val_to_sym = ctrl_std_val_to_sym,
1272 .sym_to_val = ctrl_std_sym_to_val,
1273 .type = pvr2_ctl_bitmask,
1274 },{
Mike Iselyd8554972006-06-26 20:58:46 -03001275 .desc = "Video Standard Name",
1276 .name = "video_standard",
1277 .internal_id = PVR2_CID_STDENUM,
1278 .skip_init = !0,
1279 .get_value = ctrl_stdenumcur_get,
1280 .set_value = ctrl_stdenumcur_set,
1281 .is_dirty = ctrl_stdenumcur_is_dirty,
1282 .clear_dirty = ctrl_stdenumcur_clear_dirty,
1283 .type = pvr2_ctl_enum,
1284 }
1285};
1286
Ahmed S. Darwisheca8ebf2007-01-20 00:35:03 -03001287#define CTRLDEF_COUNT ARRAY_SIZE(control_defs)
Mike Iselyd8554972006-06-26 20:58:46 -03001288
1289
1290const char *pvr2_config_get_name(enum pvr2_config cfg)
1291{
1292 switch (cfg) {
1293 case pvr2_config_empty: return "empty";
1294 case pvr2_config_mpeg: return "mpeg";
1295 case pvr2_config_vbi: return "vbi";
Mike Isely16eb40d2006-12-30 18:27:32 -03001296 case pvr2_config_pcm: return "pcm";
1297 case pvr2_config_rawvideo: return "raw video";
Mike Iselyd8554972006-06-26 20:58:46 -03001298 }
1299 return "<unknown>";
1300}
1301
1302
1303struct usb_device *pvr2_hdw_get_dev(struct pvr2_hdw *hdw)
1304{
1305 return hdw->usb_dev;
1306}
1307
1308
1309unsigned long pvr2_hdw_get_sn(struct pvr2_hdw *hdw)
1310{
1311 return hdw->serial_number;
1312}
1313
Mike Isely31a18542007-04-08 01:11:47 -03001314
1315const char *pvr2_hdw_get_bus_info(struct pvr2_hdw *hdw)
1316{
1317 return hdw->bus_info;
1318}
1319
1320
Mike Isely13a88792009-01-14 04:22:56 -03001321const char *pvr2_hdw_get_device_identifier(struct pvr2_hdw *hdw)
1322{
1323 return hdw->identifier;
1324}
1325
1326
Mike Isely1bde0282006-12-27 23:30:13 -03001327unsigned long pvr2_hdw_get_cur_freq(struct pvr2_hdw *hdw)
1328{
1329 return hdw->freqSelector ? hdw->freqValTelevision : hdw->freqValRadio;
1330}
1331
1332/* Set the currently tuned frequency and account for all possible
1333 driver-core side effects of this action. */
Adrian Bunkf55a8712008-04-18 05:38:56 -03001334static void pvr2_hdw_set_cur_freq(struct pvr2_hdw *hdw,unsigned long val)
Mike Isely1bde0282006-12-27 23:30:13 -03001335{
Mike Isely7c74e572007-01-20 00:15:41 -03001336 if (hdw->input_val == PVR2_CVAL_INPUT_RADIO) {
Mike Isely1bde0282006-12-27 23:30:13 -03001337 if (hdw->freqSelector) {
1338 /* Swing over to radio frequency selection */
1339 hdw->freqSelector = 0;
1340 hdw->freqDirty = !0;
1341 }
Mike Isely1bde0282006-12-27 23:30:13 -03001342 if (hdw->freqValRadio != val) {
1343 hdw->freqValRadio = val;
1344 hdw->freqSlotRadio = 0;
Mike Isely7c74e572007-01-20 00:15:41 -03001345 hdw->freqDirty = !0;
Mike Isely1bde0282006-12-27 23:30:13 -03001346 }
Mike Isely7c74e572007-01-20 00:15:41 -03001347 } else {
Mike Isely1bde0282006-12-27 23:30:13 -03001348 if (!(hdw->freqSelector)) {
1349 /* Swing over to television frequency selection */
1350 hdw->freqSelector = 1;
1351 hdw->freqDirty = !0;
1352 }
Mike Isely1bde0282006-12-27 23:30:13 -03001353 if (hdw->freqValTelevision != val) {
1354 hdw->freqValTelevision = val;
1355 hdw->freqSlotTelevision = 0;
Mike Isely7c74e572007-01-20 00:15:41 -03001356 hdw->freqDirty = !0;
Mike Isely1bde0282006-12-27 23:30:13 -03001357 }
Mike Isely1bde0282006-12-27 23:30:13 -03001358 }
1359}
1360
Mike Iselyd8554972006-06-26 20:58:46 -03001361int pvr2_hdw_get_unit_number(struct pvr2_hdw *hdw)
1362{
1363 return hdw->unit_number;
1364}
1365
1366
1367/* Attempt to locate one of the given set of files. Messages are logged
1368 appropriate to what has been found. The return value will be 0 or
1369 greater on success (it will be the index of the file name found) and
1370 fw_entry will be filled in. Otherwise a negative error is returned on
1371 failure. If the return value is -ENOENT then no viable firmware file
1372 could be located. */
1373static int pvr2_locate_firmware(struct pvr2_hdw *hdw,
1374 const struct firmware **fw_entry,
1375 const char *fwtypename,
1376 unsigned int fwcount,
1377 const char *fwnames[])
1378{
1379 unsigned int idx;
1380 int ret = -EINVAL;
1381 for (idx = 0; idx < fwcount; idx++) {
1382 ret = request_firmware(fw_entry,
1383 fwnames[idx],
1384 &hdw->usb_dev->dev);
1385 if (!ret) {
1386 trace_firmware("Located %s firmware: %s;"
1387 " uploading...",
1388 fwtypename,
1389 fwnames[idx]);
1390 return idx;
1391 }
1392 if (ret == -ENOENT) continue;
1393 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1394 "request_firmware fatal error with code=%d",ret);
1395 return ret;
1396 }
1397 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1398 "***WARNING***"
1399 " Device %s firmware"
1400 " seems to be missing.",
1401 fwtypename);
1402 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1403 "Did you install the pvrusb2 firmware files"
1404 " in their proper location?");
1405 if (fwcount == 1) {
1406 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1407 "request_firmware unable to locate %s file %s",
1408 fwtypename,fwnames[0]);
1409 } else {
1410 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1411 "request_firmware unable to locate"
1412 " one of the following %s files:",
1413 fwtypename);
1414 for (idx = 0; idx < fwcount; idx++) {
1415 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1416 "request_firmware: Failed to find %s",
1417 fwnames[idx]);
1418 }
1419 }
1420 return ret;
1421}
1422
1423
1424/*
1425 * pvr2_upload_firmware1().
1426 *
1427 * Send the 8051 firmware to the device. After the upload, arrange for
1428 * device to re-enumerate.
1429 *
1430 * NOTE : the pointer to the firmware data given by request_firmware()
1431 * is not suitable for an usb transaction.
1432 *
1433 */
Adrian Bunk07e337e2006-06-30 11:30:20 -03001434static int pvr2_upload_firmware1(struct pvr2_hdw *hdw)
Mike Iselyd8554972006-06-26 20:58:46 -03001435{
Mike Iselya0fd1cb2006-06-30 11:35:28 -03001436 const struct firmware *fw_entry = NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03001437 void *fw_ptr;
1438 unsigned int pipe;
1439 int ret;
1440 u16 address;
Mike Isely1d643a32007-09-08 22:18:50 -03001441
Mike Isely989eb152007-11-26 01:53:12 -03001442 if (!hdw->hdw_desc->fx2_firmware.cnt) {
Mike Isely1d643a32007-09-08 22:18:50 -03001443 hdw->fw1_state = FW1_STATE_OK;
Mike Isely56dcbfa2007-11-26 02:00:51 -03001444 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1445 "Connected device type defines"
1446 " no firmware to upload; ignoring firmware");
1447 return -ENOTTY;
Mike Isely1d643a32007-09-08 22:18:50 -03001448 }
1449
Mike Iselyd8554972006-06-26 20:58:46 -03001450 hdw->fw1_state = FW1_STATE_FAILED; // default result
1451
1452 trace_firmware("pvr2_upload_firmware1");
1453
1454 ret = pvr2_locate_firmware(hdw,&fw_entry,"fx2 controller",
Mike Isely989eb152007-11-26 01:53:12 -03001455 hdw->hdw_desc->fx2_firmware.cnt,
1456 hdw->hdw_desc->fx2_firmware.lst);
Mike Iselyd8554972006-06-26 20:58:46 -03001457 if (ret < 0) {
1458 if (ret == -ENOENT) hdw->fw1_state = FW1_STATE_MISSING;
1459 return ret;
1460 }
1461
1462 usb_settoggle(hdw->usb_dev, 0 & 0xf, !(0 & USB_DIR_IN), 0);
1463 usb_clear_halt(hdw->usb_dev, usb_sndbulkpipe(hdw->usb_dev, 0 & 0x7f));
1464
1465 pipe = usb_sndctrlpipe(hdw->usb_dev, 0);
1466
1467 if (fw_entry->size != 0x2000){
1468 pvr2_trace(PVR2_TRACE_ERROR_LEGS,"wrong fx2 firmware size");
1469 release_firmware(fw_entry);
1470 return -ENOMEM;
1471 }
1472
1473 fw_ptr = kmalloc(0x800, GFP_KERNEL);
1474 if (fw_ptr == NULL){
1475 release_firmware(fw_entry);
1476 return -ENOMEM;
1477 }
1478
1479 /* We have to hold the CPU during firmware upload. */
1480 pvr2_hdw_cpureset_assert(hdw,1);
1481
1482 /* upload the firmware to address 0000-1fff in 2048 (=0x800) bytes
1483 chunk. */
1484
1485 ret = 0;
1486 for(address = 0; address < fw_entry->size; address += 0x800) {
1487 memcpy(fw_ptr, fw_entry->data + address, 0x800);
1488 ret += usb_control_msg(hdw->usb_dev, pipe, 0xa0, 0x40, address,
1489 0, fw_ptr, 0x800, HZ);
1490 }
1491
1492 trace_firmware("Upload done, releasing device's CPU");
1493
1494 /* Now release the CPU. It will disconnect and reconnect later. */
1495 pvr2_hdw_cpureset_assert(hdw,0);
1496
1497 kfree(fw_ptr);
1498 release_firmware(fw_entry);
1499
1500 trace_firmware("Upload done (%d bytes sent)",ret);
1501
1502 /* We should have written 8192 bytes */
1503 if (ret == 8192) {
1504 hdw->fw1_state = FW1_STATE_RELOAD;
1505 return 0;
1506 }
1507
1508 return -EIO;
1509}
1510
1511
1512/*
1513 * pvr2_upload_firmware2()
1514 *
1515 * This uploads encoder firmware on endpoint 2.
1516 *
1517 */
1518
1519int pvr2_upload_firmware2(struct pvr2_hdw *hdw)
1520{
Mike Iselya0fd1cb2006-06-30 11:35:28 -03001521 const struct firmware *fw_entry = NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03001522 void *fw_ptr;
Mike Isely90060d32007-02-08 02:02:53 -03001523 unsigned int pipe, fw_len, fw_done, bcnt, icnt;
Mike Iselyd8554972006-06-26 20:58:46 -03001524 int actual_length;
1525 int ret = 0;
1526 int fwidx;
1527 static const char *fw_files[] = {
1528 CX2341X_FIRM_ENC_FILENAME,
1529 };
1530
Mike Isely989eb152007-11-26 01:53:12 -03001531 if (hdw->hdw_desc->flag_skip_cx23416_firmware) {
Mike Isely1d643a32007-09-08 22:18:50 -03001532 return 0;
1533 }
1534
Mike Iselyd8554972006-06-26 20:58:46 -03001535 trace_firmware("pvr2_upload_firmware2");
1536
1537 ret = pvr2_locate_firmware(hdw,&fw_entry,"encoder",
Ahmed S. Darwisheca8ebf2007-01-20 00:35:03 -03001538 ARRAY_SIZE(fw_files), fw_files);
Mike Iselyd8554972006-06-26 20:58:46 -03001539 if (ret < 0) return ret;
1540 fwidx = ret;
1541 ret = 0;
Mike Iselyb30d2442006-06-25 20:05:01 -03001542 /* Since we're about to completely reinitialize the encoder,
1543 invalidate our cached copy of its configuration state. Next
1544 time we configure the encoder, then we'll fully configure it. */
1545 hdw->enc_cur_valid = 0;
Mike Iselyd8554972006-06-26 20:58:46 -03001546
Mike Iselyd913d632008-04-06 04:04:35 -03001547 /* Encoder is about to be reset so note that as far as we're
1548 concerned now, the encoder has never been run. */
1549 del_timer_sync(&hdw->encoder_run_timer);
1550 if (hdw->state_encoder_runok) {
1551 hdw->state_encoder_runok = 0;
1552 trace_stbit("state_encoder_runok",hdw->state_encoder_runok);
1553 }
1554
Mike Iselyd8554972006-06-26 20:58:46 -03001555 /* First prepare firmware loading */
1556 ret |= pvr2_write_register(hdw, 0x0048, 0xffffffff); /*interrupt mask*/
1557 ret |= pvr2_hdw_gpio_chg_dir(hdw,0xffffffff,0x00000088); /*gpio dir*/
1558 ret |= pvr2_hdw_gpio_chg_out(hdw,0xffffffff,0x00000008); /*gpio output state*/
1559 ret |= pvr2_hdw_cmd_deep_reset(hdw);
1560 ret |= pvr2_write_register(hdw, 0xa064, 0x00000000); /*APU command*/
1561 ret |= pvr2_hdw_gpio_chg_dir(hdw,0xffffffff,0x00000408); /*gpio dir*/
1562 ret |= pvr2_hdw_gpio_chg_out(hdw,0xffffffff,0x00000008); /*gpio output state*/
1563 ret |= pvr2_write_register(hdw, 0x9058, 0xffffffed); /*VPU ctrl*/
1564 ret |= pvr2_write_register(hdw, 0x9054, 0xfffffffd); /*reset hw blocks*/
1565 ret |= pvr2_write_register(hdw, 0x07f8, 0x80000800); /*encoder SDRAM refresh*/
1566 ret |= pvr2_write_register(hdw, 0x07fc, 0x0000001a); /*encoder SDRAM pre-charge*/
1567 ret |= pvr2_write_register(hdw, 0x0700, 0x00000000); /*I2C clock*/
1568 ret |= pvr2_write_register(hdw, 0xaa00, 0x00000000); /*unknown*/
1569 ret |= pvr2_write_register(hdw, 0xaa04, 0x00057810); /*unknown*/
1570 ret |= pvr2_write_register(hdw, 0xaa10, 0x00148500); /*unknown*/
1571 ret |= pvr2_write_register(hdw, 0xaa18, 0x00840000); /*unknown*/
Mike Isely1c9d10d2008-03-28 05:38:54 -03001572 ret |= pvr2_issue_simple_cmd(hdw,FX2CMD_FWPOST1);
1573 ret |= pvr2_issue_simple_cmd(hdw,FX2CMD_MEMSEL | (1 << 8) | (0 << 16));
Mike Iselyd8554972006-06-26 20:58:46 -03001574
1575 if (ret) {
1576 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1577 "firmware2 upload prep failed, ret=%d",ret);
1578 release_firmware(fw_entry);
Mike Isely21684ba2008-04-21 03:49:33 -03001579 goto done;
Mike Iselyd8554972006-06-26 20:58:46 -03001580 }
1581
1582 /* Now send firmware */
1583
1584 fw_len = fw_entry->size;
1585
Mike Isely90060d32007-02-08 02:02:53 -03001586 if (fw_len % sizeof(u32)) {
Mike Iselyd8554972006-06-26 20:58:46 -03001587 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1588 "size of %s firmware"
Mike Isely48dc30a2007-03-03 10:13:05 -02001589 " must be a multiple of %zu bytes",
Mike Isely90060d32007-02-08 02:02:53 -03001590 fw_files[fwidx],sizeof(u32));
Mike Iselyd8554972006-06-26 20:58:46 -03001591 release_firmware(fw_entry);
Mike Isely21684ba2008-04-21 03:49:33 -03001592 ret = -EINVAL;
1593 goto done;
Mike Iselyd8554972006-06-26 20:58:46 -03001594 }
1595
1596 fw_ptr = kmalloc(FIRMWARE_CHUNK_SIZE, GFP_KERNEL);
1597 if (fw_ptr == NULL){
1598 release_firmware(fw_entry);
1599 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1600 "failed to allocate memory for firmware2 upload");
Mike Isely21684ba2008-04-21 03:49:33 -03001601 ret = -ENOMEM;
1602 goto done;
Mike Iselyd8554972006-06-26 20:58:46 -03001603 }
1604
1605 pipe = usb_sndbulkpipe(hdw->usb_dev, PVR2_FIRMWARE_ENDPOINT);
1606
Mike Isely90060d32007-02-08 02:02:53 -03001607 fw_done = 0;
1608 for (fw_done = 0; fw_done < fw_len;) {
1609 bcnt = fw_len - fw_done;
1610 if (bcnt > FIRMWARE_CHUNK_SIZE) bcnt = FIRMWARE_CHUNK_SIZE;
1611 memcpy(fw_ptr, fw_entry->data + fw_done, bcnt);
1612 /* Usbsnoop log shows that we must swap bytes... */
Mike Isely5f33df12008-08-30 15:09:31 -03001613 /* Some background info: The data being swapped here is a
1614 firmware image destined for the mpeg encoder chip that
1615 lives at the other end of a USB endpoint. The encoder
1616 chip always talks in 32 bit chunks and its storage is
1617 organized into 32 bit words. However from the file
1618 system to the encoder chip everything is purely a byte
1619 stream. The firmware file's contents are always 32 bit
1620 swapped from what the encoder expects. Thus the need
1621 always exists to swap the bytes regardless of the endian
1622 type of the host processor and therefore swab32() makes
1623 the most sense. */
Mike Isely90060d32007-02-08 02:02:53 -03001624 for (icnt = 0; icnt < bcnt/4 ; icnt++)
Harvey Harrison513edce2008-08-18 17:38:01 -03001625 ((u32 *)fw_ptr)[icnt] = swab32(((u32 *)fw_ptr)[icnt]);
Mike Iselyd8554972006-06-26 20:58:46 -03001626
Mike Isely90060d32007-02-08 02:02:53 -03001627 ret |= usb_bulk_msg(hdw->usb_dev, pipe, fw_ptr,bcnt,
Mike Iselyd8554972006-06-26 20:58:46 -03001628 &actual_length, HZ);
Mike Isely90060d32007-02-08 02:02:53 -03001629 ret |= (actual_length != bcnt);
1630 if (ret) break;
1631 fw_done += bcnt;
Mike Iselyd8554972006-06-26 20:58:46 -03001632 }
1633
1634 trace_firmware("upload of %s : %i / %i ",
1635 fw_files[fwidx],fw_done,fw_len);
1636
1637 kfree(fw_ptr);
1638 release_firmware(fw_entry);
1639
1640 if (ret) {
1641 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1642 "firmware2 upload transfer failure");
Mike Isely21684ba2008-04-21 03:49:33 -03001643 goto done;
Mike Iselyd8554972006-06-26 20:58:46 -03001644 }
1645
1646 /* Finish upload */
1647
1648 ret |= pvr2_write_register(hdw, 0x9054, 0xffffffff); /*reset hw blocks*/
1649 ret |= pvr2_write_register(hdw, 0x9058, 0xffffffe8); /*VPU ctrl*/
Mike Isely1c9d10d2008-03-28 05:38:54 -03001650 ret |= pvr2_issue_simple_cmd(hdw,FX2CMD_MEMSEL | (1 << 8) | (0 << 16));
Mike Iselyd8554972006-06-26 20:58:46 -03001651
1652 if (ret) {
1653 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1654 "firmware2 upload post-proc failure");
Mike Iselyd8554972006-06-26 20:58:46 -03001655 }
Mike Isely21684ba2008-04-21 03:49:33 -03001656
1657 done:
Mike Isely1df59f02008-04-21 03:50:39 -03001658 if (hdw->hdw_desc->signal_routing_scheme ==
1659 PVR2_ROUTING_SCHEME_GOTVIEW) {
1660 /* Ensure that GPIO 11 is set to output for GOTVIEW
1661 hardware. */
1662 pvr2_hdw_gpio_chg_dir(hdw,(1 << 11),~0);
1663 }
Mike Iselyd8554972006-06-26 20:58:46 -03001664 return ret;
1665}
1666
1667
Mike Isely681c7392007-11-26 01:48:52 -03001668static const char *pvr2_get_state_name(unsigned int st)
Mike Iselyd8554972006-06-26 20:58:46 -03001669{
Mike Isely681c7392007-11-26 01:48:52 -03001670 if (st < ARRAY_SIZE(pvr2_state_names)) {
1671 return pvr2_state_names[st];
Mike Iselyd8554972006-06-26 20:58:46 -03001672 }
Mike Isely681c7392007-11-26 01:48:52 -03001673 return "???";
Mike Iselyd8554972006-06-26 20:58:46 -03001674}
1675
Mike Isely681c7392007-11-26 01:48:52 -03001676static int pvr2_decoder_enable(struct pvr2_hdw *hdw,int enablefl)
Mike Iselyd8554972006-06-26 20:58:46 -03001677{
Mike Iselyaf78e162009-03-07 00:21:30 -03001678 /* Even though we really only care about the video decoder chip at
1679 this point, we'll broadcast stream on/off to all sub-devices
1680 anyway, just in case somebody else wants to hear the
1681 command... */
Mike Iselye2605082009-03-07 01:50:48 -03001682 pvr2_trace(PVR2_TRACE_CHIPS, "subdev v4l2 stream=%s",
1683 (enablefl ? "on" : "off"));
Mike Iselyaf78e162009-03-07 00:21:30 -03001684 v4l2_device_call_all(&hdw->v4l2_dev, 0, video, s_stream, enablefl);
1685 if (hdw->decoder_client_id) {
1686 /* We get here if the encoder has been noticed. Otherwise
1687 we'll issue a warning to the user (which should
1688 normally never happen). */
1689 return 0;
1690 }
1691 if (!hdw->flag_decoder_missed) {
1692 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1693 "WARNING: No decoder present");
1694 hdw->flag_decoder_missed = !0;
1695 trace_stbit("flag_decoder_missed",
1696 hdw->flag_decoder_missed);
1697 }
1698 return -EIO;
Mike Iselyd8554972006-06-26 20:58:46 -03001699}
1700
1701
Mike Isely681c7392007-11-26 01:48:52 -03001702int pvr2_hdw_get_state(struct pvr2_hdw *hdw)
1703{
1704 return hdw->master_state;
1705}
1706
1707
1708static int pvr2_hdw_untrip_unlocked(struct pvr2_hdw *hdw)
1709{
1710 if (!hdw->flag_tripped) return 0;
1711 hdw->flag_tripped = 0;
1712 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
1713 "Clearing driver error statuss");
1714 return !0;
1715}
1716
1717
1718int pvr2_hdw_untrip(struct pvr2_hdw *hdw)
1719{
1720 int fl;
1721 LOCK_TAKE(hdw->big_lock); do {
1722 fl = pvr2_hdw_untrip_unlocked(hdw);
1723 } while (0); LOCK_GIVE(hdw->big_lock);
1724 if (fl) pvr2_hdw_state_sched(hdw);
1725 return 0;
1726}
1727
1728
Mike Isely681c7392007-11-26 01:48:52 -03001729
1730
Mike Iselyd8554972006-06-26 20:58:46 -03001731int pvr2_hdw_get_streaming(struct pvr2_hdw *hdw)
1732{
Mike Isely681c7392007-11-26 01:48:52 -03001733 return hdw->state_pipeline_req != 0;
Mike Iselyd8554972006-06-26 20:58:46 -03001734}
1735
1736
1737int pvr2_hdw_set_streaming(struct pvr2_hdw *hdw,int enable_flag)
1738{
Mike Isely681c7392007-11-26 01:48:52 -03001739 int ret,st;
Mike Iselyd8554972006-06-26 20:58:46 -03001740 LOCK_TAKE(hdw->big_lock); do {
Mike Isely681c7392007-11-26 01:48:52 -03001741 pvr2_hdw_untrip_unlocked(hdw);
1742 if ((!enable_flag) != !(hdw->state_pipeline_req)) {
1743 hdw->state_pipeline_req = enable_flag != 0;
1744 pvr2_trace(PVR2_TRACE_START_STOP,
1745 "/*--TRACE_STREAM--*/ %s",
1746 enable_flag ? "enable" : "disable");
1747 }
1748 pvr2_hdw_state_sched(hdw);
Mike Iselyd8554972006-06-26 20:58:46 -03001749 } while (0); LOCK_GIVE(hdw->big_lock);
Mike Isely681c7392007-11-26 01:48:52 -03001750 if ((ret = pvr2_hdw_wait(hdw,0)) < 0) return ret;
1751 if (enable_flag) {
1752 while ((st = hdw->master_state) != PVR2_STATE_RUN) {
1753 if (st != PVR2_STATE_READY) return -EIO;
1754 if ((ret = pvr2_hdw_wait(hdw,st)) < 0) return ret;
1755 }
1756 }
Mike Iselyd8554972006-06-26 20:58:46 -03001757 return 0;
1758}
1759
1760
1761int pvr2_hdw_set_stream_type(struct pvr2_hdw *hdw,enum pvr2_config config)
1762{
Mike Isely681c7392007-11-26 01:48:52 -03001763 int fl;
Mike Iselyd8554972006-06-26 20:58:46 -03001764 LOCK_TAKE(hdw->big_lock);
Mike Isely681c7392007-11-26 01:48:52 -03001765 if ((fl = (hdw->desired_stream_type != config)) != 0) {
1766 hdw->desired_stream_type = config;
1767 hdw->state_pipeline_config = 0;
1768 trace_stbit("state_pipeline_config",
1769 hdw->state_pipeline_config);
1770 pvr2_hdw_state_sched(hdw);
1771 }
Mike Iselyd8554972006-06-26 20:58:46 -03001772 LOCK_GIVE(hdw->big_lock);
Mike Isely681c7392007-11-26 01:48:52 -03001773 if (fl) return 0;
1774 return pvr2_hdw_wait(hdw,0);
Mike Iselyd8554972006-06-26 20:58:46 -03001775}
1776
1777
1778static int get_default_tuner_type(struct pvr2_hdw *hdw)
1779{
1780 int unit_number = hdw->unit_number;
1781 int tp = -1;
1782 if ((unit_number >= 0) && (unit_number < PVR_NUM)) {
1783 tp = tuner[unit_number];
1784 }
1785 if (tp < 0) return -EINVAL;
1786 hdw->tuner_type = tp;
Mike Iselyaaf78842007-11-26 02:04:11 -03001787 hdw->tuner_updated = !0;
Mike Iselyd8554972006-06-26 20:58:46 -03001788 return 0;
1789}
1790
1791
1792static v4l2_std_id get_default_standard(struct pvr2_hdw *hdw)
1793{
1794 int unit_number = hdw->unit_number;
1795 int tp = 0;
1796 if ((unit_number >= 0) && (unit_number < PVR_NUM)) {
1797 tp = video_std[unit_number];
Mike Isely6a540252007-12-02 23:51:34 -03001798 if (tp) return tp;
Mike Iselyd8554972006-06-26 20:58:46 -03001799 }
Mike Isely6a540252007-12-02 23:51:34 -03001800 return 0;
Mike Iselyd8554972006-06-26 20:58:46 -03001801}
1802
1803
1804static unsigned int get_default_error_tolerance(struct pvr2_hdw *hdw)
1805{
1806 int unit_number = hdw->unit_number;
1807 int tp = 0;
1808 if ((unit_number >= 0) && (unit_number < PVR_NUM)) {
1809 tp = tolerance[unit_number];
1810 }
1811 return tp;
1812}
1813
1814
1815static int pvr2_hdw_check_firmware(struct pvr2_hdw *hdw)
1816{
1817 /* Try a harmless request to fetch the eeprom's address over
1818 endpoint 1. See what happens. Only the full FX2 image can
1819 respond to this. If this probe fails then likely the FX2
1820 firmware needs be loaded. */
1821 int result;
1822 LOCK_TAKE(hdw->ctl_lock); do {
Michael Krufky8d364362007-01-22 02:17:55 -03001823 hdw->cmd_buffer[0] = FX2CMD_GET_EEPROM_ADDR;
Mike Iselyd8554972006-06-26 20:58:46 -03001824 result = pvr2_send_request_ex(hdw,HZ*1,!0,
1825 hdw->cmd_buffer,1,
1826 hdw->cmd_buffer,1);
1827 if (result < 0) break;
1828 } while(0); LOCK_GIVE(hdw->ctl_lock);
1829 if (result) {
1830 pvr2_trace(PVR2_TRACE_INIT,
1831 "Probe of device endpoint 1 result status %d",
1832 result);
1833 } else {
1834 pvr2_trace(PVR2_TRACE_INIT,
1835 "Probe of device endpoint 1 succeeded");
1836 }
1837 return result == 0;
1838}
1839
Mike Isely9f66d4e2007-09-08 22:28:51 -03001840struct pvr2_std_hack {
1841 v4l2_std_id pat; /* Pattern to match */
1842 v4l2_std_id msk; /* Which bits we care about */
1843 v4l2_std_id std; /* What additional standards or default to set */
1844};
1845
1846/* This data structure labels specific combinations of standards from
1847 tveeprom that we'll try to recognize. If we recognize one, then assume
1848 a specified default standard to use. This is here because tveeprom only
1849 tells us about available standards not the intended default standard (if
1850 any) for the device in question. We guess the default based on what has
1851 been reported as available. Note that this is only for guessing a
1852 default - which can always be overridden explicitly - and if the user
1853 has otherwise named a default then that default will always be used in
1854 place of this table. */
Tobias Klauserebff0332008-04-22 14:45:45 -03001855static const struct pvr2_std_hack std_eeprom_maps[] = {
Mike Isely9f66d4e2007-09-08 22:28:51 -03001856 { /* PAL(B/G) */
1857 .pat = V4L2_STD_B|V4L2_STD_GH,
1858 .std = V4L2_STD_PAL_B|V4L2_STD_PAL_B1|V4L2_STD_PAL_G,
1859 },
1860 { /* NTSC(M) */
1861 .pat = V4L2_STD_MN,
1862 .std = V4L2_STD_NTSC_M,
1863 },
1864 { /* PAL(I) */
1865 .pat = V4L2_STD_PAL_I,
1866 .std = V4L2_STD_PAL_I,
1867 },
1868 { /* SECAM(L/L') */
1869 .pat = V4L2_STD_SECAM_L|V4L2_STD_SECAM_LC,
1870 .std = V4L2_STD_SECAM_L|V4L2_STD_SECAM_LC,
1871 },
1872 { /* PAL(D/D1/K) */
1873 .pat = V4L2_STD_DK,
Roel Kluinea2562d2007-12-02 23:04:57 -03001874 .std = V4L2_STD_PAL_D|V4L2_STD_PAL_D1|V4L2_STD_PAL_K,
Mike Isely9f66d4e2007-09-08 22:28:51 -03001875 },
1876};
1877
Mike Iselyd8554972006-06-26 20:58:46 -03001878static void pvr2_hdw_setup_std(struct pvr2_hdw *hdw)
1879{
1880 char buf[40];
1881 unsigned int bcnt;
Mike Isely3d290bd2007-12-03 01:47:12 -03001882 v4l2_std_id std1,std2,std3;
Mike Iselyd8554972006-06-26 20:58:46 -03001883
1884 std1 = get_default_standard(hdw);
Mike Isely3d290bd2007-12-03 01:47:12 -03001885 std3 = std1 ? 0 : hdw->hdw_desc->default_std_mask;
Mike Iselyd8554972006-06-26 20:58:46 -03001886
1887 bcnt = pvr2_std_id_to_str(buf,sizeof(buf),hdw->std_mask_eeprom);
Mike Isely56585382007-09-08 22:32:12 -03001888 pvr2_trace(PVR2_TRACE_STD,
Mike Isely56dcbfa2007-11-26 02:00:51 -03001889 "Supported video standard(s) reported available"
1890 " in hardware: %.*s",
Mike Iselyd8554972006-06-26 20:58:46 -03001891 bcnt,buf);
1892
1893 hdw->std_mask_avail = hdw->std_mask_eeprom;
1894
Mike Isely3d290bd2007-12-03 01:47:12 -03001895 std2 = (std1|std3) & ~hdw->std_mask_avail;
Mike Iselyd8554972006-06-26 20:58:46 -03001896 if (std2) {
1897 bcnt = pvr2_std_id_to_str(buf,sizeof(buf),std2);
Mike Isely56585382007-09-08 22:32:12 -03001898 pvr2_trace(PVR2_TRACE_STD,
Mike Iselyd8554972006-06-26 20:58:46 -03001899 "Expanding supported video standards"
1900 " to include: %.*s",
1901 bcnt,buf);
1902 hdw->std_mask_avail |= std2;
1903 }
1904
1905 pvr2_hdw_internal_set_std_avail(hdw);
1906
1907 if (std1) {
1908 bcnt = pvr2_std_id_to_str(buf,sizeof(buf),std1);
Mike Isely56585382007-09-08 22:32:12 -03001909 pvr2_trace(PVR2_TRACE_STD,
Mike Iselyd8554972006-06-26 20:58:46 -03001910 "Initial video standard forced to %.*s",
1911 bcnt,buf);
1912 hdw->std_mask_cur = std1;
1913 hdw->std_dirty = !0;
1914 pvr2_hdw_internal_find_stdenum(hdw);
1915 return;
1916 }
Mike Isely3d290bd2007-12-03 01:47:12 -03001917 if (std3) {
1918 bcnt = pvr2_std_id_to_str(buf,sizeof(buf),std3);
1919 pvr2_trace(PVR2_TRACE_STD,
1920 "Initial video standard"
1921 " (determined by device type): %.*s",bcnt,buf);
1922 hdw->std_mask_cur = std3;
1923 hdw->std_dirty = !0;
1924 pvr2_hdw_internal_find_stdenum(hdw);
1925 return;
1926 }
Mike Iselyd8554972006-06-26 20:58:46 -03001927
Mike Isely9f66d4e2007-09-08 22:28:51 -03001928 {
1929 unsigned int idx;
1930 for (idx = 0; idx < ARRAY_SIZE(std_eeprom_maps); idx++) {
1931 if (std_eeprom_maps[idx].msk ?
1932 ((std_eeprom_maps[idx].pat ^
1933 hdw->std_mask_eeprom) &
1934 std_eeprom_maps[idx].msk) :
1935 (std_eeprom_maps[idx].pat !=
1936 hdw->std_mask_eeprom)) continue;
1937 bcnt = pvr2_std_id_to_str(buf,sizeof(buf),
1938 std_eeprom_maps[idx].std);
Mike Isely56585382007-09-08 22:32:12 -03001939 pvr2_trace(PVR2_TRACE_STD,
Mike Isely9f66d4e2007-09-08 22:28:51 -03001940 "Initial video standard guessed as %.*s",
1941 bcnt,buf);
1942 hdw->std_mask_cur = std_eeprom_maps[idx].std;
1943 hdw->std_dirty = !0;
1944 pvr2_hdw_internal_find_stdenum(hdw);
1945 return;
1946 }
1947 }
1948
Mike Iselyd8554972006-06-26 20:58:46 -03001949 if (hdw->std_enum_cnt > 1) {
1950 // Autoselect the first listed standard
1951 hdw->std_enum_cur = 1;
1952 hdw->std_mask_cur = hdw->std_defs[hdw->std_enum_cur-1].id;
1953 hdw->std_dirty = !0;
Mike Isely56585382007-09-08 22:32:12 -03001954 pvr2_trace(PVR2_TRACE_STD,
Mike Iselyd8554972006-06-26 20:58:46 -03001955 "Initial video standard auto-selected to %s",
1956 hdw->std_defs[hdw->std_enum_cur-1].name);
1957 return;
1958 }
1959
Mike Isely0885ba12006-06-25 21:30:47 -03001960 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
Mike Iselyd8554972006-06-26 20:58:46 -03001961 "Unable to select a viable initial video standard");
1962}
1963
1964
Mike Iselye9c64a72009-03-06 23:42:20 -03001965static unsigned int pvr2_copy_i2c_addr_list(
1966 unsigned short *dst, const unsigned char *src,
1967 unsigned int dst_max)
1968{
Mike Isely3ab8d292009-03-07 01:37:58 -03001969 unsigned int cnt = 0;
Mike Iselye9c64a72009-03-06 23:42:20 -03001970 if (!src) return 0;
1971 while (src[cnt] && (cnt + 1) < dst_max) {
1972 dst[cnt] = src[cnt];
1973 cnt++;
1974 }
1975 dst[cnt] = I2C_CLIENT_END;
1976 return cnt;
1977}
1978
1979
Mike Isely1ab5e742009-03-07 00:24:24 -03001980static int pvr2_hdw_load_subdev(struct pvr2_hdw *hdw,
1981 const struct pvr2_device_client_desc *cd)
Mike Iselye9c64a72009-03-06 23:42:20 -03001982{
1983 const char *fname;
1984 unsigned char mid;
1985 struct v4l2_subdev *sd;
1986 unsigned int i2ccnt;
1987 const unsigned char *p;
1988 /* Arbitrary count - max # i2c addresses we will probe */
1989 unsigned short i2caddr[25];
1990
1991 mid = cd->module_id;
1992 fname = (mid < ARRAY_SIZE(module_names)) ? module_names[mid] : NULL;
1993 if (!fname) {
1994 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
Mike Isely1ab5e742009-03-07 00:24:24 -03001995 "Module ID %u for device %s has no name",
Mike Iselye9c64a72009-03-06 23:42:20 -03001996 mid,
1997 hdw->hdw_desc->description);
Mike Isely1ab5e742009-03-07 00:24:24 -03001998 return -EINVAL;
Mike Iselye9c64a72009-03-06 23:42:20 -03001999 }
Mike Iselybd14d4f2009-03-07 00:56:52 -03002000 pvr2_trace(PVR2_TRACE_INIT,
2001 "Module ID %u (%s) for device %s being loaded...",
2002 mid, fname,
2003 hdw->hdw_desc->description);
Mike Iselye9c64a72009-03-06 23:42:20 -03002004
2005 i2ccnt = pvr2_copy_i2c_addr_list(i2caddr, cd->i2c_address_list,
2006 ARRAY_SIZE(i2caddr));
2007 if (!i2ccnt && ((p = (mid < ARRAY_SIZE(module_i2c_addresses)) ?
2008 module_i2c_addresses[mid] : NULL) != NULL)) {
2009 /* Second chance: Try default i2c address list */
2010 i2ccnt = pvr2_copy_i2c_addr_list(i2caddr, p,
2011 ARRAY_SIZE(i2caddr));
Mike Iselybd14d4f2009-03-07 00:56:52 -03002012 if (i2ccnt) {
2013 pvr2_trace(PVR2_TRACE_INIT,
2014 "Module ID %u:"
2015 " Using default i2c address list",
2016 mid);
2017 }
Mike Iselye9c64a72009-03-06 23:42:20 -03002018 }
2019
2020 if (!i2ccnt) {
2021 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
Mike Isely1ab5e742009-03-07 00:24:24 -03002022 "Module ID %u (%s) for device %s:"
2023 " No i2c addresses",
2024 mid, fname, hdw->hdw_desc->description);
2025 return -EINVAL;
Mike Iselye9c64a72009-03-06 23:42:20 -03002026 }
2027
2028 /* Note how the 2nd and 3rd arguments are the same for both
2029 * v4l2_i2c_new_subdev() and v4l2_i2c_new_probed_subdev(). Why?
2030 * Well the 2nd argument is the module name to load, while the 3rd
2031 * argument is documented in the framework as being the "chipid" -
2032 * and every other place where I can find examples of this, the
2033 * "chipid" appears to just be the module name again. So here we
2034 * just do the same thing. */
2035 if (i2ccnt == 1) {
Mike Iselybd14d4f2009-03-07 00:56:52 -03002036 pvr2_trace(PVR2_TRACE_INIT,
2037 "Module ID %u:"
2038 " Setting up with specified i2c address 0x%x",
2039 mid, i2caddr[0]);
Mike Iselye9c64a72009-03-06 23:42:20 -03002040 sd = v4l2_i2c_new_subdev(&hdw->i2c_adap,
2041 fname, fname,
2042 i2caddr[0]);
2043 } else {
Mike Iselybd14d4f2009-03-07 00:56:52 -03002044 pvr2_trace(PVR2_TRACE_INIT,
2045 "Module ID %u:"
2046 " Setting up with address probe list",
2047 mid);
Mike Iselye9c64a72009-03-06 23:42:20 -03002048 sd = v4l2_i2c_new_probed_subdev(&hdw->i2c_adap,
2049 fname, fname,
2050 i2caddr);
2051 }
2052
Mike Isely446dfdc2009-03-06 23:58:15 -03002053 if (!sd) {
2054 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
Mike Isely1ab5e742009-03-07 00:24:24 -03002055 "Module ID %u (%s) for device %s failed to load",
2056 mid, fname, hdw->hdw_desc->description);
2057 return -EIO;
Mike Isely446dfdc2009-03-06 23:58:15 -03002058 }
2059
2060 /* Tag this sub-device instance with the module ID we know about.
2061 In other places we'll use that tag to determine if the instance
2062 requires special handling. */
2063 sd->grp_id = mid;
2064
Mike Iselybd14d4f2009-03-07 00:56:52 -03002065 pvr2_trace(PVR2_TRACE_INFO, "Attached sub-driver %s", fname);
Mike Iselya932f502009-03-06 23:47:10 -03002066
Mike Iselye9c64a72009-03-06 23:42:20 -03002067
Mike Isely00e5f732009-03-07 00:17:11 -03002068 /* client-specific setup... */
2069 switch (mid) {
2070 case PVR2_CLIENT_ID_CX25840:
2071 hdw->decoder_client_id = mid;
2072 {
2073 /*
2074 Mike Isely <isely@pobox.com> 19-Nov-2006 - This
2075 bit of nuttiness for cx25840 causes that module
2076 to correctly set up its video scaling. This is
2077 really a problem in the cx25840 module itself,
2078 but we work around it here. The problem has not
2079 been seen in ivtv because there VBI is supported
2080 and set up. We don't do VBI here (at least not
2081 yet) and thus we never attempted to even set it
2082 up.
2083 */
2084 struct v4l2_format fmt;
Mike Iselybd14d4f2009-03-07 00:56:52 -03002085 pvr2_trace(PVR2_TRACE_INIT,
2086 "Module ID %u:"
2087 " Executing cx25840 VBI hack",
2088 mid);
Mike Isely00e5f732009-03-07 00:17:11 -03002089 memset(&fmt, 0, sizeof(fmt));
2090 fmt.type = V4L2_BUF_TYPE_SLICED_VBI_CAPTURE;
2091 v4l2_device_call_all(&hdw->v4l2_dev, mid,
2092 video, s_fmt, &fmt);
2093 }
2094 break;
2095 case PVR2_CLIENT_ID_SAA7115:
2096 hdw->decoder_client_id = mid;
2097 break;
2098 default: break;
2099 }
Mike Isely1ab5e742009-03-07 00:24:24 -03002100
2101 return 0;
Mike Iselye9c64a72009-03-06 23:42:20 -03002102}
2103
2104
2105static void pvr2_hdw_load_modules(struct pvr2_hdw *hdw)
2106{
2107 unsigned int idx;
2108 const struct pvr2_string_table *cm;
2109 const struct pvr2_device_client_table *ct;
Mike Isely1ab5e742009-03-07 00:24:24 -03002110 int okFl = !0;
Mike Iselye9c64a72009-03-06 23:42:20 -03002111
2112 cm = &hdw->hdw_desc->client_modules;
2113 for (idx = 0; idx < cm->cnt; idx++) {
2114 request_module(cm->lst[idx]);
2115 }
2116
2117 ct = &hdw->hdw_desc->client_table;
2118 for (idx = 0; idx < ct->cnt; idx++) {
Mike Iselybd14d4f2009-03-07 00:56:52 -03002119 if (pvr2_hdw_load_subdev(hdw, &ct->lst[idx]) < 0) okFl = 0;
Mike Iselye9c64a72009-03-06 23:42:20 -03002120 }
Mike Isely1ab5e742009-03-07 00:24:24 -03002121 if (!okFl) pvr2_hdw_render_useless(hdw);
Mike Iselye9c64a72009-03-06 23:42:20 -03002122}
2123
2124
Mike Iselyd8554972006-06-26 20:58:46 -03002125static void pvr2_hdw_setup_low(struct pvr2_hdw *hdw)
2126{
2127 int ret;
2128 unsigned int idx;
2129 struct pvr2_ctrl *cptr;
2130 int reloadFl = 0;
Mike Isely989eb152007-11-26 01:53:12 -03002131 if (hdw->hdw_desc->fx2_firmware.cnt) {
Mike Isely1d643a32007-09-08 22:18:50 -03002132 if (!reloadFl) {
2133 reloadFl =
2134 (hdw->usb_intf->cur_altsetting->desc.bNumEndpoints
2135 == 0);
2136 if (reloadFl) {
2137 pvr2_trace(PVR2_TRACE_INIT,
2138 "USB endpoint config looks strange"
2139 "; possibly firmware needs to be"
2140 " loaded");
2141 }
2142 }
2143 if (!reloadFl) {
2144 reloadFl = !pvr2_hdw_check_firmware(hdw);
2145 if (reloadFl) {
2146 pvr2_trace(PVR2_TRACE_INIT,
2147 "Check for FX2 firmware failed"
2148 "; possibly firmware needs to be"
2149 " loaded");
2150 }
2151 }
Mike Iselyd8554972006-06-26 20:58:46 -03002152 if (reloadFl) {
Mike Isely1d643a32007-09-08 22:18:50 -03002153 if (pvr2_upload_firmware1(hdw) != 0) {
2154 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
2155 "Failure uploading firmware1");
2156 }
2157 return;
Mike Iselyd8554972006-06-26 20:58:46 -03002158 }
2159 }
Mike Iselyd8554972006-06-26 20:58:46 -03002160 hdw->fw1_state = FW1_STATE_OK;
2161
Mike Iselyd8554972006-06-26 20:58:46 -03002162 if (!pvr2_hdw_dev_ok(hdw)) return;
2163
Mike Isely27764722009-03-07 01:57:25 -03002164 hdw->force_dirty = !0;
2165
Mike Isely989eb152007-11-26 01:53:12 -03002166 if (!hdw->hdw_desc->flag_no_powerup) {
Mike Isely1d643a32007-09-08 22:18:50 -03002167 pvr2_hdw_cmd_powerup(hdw);
2168 if (!pvr2_hdw_dev_ok(hdw)) return;
Mike Iselyd8554972006-06-26 20:58:46 -03002169 }
2170
Mike Isely31335b12008-07-25 19:35:31 -03002171 /* Take the IR chip out of reset, if appropriate */
2172 if (hdw->hdw_desc->ir_scheme == PVR2_IR_SCHEME_ZILOG) {
2173 pvr2_issue_simple_cmd(hdw,
2174 FX2CMD_HCW_ZILOG_RESET |
2175 (1 << 8) |
2176 ((0) << 16));
2177 }
2178
Mike Iselyd8554972006-06-26 20:58:46 -03002179 // This step MUST happen after the earlier powerup step.
2180 pvr2_i2c_core_init(hdw);
2181 if (!pvr2_hdw_dev_ok(hdw)) return;
2182
Mike Iselye9c64a72009-03-06 23:42:20 -03002183 pvr2_hdw_load_modules(hdw);
Mike Isely1ab5e742009-03-07 00:24:24 -03002184 if (!pvr2_hdw_dev_ok(hdw)) return;
Mike Iselye9c64a72009-03-06 23:42:20 -03002185
Mike Isely5c6cb4e2009-03-07 01:59:34 -03002186 v4l2_device_call_all(&hdw->v4l2_dev, 0, core, init, 0);
2187
Mike Iselyc05c0462006-06-25 20:04:25 -03002188 for (idx = 0; idx < CTRLDEF_COUNT; idx++) {
Mike Iselyd8554972006-06-26 20:58:46 -03002189 cptr = hdw->controls + idx;
2190 if (cptr->info->skip_init) continue;
2191 if (!cptr->info->set_value) continue;
2192 cptr->info->set_value(cptr,~0,cptr->info->default_value);
2193 }
2194
Mike Isely1bde0282006-12-27 23:30:13 -03002195 /* Set up special default values for the television and radio
2196 frequencies here. It's not really important what these defaults
2197 are, but I set them to something usable in the Chicago area just
2198 to make driver testing a little easier. */
2199
Michael Krufky5a4f5da62008-05-11 16:37:50 -03002200 hdw->freqValTelevision = default_tv_freq;
2201 hdw->freqValRadio = default_radio_freq;
Mike Isely1bde0282006-12-27 23:30:13 -03002202
Mike Iselyd8554972006-06-26 20:58:46 -03002203 // Do not use pvr2_reset_ctl_endpoints() here. It is not
2204 // thread-safe against the normal pvr2_send_request() mechanism.
2205 // (We should make it thread safe).
2206
Mike Iselyaaf78842007-11-26 02:04:11 -03002207 if (hdw->hdw_desc->flag_has_hauppauge_rom) {
2208 ret = pvr2_hdw_get_eeprom_addr(hdw);
Mike Iselyd8554972006-06-26 20:58:46 -03002209 if (!pvr2_hdw_dev_ok(hdw)) return;
Mike Iselyaaf78842007-11-26 02:04:11 -03002210 if (ret < 0) {
2211 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
2212 "Unable to determine location of eeprom,"
2213 " skipping");
2214 } else {
2215 hdw->eeprom_addr = ret;
2216 pvr2_eeprom_analyze(hdw);
2217 if (!pvr2_hdw_dev_ok(hdw)) return;
2218 }
2219 } else {
2220 hdw->tuner_type = hdw->hdw_desc->default_tuner_type;
2221 hdw->tuner_updated = !0;
2222 hdw->std_mask_eeprom = V4L2_STD_ALL;
Mike Iselyd8554972006-06-26 20:58:46 -03002223 }
2224
Mike Isely13a88792009-01-14 04:22:56 -03002225 if (hdw->serial_number) {
2226 idx = scnprintf(hdw->identifier, sizeof(hdw->identifier) - 1,
2227 "sn-%lu", hdw->serial_number);
2228 } else if (hdw->unit_number >= 0) {
2229 idx = scnprintf(hdw->identifier, sizeof(hdw->identifier) - 1,
2230 "unit-%c",
2231 hdw->unit_number + 'a');
2232 } else {
2233 idx = scnprintf(hdw->identifier, sizeof(hdw->identifier) - 1,
2234 "unit-??");
2235 }
2236 hdw->identifier[idx] = 0;
2237
Mike Iselyd8554972006-06-26 20:58:46 -03002238 pvr2_hdw_setup_std(hdw);
2239
2240 if (!get_default_tuner_type(hdw)) {
2241 pvr2_trace(PVR2_TRACE_INIT,
2242 "pvr2_hdw_setup: Tuner type overridden to %d",
2243 hdw->tuner_type);
2244 }
2245
Mike Iselyd8554972006-06-26 20:58:46 -03002246
2247 if (!pvr2_hdw_dev_ok(hdw)) return;
2248
Mike Isely1df59f02008-04-21 03:50:39 -03002249 if (hdw->hdw_desc->signal_routing_scheme ==
2250 PVR2_ROUTING_SCHEME_GOTVIEW) {
2251 /* Ensure that GPIO 11 is set to output for GOTVIEW
2252 hardware. */
2253 pvr2_hdw_gpio_chg_dir(hdw,(1 << 11),~0);
2254 }
2255
Mike Isely681c7392007-11-26 01:48:52 -03002256 pvr2_hdw_commit_setup(hdw);
Mike Iselyd8554972006-06-26 20:58:46 -03002257
2258 hdw->vid_stream = pvr2_stream_create();
2259 if (!pvr2_hdw_dev_ok(hdw)) return;
2260 pvr2_trace(PVR2_TRACE_INIT,
2261 "pvr2_hdw_setup: video stream is %p",hdw->vid_stream);
2262 if (hdw->vid_stream) {
2263 idx = get_default_error_tolerance(hdw);
2264 if (idx) {
2265 pvr2_trace(PVR2_TRACE_INIT,
2266 "pvr2_hdw_setup: video stream %p"
2267 " setting tolerance %u",
2268 hdw->vid_stream,idx);
2269 }
2270 pvr2_stream_setup(hdw->vid_stream,hdw->usb_dev,
2271 PVR2_VID_ENDPOINT,idx);
2272 }
2273
2274 if (!pvr2_hdw_dev_ok(hdw)) return;
2275
Mike Iselyd8554972006-06-26 20:58:46 -03002276 hdw->flag_init_ok = !0;
Mike Isely681c7392007-11-26 01:48:52 -03002277
2278 pvr2_hdw_state_sched(hdw);
Mike Iselyd8554972006-06-26 20:58:46 -03002279}
2280
2281
Mike Isely681c7392007-11-26 01:48:52 -03002282/* Set up the structure and attempt to put the device into a usable state.
2283 This can be a time-consuming operation, which is why it is not done
2284 internally as part of the create() step. */
2285static void pvr2_hdw_setup(struct pvr2_hdw *hdw)
Mike Iselyd8554972006-06-26 20:58:46 -03002286{
2287 pvr2_trace(PVR2_TRACE_INIT,"pvr2_hdw_setup(hdw=%p) begin",hdw);
Mike Isely681c7392007-11-26 01:48:52 -03002288 do {
Mike Iselyd8554972006-06-26 20:58:46 -03002289 pvr2_hdw_setup_low(hdw);
2290 pvr2_trace(PVR2_TRACE_INIT,
2291 "pvr2_hdw_setup(hdw=%p) done, ok=%d init_ok=%d",
Mike Isely681c7392007-11-26 01:48:52 -03002292 hdw,pvr2_hdw_dev_ok(hdw),hdw->flag_init_ok);
Mike Iselyd8554972006-06-26 20:58:46 -03002293 if (pvr2_hdw_dev_ok(hdw)) {
Mike Isely681c7392007-11-26 01:48:52 -03002294 if (hdw->flag_init_ok) {
Mike Iselyd8554972006-06-26 20:58:46 -03002295 pvr2_trace(
2296 PVR2_TRACE_INFO,
2297 "Device initialization"
2298 " completed successfully.");
2299 break;
2300 }
2301 if (hdw->fw1_state == FW1_STATE_RELOAD) {
2302 pvr2_trace(
2303 PVR2_TRACE_INFO,
2304 "Device microcontroller firmware"
2305 " (re)loaded; it should now reset"
2306 " and reconnect.");
2307 break;
2308 }
2309 pvr2_trace(
2310 PVR2_TRACE_ERROR_LEGS,
2311 "Device initialization was not successful.");
2312 if (hdw->fw1_state == FW1_STATE_MISSING) {
2313 pvr2_trace(
2314 PVR2_TRACE_ERROR_LEGS,
2315 "Giving up since device"
2316 " microcontroller firmware"
2317 " appears to be missing.");
2318 break;
2319 }
2320 }
2321 if (procreload) {
2322 pvr2_trace(
2323 PVR2_TRACE_ERROR_LEGS,
2324 "Attempting pvrusb2 recovery by reloading"
2325 " primary firmware.");
2326 pvr2_trace(
2327 PVR2_TRACE_ERROR_LEGS,
2328 "If this works, device should disconnect"
2329 " and reconnect in a sane state.");
2330 hdw->fw1_state = FW1_STATE_UNKNOWN;
2331 pvr2_upload_firmware1(hdw);
2332 } else {
2333 pvr2_trace(
2334 PVR2_TRACE_ERROR_LEGS,
2335 "***WARNING*** pvrusb2 device hardware"
2336 " appears to be jammed"
2337 " and I can't clear it.");
2338 pvr2_trace(
2339 PVR2_TRACE_ERROR_LEGS,
2340 "You might need to power cycle"
2341 " the pvrusb2 device"
2342 " in order to recover.");
2343 }
Mike Isely681c7392007-11-26 01:48:52 -03002344 } while (0);
Mike Iselyd8554972006-06-26 20:58:46 -03002345 pvr2_trace(PVR2_TRACE_INIT,"pvr2_hdw_setup(hdw=%p) end",hdw);
Mike Iselyd8554972006-06-26 20:58:46 -03002346}
2347
2348
Mike Iselyc4a8828d2008-04-22 14:45:44 -03002349/* Perform second stage initialization. Set callback pointer first so that
2350 we can avoid a possible initialization race (if the kernel thread runs
2351 before the callback has been set). */
Mike Isely794b1602008-04-22 14:45:45 -03002352int pvr2_hdw_initialize(struct pvr2_hdw *hdw,
2353 void (*callback_func)(void *),
2354 void *callback_data)
Mike Iselyc4a8828d2008-04-22 14:45:44 -03002355{
2356 LOCK_TAKE(hdw->big_lock); do {
Mike Isely97f26ff2008-04-07 02:22:43 -03002357 if (hdw->flag_disconnected) {
2358 /* Handle a race here: If we're already
2359 disconnected by this point, then give up. If we
2360 get past this then we'll remain connected for
2361 the duration of initialization since the entire
2362 initialization sequence is now protected by the
2363 big_lock. */
2364 break;
2365 }
Mike Iselyc4a8828d2008-04-22 14:45:44 -03002366 hdw->state_data = callback_data;
2367 hdw->state_func = callback_func;
Mike Isely97f26ff2008-04-07 02:22:43 -03002368 pvr2_hdw_setup(hdw);
Mike Iselyc4a8828d2008-04-22 14:45:44 -03002369 } while (0); LOCK_GIVE(hdw->big_lock);
Mike Isely794b1602008-04-22 14:45:45 -03002370 return hdw->flag_init_ok;
Mike Iselyc4a8828d2008-04-22 14:45:44 -03002371}
2372
2373
2374/* Create, set up, and return a structure for interacting with the
2375 underlying hardware. */
Mike Iselyd8554972006-06-26 20:58:46 -03002376struct pvr2_hdw *pvr2_hdw_create(struct usb_interface *intf,
2377 const struct usb_device_id *devid)
2378{
Mike Isely7fb20fa2008-04-22 14:45:37 -03002379 unsigned int idx,cnt1,cnt2,m;
Mike Iselyfe15f132008-08-30 18:11:40 -03002380 struct pvr2_hdw *hdw = NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002381 int valid_std_mask;
2382 struct pvr2_ctrl *cptr;
Mike Iselyb72b7bf2009-03-06 23:20:31 -03002383 struct usb_device *usb_dev;
Mike Isely989eb152007-11-26 01:53:12 -03002384 const struct pvr2_device_desc *hdw_desc;
Mike Iselyd8554972006-06-26 20:58:46 -03002385 __u8 ifnum;
Mike Iselyb30d2442006-06-25 20:05:01 -03002386 struct v4l2_queryctrl qctrl;
2387 struct pvr2_ctl_info *ciptr;
Mike Iselyd8554972006-06-26 20:58:46 -03002388
Mike Iselyb72b7bf2009-03-06 23:20:31 -03002389 usb_dev = interface_to_usbdev(intf);
2390
Mike Iselyd130fa82007-12-08 17:20:06 -03002391 hdw_desc = (const struct pvr2_device_desc *)(devid->driver_info);
Mike Iselyd8554972006-06-26 20:58:46 -03002392
Mike Iselyfe15f132008-08-30 18:11:40 -03002393 if (hdw_desc == NULL) {
2394 pvr2_trace(PVR2_TRACE_INIT, "pvr2_hdw_create:"
2395 " No device description pointer,"
2396 " unable to continue.");
2397 pvr2_trace(PVR2_TRACE_INIT, "If you have a new device type,"
2398 " please contact Mike Isely <isely@pobox.com>"
2399 " to get it included in the driver\n");
2400 goto fail;
2401 }
2402
Mike Iselyca545f72007-01-20 00:37:11 -03002403 hdw = kzalloc(sizeof(*hdw),GFP_KERNEL);
Mike Iselyd8554972006-06-26 20:58:46 -03002404 pvr2_trace(PVR2_TRACE_INIT,"pvr2_hdw_create: hdw=%p, type \"%s\"",
Mike Isely989eb152007-11-26 01:53:12 -03002405 hdw,hdw_desc->description);
Mike Iselyd8554972006-06-26 20:58:46 -03002406 if (!hdw) goto fail;
Mike Isely681c7392007-11-26 01:48:52 -03002407
2408 init_timer(&hdw->quiescent_timer);
2409 hdw->quiescent_timer.data = (unsigned long)hdw;
2410 hdw->quiescent_timer.function = pvr2_hdw_quiescent_timeout;
2411
2412 init_timer(&hdw->encoder_wait_timer);
2413 hdw->encoder_wait_timer.data = (unsigned long)hdw;
2414 hdw->encoder_wait_timer.function = pvr2_hdw_encoder_wait_timeout;
2415
Mike Iselyd913d632008-04-06 04:04:35 -03002416 init_timer(&hdw->encoder_run_timer);
2417 hdw->encoder_run_timer.data = (unsigned long)hdw;
2418 hdw->encoder_run_timer.function = pvr2_hdw_encoder_run_timeout;
2419
Mike Isely681c7392007-11-26 01:48:52 -03002420 hdw->master_state = PVR2_STATE_DEAD;
2421
2422 init_waitqueue_head(&hdw->state_wait_data);
2423
Mike Isely18103c572007-01-20 00:09:47 -03002424 hdw->tuner_signal_stale = !0;
Mike Iselyb30d2442006-06-25 20:05:01 -03002425 cx2341x_fill_defaults(&hdw->enc_ctl_state);
Mike Iselyd8554972006-06-26 20:58:46 -03002426
Mike Isely7fb20fa2008-04-22 14:45:37 -03002427 /* Calculate which inputs are OK */
2428 m = 0;
2429 if (hdw_desc->flag_has_analogtuner) m |= 1 << PVR2_CVAL_INPUT_TV;
Mike Iselye8f5bac2008-04-22 14:45:40 -03002430 if (hdw_desc->digital_control_scheme != PVR2_DIGITAL_SCHEME_NONE) {
2431 m |= 1 << PVR2_CVAL_INPUT_DTV;
2432 }
Mike Isely7fb20fa2008-04-22 14:45:37 -03002433 if (hdw_desc->flag_has_svideo) m |= 1 << PVR2_CVAL_INPUT_SVIDEO;
2434 if (hdw_desc->flag_has_composite) m |= 1 << PVR2_CVAL_INPUT_COMPOSITE;
2435 if (hdw_desc->flag_has_fmradio) m |= 1 << PVR2_CVAL_INPUT_RADIO;
2436 hdw->input_avail_mask = m;
Mike Isely1cb03b72008-04-21 03:47:43 -03002437 hdw->input_allowed_mask = hdw->input_avail_mask;
Mike Isely7fb20fa2008-04-22 14:45:37 -03002438
Mike Isely62433e32008-04-22 14:45:40 -03002439 /* If not a hybrid device, pathway_state never changes. So
2440 initialize it here to what it should forever be. */
2441 if (!(hdw->input_avail_mask & (1 << PVR2_CVAL_INPUT_DTV))) {
2442 hdw->pathway_state = PVR2_PATHWAY_ANALOG;
2443 } else if (!(hdw->input_avail_mask & (1 << PVR2_CVAL_INPUT_TV))) {
2444 hdw->pathway_state = PVR2_PATHWAY_DIGITAL;
2445 }
2446
Mike Iselyc05c0462006-06-25 20:04:25 -03002447 hdw->control_cnt = CTRLDEF_COUNT;
Mike Iselyb30d2442006-06-25 20:05:01 -03002448 hdw->control_cnt += MPEGDEF_COUNT;
Mike Iselyca545f72007-01-20 00:37:11 -03002449 hdw->controls = kzalloc(sizeof(struct pvr2_ctrl) * hdw->control_cnt,
Mike Iselyd8554972006-06-26 20:58:46 -03002450 GFP_KERNEL);
2451 if (!hdw->controls) goto fail;
Mike Isely989eb152007-11-26 01:53:12 -03002452 hdw->hdw_desc = hdw_desc;
Mike Iselyc05c0462006-06-25 20:04:25 -03002453 for (idx = 0; idx < hdw->control_cnt; idx++) {
2454 cptr = hdw->controls + idx;
2455 cptr->hdw = hdw;
2456 }
Mike Iselyd8554972006-06-26 20:58:46 -03002457 for (idx = 0; idx < 32; idx++) {
2458 hdw->std_mask_ptrs[idx] = hdw->std_mask_names[idx];
2459 }
Mike Iselyc05c0462006-06-25 20:04:25 -03002460 for (idx = 0; idx < CTRLDEF_COUNT; idx++) {
Mike Iselyd8554972006-06-26 20:58:46 -03002461 cptr = hdw->controls + idx;
Mike Iselyd8554972006-06-26 20:58:46 -03002462 cptr->info = control_defs+idx;
2463 }
Mike Iselydbc40a02008-04-22 14:45:39 -03002464
2465 /* Ensure that default input choice is a valid one. */
2466 m = hdw->input_avail_mask;
2467 if (m) for (idx = 0; idx < (sizeof(m) << 3); idx++) {
2468 if (!((1 << idx) & m)) continue;
2469 hdw->input_val = idx;
2470 break;
2471 }
2472
Mike Iselyb30d2442006-06-25 20:05:01 -03002473 /* Define and configure additional controls from cx2341x module. */
Mike Iselyca545f72007-01-20 00:37:11 -03002474 hdw->mpeg_ctrl_info = kzalloc(
Mike Iselyb30d2442006-06-25 20:05:01 -03002475 sizeof(*(hdw->mpeg_ctrl_info)) * MPEGDEF_COUNT, GFP_KERNEL);
2476 if (!hdw->mpeg_ctrl_info) goto fail;
Mike Iselyb30d2442006-06-25 20:05:01 -03002477 for (idx = 0; idx < MPEGDEF_COUNT; idx++) {
2478 cptr = hdw->controls + idx + CTRLDEF_COUNT;
2479 ciptr = &(hdw->mpeg_ctrl_info[idx].info);
2480 ciptr->desc = hdw->mpeg_ctrl_info[idx].desc;
2481 ciptr->name = mpeg_ids[idx].strid;
2482 ciptr->v4l_id = mpeg_ids[idx].id;
2483 ciptr->skip_init = !0;
2484 ciptr->get_value = ctrl_cx2341x_get;
2485 ciptr->get_v4lflags = ctrl_cx2341x_getv4lflags;
2486 ciptr->is_dirty = ctrl_cx2341x_is_dirty;
2487 if (!idx) ciptr->clear_dirty = ctrl_cx2341x_clear_dirty;
2488 qctrl.id = ciptr->v4l_id;
2489 cx2341x_ctrl_query(&hdw->enc_ctl_state,&qctrl);
2490 if (!(qctrl.flags & V4L2_CTRL_FLAG_READ_ONLY)) {
2491 ciptr->set_value = ctrl_cx2341x_set;
2492 }
2493 strncpy(hdw->mpeg_ctrl_info[idx].desc,qctrl.name,
2494 PVR2_CTLD_INFO_DESC_SIZE);
2495 hdw->mpeg_ctrl_info[idx].desc[PVR2_CTLD_INFO_DESC_SIZE-1] = 0;
2496 ciptr->default_value = qctrl.default_value;
2497 switch (qctrl.type) {
2498 default:
2499 case V4L2_CTRL_TYPE_INTEGER:
2500 ciptr->type = pvr2_ctl_int;
2501 ciptr->def.type_int.min_value = qctrl.minimum;
2502 ciptr->def.type_int.max_value = qctrl.maximum;
2503 break;
2504 case V4L2_CTRL_TYPE_BOOLEAN:
2505 ciptr->type = pvr2_ctl_bool;
2506 break;
2507 case V4L2_CTRL_TYPE_MENU:
2508 ciptr->type = pvr2_ctl_enum;
2509 ciptr->def.type_enum.value_names =
Hans Verkuile0e31cd2008-06-22 12:03:28 -03002510 cx2341x_ctrl_get_menu(&hdw->enc_ctl_state,
2511 ciptr->v4l_id);
Mike Iselyb30d2442006-06-25 20:05:01 -03002512 for (cnt1 = 0;
2513 ciptr->def.type_enum.value_names[cnt1] != NULL;
2514 cnt1++) { }
2515 ciptr->def.type_enum.count = cnt1;
2516 break;
2517 }
2518 cptr->info = ciptr;
2519 }
Mike Iselyd8554972006-06-26 20:58:46 -03002520
2521 // Initialize video standard enum dynamic control
2522 cptr = pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_STDENUM);
2523 if (cptr) {
2524 memcpy(&hdw->std_info_enum,cptr->info,
2525 sizeof(hdw->std_info_enum));
2526 cptr->info = &hdw->std_info_enum;
2527
2528 }
2529 // Initialize control data regarding video standard masks
2530 valid_std_mask = pvr2_std_get_usable();
2531 for (idx = 0; idx < 32; idx++) {
2532 if (!(valid_std_mask & (1 << idx))) continue;
2533 cnt1 = pvr2_std_id_to_str(
2534 hdw->std_mask_names[idx],
2535 sizeof(hdw->std_mask_names[idx])-1,
2536 1 << idx);
2537 hdw->std_mask_names[idx][cnt1] = 0;
2538 }
2539 cptr = pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_STDAVAIL);
2540 if (cptr) {
2541 memcpy(&hdw->std_info_avail,cptr->info,
2542 sizeof(hdw->std_info_avail));
2543 cptr->info = &hdw->std_info_avail;
2544 hdw->std_info_avail.def.type_bitmask.bit_names =
2545 hdw->std_mask_ptrs;
2546 hdw->std_info_avail.def.type_bitmask.valid_bits =
2547 valid_std_mask;
2548 }
2549 cptr = pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_STDCUR);
2550 if (cptr) {
2551 memcpy(&hdw->std_info_cur,cptr->info,
2552 sizeof(hdw->std_info_cur));
2553 cptr->info = &hdw->std_info_cur;
2554 hdw->std_info_cur.def.type_bitmask.bit_names =
2555 hdw->std_mask_ptrs;
2556 hdw->std_info_avail.def.type_bitmask.valid_bits =
2557 valid_std_mask;
2558 }
2559
Mike Isely432907f2008-08-31 21:02:20 -03002560 hdw->cropcap_stale = !0;
Mike Iselyd8554972006-06-26 20:58:46 -03002561 hdw->eeprom_addr = -1;
2562 hdw->unit_number = -1;
Mike Isely80793842006-12-27 23:12:28 -03002563 hdw->v4l_minor_number_video = -1;
2564 hdw->v4l_minor_number_vbi = -1;
Mike Iselyfd5a75f2006-12-27 23:11:22 -03002565 hdw->v4l_minor_number_radio = -1;
Mike Iselyd8554972006-06-26 20:58:46 -03002566 hdw->ctl_write_buffer = kmalloc(PVR2_CTL_BUFFSIZE,GFP_KERNEL);
2567 if (!hdw->ctl_write_buffer) goto fail;
2568 hdw->ctl_read_buffer = kmalloc(PVR2_CTL_BUFFSIZE,GFP_KERNEL);
2569 if (!hdw->ctl_read_buffer) goto fail;
2570 hdw->ctl_write_urb = usb_alloc_urb(0,GFP_KERNEL);
2571 if (!hdw->ctl_write_urb) goto fail;
2572 hdw->ctl_read_urb = usb_alloc_urb(0,GFP_KERNEL);
2573 if (!hdw->ctl_read_urb) goto fail;
2574
Mike Iselyb72b7bf2009-03-06 23:20:31 -03002575 if (v4l2_device_register(&usb_dev->dev, &hdw->v4l2_dev) != 0) {
2576 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
2577 "Error registering with v4l core, giving up");
2578 goto fail;
2579 }
Matthias Kaehlcke8df0c872007-04-28 20:00:18 -03002580 mutex_lock(&pvr2_unit_mtx); do {
Mike Iselyd8554972006-06-26 20:58:46 -03002581 for (idx = 0; idx < PVR_NUM; idx++) {
2582 if (unit_pointers[idx]) continue;
2583 hdw->unit_number = idx;
2584 unit_pointers[idx] = hdw;
2585 break;
2586 }
Matthias Kaehlcke8df0c872007-04-28 20:00:18 -03002587 } while (0); mutex_unlock(&pvr2_unit_mtx);
Mike Iselyd8554972006-06-26 20:58:46 -03002588
2589 cnt1 = 0;
2590 cnt2 = scnprintf(hdw->name+cnt1,sizeof(hdw->name)-cnt1,"pvrusb2");
2591 cnt1 += cnt2;
2592 if (hdw->unit_number >= 0) {
2593 cnt2 = scnprintf(hdw->name+cnt1,sizeof(hdw->name)-cnt1,"_%c",
2594 ('a' + hdw->unit_number));
2595 cnt1 += cnt2;
2596 }
2597 if (cnt1 >= sizeof(hdw->name)) cnt1 = sizeof(hdw->name)-1;
2598 hdw->name[cnt1] = 0;
2599
Mike Isely681c7392007-11-26 01:48:52 -03002600 hdw->workqueue = create_singlethread_workqueue(hdw->name);
2601 INIT_WORK(&hdw->workpoll,pvr2_hdw_worker_poll);
Mike Isely681c7392007-11-26 01:48:52 -03002602
Mike Iselyd8554972006-06-26 20:58:46 -03002603 pvr2_trace(PVR2_TRACE_INIT,"Driver unit number is %d, name is %s",
2604 hdw->unit_number,hdw->name);
2605
2606 hdw->tuner_type = -1;
2607 hdw->flag_ok = !0;
Mike Iselyd8554972006-06-26 20:58:46 -03002608
2609 hdw->usb_intf = intf;
Mike Iselyb72b7bf2009-03-06 23:20:31 -03002610 hdw->usb_dev = usb_dev;
Mike Iselyd8554972006-06-26 20:58:46 -03002611
Mike Isely87e34952009-01-23 01:20:24 -03002612 usb_make_path(hdw->usb_dev, hdw->bus_info, sizeof(hdw->bus_info));
Mike Isely31a18542007-04-08 01:11:47 -03002613
Mike Iselyd8554972006-06-26 20:58:46 -03002614 ifnum = hdw->usb_intf->cur_altsetting->desc.bInterfaceNumber;
2615 usb_set_interface(hdw->usb_dev,ifnum,0);
2616
2617 mutex_init(&hdw->ctl_lock_mutex);
2618 mutex_init(&hdw->big_lock_mutex);
2619
2620 return hdw;
2621 fail:
2622 if (hdw) {
Mike Isely681c7392007-11-26 01:48:52 -03002623 del_timer_sync(&hdw->quiescent_timer);
Mike Iselyd913d632008-04-06 04:04:35 -03002624 del_timer_sync(&hdw->encoder_run_timer);
Mike Isely681c7392007-11-26 01:48:52 -03002625 del_timer_sync(&hdw->encoder_wait_timer);
2626 if (hdw->workqueue) {
2627 flush_workqueue(hdw->workqueue);
2628 destroy_workqueue(hdw->workqueue);
2629 hdw->workqueue = NULL;
2630 }
Mariusz Kozlowski5e55d2c2006-11-08 15:34:31 +01002631 usb_free_urb(hdw->ctl_read_urb);
2632 usb_free_urb(hdw->ctl_write_urb);
Mariusz Kozlowski22071a42007-01-07 10:33:39 -03002633 kfree(hdw->ctl_read_buffer);
2634 kfree(hdw->ctl_write_buffer);
2635 kfree(hdw->controls);
2636 kfree(hdw->mpeg_ctrl_info);
Mike Isely681c7392007-11-26 01:48:52 -03002637 kfree(hdw->std_defs);
2638 kfree(hdw->std_enum_names);
Mike Iselyd8554972006-06-26 20:58:46 -03002639 kfree(hdw);
2640 }
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002641 return NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002642}
2643
2644
2645/* Remove _all_ associations between this driver and the underlying USB
2646 layer. */
Adrian Bunk07e337e2006-06-30 11:30:20 -03002647static void pvr2_hdw_remove_usb_stuff(struct pvr2_hdw *hdw)
Mike Iselyd8554972006-06-26 20:58:46 -03002648{
2649 if (hdw->flag_disconnected) return;
2650 pvr2_trace(PVR2_TRACE_INIT,"pvr2_hdw_remove_usb_stuff: hdw=%p",hdw);
2651 if (hdw->ctl_read_urb) {
2652 usb_kill_urb(hdw->ctl_read_urb);
2653 usb_free_urb(hdw->ctl_read_urb);
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002654 hdw->ctl_read_urb = NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002655 }
2656 if (hdw->ctl_write_urb) {
2657 usb_kill_urb(hdw->ctl_write_urb);
2658 usb_free_urb(hdw->ctl_write_urb);
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002659 hdw->ctl_write_urb = NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002660 }
2661 if (hdw->ctl_read_buffer) {
2662 kfree(hdw->ctl_read_buffer);
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002663 hdw->ctl_read_buffer = NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002664 }
2665 if (hdw->ctl_write_buffer) {
2666 kfree(hdw->ctl_write_buffer);
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002667 hdw->ctl_write_buffer = NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002668 }
Mike Iselyd8554972006-06-26 20:58:46 -03002669 hdw->flag_disconnected = !0;
Mike Iselyb72b7bf2009-03-06 23:20:31 -03002670 /* If we don't do this, then there will be a dangling struct device
2671 reference to our disappearing device persisting inside the V4L
2672 core... */
2673 if (hdw->v4l2_dev.dev) {
2674 dev_set_drvdata(hdw->v4l2_dev.dev, NULL);
2675 hdw->v4l2_dev.dev = NULL;
2676 }
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002677 hdw->usb_dev = NULL;
2678 hdw->usb_intf = NULL;
Mike Isely681c7392007-11-26 01:48:52 -03002679 pvr2_hdw_render_useless(hdw);
Mike Iselyd8554972006-06-26 20:58:46 -03002680}
2681
2682
2683/* Destroy hardware interaction structure */
2684void pvr2_hdw_destroy(struct pvr2_hdw *hdw)
2685{
Mike Isely401c27c2007-09-08 22:11:46 -03002686 if (!hdw) return;
Mike Iselyd8554972006-06-26 20:58:46 -03002687 pvr2_trace(PVR2_TRACE_INIT,"pvr2_hdw_destroy: hdw=%p",hdw);
Mike Isely681c7392007-11-26 01:48:52 -03002688 if (hdw->workqueue) {
2689 flush_workqueue(hdw->workqueue);
2690 destroy_workqueue(hdw->workqueue);
2691 hdw->workqueue = NULL;
2692 }
Mike Isely8f591002008-04-22 14:45:45 -03002693 del_timer_sync(&hdw->quiescent_timer);
Mike Iselyd913d632008-04-06 04:04:35 -03002694 del_timer_sync(&hdw->encoder_run_timer);
Mike Isely8f591002008-04-22 14:45:45 -03002695 del_timer_sync(&hdw->encoder_wait_timer);
Mike Iselyd8554972006-06-26 20:58:46 -03002696 if (hdw->fw_buffer) {
2697 kfree(hdw->fw_buffer);
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002698 hdw->fw_buffer = NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002699 }
2700 if (hdw->vid_stream) {
2701 pvr2_stream_destroy(hdw->vid_stream);
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002702 hdw->vid_stream = NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002703 }
Mike Iselyd8554972006-06-26 20:58:46 -03002704 pvr2_i2c_core_done(hdw);
Mike Iselyb72b7bf2009-03-06 23:20:31 -03002705 v4l2_device_unregister(&hdw->v4l2_dev);
Mike Iselyd8554972006-06-26 20:58:46 -03002706 pvr2_hdw_remove_usb_stuff(hdw);
Matthias Kaehlcke8df0c872007-04-28 20:00:18 -03002707 mutex_lock(&pvr2_unit_mtx); do {
Mike Iselyd8554972006-06-26 20:58:46 -03002708 if ((hdw->unit_number >= 0) &&
2709 (hdw->unit_number < PVR_NUM) &&
2710 (unit_pointers[hdw->unit_number] == hdw)) {
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002711 unit_pointers[hdw->unit_number] = NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002712 }
Matthias Kaehlcke8df0c872007-04-28 20:00:18 -03002713 } while (0); mutex_unlock(&pvr2_unit_mtx);
Mariusz Kozlowski22071a42007-01-07 10:33:39 -03002714 kfree(hdw->controls);
2715 kfree(hdw->mpeg_ctrl_info);
2716 kfree(hdw->std_defs);
2717 kfree(hdw->std_enum_names);
Mike Iselyd8554972006-06-26 20:58:46 -03002718 kfree(hdw);
2719}
2720
2721
Mike Iselyd8554972006-06-26 20:58:46 -03002722int pvr2_hdw_dev_ok(struct pvr2_hdw *hdw)
2723{
2724 return (hdw && hdw->flag_ok);
2725}
2726
2727
2728/* Called when hardware has been unplugged */
2729void pvr2_hdw_disconnect(struct pvr2_hdw *hdw)
2730{
2731 pvr2_trace(PVR2_TRACE_INIT,"pvr2_hdw_disconnect(hdw=%p)",hdw);
2732 LOCK_TAKE(hdw->big_lock);
2733 LOCK_TAKE(hdw->ctl_lock);
2734 pvr2_hdw_remove_usb_stuff(hdw);
2735 LOCK_GIVE(hdw->ctl_lock);
2736 LOCK_GIVE(hdw->big_lock);
2737}
2738
2739
2740// Attempt to autoselect an appropriate value for std_enum_cur given
2741// whatever is currently in std_mask_cur
Adrian Bunk07e337e2006-06-30 11:30:20 -03002742static void pvr2_hdw_internal_find_stdenum(struct pvr2_hdw *hdw)
Mike Iselyd8554972006-06-26 20:58:46 -03002743{
2744 unsigned int idx;
2745 for (idx = 1; idx < hdw->std_enum_cnt; idx++) {
2746 if (hdw->std_defs[idx-1].id == hdw->std_mask_cur) {
2747 hdw->std_enum_cur = idx;
2748 return;
2749 }
2750 }
2751 hdw->std_enum_cur = 0;
2752}
2753
2754
2755// Calculate correct set of enumerated standards based on currently known
2756// set of available standards bits.
Adrian Bunk07e337e2006-06-30 11:30:20 -03002757static void pvr2_hdw_internal_set_std_avail(struct pvr2_hdw *hdw)
Mike Iselyd8554972006-06-26 20:58:46 -03002758{
2759 struct v4l2_standard *newstd;
2760 unsigned int std_cnt;
2761 unsigned int idx;
2762
2763 newstd = pvr2_std_create_enum(&std_cnt,hdw->std_mask_avail);
2764
2765 if (hdw->std_defs) {
2766 kfree(hdw->std_defs);
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002767 hdw->std_defs = NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002768 }
2769 hdw->std_enum_cnt = 0;
2770 if (hdw->std_enum_names) {
2771 kfree(hdw->std_enum_names);
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002772 hdw->std_enum_names = NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002773 }
2774
2775 if (!std_cnt) {
2776 pvr2_trace(
2777 PVR2_TRACE_ERROR_LEGS,
2778 "WARNING: Failed to identify any viable standards");
2779 }
2780 hdw->std_enum_names = kmalloc(sizeof(char *)*(std_cnt+1),GFP_KERNEL);
2781 hdw->std_enum_names[0] = "none";
2782 for (idx = 0; idx < std_cnt; idx++) {
2783 hdw->std_enum_names[idx+1] =
2784 newstd[idx].name;
2785 }
2786 // Set up the dynamic control for this standard
2787 hdw->std_info_enum.def.type_enum.value_names = hdw->std_enum_names;
2788 hdw->std_info_enum.def.type_enum.count = std_cnt+1;
2789 hdw->std_defs = newstd;
2790 hdw->std_enum_cnt = std_cnt+1;
2791 hdw->std_enum_cur = 0;
2792 hdw->std_info_cur.def.type_bitmask.valid_bits = hdw->std_mask_avail;
2793}
2794
2795
2796int pvr2_hdw_get_stdenum_value(struct pvr2_hdw *hdw,
2797 struct v4l2_standard *std,
2798 unsigned int idx)
2799{
2800 int ret = -EINVAL;
2801 if (!idx) return ret;
2802 LOCK_TAKE(hdw->big_lock); do {
2803 if (idx >= hdw->std_enum_cnt) break;
2804 idx--;
2805 memcpy(std,hdw->std_defs+idx,sizeof(*std));
2806 ret = 0;
2807 } while (0); LOCK_GIVE(hdw->big_lock);
2808 return ret;
2809}
2810
2811
2812/* Get the number of defined controls */
2813unsigned int pvr2_hdw_get_ctrl_count(struct pvr2_hdw *hdw)
2814{
Mike Iselyc05c0462006-06-25 20:04:25 -03002815 return hdw->control_cnt;
Mike Iselyd8554972006-06-26 20:58:46 -03002816}
2817
2818
2819/* Retrieve a control handle given its index (0..count-1) */
2820struct pvr2_ctrl *pvr2_hdw_get_ctrl_by_index(struct pvr2_hdw *hdw,
2821 unsigned int idx)
2822{
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002823 if (idx >= hdw->control_cnt) return NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002824 return hdw->controls + idx;
2825}
2826
2827
2828/* Retrieve a control handle given its index (0..count-1) */
2829struct pvr2_ctrl *pvr2_hdw_get_ctrl_by_id(struct pvr2_hdw *hdw,
2830 unsigned int ctl_id)
2831{
2832 struct pvr2_ctrl *cptr;
2833 unsigned int idx;
2834 int i;
2835
2836 /* This could be made a lot more efficient, but for now... */
Mike Iselyc05c0462006-06-25 20:04:25 -03002837 for (idx = 0; idx < hdw->control_cnt; idx++) {
Mike Iselyd8554972006-06-26 20:58:46 -03002838 cptr = hdw->controls + idx;
2839 i = cptr->info->internal_id;
2840 if (i && (i == ctl_id)) return cptr;
2841 }
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002842 return NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002843}
2844
2845
Mike Iselya761f432006-06-25 20:04:44 -03002846/* Given a V4L ID, retrieve the control structure associated with it. */
Mike Iselyd8554972006-06-26 20:58:46 -03002847struct pvr2_ctrl *pvr2_hdw_get_ctrl_v4l(struct pvr2_hdw *hdw,unsigned int ctl_id)
2848{
2849 struct pvr2_ctrl *cptr;
2850 unsigned int idx;
2851 int i;
2852
2853 /* This could be made a lot more efficient, but for now... */
Mike Iselyc05c0462006-06-25 20:04:25 -03002854 for (idx = 0; idx < hdw->control_cnt; idx++) {
Mike Iselyd8554972006-06-26 20:58:46 -03002855 cptr = hdw->controls + idx;
2856 i = cptr->info->v4l_id;
2857 if (i && (i == ctl_id)) return cptr;
2858 }
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002859 return NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03002860}
2861
2862
Mike Iselya761f432006-06-25 20:04:44 -03002863/* Given a V4L ID for its immediate predecessor, retrieve the control
2864 structure associated with it. */
2865struct pvr2_ctrl *pvr2_hdw_get_ctrl_nextv4l(struct pvr2_hdw *hdw,
2866 unsigned int ctl_id)
2867{
2868 struct pvr2_ctrl *cptr,*cp2;
2869 unsigned int idx;
2870 int i;
2871
2872 /* This could be made a lot more efficient, but for now... */
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002873 cp2 = NULL;
Mike Iselya761f432006-06-25 20:04:44 -03002874 for (idx = 0; idx < hdw->control_cnt; idx++) {
2875 cptr = hdw->controls + idx;
2876 i = cptr->info->v4l_id;
2877 if (!i) continue;
2878 if (i <= ctl_id) continue;
2879 if (cp2 && (cp2->info->v4l_id < i)) continue;
2880 cp2 = cptr;
2881 }
2882 return cp2;
Mike Iselya0fd1cb2006-06-30 11:35:28 -03002883 return NULL;
Mike Iselya761f432006-06-25 20:04:44 -03002884}
2885
2886
Mike Iselyd8554972006-06-26 20:58:46 -03002887static const char *get_ctrl_typename(enum pvr2_ctl_type tp)
2888{
2889 switch (tp) {
2890 case pvr2_ctl_int: return "integer";
2891 case pvr2_ctl_enum: return "enum";
Mike Isely33213962006-06-25 20:04:40 -03002892 case pvr2_ctl_bool: return "boolean";
Mike Iselyd8554972006-06-26 20:58:46 -03002893 case pvr2_ctl_bitmask: return "bitmask";
2894 }
2895 return "";
2896}
2897
2898
Mike Isely2641df32009-03-07 00:13:25 -03002899static void pvr2_subdev_set_control(struct pvr2_hdw *hdw, int id,
2900 const char *name, int val)
2901{
2902 struct v4l2_control ctrl;
2903 pvr2_trace(PVR2_TRACE_CHIPS, "subdev v4l2 %s=%d", name, val);
2904 memset(&ctrl, 0, sizeof(ctrl));
2905 ctrl.id = id;
2906 ctrl.value = val;
2907 v4l2_device_call_all(&hdw->v4l2_dev, 0, core, s_ctrl, &ctrl);
2908}
2909
2910#define PVR2_SUBDEV_SET_CONTROL(hdw, id, lab) \
Mike Isely27764722009-03-07 01:57:25 -03002911 if ((hdw)->lab##_dirty || (hdw)->force_dirty) { \
Mike Isely2641df32009-03-07 00:13:25 -03002912 pvr2_subdev_set_control(hdw, id, #lab, (hdw)->lab##_val); \
2913 }
2914
Mike Isely5ceaad12009-03-07 00:01:20 -03002915/* Execute whatever commands are required to update the state of all the
Mike Isely2641df32009-03-07 00:13:25 -03002916 sub-devices so that they match our current control values. */
Mike Isely5ceaad12009-03-07 00:01:20 -03002917static void pvr2_subdev_update(struct pvr2_hdw *hdw)
2918{
Mike Iselyedb9dcb2009-03-07 00:37:10 -03002919 struct v4l2_subdev *sd;
2920 unsigned int id;
2921 pvr2_subdev_update_func fp;
2922
Mike Isely75212a02009-03-07 01:48:42 -03002923 pvr2_trace(PVR2_TRACE_CHIPS, "subdev update...");
2924
Mike Isely27764722009-03-07 01:57:25 -03002925 if (hdw->tuner_updated || hdw->force_dirty) {
Mike Isely75212a02009-03-07 01:48:42 -03002926 struct tuner_setup setup;
2927 pvr2_trace(PVR2_TRACE_CHIPS, "subdev tuner set_type(%d)",
2928 hdw->tuner_type);
2929 if (((int)(hdw->tuner_type)) >= 0) {
2930 setup.addr = ADDR_UNSET;
2931 setup.type = hdw->tuner_type;
2932 setup.mode_mask = T_RADIO | T_ANALOG_TV;
2933 v4l2_device_call_all(&hdw->v4l2_dev, 0,
2934 tuner, s_type_addr, &setup);
2935 }
2936 }
2937
Mike Isely27764722009-03-07 01:57:25 -03002938 if (hdw->input_dirty || hdw->std_dirty || hdw->force_dirty) {
Mike Iselyb4818802009-03-07 01:46:17 -03002939 pvr2_trace(PVR2_TRACE_CHIPS, "subdev v4l2 set_standard");
Mike Isely2641df32009-03-07 00:13:25 -03002940 if (hdw->input_val == PVR2_CVAL_INPUT_RADIO) {
2941 v4l2_device_call_all(&hdw->v4l2_dev, 0,
2942 tuner, s_radio);
2943 } else {
2944 v4l2_std_id vs;
2945 vs = hdw->std_mask_cur;
2946 v4l2_device_call_all(&hdw->v4l2_dev, 0,
2947 tuner, s_std, vs);
2948 }
2949 hdw->tuner_signal_stale = !0;
2950 hdw->cropcap_stale = !0;
2951 }
2952
2953 PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_BRIGHTNESS, brightness);
2954 PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_CONTRAST, contrast);
2955 PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_SATURATION, saturation);
2956 PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_HUE, hue);
2957 PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_AUDIO_MUTE, mute);
2958 PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_AUDIO_VOLUME, volume);
2959 PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_AUDIO_BALANCE, balance);
2960 PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_AUDIO_BASS, bass);
2961 PVR2_SUBDEV_SET_CONTROL(hdw, V4L2_CID_AUDIO_TREBLE, treble);
2962
Mike Isely27764722009-03-07 01:57:25 -03002963 if (hdw->input_dirty || hdw->audiomode_dirty || hdw->force_dirty) {
Mike Isely2641df32009-03-07 00:13:25 -03002964 struct v4l2_tuner vt;
2965 memset(&vt, 0, sizeof(vt));
2966 vt.audmode = hdw->audiomode_val;
2967 v4l2_device_call_all(&hdw->v4l2_dev, 0, tuner, s_tuner, &vt);
2968 }
2969
Mike Isely27764722009-03-07 01:57:25 -03002970 if (hdw->freqDirty || hdw->force_dirty) {
Mike Isely2641df32009-03-07 00:13:25 -03002971 unsigned long fv;
2972 struct v4l2_frequency freq;
2973 fv = pvr2_hdw_get_cur_freq(hdw);
2974 pvr2_trace(PVR2_TRACE_CHIPS, "subdev v4l2 set_freq(%lu)", fv);
2975 if (hdw->tuner_signal_stale) pvr2_hdw_status_poll(hdw);
2976 memset(&freq, 0, sizeof(freq));
2977 if (hdw->tuner_signal_info.capability & V4L2_TUNER_CAP_LOW) {
2978 /* ((fv * 1000) / 62500) */
2979 freq.frequency = (fv * 2) / 125;
2980 } else {
2981 freq.frequency = fv / 62500;
2982 }
2983 /* tuner-core currently doesn't seem to care about this, but
2984 let's set it anyway for completeness. */
2985 if (hdw->input_val == PVR2_CVAL_INPUT_RADIO) {
2986 freq.type = V4L2_TUNER_RADIO;
2987 } else {
2988 freq.type = V4L2_TUNER_ANALOG_TV;
2989 }
2990 freq.tuner = 0;
2991 v4l2_device_call_all(&hdw->v4l2_dev, 0, tuner,
2992 s_frequency, &freq);
2993 }
2994
Mike Isely27764722009-03-07 01:57:25 -03002995 if (hdw->res_hor_dirty || hdw->res_ver_dirty || hdw->force_dirty) {
Mike Isely2641df32009-03-07 00:13:25 -03002996 struct v4l2_format fmt;
2997 memset(&fmt, 0, sizeof(fmt));
2998 fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
2999 fmt.fmt.pix.width = hdw->res_hor_val;
3000 fmt.fmt.pix.height = hdw->res_ver_val;
Mike Isely7dfdf1e2009-03-07 02:11:12 -03003001 pvr2_trace(PVR2_TRACE_CHIPS, "subdev v4l2 set_size(%dx%d)",
Mike Isely2641df32009-03-07 00:13:25 -03003002 fmt.fmt.pix.width, fmt.fmt.pix.height);
3003 v4l2_device_call_all(&hdw->v4l2_dev, 0, video, s_fmt, &fmt);
3004 }
3005
Mike Isely27764722009-03-07 01:57:25 -03003006 if (hdw->srate_dirty || hdw->force_dirty) {
Mike Isely01c59df2009-03-07 00:48:09 -03003007 u32 val;
3008 pvr2_trace(PVR2_TRACE_CHIPS, "subdev v4l2 set_audio %d",
3009 hdw->srate_val);
3010 switch (hdw->srate_val) {
3011 default:
3012 case V4L2_MPEG_AUDIO_SAMPLING_FREQ_48000:
3013 val = 48000;
3014 break;
3015 case V4L2_MPEG_AUDIO_SAMPLING_FREQ_44100:
3016 val = 44100;
3017 break;
3018 case V4L2_MPEG_AUDIO_SAMPLING_FREQ_32000:
3019 val = 32000;
3020 break;
3021 }
3022 v4l2_device_call_all(&hdw->v4l2_dev, 0,
3023 audio, s_clock_freq, val);
3024 }
3025
Mike Isely2641df32009-03-07 00:13:25 -03003026 /* Unable to set crop parameters; there is apparently no equivalent
3027 for VIDIOC_S_CROP */
3028
Mike Iselyedb9dcb2009-03-07 00:37:10 -03003029 v4l2_device_for_each_subdev(sd, &hdw->v4l2_dev) {
3030 id = sd->grp_id;
3031 if (id >= ARRAY_SIZE(pvr2_module_update_functions)) continue;
3032 fp = pvr2_module_update_functions[id];
3033 if (!fp) continue;
3034 (*fp)(hdw, sd);
3035 }
Mike Isely2641df32009-03-07 00:13:25 -03003036
Mike Isely27764722009-03-07 01:57:25 -03003037 if (hdw->tuner_signal_stale || hdw->cropcap_stale) {
Mike Isely2641df32009-03-07 00:13:25 -03003038 pvr2_hdw_status_poll(hdw);
3039 }
Mike Isely5ceaad12009-03-07 00:01:20 -03003040}
3041
3042
Mike Isely681c7392007-11-26 01:48:52 -03003043/* Figure out if we need to commit control changes. If so, mark internal
3044 state flags to indicate this fact and return true. Otherwise do nothing
3045 else and return false. */
3046static int pvr2_hdw_commit_setup(struct pvr2_hdw *hdw)
Mike Iselyd8554972006-06-26 20:58:46 -03003047{
Mike Iselyd8554972006-06-26 20:58:46 -03003048 unsigned int idx;
3049 struct pvr2_ctrl *cptr;
3050 int value;
Mike Isely27764722009-03-07 01:57:25 -03003051 int commit_flag = hdw->force_dirty;
Mike Iselyd8554972006-06-26 20:58:46 -03003052 char buf[100];
3053 unsigned int bcnt,ccnt;
3054
Mike Iselyc05c0462006-06-25 20:04:25 -03003055 for (idx = 0; idx < hdw->control_cnt; idx++) {
Mike Iselyd8554972006-06-26 20:58:46 -03003056 cptr = hdw->controls + idx;
Al Viro5fa12472008-03-29 03:07:38 +00003057 if (!cptr->info->is_dirty) continue;
Mike Iselyd8554972006-06-26 20:58:46 -03003058 if (!cptr->info->is_dirty(cptr)) continue;
Mike Iselyfe23a282007-01-20 00:10:55 -03003059 commit_flag = !0;
Mike Iselyd8554972006-06-26 20:58:46 -03003060
Mike Iselyfe23a282007-01-20 00:10:55 -03003061 if (!(pvrusb2_debug & PVR2_TRACE_CTL)) continue;
Mike Iselyd8554972006-06-26 20:58:46 -03003062 bcnt = scnprintf(buf,sizeof(buf),"\"%s\" <-- ",
3063 cptr->info->name);
3064 value = 0;
3065 cptr->info->get_value(cptr,&value);
3066 pvr2_ctrl_value_to_sym_internal(cptr,~0,value,
3067 buf+bcnt,
3068 sizeof(buf)-bcnt,&ccnt);
3069 bcnt += ccnt;
3070 bcnt += scnprintf(buf+bcnt,sizeof(buf)-bcnt," <%s>",
3071 get_ctrl_typename(cptr->info->type));
3072 pvr2_trace(PVR2_TRACE_CTL,
3073 "/*--TRACE_COMMIT--*/ %.*s",
3074 bcnt,buf);
3075 }
3076
3077 if (!commit_flag) {
3078 /* Nothing has changed */
3079 return 0;
3080 }
3081
Mike Isely681c7392007-11-26 01:48:52 -03003082 hdw->state_pipeline_config = 0;
3083 trace_stbit("state_pipeline_config",hdw->state_pipeline_config);
3084 pvr2_hdw_state_sched(hdw);
3085
3086 return !0;
3087}
3088
3089
3090/* Perform all operations needed to commit all control changes. This must
3091 be performed in synchronization with the pipeline state and is thus
3092 expected to be called as part of the driver's worker thread. Return
3093 true if commit successful, otherwise return false to indicate that
3094 commit isn't possible at this time. */
3095static int pvr2_hdw_commit_execute(struct pvr2_hdw *hdw)
3096{
3097 unsigned int idx;
3098 struct pvr2_ctrl *cptr;
3099 int disruptive_change;
3100
Mike Iselyab062fe2008-06-30 03:32:35 -03003101 /* Handle some required side effects when the video standard is
3102 changed.... */
Mike Iselyd8554972006-06-26 20:58:46 -03003103 if (hdw->std_dirty) {
Mike Iselyd8554972006-06-26 20:58:46 -03003104 int nvres;
Mike Isely00528d92008-06-30 03:35:52 -03003105 int gop_size;
Mike Iselyd8554972006-06-26 20:58:46 -03003106 if (hdw->std_mask_cur & V4L2_STD_525_60) {
3107 nvres = 480;
Mike Isely00528d92008-06-30 03:35:52 -03003108 gop_size = 15;
Mike Iselyd8554972006-06-26 20:58:46 -03003109 } else {
3110 nvres = 576;
Mike Isely00528d92008-06-30 03:35:52 -03003111 gop_size = 12;
Mike Iselyd8554972006-06-26 20:58:46 -03003112 }
Mike Isely00528d92008-06-30 03:35:52 -03003113 /* Rewrite the vertical resolution to be appropriate to the
3114 video standard that has been selected. */
Mike Iselyd8554972006-06-26 20:58:46 -03003115 if (nvres != hdw->res_ver_val) {
3116 hdw->res_ver_val = nvres;
3117 hdw->res_ver_dirty = !0;
3118 }
Mike Isely00528d92008-06-30 03:35:52 -03003119 /* Rewrite the GOP size to be appropriate to the video
3120 standard that has been selected. */
3121 if (gop_size != hdw->enc_ctl_state.video_gop_size) {
3122 struct v4l2_ext_controls cs;
3123 struct v4l2_ext_control c1;
3124 memset(&cs, 0, sizeof(cs));
3125 memset(&c1, 0, sizeof(c1));
3126 cs.controls = &c1;
3127 cs.count = 1;
3128 c1.id = V4L2_CID_MPEG_VIDEO_GOP_SIZE;
3129 c1.value = gop_size;
3130 cx2341x_ext_ctrls(&hdw->enc_ctl_state, 0, &cs,
3131 VIDIOC_S_EXT_CTRLS);
3132 }
Mike Iselyd8554972006-06-26 20:58:46 -03003133 }
3134
Mike Isely38d9a2c2008-03-28 05:30:48 -03003135 if (hdw->input_dirty && hdw->state_pathway_ok &&
Mike Isely62433e32008-04-22 14:45:40 -03003136 (((hdw->input_val == PVR2_CVAL_INPUT_DTV) ?
3137 PVR2_PATHWAY_DIGITAL : PVR2_PATHWAY_ANALOG) !=
3138 hdw->pathway_state)) {
3139 /* Change of mode being asked for... */
3140 hdw->state_pathway_ok = 0;
Mike Iselye9db1ff2008-04-22 14:45:41 -03003141 trace_stbit("state_pathway_ok",hdw->state_pathway_ok);
Mike Isely62433e32008-04-22 14:45:40 -03003142 }
3143 if (!hdw->state_pathway_ok) {
3144 /* Can't commit anything until pathway is ok. */
3145 return 0;
3146 }
vdb128@picaros.orge784bfb2008-08-30 18:26:39 -03003147 /* The broadcast decoder can only scale down, so if
3148 * res_*_dirty && crop window < output format ==> enlarge crop.
3149 *
3150 * The mpeg encoder receives fields of res_hor_val dots and
3151 * res_ver_val halflines. Limits: hor<=720, ver<=576.
3152 */
3153 if (hdw->res_hor_dirty && hdw->cropw_val < hdw->res_hor_val) {
3154 hdw->cropw_val = hdw->res_hor_val;
3155 hdw->cropw_dirty = !0;
3156 } else if (hdw->cropw_dirty) {
3157 hdw->res_hor_dirty = !0; /* must rescale */
3158 hdw->res_hor_val = min(720, hdw->cropw_val);
3159 }
3160 if (hdw->res_ver_dirty && hdw->croph_val < hdw->res_ver_val) {
3161 hdw->croph_val = hdw->res_ver_val;
3162 hdw->croph_dirty = !0;
3163 } else if (hdw->croph_dirty) {
3164 int nvres = hdw->std_mask_cur & V4L2_STD_525_60 ? 480 : 576;
3165 hdw->res_ver_dirty = !0;
3166 hdw->res_ver_val = min(nvres, hdw->croph_val);
3167 }
3168
Mike Isely681c7392007-11-26 01:48:52 -03003169 /* If any of the below has changed, then we can't do the update
3170 while the pipeline is running. Pipeline must be paused first
3171 and decoder -> encoder connection be made quiescent before we
3172 can proceed. */
3173 disruptive_change =
3174 (hdw->std_dirty ||
3175 hdw->enc_unsafe_stale ||
3176 hdw->srate_dirty ||
3177 hdw->res_ver_dirty ||
3178 hdw->res_hor_dirty ||
Mike Isely755879c2008-08-31 20:50:59 -03003179 hdw->cropw_dirty ||
3180 hdw->croph_dirty ||
Mike Isely681c7392007-11-26 01:48:52 -03003181 hdw->input_dirty ||
3182 (hdw->active_stream_type != hdw->desired_stream_type));
3183 if (disruptive_change && !hdw->state_pipeline_idle) {
3184 /* Pipeline is not idle; we can't proceed. Arrange to
3185 cause pipeline to stop so that we can try this again
3186 later.... */
3187 hdw->state_pipeline_pause = !0;
3188 return 0;
Mike Iselyd8554972006-06-26 20:58:46 -03003189 }
3190
Mike Iselyb30d2442006-06-25 20:05:01 -03003191 if (hdw->srate_dirty) {
3192 /* Write new sample rate into control structure since
3193 * the master copy is stale. We must track srate
3194 * separate from the mpeg control structure because
3195 * other logic also uses this value. */
3196 struct v4l2_ext_controls cs;
3197 struct v4l2_ext_control c1;
3198 memset(&cs,0,sizeof(cs));
3199 memset(&c1,0,sizeof(c1));
3200 cs.controls = &c1;
3201 cs.count = 1;
3202 c1.id = V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ;
3203 c1.value = hdw->srate_val;
Hans Verkuil01f1e442007-08-21 18:32:42 -03003204 cx2341x_ext_ctrls(&hdw->enc_ctl_state, 0, &cs,VIDIOC_S_EXT_CTRLS);
Mike Iselyb30d2442006-06-25 20:05:01 -03003205 }
Mike Iselyc05c0462006-06-25 20:04:25 -03003206
Mike Isely681c7392007-11-26 01:48:52 -03003207 if (hdw->active_stream_type != hdw->desired_stream_type) {
3208 /* Handle any side effects of stream config here */
3209 hdw->active_stream_type = hdw->desired_stream_type;
3210 }
3211
Mike Isely1df59f02008-04-21 03:50:39 -03003212 if (hdw->hdw_desc->signal_routing_scheme ==
3213 PVR2_ROUTING_SCHEME_GOTVIEW) {
3214 u32 b;
3215 /* Handle GOTVIEW audio switching */
3216 pvr2_hdw_gpio_get_out(hdw,&b);
3217 if (hdw->input_val == PVR2_CVAL_INPUT_RADIO) {
3218 /* Set GPIO 11 */
3219 pvr2_hdw_gpio_chg_out(hdw,(1 << 11),~0);
3220 } else {
3221 /* Clear GPIO 11 */
3222 pvr2_hdw_gpio_chg_out(hdw,(1 << 11),0);
3223 }
3224 }
3225
Mike Iselye68a6192009-03-07 01:45:10 -03003226 /* Check and update state for all sub-devices. */
3227 pvr2_subdev_update(hdw);
3228
Mike Isely75212a02009-03-07 01:48:42 -03003229 hdw->tuner_updated = 0;
Mike Isely27764722009-03-07 01:57:25 -03003230 hdw->force_dirty = 0;
Mike Isely5ceaad12009-03-07 00:01:20 -03003231 for (idx = 0; idx < hdw->control_cnt; idx++) {
3232 cptr = hdw->controls + idx;
3233 if (!cptr->info->clear_dirty) continue;
3234 cptr->info->clear_dirty(cptr);
3235 }
3236
Mike Isely62433e32008-04-22 14:45:40 -03003237 if ((hdw->pathway_state == PVR2_PATHWAY_ANALOG) &&
3238 hdw->state_encoder_run) {
3239 /* If encoder isn't running or it can't be touched, then
3240 this will get worked out later when we start the
3241 encoder. */
Mike Isely681c7392007-11-26 01:48:52 -03003242 if (pvr2_encoder_adjust(hdw) < 0) return !0;
3243 }
Mike Iselyd8554972006-06-26 20:58:46 -03003244
Mike Isely681c7392007-11-26 01:48:52 -03003245 hdw->state_pipeline_config = !0;
Mike Isely432907f2008-08-31 21:02:20 -03003246 /* Hardware state may have changed in a way to cause the cropping
3247 capabilities to have changed. So mark it stale, which will
3248 cause a later re-fetch. */
Mike Isely681c7392007-11-26 01:48:52 -03003249 trace_stbit("state_pipeline_config",hdw->state_pipeline_config);
3250 return !0;
Mike Iselyd8554972006-06-26 20:58:46 -03003251}
3252
3253
3254int pvr2_hdw_commit_ctl(struct pvr2_hdw *hdw)
3255{
Mike Isely681c7392007-11-26 01:48:52 -03003256 int fl;
3257 LOCK_TAKE(hdw->big_lock);
3258 fl = pvr2_hdw_commit_setup(hdw);
3259 LOCK_GIVE(hdw->big_lock);
3260 if (!fl) return 0;
3261 return pvr2_hdw_wait(hdw,0);
Mike Iselyd8554972006-06-26 20:58:46 -03003262}
3263
3264
Mike Isely681c7392007-11-26 01:48:52 -03003265static void pvr2_hdw_worker_poll(struct work_struct *work)
Mike Iselyd8554972006-06-26 20:58:46 -03003266{
Mike Isely681c7392007-11-26 01:48:52 -03003267 int fl = 0;
3268 struct pvr2_hdw *hdw = container_of(work,struct pvr2_hdw,workpoll);
Mike Iselyd8554972006-06-26 20:58:46 -03003269 LOCK_TAKE(hdw->big_lock); do {
Mike Isely681c7392007-11-26 01:48:52 -03003270 fl = pvr2_hdw_state_eval(hdw);
3271 } while (0); LOCK_GIVE(hdw->big_lock);
3272 if (fl && hdw->state_func) {
3273 hdw->state_func(hdw->state_data);
3274 }
3275}
3276
3277
Mike Isely681c7392007-11-26 01:48:52 -03003278static int pvr2_hdw_wait(struct pvr2_hdw *hdw,int state)
Mike Iselyd8554972006-06-26 20:58:46 -03003279{
Mike Isely681c7392007-11-26 01:48:52 -03003280 return wait_event_interruptible(
3281 hdw->state_wait_data,
3282 (hdw->state_stale == 0) &&
3283 (!state || (hdw->master_state != state)));
Mike Iselyd8554972006-06-26 20:58:46 -03003284}
3285
Mike Isely681c7392007-11-26 01:48:52 -03003286
Mike Iselyd8554972006-06-26 20:58:46 -03003287/* Return name for this driver instance */
3288const char *pvr2_hdw_get_driver_name(struct pvr2_hdw *hdw)
3289{
3290 return hdw->name;
3291}
3292
3293
Mike Isely78a47102007-11-26 01:58:20 -03003294const char *pvr2_hdw_get_desc(struct pvr2_hdw *hdw)
3295{
3296 return hdw->hdw_desc->description;
3297}
3298
3299
3300const char *pvr2_hdw_get_type(struct pvr2_hdw *hdw)
3301{
3302 return hdw->hdw_desc->shortname;
3303}
3304
3305
Mike Iselyd8554972006-06-26 20:58:46 -03003306int pvr2_hdw_is_hsm(struct pvr2_hdw *hdw)
3307{
3308 int result;
3309 LOCK_TAKE(hdw->ctl_lock); do {
Michael Krufky8d364362007-01-22 02:17:55 -03003310 hdw->cmd_buffer[0] = FX2CMD_GET_USB_SPEED;
Mike Iselyd8554972006-06-26 20:58:46 -03003311 result = pvr2_send_request(hdw,
3312 hdw->cmd_buffer,1,
3313 hdw->cmd_buffer,1);
3314 if (result < 0) break;
3315 result = (hdw->cmd_buffer[0] != 0);
3316 } while(0); LOCK_GIVE(hdw->ctl_lock);
3317 return result;
3318}
3319
3320
Mike Isely18103c572007-01-20 00:09:47 -03003321/* Execute poll of tuner status */
3322void pvr2_hdw_execute_tuner_poll(struct pvr2_hdw *hdw)
Mike Iselyd8554972006-06-26 20:58:46 -03003323{
Mike Iselyd8554972006-06-26 20:58:46 -03003324 LOCK_TAKE(hdw->big_lock); do {
Mike Iselya51f5002009-03-06 23:30:37 -03003325 pvr2_hdw_status_poll(hdw);
Mike Iselyd8554972006-06-26 20:58:46 -03003326 } while (0); LOCK_GIVE(hdw->big_lock);
Mike Isely18103c572007-01-20 00:09:47 -03003327}
3328
3329
Mike Isely432907f2008-08-31 21:02:20 -03003330static int pvr2_hdw_check_cropcap(struct pvr2_hdw *hdw)
3331{
3332 if (!hdw->cropcap_stale) {
Mike Isely432907f2008-08-31 21:02:20 -03003333 return 0;
3334 }
Mike Iselya51f5002009-03-06 23:30:37 -03003335 pvr2_hdw_status_poll(hdw);
Mike Isely432907f2008-08-31 21:02:20 -03003336 if (hdw->cropcap_stale) {
Mike Isely432907f2008-08-31 21:02:20 -03003337 return -EIO;
3338 }
3339 return 0;
3340}
3341
3342
3343/* Return information about cropping capabilities */
3344int pvr2_hdw_get_cropcap(struct pvr2_hdw *hdw, struct v4l2_cropcap *pp)
3345{
3346 int stat = 0;
3347 LOCK_TAKE(hdw->big_lock);
3348 stat = pvr2_hdw_check_cropcap(hdw);
3349 if (!stat) {
Mike Isely432907f2008-08-31 21:02:20 -03003350 memcpy(pp, &hdw->cropcap_info, sizeof(hdw->cropcap_info));
3351 }
3352 LOCK_GIVE(hdw->big_lock);
3353 return stat;
3354}
3355
3356
Mike Isely18103c572007-01-20 00:09:47 -03003357/* Return information about the tuner */
3358int pvr2_hdw_get_tuner_status(struct pvr2_hdw *hdw,struct v4l2_tuner *vtp)
3359{
3360 LOCK_TAKE(hdw->big_lock); do {
3361 if (hdw->tuner_signal_stale) {
Mike Iselya51f5002009-03-06 23:30:37 -03003362 pvr2_hdw_status_poll(hdw);
Mike Isely18103c572007-01-20 00:09:47 -03003363 }
3364 memcpy(vtp,&hdw->tuner_signal_info,sizeof(struct v4l2_tuner));
3365 } while (0); LOCK_GIVE(hdw->big_lock);
3366 return 0;
Mike Iselyd8554972006-06-26 20:58:46 -03003367}
3368
3369
3370/* Get handle to video output stream */
3371struct pvr2_stream *pvr2_hdw_get_video_stream(struct pvr2_hdw *hp)
3372{
3373 return hp->vid_stream;
3374}
3375
3376
3377void pvr2_hdw_trigger_module_log(struct pvr2_hdw *hdw)
3378{
Mike Isely4f1a3e52006-06-25 20:04:31 -03003379 int nr = pvr2_hdw_get_unit_number(hdw);
Mike Iselyd8554972006-06-26 20:58:46 -03003380 LOCK_TAKE(hdw->big_lock); do {
Mike Isely4f1a3e52006-06-25 20:04:31 -03003381 printk(KERN_INFO "pvrusb2: ================= START STATUS CARD #%d =================\n", nr);
Mike Iselyed3261a2009-03-07 00:02:33 -03003382 v4l2_device_call_all(&hdw->v4l2_dev, 0, core, log_status);
Mike Iselyb30d2442006-06-25 20:05:01 -03003383 pvr2_trace(PVR2_TRACE_INFO,"cx2341x config:");
Hans Verkuil99eb44f2006-06-26 18:24:05 -03003384 cx2341x_log_status(&hdw->enc_ctl_state, "pvrusb2");
Mike Isely681c7392007-11-26 01:48:52 -03003385 pvr2_hdw_state_log_state(hdw);
Mike Isely4f1a3e52006-06-25 20:04:31 -03003386 printk(KERN_INFO "pvrusb2: ================== END STATUS CARD #%d ==================\n", nr);
Mike Iselyd8554972006-06-26 20:58:46 -03003387 } while (0); LOCK_GIVE(hdw->big_lock);
3388}
3389
Mike Isely4db666c2007-09-08 22:16:27 -03003390
3391/* Grab EEPROM contents, needed for direct method. */
3392#define EEPROM_SIZE 8192
3393#define trace_eeprom(...) pvr2_trace(PVR2_TRACE_EEPROM,__VA_ARGS__)
3394static u8 *pvr2_full_eeprom_fetch(struct pvr2_hdw *hdw)
3395{
3396 struct i2c_msg msg[2];
3397 u8 *eeprom;
3398 u8 iadd[2];
3399 u8 addr;
3400 u16 eepromSize;
3401 unsigned int offs;
3402 int ret;
3403 int mode16 = 0;
3404 unsigned pcnt,tcnt;
3405 eeprom = kmalloc(EEPROM_SIZE,GFP_KERNEL);
3406 if (!eeprom) {
3407 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3408 "Failed to allocate memory"
3409 " required to read eeprom");
3410 return NULL;
3411 }
3412
3413 trace_eeprom("Value for eeprom addr from controller was 0x%x",
3414 hdw->eeprom_addr);
3415 addr = hdw->eeprom_addr;
3416 /* Seems that if the high bit is set, then the *real* eeprom
3417 address is shifted right now bit position (noticed this in
3418 newer PVR USB2 hardware) */
3419 if (addr & 0x80) addr >>= 1;
3420
3421 /* FX2 documentation states that a 16bit-addressed eeprom is
3422 expected if the I2C address is an odd number (yeah, this is
3423 strange but it's what they do) */
3424 mode16 = (addr & 1);
3425 eepromSize = (mode16 ? EEPROM_SIZE : 256);
3426 trace_eeprom("Examining %d byte eeprom at location 0x%x"
3427 " using %d bit addressing",eepromSize,addr,
3428 mode16 ? 16 : 8);
3429
3430 msg[0].addr = addr;
3431 msg[0].flags = 0;
3432 msg[0].len = mode16 ? 2 : 1;
3433 msg[0].buf = iadd;
3434 msg[1].addr = addr;
3435 msg[1].flags = I2C_M_RD;
3436
3437 /* We have to do the actual eeprom data fetch ourselves, because
3438 (1) we're only fetching part of the eeprom, and (2) if we were
3439 getting the whole thing our I2C driver can't grab it in one
3440 pass - which is what tveeprom is otherwise going to attempt */
3441 memset(eeprom,0,EEPROM_SIZE);
3442 for (tcnt = 0; tcnt < EEPROM_SIZE; tcnt += pcnt) {
3443 pcnt = 16;
3444 if (pcnt + tcnt > EEPROM_SIZE) pcnt = EEPROM_SIZE-tcnt;
3445 offs = tcnt + (eepromSize - EEPROM_SIZE);
3446 if (mode16) {
3447 iadd[0] = offs >> 8;
3448 iadd[1] = offs;
3449 } else {
3450 iadd[0] = offs;
3451 }
3452 msg[1].len = pcnt;
3453 msg[1].buf = eeprom+tcnt;
3454 if ((ret = i2c_transfer(&hdw->i2c_adap,
3455 msg,ARRAY_SIZE(msg))) != 2) {
3456 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3457 "eeprom fetch set offs err=%d",ret);
3458 kfree(eeprom);
3459 return NULL;
3460 }
3461 }
3462 return eeprom;
3463}
3464
3465
3466void pvr2_hdw_cpufw_set_enabled(struct pvr2_hdw *hdw,
3467 int prom_flag,
3468 int enable_flag)
Mike Iselyd8554972006-06-26 20:58:46 -03003469{
3470 int ret;
3471 u16 address;
3472 unsigned int pipe;
3473 LOCK_TAKE(hdw->big_lock); do {
Al Viro5fa12472008-03-29 03:07:38 +00003474 if ((hdw->fw_buffer == NULL) == !enable_flag) break;
Mike Iselyd8554972006-06-26 20:58:46 -03003475
3476 if (!enable_flag) {
3477 pvr2_trace(PVR2_TRACE_FIRMWARE,
3478 "Cleaning up after CPU firmware fetch");
3479 kfree(hdw->fw_buffer);
Mike Iselya0fd1cb2006-06-30 11:35:28 -03003480 hdw->fw_buffer = NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03003481 hdw->fw_size = 0;
Mike Isely4db666c2007-09-08 22:16:27 -03003482 if (hdw->fw_cpu_flag) {
3483 /* Now release the CPU. It will disconnect
3484 and reconnect later. */
3485 pvr2_hdw_cpureset_assert(hdw,0);
3486 }
Mike Iselyd8554972006-06-26 20:58:46 -03003487 break;
3488 }
3489
Mike Isely4db666c2007-09-08 22:16:27 -03003490 hdw->fw_cpu_flag = (prom_flag == 0);
3491 if (hdw->fw_cpu_flag) {
3492 pvr2_trace(PVR2_TRACE_FIRMWARE,
3493 "Preparing to suck out CPU firmware");
3494 hdw->fw_size = 0x2000;
3495 hdw->fw_buffer = kzalloc(hdw->fw_size,GFP_KERNEL);
3496 if (!hdw->fw_buffer) {
3497 hdw->fw_size = 0;
3498 break;
3499 }
3500
3501 /* We have to hold the CPU during firmware upload. */
3502 pvr2_hdw_cpureset_assert(hdw,1);
3503
3504 /* download the firmware from address 0000-1fff in 2048
3505 (=0x800) bytes chunk. */
3506
3507 pvr2_trace(PVR2_TRACE_FIRMWARE,
3508 "Grabbing CPU firmware");
3509 pipe = usb_rcvctrlpipe(hdw->usb_dev, 0);
3510 for(address = 0; address < hdw->fw_size;
3511 address += 0x800) {
3512 ret = usb_control_msg(hdw->usb_dev,pipe,
3513 0xa0,0xc0,
3514 address,0,
3515 hdw->fw_buffer+address,
3516 0x800,HZ);
3517 if (ret < 0) break;
3518 }
3519
3520 pvr2_trace(PVR2_TRACE_FIRMWARE,
3521 "Done grabbing CPU firmware");
3522 } else {
3523 pvr2_trace(PVR2_TRACE_FIRMWARE,
3524 "Sucking down EEPROM contents");
3525 hdw->fw_buffer = pvr2_full_eeprom_fetch(hdw);
3526 if (!hdw->fw_buffer) {
3527 pvr2_trace(PVR2_TRACE_FIRMWARE,
3528 "EEPROM content suck failed.");
3529 break;
3530 }
3531 hdw->fw_size = EEPROM_SIZE;
3532 pvr2_trace(PVR2_TRACE_FIRMWARE,
3533 "Done sucking down EEPROM contents");
Mike Iselyd8554972006-06-26 20:58:46 -03003534 }
3535
Mike Iselyd8554972006-06-26 20:58:46 -03003536 } while (0); LOCK_GIVE(hdw->big_lock);
3537}
3538
3539
3540/* Return true if we're in a mode for retrieval CPU firmware */
3541int pvr2_hdw_cpufw_get_enabled(struct pvr2_hdw *hdw)
3542{
Al Viro5fa12472008-03-29 03:07:38 +00003543 return hdw->fw_buffer != NULL;
Mike Iselyd8554972006-06-26 20:58:46 -03003544}
3545
3546
3547int pvr2_hdw_cpufw_get(struct pvr2_hdw *hdw,unsigned int offs,
3548 char *buf,unsigned int cnt)
3549{
3550 int ret = -EINVAL;
3551 LOCK_TAKE(hdw->big_lock); do {
3552 if (!buf) break;
3553 if (!cnt) break;
3554
3555 if (!hdw->fw_buffer) {
3556 ret = -EIO;
3557 break;
3558 }
3559
3560 if (offs >= hdw->fw_size) {
3561 pvr2_trace(PVR2_TRACE_FIRMWARE,
3562 "Read firmware data offs=%d EOF",
3563 offs);
3564 ret = 0;
3565 break;
3566 }
3567
3568 if (offs + cnt > hdw->fw_size) cnt = hdw->fw_size - offs;
3569
3570 memcpy(buf,hdw->fw_buffer+offs,cnt);
3571
3572 pvr2_trace(PVR2_TRACE_FIRMWARE,
3573 "Read firmware data offs=%d cnt=%d",
3574 offs,cnt);
3575 ret = cnt;
3576 } while (0); LOCK_GIVE(hdw->big_lock);
3577
3578 return ret;
3579}
3580
3581
Mike Iselyfd5a75f2006-12-27 23:11:22 -03003582int pvr2_hdw_v4l_get_minor_number(struct pvr2_hdw *hdw,
Mike Isely80793842006-12-27 23:12:28 -03003583 enum pvr2_v4l_type index)
Mike Iselyd8554972006-06-26 20:58:46 -03003584{
Mike Iselyfd5a75f2006-12-27 23:11:22 -03003585 switch (index) {
Mike Isely80793842006-12-27 23:12:28 -03003586 case pvr2_v4l_type_video: return hdw->v4l_minor_number_video;
3587 case pvr2_v4l_type_vbi: return hdw->v4l_minor_number_vbi;
3588 case pvr2_v4l_type_radio: return hdw->v4l_minor_number_radio;
Mike Iselyfd5a75f2006-12-27 23:11:22 -03003589 default: return -1;
3590 }
Mike Iselyd8554972006-06-26 20:58:46 -03003591}
3592
3593
Pantelis Koukousoulas2fdf3d92006-12-27 23:07:58 -03003594/* Store a v4l minor device number */
Mike Iselyfd5a75f2006-12-27 23:11:22 -03003595void pvr2_hdw_v4l_store_minor_number(struct pvr2_hdw *hdw,
Mike Isely80793842006-12-27 23:12:28 -03003596 enum pvr2_v4l_type index,int v)
Mike Iselyd8554972006-06-26 20:58:46 -03003597{
Mike Iselyfd5a75f2006-12-27 23:11:22 -03003598 switch (index) {
Mike Isely80793842006-12-27 23:12:28 -03003599 case pvr2_v4l_type_video: hdw->v4l_minor_number_video = v;
3600 case pvr2_v4l_type_vbi: hdw->v4l_minor_number_vbi = v;
3601 case pvr2_v4l_type_radio: hdw->v4l_minor_number_radio = v;
Mike Iselyfd5a75f2006-12-27 23:11:22 -03003602 default: break;
3603 }
Mike Iselyd8554972006-06-26 20:58:46 -03003604}
3605
3606
David Howells7d12e782006-10-05 14:55:46 +01003607static void pvr2_ctl_write_complete(struct urb *urb)
Mike Iselyd8554972006-06-26 20:58:46 -03003608{
3609 struct pvr2_hdw *hdw = urb->context;
3610 hdw->ctl_write_pend_flag = 0;
3611 if (hdw->ctl_read_pend_flag) return;
3612 complete(&hdw->ctl_done);
3613}
3614
3615
David Howells7d12e782006-10-05 14:55:46 +01003616static void pvr2_ctl_read_complete(struct urb *urb)
Mike Iselyd8554972006-06-26 20:58:46 -03003617{
3618 struct pvr2_hdw *hdw = urb->context;
3619 hdw->ctl_read_pend_flag = 0;
3620 if (hdw->ctl_write_pend_flag) return;
3621 complete(&hdw->ctl_done);
3622}
3623
3624
3625static void pvr2_ctl_timeout(unsigned long data)
3626{
3627 struct pvr2_hdw *hdw = (struct pvr2_hdw *)data;
3628 if (hdw->ctl_write_pend_flag || hdw->ctl_read_pend_flag) {
3629 hdw->ctl_timeout_flag = !0;
Mariusz Kozlowski5e55d2c2006-11-08 15:34:31 +01003630 if (hdw->ctl_write_pend_flag)
Mike Iselyd8554972006-06-26 20:58:46 -03003631 usb_unlink_urb(hdw->ctl_write_urb);
Mariusz Kozlowski5e55d2c2006-11-08 15:34:31 +01003632 if (hdw->ctl_read_pend_flag)
Mike Iselyd8554972006-06-26 20:58:46 -03003633 usb_unlink_urb(hdw->ctl_read_urb);
Mike Iselyd8554972006-06-26 20:58:46 -03003634 }
3635}
3636
3637
Mike Iselye61b6fc2006-07-18 22:42:18 -03003638/* Issue a command and get a response from the device. This extended
3639 version includes a probe flag (which if set means that device errors
3640 should not be logged or treated as fatal) and a timeout in jiffies.
3641 This can be used to non-lethally probe the health of endpoint 1. */
Adrian Bunk07e337e2006-06-30 11:30:20 -03003642static int pvr2_send_request_ex(struct pvr2_hdw *hdw,
3643 unsigned int timeout,int probe_fl,
3644 void *write_data,unsigned int write_len,
3645 void *read_data,unsigned int read_len)
Mike Iselyd8554972006-06-26 20:58:46 -03003646{
3647 unsigned int idx;
3648 int status = 0;
3649 struct timer_list timer;
3650 if (!hdw->ctl_lock_held) {
3651 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3652 "Attempted to execute control transfer"
3653 " without lock!!");
3654 return -EDEADLK;
3655 }
Mike Isely681c7392007-11-26 01:48:52 -03003656 if (!hdw->flag_ok && !probe_fl) {
Mike Iselyd8554972006-06-26 20:58:46 -03003657 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3658 "Attempted to execute control transfer"
3659 " when device not ok");
3660 return -EIO;
3661 }
3662 if (!(hdw->ctl_read_urb && hdw->ctl_write_urb)) {
3663 if (!probe_fl) {
3664 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3665 "Attempted to execute control transfer"
3666 " when USB is disconnected");
3667 }
3668 return -ENOTTY;
3669 }
3670
3671 /* Ensure that we have sane parameters */
3672 if (!write_data) write_len = 0;
3673 if (!read_data) read_len = 0;
3674 if (write_len > PVR2_CTL_BUFFSIZE) {
3675 pvr2_trace(
3676 PVR2_TRACE_ERROR_LEGS,
3677 "Attempted to execute %d byte"
3678 " control-write transfer (limit=%d)",
3679 write_len,PVR2_CTL_BUFFSIZE);
3680 return -EINVAL;
3681 }
3682 if (read_len > PVR2_CTL_BUFFSIZE) {
3683 pvr2_trace(
3684 PVR2_TRACE_ERROR_LEGS,
3685 "Attempted to execute %d byte"
3686 " control-read transfer (limit=%d)",
3687 write_len,PVR2_CTL_BUFFSIZE);
3688 return -EINVAL;
3689 }
3690 if ((!write_len) && (!read_len)) {
3691 pvr2_trace(
3692 PVR2_TRACE_ERROR_LEGS,
3693 "Attempted to execute null control transfer?");
3694 return -EINVAL;
3695 }
3696
3697
3698 hdw->cmd_debug_state = 1;
3699 if (write_len) {
3700 hdw->cmd_debug_code = ((unsigned char *)write_data)[0];
3701 } else {
3702 hdw->cmd_debug_code = 0;
3703 }
3704 hdw->cmd_debug_write_len = write_len;
3705 hdw->cmd_debug_read_len = read_len;
3706
3707 /* Initialize common stuff */
3708 init_completion(&hdw->ctl_done);
3709 hdw->ctl_timeout_flag = 0;
3710 hdw->ctl_write_pend_flag = 0;
3711 hdw->ctl_read_pend_flag = 0;
3712 init_timer(&timer);
3713 timer.expires = jiffies + timeout;
3714 timer.data = (unsigned long)hdw;
3715 timer.function = pvr2_ctl_timeout;
3716
3717 if (write_len) {
3718 hdw->cmd_debug_state = 2;
3719 /* Transfer write data to internal buffer */
3720 for (idx = 0; idx < write_len; idx++) {
3721 hdw->ctl_write_buffer[idx] =
3722 ((unsigned char *)write_data)[idx];
3723 }
3724 /* Initiate a write request */
3725 usb_fill_bulk_urb(hdw->ctl_write_urb,
3726 hdw->usb_dev,
3727 usb_sndbulkpipe(hdw->usb_dev,
3728 PVR2_CTL_WRITE_ENDPOINT),
3729 hdw->ctl_write_buffer,
3730 write_len,
3731 pvr2_ctl_write_complete,
3732 hdw);
3733 hdw->ctl_write_urb->actual_length = 0;
3734 hdw->ctl_write_pend_flag = !0;
3735 status = usb_submit_urb(hdw->ctl_write_urb,GFP_KERNEL);
3736 if (status < 0) {
3737 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3738 "Failed to submit write-control"
3739 " URB status=%d",status);
3740 hdw->ctl_write_pend_flag = 0;
3741 goto done;
3742 }
3743 }
3744
3745 if (read_len) {
3746 hdw->cmd_debug_state = 3;
3747 memset(hdw->ctl_read_buffer,0x43,read_len);
3748 /* Initiate a read request */
3749 usb_fill_bulk_urb(hdw->ctl_read_urb,
3750 hdw->usb_dev,
3751 usb_rcvbulkpipe(hdw->usb_dev,
3752 PVR2_CTL_READ_ENDPOINT),
3753 hdw->ctl_read_buffer,
3754 read_len,
3755 pvr2_ctl_read_complete,
3756 hdw);
3757 hdw->ctl_read_urb->actual_length = 0;
3758 hdw->ctl_read_pend_flag = !0;
3759 status = usb_submit_urb(hdw->ctl_read_urb,GFP_KERNEL);
3760 if (status < 0) {
3761 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3762 "Failed to submit read-control"
3763 " URB status=%d",status);
3764 hdw->ctl_read_pend_flag = 0;
3765 goto done;
3766 }
3767 }
3768
3769 /* Start timer */
3770 add_timer(&timer);
3771
3772 /* Now wait for all I/O to complete */
3773 hdw->cmd_debug_state = 4;
3774 while (hdw->ctl_write_pend_flag || hdw->ctl_read_pend_flag) {
3775 wait_for_completion(&hdw->ctl_done);
3776 }
3777 hdw->cmd_debug_state = 5;
3778
3779 /* Stop timer */
3780 del_timer_sync(&timer);
3781
3782 hdw->cmd_debug_state = 6;
3783 status = 0;
3784
3785 if (hdw->ctl_timeout_flag) {
3786 status = -ETIMEDOUT;
3787 if (!probe_fl) {
3788 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3789 "Timed out control-write");
3790 }
3791 goto done;
3792 }
3793
3794 if (write_len) {
3795 /* Validate results of write request */
3796 if ((hdw->ctl_write_urb->status != 0) &&
3797 (hdw->ctl_write_urb->status != -ENOENT) &&
3798 (hdw->ctl_write_urb->status != -ESHUTDOWN) &&
3799 (hdw->ctl_write_urb->status != -ECONNRESET)) {
3800 /* USB subsystem is reporting some kind of failure
3801 on the write */
3802 status = hdw->ctl_write_urb->status;
3803 if (!probe_fl) {
3804 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3805 "control-write URB failure,"
3806 " status=%d",
3807 status);
3808 }
3809 goto done;
3810 }
3811 if (hdw->ctl_write_urb->actual_length < write_len) {
3812 /* Failed to write enough data */
3813 status = -EIO;
3814 if (!probe_fl) {
3815 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3816 "control-write URB short,"
3817 " expected=%d got=%d",
3818 write_len,
3819 hdw->ctl_write_urb->actual_length);
3820 }
3821 goto done;
3822 }
3823 }
3824 if (read_len) {
3825 /* Validate results of read request */
3826 if ((hdw->ctl_read_urb->status != 0) &&
3827 (hdw->ctl_read_urb->status != -ENOENT) &&
3828 (hdw->ctl_read_urb->status != -ESHUTDOWN) &&
3829 (hdw->ctl_read_urb->status != -ECONNRESET)) {
3830 /* USB subsystem is reporting some kind of failure
3831 on the read */
3832 status = hdw->ctl_read_urb->status;
3833 if (!probe_fl) {
3834 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3835 "control-read URB failure,"
3836 " status=%d",
3837 status);
3838 }
3839 goto done;
3840 }
3841 if (hdw->ctl_read_urb->actual_length < read_len) {
3842 /* Failed to read enough data */
3843 status = -EIO;
3844 if (!probe_fl) {
3845 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3846 "control-read URB short,"
3847 " expected=%d got=%d",
3848 read_len,
3849 hdw->ctl_read_urb->actual_length);
3850 }
3851 goto done;
3852 }
3853 /* Transfer retrieved data out from internal buffer */
3854 for (idx = 0; idx < read_len; idx++) {
3855 ((unsigned char *)read_data)[idx] =
3856 hdw->ctl_read_buffer[idx];
3857 }
3858 }
3859
3860 done:
3861
3862 hdw->cmd_debug_state = 0;
3863 if ((status < 0) && (!probe_fl)) {
Mike Isely681c7392007-11-26 01:48:52 -03003864 pvr2_hdw_render_useless(hdw);
Mike Iselyd8554972006-06-26 20:58:46 -03003865 }
3866 return status;
3867}
3868
3869
3870int pvr2_send_request(struct pvr2_hdw *hdw,
3871 void *write_data,unsigned int write_len,
3872 void *read_data,unsigned int read_len)
3873{
3874 return pvr2_send_request_ex(hdw,HZ*4,0,
3875 write_data,write_len,
3876 read_data,read_len);
3877}
3878
Mike Isely1c9d10d2008-03-28 05:38:54 -03003879
3880static int pvr2_issue_simple_cmd(struct pvr2_hdw *hdw,u32 cmdcode)
3881{
3882 int ret;
3883 unsigned int cnt = 1;
3884 unsigned int args = 0;
3885 LOCK_TAKE(hdw->ctl_lock);
3886 hdw->cmd_buffer[0] = cmdcode & 0xffu;
3887 args = (cmdcode >> 8) & 0xffu;
3888 args = (args > 2) ? 2 : args;
3889 if (args) {
3890 cnt += args;
3891 hdw->cmd_buffer[1] = (cmdcode >> 16) & 0xffu;
3892 if (args > 1) {
3893 hdw->cmd_buffer[2] = (cmdcode >> 24) & 0xffu;
3894 }
3895 }
3896 if (pvrusb2_debug & PVR2_TRACE_INIT) {
3897 unsigned int idx;
3898 unsigned int ccnt,bcnt;
3899 char tbuf[50];
3900 cmdcode &= 0xffu;
3901 bcnt = 0;
3902 ccnt = scnprintf(tbuf+bcnt,
3903 sizeof(tbuf)-bcnt,
3904 "Sending FX2 command 0x%x",cmdcode);
3905 bcnt += ccnt;
3906 for (idx = 0; idx < ARRAY_SIZE(pvr2_fx2cmd_desc); idx++) {
3907 if (pvr2_fx2cmd_desc[idx].id == cmdcode) {
3908 ccnt = scnprintf(tbuf+bcnt,
3909 sizeof(tbuf)-bcnt,
3910 " \"%s\"",
3911 pvr2_fx2cmd_desc[idx].desc);
3912 bcnt += ccnt;
3913 break;
3914 }
3915 }
3916 if (args) {
3917 ccnt = scnprintf(tbuf+bcnt,
3918 sizeof(tbuf)-bcnt,
3919 " (%u",hdw->cmd_buffer[1]);
3920 bcnt += ccnt;
3921 if (args > 1) {
3922 ccnt = scnprintf(tbuf+bcnt,
3923 sizeof(tbuf)-bcnt,
3924 ",%u",hdw->cmd_buffer[2]);
3925 bcnt += ccnt;
3926 }
3927 ccnt = scnprintf(tbuf+bcnt,
3928 sizeof(tbuf)-bcnt,
3929 ")");
3930 bcnt += ccnt;
3931 }
3932 pvr2_trace(PVR2_TRACE_INIT,"%.*s",bcnt,tbuf);
3933 }
3934 ret = pvr2_send_request(hdw,hdw->cmd_buffer,cnt,NULL,0);
3935 LOCK_GIVE(hdw->ctl_lock);
3936 return ret;
3937}
3938
3939
Mike Iselyd8554972006-06-26 20:58:46 -03003940int pvr2_write_register(struct pvr2_hdw *hdw, u16 reg, u32 data)
3941{
3942 int ret;
3943
3944 LOCK_TAKE(hdw->ctl_lock);
3945
Michael Krufky8d364362007-01-22 02:17:55 -03003946 hdw->cmd_buffer[0] = FX2CMD_REG_WRITE; /* write register prefix */
Mike Iselyd8554972006-06-26 20:58:46 -03003947 PVR2_DECOMPOSE_LE(hdw->cmd_buffer,1,data);
3948 hdw->cmd_buffer[5] = 0;
3949 hdw->cmd_buffer[6] = (reg >> 8) & 0xff;
3950 hdw->cmd_buffer[7] = reg & 0xff;
3951
3952
3953 ret = pvr2_send_request(hdw, hdw->cmd_buffer, 8, hdw->cmd_buffer, 0);
3954
3955 LOCK_GIVE(hdw->ctl_lock);
3956
3957 return ret;
3958}
3959
3960
Adrian Bunk07e337e2006-06-30 11:30:20 -03003961static int pvr2_read_register(struct pvr2_hdw *hdw, u16 reg, u32 *data)
Mike Iselyd8554972006-06-26 20:58:46 -03003962{
3963 int ret = 0;
3964
3965 LOCK_TAKE(hdw->ctl_lock);
3966
Michael Krufky8d364362007-01-22 02:17:55 -03003967 hdw->cmd_buffer[0] = FX2CMD_REG_READ; /* read register prefix */
Mike Iselyd8554972006-06-26 20:58:46 -03003968 hdw->cmd_buffer[1] = 0;
3969 hdw->cmd_buffer[2] = 0;
3970 hdw->cmd_buffer[3] = 0;
3971 hdw->cmd_buffer[4] = 0;
3972 hdw->cmd_buffer[5] = 0;
3973 hdw->cmd_buffer[6] = (reg >> 8) & 0xff;
3974 hdw->cmd_buffer[7] = reg & 0xff;
3975
3976 ret |= pvr2_send_request(hdw, hdw->cmd_buffer, 8, hdw->cmd_buffer, 4);
3977 *data = PVR2_COMPOSE_LE(hdw->cmd_buffer,0);
3978
3979 LOCK_GIVE(hdw->ctl_lock);
3980
3981 return ret;
3982}
3983
3984
Mike Isely681c7392007-11-26 01:48:52 -03003985void pvr2_hdw_render_useless(struct pvr2_hdw *hdw)
Mike Iselyd8554972006-06-26 20:58:46 -03003986{
3987 if (!hdw->flag_ok) return;
Mike Isely681c7392007-11-26 01:48:52 -03003988 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
3989 "Device being rendered inoperable");
Mike Iselyd8554972006-06-26 20:58:46 -03003990 if (hdw->vid_stream) {
Mike Iselya0fd1cb2006-06-30 11:35:28 -03003991 pvr2_stream_setup(hdw->vid_stream,NULL,0,0);
Mike Iselyd8554972006-06-26 20:58:46 -03003992 }
Mike Isely681c7392007-11-26 01:48:52 -03003993 hdw->flag_ok = 0;
3994 trace_stbit("flag_ok",hdw->flag_ok);
3995 pvr2_hdw_state_sched(hdw);
Mike Iselyd8554972006-06-26 20:58:46 -03003996}
3997
3998
3999void pvr2_hdw_device_reset(struct pvr2_hdw *hdw)
4000{
4001 int ret;
4002 pvr2_trace(PVR2_TRACE_INIT,"Performing a device reset...");
Mike Iselya0fd1cb2006-06-30 11:35:28 -03004003 ret = usb_lock_device_for_reset(hdw->usb_dev,NULL);
Alan Stern011b15d2008-11-04 11:29:27 -05004004 if (ret == 0) {
Mike Iselyd8554972006-06-26 20:58:46 -03004005 ret = usb_reset_device(hdw->usb_dev);
4006 usb_unlock_device(hdw->usb_dev);
4007 } else {
4008 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
4009 "Failed to lock USB device ret=%d",ret);
4010 }
4011 if (init_pause_msec) {
4012 pvr2_trace(PVR2_TRACE_INFO,
4013 "Waiting %u msec for hardware to settle",
4014 init_pause_msec);
4015 msleep(init_pause_msec);
4016 }
4017
4018}
4019
4020
4021void pvr2_hdw_cpureset_assert(struct pvr2_hdw *hdw,int val)
4022{
4023 char da[1];
4024 unsigned int pipe;
4025 int ret;
4026
4027 if (!hdw->usb_dev) return;
4028
4029 pvr2_trace(PVR2_TRACE_INIT,"cpureset_assert(%d)",val);
4030
4031 da[0] = val ? 0x01 : 0x00;
4032
4033 /* Write the CPUCS register on the 8051. The lsb of the register
4034 is the reset bit; a 1 asserts reset while a 0 clears it. */
4035 pipe = usb_sndctrlpipe(hdw->usb_dev, 0);
4036 ret = usb_control_msg(hdw->usb_dev,pipe,0xa0,0x40,0xe600,0,da,1,HZ);
4037 if (ret < 0) {
4038 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
4039 "cpureset_assert(%d) error=%d",val,ret);
4040 pvr2_hdw_render_useless(hdw);
4041 }
4042}
4043
4044
4045int pvr2_hdw_cmd_deep_reset(struct pvr2_hdw *hdw)
4046{
Mike Isely1c9d10d2008-03-28 05:38:54 -03004047 return pvr2_issue_simple_cmd(hdw,FX2CMD_DEEP_RESET);
Mike Iselyd8554972006-06-26 20:58:46 -03004048}
4049
4050
Michael Krufkye1edb192008-04-22 14:45:39 -03004051int pvr2_hdw_cmd_powerup(struct pvr2_hdw *hdw)
4052{
Mike Isely1c9d10d2008-03-28 05:38:54 -03004053 return pvr2_issue_simple_cmd(hdw,FX2CMD_POWER_ON);
Michael Krufkye1edb192008-04-22 14:45:39 -03004054}
4055
Mike Isely1c9d10d2008-03-28 05:38:54 -03004056
Michael Krufkye1edb192008-04-22 14:45:39 -03004057int pvr2_hdw_cmd_powerdown(struct pvr2_hdw *hdw)
4058{
Mike Isely1c9d10d2008-03-28 05:38:54 -03004059 return pvr2_issue_simple_cmd(hdw,FX2CMD_POWER_OFF);
Michael Krufkye1edb192008-04-22 14:45:39 -03004060}
4061
Mike Iselyd8554972006-06-26 20:58:46 -03004062
4063int pvr2_hdw_cmd_decoder_reset(struct pvr2_hdw *hdw)
4064{
Mike Iselyd8554972006-06-26 20:58:46 -03004065 pvr2_trace(PVR2_TRACE_INIT,
4066 "Requesting decoder reset");
Mike Iselyaf78e162009-03-07 00:21:30 -03004067 if (hdw->decoder_client_id) {
4068 v4l2_device_call_all(&hdw->v4l2_dev, hdw->decoder_client_id,
4069 core, reset, 0);
4070 return 0;
4071 }
4072 pvr2_trace(PVR2_TRACE_INIT,
4073 "Unable to reset decoder: nothing attached");
4074 return -ENOTTY;
Mike Iselyd8554972006-06-26 20:58:46 -03004075}
4076
4077
Mike Isely62433e32008-04-22 14:45:40 -03004078static int pvr2_hdw_cmd_hcw_demod_reset(struct pvr2_hdw *hdw, int onoff)
Mike Isely84147f32008-04-22 14:45:40 -03004079{
Mike Isely1c9d10d2008-03-28 05:38:54 -03004080 hdw->flag_ok = !0;
4081 return pvr2_issue_simple_cmd(hdw,
4082 FX2CMD_HCW_DEMOD_RESETIN |
4083 (1 << 8) |
4084 ((onoff ? 1 : 0) << 16));
Mike Isely84147f32008-04-22 14:45:40 -03004085}
4086
Mike Isely84147f32008-04-22 14:45:40 -03004087
Mike Isely62433e32008-04-22 14:45:40 -03004088static int pvr2_hdw_cmd_onair_fe_power_ctrl(struct pvr2_hdw *hdw, int onoff)
Mike Isely84147f32008-04-22 14:45:40 -03004089{
Mike Isely1c9d10d2008-03-28 05:38:54 -03004090 hdw->flag_ok = !0;
4091 return pvr2_issue_simple_cmd(hdw,(onoff ?
4092 FX2CMD_ONAIR_DTV_POWER_ON :
4093 FX2CMD_ONAIR_DTV_POWER_OFF));
Mike Isely84147f32008-04-22 14:45:40 -03004094}
4095
Mike Isely62433e32008-04-22 14:45:40 -03004096
4097static int pvr2_hdw_cmd_onair_digital_path_ctrl(struct pvr2_hdw *hdw,
4098 int onoff)
Mike Isely84147f32008-04-22 14:45:40 -03004099{
Mike Isely1c9d10d2008-03-28 05:38:54 -03004100 return pvr2_issue_simple_cmd(hdw,(onoff ?
4101 FX2CMD_ONAIR_DTV_STREAMING_ON :
4102 FX2CMD_ONAIR_DTV_STREAMING_OFF));
Mike Isely84147f32008-04-22 14:45:40 -03004103}
4104
Mike Isely62433e32008-04-22 14:45:40 -03004105
4106static void pvr2_hdw_cmd_modeswitch(struct pvr2_hdw *hdw,int digitalFl)
4107{
4108 int cmode;
4109 /* Compare digital/analog desired setting with current setting. If
4110 they don't match, fix it... */
4111 cmode = (digitalFl ? PVR2_PATHWAY_DIGITAL : PVR2_PATHWAY_ANALOG);
4112 if (cmode == hdw->pathway_state) {
4113 /* They match; nothing to do */
4114 return;
4115 }
4116
4117 switch (hdw->hdw_desc->digital_control_scheme) {
4118 case PVR2_DIGITAL_SCHEME_HAUPPAUGE:
4119 pvr2_hdw_cmd_hcw_demod_reset(hdw,digitalFl);
4120 if (cmode == PVR2_PATHWAY_ANALOG) {
4121 /* If moving to analog mode, also force the decoder
4122 to reset. If no decoder is attached, then it's
4123 ok to ignore this because if/when the decoder
4124 attaches, it will reset itself at that time. */
4125 pvr2_hdw_cmd_decoder_reset(hdw);
4126 }
4127 break;
4128 case PVR2_DIGITAL_SCHEME_ONAIR:
4129 /* Supposedly we should always have the power on whether in
4130 digital or analog mode. But for now do what appears to
4131 work... */
Mike Iselybb0c2fe2008-03-28 05:41:19 -03004132 pvr2_hdw_cmd_onair_fe_power_ctrl(hdw,digitalFl);
Mike Isely62433e32008-04-22 14:45:40 -03004133 break;
4134 default: break;
4135 }
4136
Mike Isely1b9c18c2008-04-22 14:45:41 -03004137 pvr2_hdw_untrip_unlocked(hdw);
Mike Isely62433e32008-04-22 14:45:40 -03004138 hdw->pathway_state = cmode;
4139}
4140
4141
Adrian Bunke9b59f62008-05-10 04:35:24 -03004142static void pvr2_led_ctrl_hauppauge(struct pvr2_hdw *hdw, int onoff)
Mike Iselyc55a97d2008-04-22 14:45:41 -03004143{
4144 /* change some GPIO data
4145 *
4146 * note: bit d7 of dir appears to control the LED,
4147 * so we shut it off here.
4148 *
Mike Iselyc55a97d2008-04-22 14:45:41 -03004149 */
Mike Isely40381cb2008-04-22 14:45:42 -03004150 if (onoff) {
Mike Iselyc55a97d2008-04-22 14:45:41 -03004151 pvr2_hdw_gpio_chg_dir(hdw, 0xffffffff, 0x00000481);
Mike Isely40381cb2008-04-22 14:45:42 -03004152 } else {
Mike Iselyc55a97d2008-04-22 14:45:41 -03004153 pvr2_hdw_gpio_chg_dir(hdw, 0xffffffff, 0x00000401);
Mike Isely40381cb2008-04-22 14:45:42 -03004154 }
Mike Iselyc55a97d2008-04-22 14:45:41 -03004155 pvr2_hdw_gpio_chg_out(hdw, 0xffffffff, 0x00000000);
Mike Isely40381cb2008-04-22 14:45:42 -03004156}
Mike Iselyc55a97d2008-04-22 14:45:41 -03004157
Mike Isely40381cb2008-04-22 14:45:42 -03004158
4159typedef void (*led_method_func)(struct pvr2_hdw *,int);
4160
4161static led_method_func led_methods[] = {
4162 [PVR2_LED_SCHEME_HAUPPAUGE] = pvr2_led_ctrl_hauppauge,
4163};
4164
4165
4166/* Toggle LED */
4167static void pvr2_led_ctrl(struct pvr2_hdw *hdw,int onoff)
4168{
4169 unsigned int scheme_id;
4170 led_method_func fp;
4171
4172 if ((!onoff) == (!hdw->led_on)) return;
4173
4174 hdw->led_on = onoff != 0;
4175
4176 scheme_id = hdw->hdw_desc->led_scheme;
4177 if (scheme_id < ARRAY_SIZE(led_methods)) {
4178 fp = led_methods[scheme_id];
4179 } else {
4180 fp = NULL;
4181 }
4182
4183 if (fp) (*fp)(hdw,onoff);
Mike Iselyc55a97d2008-04-22 14:45:41 -03004184}
4185
4186
Mike Iselye61b6fc2006-07-18 22:42:18 -03004187/* Stop / start video stream transport */
Adrian Bunk07e337e2006-06-30 11:30:20 -03004188static int pvr2_hdw_cmd_usbstream(struct pvr2_hdw *hdw,int runFl)
Mike Iselyd8554972006-06-26 20:58:46 -03004189{
Mike Iselybb0c2fe2008-03-28 05:41:19 -03004190 int ret;
4191
4192 /* If we're in analog mode, then just issue the usual analog
4193 command. */
4194 if (hdw->pathway_state == PVR2_PATHWAY_ANALOG) {
4195 return pvr2_issue_simple_cmd(hdw,
4196 (runFl ?
4197 FX2CMD_STREAMING_ON :
4198 FX2CMD_STREAMING_OFF));
4199 /*Note: Not reached */
Mike Isely62433e32008-04-22 14:45:40 -03004200 }
Mike Iselybb0c2fe2008-03-28 05:41:19 -03004201
4202 if (hdw->pathway_state != PVR2_PATHWAY_DIGITAL) {
4203 /* Whoops, we don't know what mode we're in... */
4204 return -EINVAL;
4205 }
4206
4207 /* To get here we have to be in digital mode. The mechanism here
4208 is unfortunately different for different vendors. So we switch
4209 on the device's digital scheme attribute in order to figure out
4210 what to do. */
4211 switch (hdw->hdw_desc->digital_control_scheme) {
4212 case PVR2_DIGITAL_SCHEME_HAUPPAUGE:
4213 return pvr2_issue_simple_cmd(hdw,
4214 (runFl ?
4215 FX2CMD_HCW_DTV_STREAMING_ON :
4216 FX2CMD_HCW_DTV_STREAMING_OFF));
4217 case PVR2_DIGITAL_SCHEME_ONAIR:
4218 ret = pvr2_issue_simple_cmd(hdw,
4219 (runFl ?
4220 FX2CMD_STREAMING_ON :
4221 FX2CMD_STREAMING_OFF));
4222 if (ret) return ret;
4223 return pvr2_hdw_cmd_onair_digital_path_ctrl(hdw,runFl);
4224 default:
4225 return -EINVAL;
4226 }
Mike Iselyd8554972006-06-26 20:58:46 -03004227}
4228
4229
Mike Isely62433e32008-04-22 14:45:40 -03004230/* Evaluate whether or not state_pathway_ok can change */
4231static int state_eval_pathway_ok(struct pvr2_hdw *hdw)
4232{
4233 if (hdw->state_pathway_ok) {
4234 /* Nothing to do if pathway is already ok */
4235 return 0;
4236 }
4237 if (!hdw->state_pipeline_idle) {
4238 /* Not allowed to change anything if pipeline is not idle */
4239 return 0;
4240 }
4241 pvr2_hdw_cmd_modeswitch(hdw,hdw->input_val == PVR2_CVAL_INPUT_DTV);
4242 hdw->state_pathway_ok = !0;
Mike Iselye9db1ff2008-04-22 14:45:41 -03004243 trace_stbit("state_pathway_ok",hdw->state_pathway_ok);
Mike Isely62433e32008-04-22 14:45:40 -03004244 return !0;
4245}
4246
4247
Mike Isely681c7392007-11-26 01:48:52 -03004248/* Evaluate whether or not state_encoder_ok can change */
4249static int state_eval_encoder_ok(struct pvr2_hdw *hdw)
4250{
4251 if (hdw->state_encoder_ok) return 0;
4252 if (hdw->flag_tripped) return 0;
4253 if (hdw->state_encoder_run) return 0;
4254 if (hdw->state_encoder_config) return 0;
4255 if (hdw->state_decoder_run) return 0;
4256 if (hdw->state_usbstream_run) return 0;
Mike Isely72998b72008-04-03 04:51:19 -03004257 if (hdw->pathway_state == PVR2_PATHWAY_DIGITAL) {
4258 if (!hdw->hdw_desc->flag_digital_requires_cx23416) return 0;
4259 } else if (hdw->pathway_state != PVR2_PATHWAY_ANALOG) {
4260 return 0;
4261 }
4262
Mike Isely681c7392007-11-26 01:48:52 -03004263 if (pvr2_upload_firmware2(hdw) < 0) {
4264 hdw->flag_tripped = !0;
4265 trace_stbit("flag_tripped",hdw->flag_tripped);
4266 return !0;
4267 }
4268 hdw->state_encoder_ok = !0;
4269 trace_stbit("state_encoder_ok",hdw->state_encoder_ok);
4270 return !0;
4271}
4272
4273
4274/* Evaluate whether or not state_encoder_config can change */
4275static int state_eval_encoder_config(struct pvr2_hdw *hdw)
4276{
4277 if (hdw->state_encoder_config) {
4278 if (hdw->state_encoder_ok) {
4279 if (hdw->state_pipeline_req &&
4280 !hdw->state_pipeline_pause) return 0;
4281 }
4282 hdw->state_encoder_config = 0;
4283 hdw->state_encoder_waitok = 0;
4284 trace_stbit("state_encoder_waitok",hdw->state_encoder_waitok);
4285 /* paranoia - solve race if timer just completed */
4286 del_timer_sync(&hdw->encoder_wait_timer);
4287 } else {
Mike Isely62433e32008-04-22 14:45:40 -03004288 if (!hdw->state_pathway_ok ||
4289 (hdw->pathway_state != PVR2_PATHWAY_ANALOG) ||
4290 !hdw->state_encoder_ok ||
Mike Isely681c7392007-11-26 01:48:52 -03004291 !hdw->state_pipeline_idle ||
4292 hdw->state_pipeline_pause ||
4293 !hdw->state_pipeline_req ||
4294 !hdw->state_pipeline_config) {
4295 /* We must reset the enforced wait interval if
4296 anything has happened that might have disturbed
4297 the encoder. This should be a rare case. */
4298 if (timer_pending(&hdw->encoder_wait_timer)) {
4299 del_timer_sync(&hdw->encoder_wait_timer);
4300 }
4301 if (hdw->state_encoder_waitok) {
4302 /* Must clear the state - therefore we did
4303 something to a state bit and must also
4304 return true. */
4305 hdw->state_encoder_waitok = 0;
4306 trace_stbit("state_encoder_waitok",
4307 hdw->state_encoder_waitok);
4308 return !0;
4309 }
4310 return 0;
4311 }
4312 if (!hdw->state_encoder_waitok) {
4313 if (!timer_pending(&hdw->encoder_wait_timer)) {
4314 /* waitok flag wasn't set and timer isn't
4315 running. Check flag once more to avoid
4316 a race then start the timer. This is
4317 the point when we measure out a minimal
4318 quiet interval before doing something to
4319 the encoder. */
4320 if (!hdw->state_encoder_waitok) {
4321 hdw->encoder_wait_timer.expires =
Mike Isely83ce57a2008-05-26 05:51:57 -03004322 jiffies +
4323 (HZ * TIME_MSEC_ENCODER_WAIT
4324 / 1000);
Mike Isely681c7392007-11-26 01:48:52 -03004325 add_timer(&hdw->encoder_wait_timer);
4326 }
4327 }
4328 /* We can't continue until we know we have been
4329 quiet for the interval measured by this
4330 timer. */
4331 return 0;
4332 }
4333 pvr2_encoder_configure(hdw);
4334 if (hdw->state_encoder_ok) hdw->state_encoder_config = !0;
4335 }
4336 trace_stbit("state_encoder_config",hdw->state_encoder_config);
4337 return !0;
4338}
4339
4340
Mike Iselyd913d632008-04-06 04:04:35 -03004341/* Return true if the encoder should not be running. */
4342static int state_check_disable_encoder_run(struct pvr2_hdw *hdw)
4343{
4344 if (!hdw->state_encoder_ok) {
4345 /* Encoder isn't healthy at the moment, so stop it. */
4346 return !0;
4347 }
4348 if (!hdw->state_pathway_ok) {
4349 /* Mode is not understood at the moment (i.e. it wants to
4350 change), so encoder must be stopped. */
4351 return !0;
4352 }
4353
4354 switch (hdw->pathway_state) {
4355 case PVR2_PATHWAY_ANALOG:
4356 if (!hdw->state_decoder_run) {
4357 /* We're in analog mode and the decoder is not
4358 running; thus the encoder should be stopped as
4359 well. */
4360 return !0;
4361 }
4362 break;
4363 case PVR2_PATHWAY_DIGITAL:
4364 if (hdw->state_encoder_runok) {
4365 /* This is a funny case. We're in digital mode so
4366 really the encoder should be stopped. However
4367 if it really is running, only kill it after
4368 runok has been set. This gives a chance for the
4369 onair quirk to function (encoder must run
4370 briefly first, at least once, before onair
4371 digital streaming can work). */
4372 return !0;
4373 }
4374 break;
4375 default:
4376 /* Unknown mode; so encoder should be stopped. */
4377 return !0;
4378 }
4379
4380 /* If we get here, we haven't found a reason to stop the
4381 encoder. */
4382 return 0;
4383}
4384
4385
4386/* Return true if the encoder should be running. */
4387static int state_check_enable_encoder_run(struct pvr2_hdw *hdw)
4388{
4389 if (!hdw->state_encoder_ok) {
4390 /* Don't run the encoder if it isn't healthy... */
4391 return 0;
4392 }
4393 if (!hdw->state_pathway_ok) {
4394 /* Don't run the encoder if we don't (yet) know what mode
4395 we need to be in... */
4396 return 0;
4397 }
4398
4399 switch (hdw->pathway_state) {
4400 case PVR2_PATHWAY_ANALOG:
4401 if (hdw->state_decoder_run) {
4402 /* In analog mode, if the decoder is running, then
4403 run the encoder. */
4404 return !0;
4405 }
4406 break;
4407 case PVR2_PATHWAY_DIGITAL:
4408 if ((hdw->hdw_desc->digital_control_scheme ==
4409 PVR2_DIGITAL_SCHEME_ONAIR) &&
4410 !hdw->state_encoder_runok) {
4411 /* This is a quirk. OnAir hardware won't stream
4412 digital until the encoder has been run at least
4413 once, for a minimal period of time (empiricially
4414 measured to be 1/4 second). So if we're on
4415 OnAir hardware and the encoder has never been
4416 run at all, then start the encoder. Normal
4417 state machine logic in the driver will
4418 automatically handle the remaining bits. */
4419 return !0;
4420 }
4421 break;
4422 default:
4423 /* For completeness (unknown mode; encoder won't run ever) */
4424 break;
4425 }
4426 /* If we get here, then we haven't found any reason to run the
4427 encoder, so don't run it. */
4428 return 0;
4429}
4430
4431
Mike Isely681c7392007-11-26 01:48:52 -03004432/* Evaluate whether or not state_encoder_run can change */
4433static int state_eval_encoder_run(struct pvr2_hdw *hdw)
4434{
4435 if (hdw->state_encoder_run) {
Mike Iselyd913d632008-04-06 04:04:35 -03004436 if (!state_check_disable_encoder_run(hdw)) return 0;
Mike Isely681c7392007-11-26 01:48:52 -03004437 if (hdw->state_encoder_ok) {
Mike Iselyd913d632008-04-06 04:04:35 -03004438 del_timer_sync(&hdw->encoder_run_timer);
Mike Isely681c7392007-11-26 01:48:52 -03004439 if (pvr2_encoder_stop(hdw) < 0) return !0;
4440 }
4441 hdw->state_encoder_run = 0;
4442 } else {
Mike Iselyd913d632008-04-06 04:04:35 -03004443 if (!state_check_enable_encoder_run(hdw)) return 0;
Mike Isely681c7392007-11-26 01:48:52 -03004444 if (pvr2_encoder_start(hdw) < 0) return !0;
4445 hdw->state_encoder_run = !0;
Mike Iselyd913d632008-04-06 04:04:35 -03004446 if (!hdw->state_encoder_runok) {
4447 hdw->encoder_run_timer.expires =
Mike Isely83ce57a2008-05-26 05:51:57 -03004448 jiffies + (HZ * TIME_MSEC_ENCODER_OK / 1000);
Mike Iselyd913d632008-04-06 04:04:35 -03004449 add_timer(&hdw->encoder_run_timer);
4450 }
Mike Isely681c7392007-11-26 01:48:52 -03004451 }
4452 trace_stbit("state_encoder_run",hdw->state_encoder_run);
4453 return !0;
4454}
4455
4456
4457/* Timeout function for quiescent timer. */
4458static void pvr2_hdw_quiescent_timeout(unsigned long data)
4459{
4460 struct pvr2_hdw *hdw = (struct pvr2_hdw *)data;
4461 hdw->state_decoder_quiescent = !0;
4462 trace_stbit("state_decoder_quiescent",hdw->state_decoder_quiescent);
4463 hdw->state_stale = !0;
4464 queue_work(hdw->workqueue,&hdw->workpoll);
4465}
4466
4467
4468/* Timeout function for encoder wait timer. */
4469static void pvr2_hdw_encoder_wait_timeout(unsigned long data)
4470{
4471 struct pvr2_hdw *hdw = (struct pvr2_hdw *)data;
4472 hdw->state_encoder_waitok = !0;
4473 trace_stbit("state_encoder_waitok",hdw->state_encoder_waitok);
4474 hdw->state_stale = !0;
4475 queue_work(hdw->workqueue,&hdw->workpoll);
4476}
4477
4478
Mike Iselyd913d632008-04-06 04:04:35 -03004479/* Timeout function for encoder run timer. */
4480static void pvr2_hdw_encoder_run_timeout(unsigned long data)
4481{
4482 struct pvr2_hdw *hdw = (struct pvr2_hdw *)data;
4483 if (!hdw->state_encoder_runok) {
4484 hdw->state_encoder_runok = !0;
4485 trace_stbit("state_encoder_runok",hdw->state_encoder_runok);
4486 hdw->state_stale = !0;
4487 queue_work(hdw->workqueue,&hdw->workpoll);
4488 }
4489}
4490
4491
Mike Isely681c7392007-11-26 01:48:52 -03004492/* Evaluate whether or not state_decoder_run can change */
4493static int state_eval_decoder_run(struct pvr2_hdw *hdw)
4494{
4495 if (hdw->state_decoder_run) {
4496 if (hdw->state_encoder_ok) {
4497 if (hdw->state_pipeline_req &&
Mike Isely62433e32008-04-22 14:45:40 -03004498 !hdw->state_pipeline_pause &&
4499 hdw->state_pathway_ok) return 0;
Mike Isely681c7392007-11-26 01:48:52 -03004500 }
4501 if (!hdw->flag_decoder_missed) {
4502 pvr2_decoder_enable(hdw,0);
4503 }
4504 hdw->state_decoder_quiescent = 0;
4505 hdw->state_decoder_run = 0;
4506 /* paranoia - solve race if timer just completed */
4507 del_timer_sync(&hdw->quiescent_timer);
4508 } else {
4509 if (!hdw->state_decoder_quiescent) {
4510 if (!timer_pending(&hdw->quiescent_timer)) {
4511 /* We don't do something about the
4512 quiescent timer until right here because
4513 we also want to catch cases where the
4514 decoder was already not running (like
4515 after initialization) as opposed to
4516 knowing that we had just stopped it.
4517 The second flag check is here to cover a
4518 race - the timer could have run and set
4519 this flag just after the previous check
4520 but before we did the pending check. */
4521 if (!hdw->state_decoder_quiescent) {
4522 hdw->quiescent_timer.expires =
Mike Isely83ce57a2008-05-26 05:51:57 -03004523 jiffies +
4524 (HZ * TIME_MSEC_DECODER_WAIT
4525 / 1000);
Mike Isely681c7392007-11-26 01:48:52 -03004526 add_timer(&hdw->quiescent_timer);
4527 }
4528 }
4529 /* Don't allow decoder to start again until it has
4530 been quiesced first. This little detail should
4531 hopefully further stabilize the encoder. */
4532 return 0;
4533 }
Mike Isely62433e32008-04-22 14:45:40 -03004534 if (!hdw->state_pathway_ok ||
4535 (hdw->pathway_state != PVR2_PATHWAY_ANALOG) ||
4536 !hdw->state_pipeline_req ||
Mike Isely681c7392007-11-26 01:48:52 -03004537 hdw->state_pipeline_pause ||
4538 !hdw->state_pipeline_config ||
4539 !hdw->state_encoder_config ||
4540 !hdw->state_encoder_ok) return 0;
4541 del_timer_sync(&hdw->quiescent_timer);
4542 if (hdw->flag_decoder_missed) return 0;
4543 if (pvr2_decoder_enable(hdw,!0) < 0) return 0;
4544 hdw->state_decoder_quiescent = 0;
4545 hdw->state_decoder_run = !0;
4546 }
4547 trace_stbit("state_decoder_quiescent",hdw->state_decoder_quiescent);
4548 trace_stbit("state_decoder_run",hdw->state_decoder_run);
4549 return !0;
4550}
4551
4552
4553/* Evaluate whether or not state_usbstream_run can change */
4554static int state_eval_usbstream_run(struct pvr2_hdw *hdw)
4555{
4556 if (hdw->state_usbstream_run) {
Mike Isely72998b72008-04-03 04:51:19 -03004557 int fl = !0;
Mike Isely62433e32008-04-22 14:45:40 -03004558 if (hdw->pathway_state == PVR2_PATHWAY_ANALOG) {
Mike Isely72998b72008-04-03 04:51:19 -03004559 fl = (hdw->state_encoder_ok &&
4560 hdw->state_encoder_run);
4561 } else if ((hdw->pathway_state == PVR2_PATHWAY_DIGITAL) &&
4562 (hdw->hdw_desc->flag_digital_requires_cx23416)) {
4563 fl = hdw->state_encoder_ok;
4564 }
4565 if (fl &&
4566 hdw->state_pipeline_req &&
4567 !hdw->state_pipeline_pause &&
4568 hdw->state_pathway_ok) {
4569 return 0;
Mike Isely681c7392007-11-26 01:48:52 -03004570 }
4571 pvr2_hdw_cmd_usbstream(hdw,0);
4572 hdw->state_usbstream_run = 0;
4573 } else {
Mike Isely62433e32008-04-22 14:45:40 -03004574 if (!hdw->state_pipeline_req ||
4575 hdw->state_pipeline_pause ||
4576 !hdw->state_pathway_ok) return 0;
4577 if (hdw->pathway_state == PVR2_PATHWAY_ANALOG) {
4578 if (!hdw->state_encoder_ok ||
4579 !hdw->state_encoder_run) return 0;
Mike Isely72998b72008-04-03 04:51:19 -03004580 } else if ((hdw->pathway_state == PVR2_PATHWAY_DIGITAL) &&
4581 (hdw->hdw_desc->flag_digital_requires_cx23416)) {
4582 if (!hdw->state_encoder_ok) return 0;
Mike Iselyd913d632008-04-06 04:04:35 -03004583 if (hdw->state_encoder_run) return 0;
4584 if (hdw->hdw_desc->digital_control_scheme ==
4585 PVR2_DIGITAL_SCHEME_ONAIR) {
4586 /* OnAir digital receivers won't stream
4587 unless the analog encoder has run first.
4588 Why? I have no idea. But don't even
4589 try until we know the analog side is
4590 known to have run. */
4591 if (!hdw->state_encoder_runok) return 0;
4592 }
Mike Isely62433e32008-04-22 14:45:40 -03004593 }
Mike Isely681c7392007-11-26 01:48:52 -03004594 if (pvr2_hdw_cmd_usbstream(hdw,!0) < 0) return 0;
4595 hdw->state_usbstream_run = !0;
4596 }
4597 trace_stbit("state_usbstream_run",hdw->state_usbstream_run);
4598 return !0;
4599}
4600
4601
4602/* Attempt to configure pipeline, if needed */
4603static int state_eval_pipeline_config(struct pvr2_hdw *hdw)
4604{
4605 if (hdw->state_pipeline_config ||
4606 hdw->state_pipeline_pause) return 0;
4607 pvr2_hdw_commit_execute(hdw);
4608 return !0;
4609}
4610
4611
4612/* Update pipeline idle and pipeline pause tracking states based on other
4613 inputs. This must be called whenever the other relevant inputs have
4614 changed. */
4615static int state_update_pipeline_state(struct pvr2_hdw *hdw)
4616{
4617 unsigned int st;
4618 int updatedFl = 0;
4619 /* Update pipeline state */
4620 st = !(hdw->state_encoder_run ||
4621 hdw->state_decoder_run ||
4622 hdw->state_usbstream_run ||
4623 (!hdw->state_decoder_quiescent));
4624 if (!st != !hdw->state_pipeline_idle) {
4625 hdw->state_pipeline_idle = st;
4626 updatedFl = !0;
4627 }
4628 if (hdw->state_pipeline_idle && hdw->state_pipeline_pause) {
4629 hdw->state_pipeline_pause = 0;
4630 updatedFl = !0;
4631 }
4632 return updatedFl;
4633}
4634
4635
4636typedef int (*state_eval_func)(struct pvr2_hdw *);
4637
4638/* Set of functions to be run to evaluate various states in the driver. */
Tobias Klauserebff0332008-04-22 14:45:45 -03004639static const state_eval_func eval_funcs[] = {
Mike Isely62433e32008-04-22 14:45:40 -03004640 state_eval_pathway_ok,
Mike Isely681c7392007-11-26 01:48:52 -03004641 state_eval_pipeline_config,
4642 state_eval_encoder_ok,
4643 state_eval_encoder_config,
4644 state_eval_decoder_run,
4645 state_eval_encoder_run,
4646 state_eval_usbstream_run,
4647};
4648
4649
4650/* Process various states and return true if we did anything interesting. */
4651static int pvr2_hdw_state_update(struct pvr2_hdw *hdw)
4652{
4653 unsigned int i;
4654 int state_updated = 0;
4655 int check_flag;
4656
4657 if (!hdw->state_stale) return 0;
4658 if ((hdw->fw1_state != FW1_STATE_OK) ||
4659 !hdw->flag_ok) {
4660 hdw->state_stale = 0;
4661 return !0;
4662 }
4663 /* This loop is the heart of the entire driver. It keeps trying to
4664 evaluate various bits of driver state until nothing changes for
4665 one full iteration. Each "bit of state" tracks some global
4666 aspect of the driver, e.g. whether decoder should run, if
4667 pipeline is configured, usb streaming is on, etc. We separately
4668 evaluate each of those questions based on other driver state to
4669 arrive at the correct running configuration. */
4670 do {
4671 check_flag = 0;
4672 state_update_pipeline_state(hdw);
4673 /* Iterate over each bit of state */
4674 for (i = 0; (i<ARRAY_SIZE(eval_funcs)) && hdw->flag_ok; i++) {
4675 if ((*eval_funcs[i])(hdw)) {
4676 check_flag = !0;
4677 state_updated = !0;
4678 state_update_pipeline_state(hdw);
4679 }
4680 }
4681 } while (check_flag && hdw->flag_ok);
4682 hdw->state_stale = 0;
4683 trace_stbit("state_stale",hdw->state_stale);
4684 return state_updated;
4685}
4686
4687
Mike Isely1cb03b72008-04-21 03:47:43 -03004688static unsigned int print_input_mask(unsigned int msk,
4689 char *buf,unsigned int acnt)
4690{
4691 unsigned int idx,ccnt;
4692 unsigned int tcnt = 0;
4693 for (idx = 0; idx < ARRAY_SIZE(control_values_input); idx++) {
4694 if (!((1 << idx) & msk)) continue;
4695 ccnt = scnprintf(buf+tcnt,
4696 acnt-tcnt,
4697 "%s%s",
4698 (tcnt ? ", " : ""),
4699 control_values_input[idx]);
4700 tcnt += ccnt;
4701 }
4702 return tcnt;
4703}
4704
4705
Mike Isely62433e32008-04-22 14:45:40 -03004706static const char *pvr2_pathway_state_name(int id)
4707{
4708 switch (id) {
4709 case PVR2_PATHWAY_ANALOG: return "analog";
4710 case PVR2_PATHWAY_DIGITAL: return "digital";
4711 default: return "unknown";
4712 }
4713}
4714
4715
Mike Isely681c7392007-11-26 01:48:52 -03004716static unsigned int pvr2_hdw_report_unlocked(struct pvr2_hdw *hdw,int which,
4717 char *buf,unsigned int acnt)
4718{
4719 switch (which) {
4720 case 0:
4721 return scnprintf(
4722 buf,acnt,
Mike Iselye9db1ff2008-04-22 14:45:41 -03004723 "driver:%s%s%s%s%s <mode=%s>",
Mike Isely681c7392007-11-26 01:48:52 -03004724 (hdw->flag_ok ? " <ok>" : " <fail>"),
4725 (hdw->flag_init_ok ? " <init>" : " <uninitialized>"),
4726 (hdw->flag_disconnected ? " <disconnected>" :
4727 " <connected>"),
4728 (hdw->flag_tripped ? " <tripped>" : ""),
Mike Isely62433e32008-04-22 14:45:40 -03004729 (hdw->flag_decoder_missed ? " <no decoder>" : ""),
4730 pvr2_pathway_state_name(hdw->pathway_state));
4731
Mike Isely681c7392007-11-26 01:48:52 -03004732 case 1:
4733 return scnprintf(
4734 buf,acnt,
4735 "pipeline:%s%s%s%s",
4736 (hdw->state_pipeline_idle ? " <idle>" : ""),
4737 (hdw->state_pipeline_config ?
4738 " <configok>" : " <stale>"),
4739 (hdw->state_pipeline_req ? " <req>" : ""),
4740 (hdw->state_pipeline_pause ? " <pause>" : ""));
4741 case 2:
4742 return scnprintf(
4743 buf,acnt,
Mike Isely62433e32008-04-22 14:45:40 -03004744 "worker:%s%s%s%s%s%s%s",
Mike Isely681c7392007-11-26 01:48:52 -03004745 (hdw->state_decoder_run ?
4746 " <decode:run>" :
4747 (hdw->state_decoder_quiescent ?
4748 "" : " <decode:stop>")),
4749 (hdw->state_decoder_quiescent ?
4750 " <decode:quiescent>" : ""),
4751 (hdw->state_encoder_ok ?
4752 "" : " <encode:init>"),
4753 (hdw->state_encoder_run ?
Mike Iselyd913d632008-04-06 04:04:35 -03004754 (hdw->state_encoder_runok ?
4755 " <encode:run>" :
4756 " <encode:firstrun>") :
4757 (hdw->state_encoder_runok ?
4758 " <encode:stop>" :
4759 " <encode:virgin>")),
Mike Isely681c7392007-11-26 01:48:52 -03004760 (hdw->state_encoder_config ?
4761 " <encode:configok>" :
4762 (hdw->state_encoder_waitok ?
Mike Iselyb9a37d92008-03-28 05:31:40 -03004763 "" : " <encode:waitok>")),
Mike Isely681c7392007-11-26 01:48:52 -03004764 (hdw->state_usbstream_run ?
Mike Isely62433e32008-04-22 14:45:40 -03004765 " <usb:run>" : " <usb:stop>"),
4766 (hdw->state_pathway_ok ?
Mike Iselye9db1ff2008-04-22 14:45:41 -03004767 " <pathway:ok>" : ""));
Mike Isely681c7392007-11-26 01:48:52 -03004768 case 3:
4769 return scnprintf(
4770 buf,acnt,
4771 "state: %s",
4772 pvr2_get_state_name(hdw->master_state));
Mike Iselyad0992e2008-03-28 05:34:45 -03004773 case 4: {
Mike Isely1cb03b72008-04-21 03:47:43 -03004774 unsigned int tcnt = 0;
4775 unsigned int ccnt;
4776
4777 ccnt = scnprintf(buf,
4778 acnt,
4779 "Hardware supported inputs: ");
4780 tcnt += ccnt;
4781 tcnt += print_input_mask(hdw->input_avail_mask,
4782 buf+tcnt,
4783 acnt-tcnt);
4784 if (hdw->input_avail_mask != hdw->input_allowed_mask) {
4785 ccnt = scnprintf(buf+tcnt,
4786 acnt-tcnt,
4787 "; allowed inputs: ");
4788 tcnt += ccnt;
4789 tcnt += print_input_mask(hdw->input_allowed_mask,
4790 buf+tcnt,
4791 acnt-tcnt);
4792 }
4793 return tcnt;
4794 }
4795 case 5: {
Mike Iselyad0992e2008-03-28 05:34:45 -03004796 struct pvr2_stream_stats stats;
4797 if (!hdw->vid_stream) break;
4798 pvr2_stream_get_stats(hdw->vid_stream,
4799 &stats,
4800 0);
4801 return scnprintf(
4802 buf,acnt,
4803 "Bytes streamed=%u"
4804 " URBs: queued=%u idle=%u ready=%u"
4805 " processed=%u failed=%u",
4806 stats.bytes_processed,
4807 stats.buffers_in_queue,
4808 stats.buffers_in_idle,
4809 stats.buffers_in_ready,
4810 stats.buffers_processed,
4811 stats.buffers_failed);
4812 }
Mike Isely681c7392007-11-26 01:48:52 -03004813 default: break;
4814 }
4815 return 0;
4816}
4817
4818
Mike Isely2eb563b2009-03-08 18:25:46 -03004819/* Generate report containing info about attached sub-devices and attached
4820 i2c clients, including an indication of which attached i2c clients are
4821 actually sub-devices. */
4822static unsigned int pvr2_hdw_report_clients(struct pvr2_hdw *hdw,
4823 char *buf, unsigned int acnt)
4824{
4825 struct v4l2_subdev *sd;
4826 unsigned int tcnt = 0;
4827 unsigned int ccnt;
4828 struct i2c_client *client;
4829 struct list_head *item;
4830 void *cd;
4831 const char *p;
4832 unsigned int id;
4833
4834 ccnt = scnprintf(buf, acnt, "Associated v4l2-subdev drivers:");
4835 tcnt += ccnt;
4836 v4l2_device_for_each_subdev(sd, &hdw->v4l2_dev) {
4837 id = sd->grp_id;
4838 p = NULL;
4839 if (id < ARRAY_SIZE(module_names)) p = module_names[id];
4840 if (p) {
4841 ccnt = scnprintf(buf + tcnt, acnt - tcnt, " %s", p);
4842 tcnt += ccnt;
4843 } else {
4844 ccnt = scnprintf(buf + tcnt, acnt - tcnt,
4845 " (unknown id=%u)", id);
4846 tcnt += ccnt;
4847 }
4848 }
4849 ccnt = scnprintf(buf + tcnt, acnt - tcnt, "\n");
4850 tcnt += ccnt;
4851
4852 ccnt = scnprintf(buf + tcnt, acnt - tcnt, "I2C clients:\n");
4853 tcnt += ccnt;
4854
4855 mutex_lock(&hdw->i2c_adap.clist_lock);
4856 list_for_each(item, &hdw->i2c_adap.clients) {
4857 client = list_entry(item, struct i2c_client, list);
4858 ccnt = scnprintf(buf + tcnt, acnt - tcnt,
4859 " %s: i2c=%02x", client->name, client->addr);
4860 tcnt += ccnt;
4861 cd = i2c_get_clientdata(client);
4862 v4l2_device_for_each_subdev(sd, &hdw->v4l2_dev) {
4863 if (cd == sd) {
4864 id = sd->grp_id;
4865 p = NULL;
4866 if (id < ARRAY_SIZE(module_names)) {
4867 p = module_names[id];
4868 }
4869 if (p) {
4870 ccnt = scnprintf(buf + tcnt,
4871 acnt - tcnt,
4872 " subdev=%s", p);
4873 tcnt += ccnt;
4874 } else {
4875 ccnt = scnprintf(buf + tcnt,
4876 acnt - tcnt,
4877 " subdev= id %u)",
4878 id);
4879 tcnt += ccnt;
4880 }
4881 break;
4882 }
4883 }
4884 ccnt = scnprintf(buf + tcnt, acnt - tcnt, "\n");
4885 tcnt += ccnt;
4886 }
4887 mutex_unlock(&hdw->i2c_adap.clist_lock);
4888 return tcnt;
4889}
4890
4891
Mike Isely681c7392007-11-26 01:48:52 -03004892unsigned int pvr2_hdw_state_report(struct pvr2_hdw *hdw,
4893 char *buf,unsigned int acnt)
4894{
4895 unsigned int bcnt,ccnt,idx;
4896 bcnt = 0;
4897 LOCK_TAKE(hdw->big_lock);
4898 for (idx = 0; ; idx++) {
4899 ccnt = pvr2_hdw_report_unlocked(hdw,idx,buf,acnt);
4900 if (!ccnt) break;
4901 bcnt += ccnt; acnt -= ccnt; buf += ccnt;
4902 if (!acnt) break;
4903 buf[0] = '\n'; ccnt = 1;
4904 bcnt += ccnt; acnt -= ccnt; buf += ccnt;
4905 }
Mike Isely2eb563b2009-03-08 18:25:46 -03004906 ccnt = pvr2_hdw_report_clients(hdw, buf, acnt);
4907 bcnt += ccnt; acnt -= ccnt; buf += ccnt;
Mike Isely681c7392007-11-26 01:48:52 -03004908 LOCK_GIVE(hdw->big_lock);
4909 return bcnt;
4910}
4911
4912
4913static void pvr2_hdw_state_log_state(struct pvr2_hdw *hdw)
4914{
Mike Isely2eb563b2009-03-08 18:25:46 -03004915 char buf[256];
4916 unsigned int idx, ccnt;
4917 unsigned int lcnt, ucnt;
Mike Isely681c7392007-11-26 01:48:52 -03004918
4919 for (idx = 0; ; idx++) {
4920 ccnt = pvr2_hdw_report_unlocked(hdw,idx,buf,sizeof(buf));
4921 if (!ccnt) break;
4922 printk(KERN_INFO "%s %.*s\n",hdw->name,ccnt,buf);
4923 }
Mike Isely2eb563b2009-03-08 18:25:46 -03004924 ccnt = pvr2_hdw_report_clients(hdw, buf, sizeof(buf));
4925 ucnt = 0;
4926 while (ucnt < ccnt) {
4927 lcnt = 0;
4928 while ((lcnt + ucnt < ccnt) && (buf[lcnt + ucnt] != '\n')) {
4929 lcnt++;
4930 }
4931 printk(KERN_INFO "%s %.*s\n", hdw->name, lcnt, buf + ucnt);
4932 ucnt += lcnt + 1;
4933 }
Mike Isely681c7392007-11-26 01:48:52 -03004934}
4935
4936
4937/* Evaluate and update the driver's current state, taking various actions
4938 as appropriate for the update. */
4939static int pvr2_hdw_state_eval(struct pvr2_hdw *hdw)
4940{
4941 unsigned int st;
4942 int state_updated = 0;
4943 int callback_flag = 0;
Mike Isely1b9c18c2008-04-22 14:45:41 -03004944 int analog_mode;
Mike Isely681c7392007-11-26 01:48:52 -03004945
4946 pvr2_trace(PVR2_TRACE_STBITS,
4947 "Drive state check START");
4948 if (pvrusb2_debug & PVR2_TRACE_STBITS) {
4949 pvr2_hdw_state_log_state(hdw);
4950 }
4951
4952 /* Process all state and get back over disposition */
4953 state_updated = pvr2_hdw_state_update(hdw);
4954
Mike Isely1b9c18c2008-04-22 14:45:41 -03004955 analog_mode = (hdw->pathway_state != PVR2_PATHWAY_DIGITAL);
4956
Mike Isely681c7392007-11-26 01:48:52 -03004957 /* Update master state based upon all other states. */
4958 if (!hdw->flag_ok) {
4959 st = PVR2_STATE_DEAD;
4960 } else if (hdw->fw1_state != FW1_STATE_OK) {
4961 st = PVR2_STATE_COLD;
Mike Isely72998b72008-04-03 04:51:19 -03004962 } else if ((analog_mode ||
4963 hdw->hdw_desc->flag_digital_requires_cx23416) &&
4964 !hdw->state_encoder_ok) {
Mike Isely681c7392007-11-26 01:48:52 -03004965 st = PVR2_STATE_WARM;
Mike Isely1b9c18c2008-04-22 14:45:41 -03004966 } else if (hdw->flag_tripped ||
4967 (analog_mode && hdw->flag_decoder_missed)) {
Mike Isely681c7392007-11-26 01:48:52 -03004968 st = PVR2_STATE_ERROR;
Mike Isely62433e32008-04-22 14:45:40 -03004969 } else if (hdw->state_usbstream_run &&
Mike Isely1b9c18c2008-04-22 14:45:41 -03004970 (!analog_mode ||
Mike Isely62433e32008-04-22 14:45:40 -03004971 (hdw->state_encoder_run && hdw->state_decoder_run))) {
Mike Isely681c7392007-11-26 01:48:52 -03004972 st = PVR2_STATE_RUN;
4973 } else {
4974 st = PVR2_STATE_READY;
4975 }
4976 if (hdw->master_state != st) {
4977 pvr2_trace(PVR2_TRACE_STATE,
4978 "Device state change from %s to %s",
4979 pvr2_get_state_name(hdw->master_state),
4980 pvr2_get_state_name(st));
Mike Isely40381cb2008-04-22 14:45:42 -03004981 pvr2_led_ctrl(hdw,st == PVR2_STATE_RUN);
Mike Isely681c7392007-11-26 01:48:52 -03004982 hdw->master_state = st;
4983 state_updated = !0;
4984 callback_flag = !0;
4985 }
4986 if (state_updated) {
4987 /* Trigger anyone waiting on any state changes here. */
4988 wake_up(&hdw->state_wait_data);
4989 }
4990
4991 if (pvrusb2_debug & PVR2_TRACE_STBITS) {
4992 pvr2_hdw_state_log_state(hdw);
4993 }
4994 pvr2_trace(PVR2_TRACE_STBITS,
4995 "Drive state check DONE callback=%d",callback_flag);
4996
4997 return callback_flag;
4998}
4999
5000
5001/* Cause kernel thread to check / update driver state */
5002static void pvr2_hdw_state_sched(struct pvr2_hdw *hdw)
5003{
5004 if (hdw->state_stale) return;
5005 hdw->state_stale = !0;
5006 trace_stbit("state_stale",hdw->state_stale);
5007 queue_work(hdw->workqueue,&hdw->workpoll);
5008}
5009
5010
Mike Iselyd8554972006-06-26 20:58:46 -03005011int pvr2_hdw_gpio_get_dir(struct pvr2_hdw *hdw,u32 *dp)
5012{
5013 return pvr2_read_register(hdw,PVR2_GPIO_DIR,dp);
5014}
5015
5016
5017int pvr2_hdw_gpio_get_out(struct pvr2_hdw *hdw,u32 *dp)
5018{
5019 return pvr2_read_register(hdw,PVR2_GPIO_OUT,dp);
5020}
5021
5022
5023int pvr2_hdw_gpio_get_in(struct pvr2_hdw *hdw,u32 *dp)
5024{
5025 return pvr2_read_register(hdw,PVR2_GPIO_IN,dp);
5026}
5027
5028
5029int pvr2_hdw_gpio_chg_dir(struct pvr2_hdw *hdw,u32 msk,u32 val)
5030{
5031 u32 cval,nval;
5032 int ret;
5033 if (~msk) {
5034 ret = pvr2_read_register(hdw,PVR2_GPIO_DIR,&cval);
5035 if (ret) return ret;
5036 nval = (cval & ~msk) | (val & msk);
5037 pvr2_trace(PVR2_TRACE_GPIO,
5038 "GPIO direction changing 0x%x:0x%x"
5039 " from 0x%x to 0x%x",
5040 msk,val,cval,nval);
5041 } else {
5042 nval = val;
5043 pvr2_trace(PVR2_TRACE_GPIO,
5044 "GPIO direction changing to 0x%x",nval);
5045 }
5046 return pvr2_write_register(hdw,PVR2_GPIO_DIR,nval);
5047}
5048
5049
5050int pvr2_hdw_gpio_chg_out(struct pvr2_hdw *hdw,u32 msk,u32 val)
5051{
5052 u32 cval,nval;
5053 int ret;
5054 if (~msk) {
5055 ret = pvr2_read_register(hdw,PVR2_GPIO_OUT,&cval);
5056 if (ret) return ret;
5057 nval = (cval & ~msk) | (val & msk);
5058 pvr2_trace(PVR2_TRACE_GPIO,
5059 "GPIO output changing 0x%x:0x%x from 0x%x to 0x%x",
5060 msk,val,cval,nval);
5061 } else {
5062 nval = val;
5063 pvr2_trace(PVR2_TRACE_GPIO,
5064 "GPIO output changing to 0x%x",nval);
5065 }
5066 return pvr2_write_register(hdw,PVR2_GPIO_OUT,nval);
5067}
5068
5069
Mike Iselya51f5002009-03-06 23:30:37 -03005070void pvr2_hdw_status_poll(struct pvr2_hdw *hdw)
5071{
Mike Isely40f07112009-03-07 00:08:17 -03005072 struct v4l2_tuner *vtp = &hdw->tuner_signal_info;
5073 memset(vtp, 0, sizeof(*vtp));
Mike Isely2641df32009-03-07 00:13:25 -03005074 hdw->tuner_signal_stale = 0;
Mike Isely40f07112009-03-07 00:08:17 -03005075 /* Note: There apparently is no replacement for VIDIOC_CROPCAP
5076 using v4l2-subdev - therefore we can't support that AT ALL right
5077 now. (Of course, no sub-drivers seem to implement it either.
5078 But now it's a a chicken and egg problem...) */
5079 v4l2_device_call_all(&hdw->v4l2_dev, 0, tuner, g_tuner,
5080 &hdw->tuner_signal_info);
Mike Isely2641df32009-03-07 00:13:25 -03005081 pvr2_trace(PVR2_TRACE_CHIPS, "subdev status poll"
Mike Isely40f07112009-03-07 00:08:17 -03005082 " type=%u strength=%u audio=0x%x cap=0x%x"
5083 " low=%u hi=%u",
5084 vtp->type,
5085 vtp->signal, vtp->rxsubchans, vtp->capability,
5086 vtp->rangelow, vtp->rangehigh);
Mike Isely2641df32009-03-07 00:13:25 -03005087
5088 /* We have to do this to avoid getting into constant polling if
5089 there's nobody to answer a poll of cropcap info. */
5090 hdw->cropcap_stale = 0;
Mike Iselya51f5002009-03-06 23:30:37 -03005091}
5092
5093
Mike Isely7fb20fa2008-04-22 14:45:37 -03005094unsigned int pvr2_hdw_get_input_available(struct pvr2_hdw *hdw)
5095{
5096 return hdw->input_avail_mask;
5097}
5098
5099
Mike Isely1cb03b72008-04-21 03:47:43 -03005100unsigned int pvr2_hdw_get_input_allowed(struct pvr2_hdw *hdw)
5101{
5102 return hdw->input_allowed_mask;
5103}
5104
5105
5106static int pvr2_hdw_set_input(struct pvr2_hdw *hdw,int v)
5107{
5108 if (hdw->input_val != v) {
5109 hdw->input_val = v;
5110 hdw->input_dirty = !0;
5111 }
5112
5113 /* Handle side effects - if we switch to a mode that needs the RF
5114 tuner, then select the right frequency choice as well and mark
5115 it dirty. */
5116 if (hdw->input_val == PVR2_CVAL_INPUT_RADIO) {
5117 hdw->freqSelector = 0;
5118 hdw->freqDirty = !0;
5119 } else if ((hdw->input_val == PVR2_CVAL_INPUT_TV) ||
5120 (hdw->input_val == PVR2_CVAL_INPUT_DTV)) {
5121 hdw->freqSelector = 1;
5122 hdw->freqDirty = !0;
5123 }
5124 return 0;
5125}
5126
5127
5128int pvr2_hdw_set_input_allowed(struct pvr2_hdw *hdw,
5129 unsigned int change_mask,
5130 unsigned int change_val)
5131{
5132 int ret = 0;
5133 unsigned int nv,m,idx;
5134 LOCK_TAKE(hdw->big_lock);
5135 do {
5136 nv = hdw->input_allowed_mask & ~change_mask;
5137 nv |= (change_val & change_mask);
5138 nv &= hdw->input_avail_mask;
5139 if (!nv) {
5140 /* No legal modes left; return error instead. */
5141 ret = -EPERM;
5142 break;
5143 }
5144 hdw->input_allowed_mask = nv;
5145 if ((1 << hdw->input_val) & hdw->input_allowed_mask) {
5146 /* Current mode is still in the allowed mask, so
5147 we're done. */
5148 break;
5149 }
5150 /* Select and switch to a mode that is still in the allowed
5151 mask */
5152 if (!hdw->input_allowed_mask) {
5153 /* Nothing legal; give up */
5154 break;
5155 }
5156 m = hdw->input_allowed_mask;
5157 for (idx = 0; idx < (sizeof(m) << 3); idx++) {
5158 if (!((1 << idx) & m)) continue;
5159 pvr2_hdw_set_input(hdw,idx);
5160 break;
5161 }
5162 } while (0);
5163 LOCK_GIVE(hdw->big_lock);
5164 return ret;
5165}
5166
5167
Mike Iselye61b6fc2006-07-18 22:42:18 -03005168/* Find I2C address of eeprom */
Adrian Bunk07e337e2006-06-30 11:30:20 -03005169static int pvr2_hdw_get_eeprom_addr(struct pvr2_hdw *hdw)
Mike Iselyd8554972006-06-26 20:58:46 -03005170{
5171 int result;
5172 LOCK_TAKE(hdw->ctl_lock); do {
Michael Krufky8d364362007-01-22 02:17:55 -03005173 hdw->cmd_buffer[0] = FX2CMD_GET_EEPROM_ADDR;
Mike Iselyd8554972006-06-26 20:58:46 -03005174 result = pvr2_send_request(hdw,
5175 hdw->cmd_buffer,1,
5176 hdw->cmd_buffer,1);
5177 if (result < 0) break;
5178 result = hdw->cmd_buffer[0];
5179 } while(0); LOCK_GIVE(hdw->ctl_lock);
5180 return result;
5181}
5182
5183
Mike Isely32ffa9a2006-09-23 22:26:52 -03005184int pvr2_hdw_register_access(struct pvr2_hdw *hdw,
Hans Verkuilaecde8b2008-12-30 07:14:19 -03005185 struct v4l2_dbg_match *match, u64 reg_id,
5186 int setFl, u64 *val_ptr)
Mike Isely32ffa9a2006-09-23 22:26:52 -03005187{
5188#ifdef CONFIG_VIDEO_ADV_DEBUG
Hans Verkuilaecde8b2008-12-30 07:14:19 -03005189 struct v4l2_dbg_register req;
Mike Isely6d988162006-09-28 17:53:49 -03005190 int stat = 0;
5191 int okFl = 0;
Mike Isely32ffa9a2006-09-23 22:26:52 -03005192
Mike Isely201f5c92007-01-28 16:08:36 -03005193 if (!capable(CAP_SYS_ADMIN)) return -EPERM;
5194
Hans Verkuilaecde8b2008-12-30 07:14:19 -03005195 req.match = *match;
Mike Isely32ffa9a2006-09-23 22:26:52 -03005196 req.reg = reg_id;
5197 if (setFl) req.val = *val_ptr;
Mike Iselyd8f5b9b2009-03-07 00:05:00 -03005198 /* It would be nice to know if a sub-device answered the request */
5199 v4l2_device_call_all(&hdw->v4l2_dev, 0, core, g_register, &req);
5200 if (!setFl) *val_ptr = req.val;
Mike Isely6d988162006-09-28 17:53:49 -03005201 if (okFl) {
5202 return stat;
5203 }
Mike Isely32ffa9a2006-09-23 22:26:52 -03005204 return -EINVAL;
5205#else
5206 return -ENOSYS;
5207#endif
5208}
5209
5210
Mike Iselyd8554972006-06-26 20:58:46 -03005211/*
5212 Stuff for Emacs to see, in order to encourage consistent editing style:
5213 *** Local Variables: ***
5214 *** mode: c ***
5215 *** fill-column: 75 ***
5216 *** tab-width: 8 ***
5217 *** c-basic-offset: 8 ***
5218 *** End: ***
5219 */