diff options
Diffstat (limited to 'drivers/media/video/saa7164/saa7164-api.c')
| -rw-r--r-- | drivers/media/video/saa7164/saa7164-api.c | 1519 |
1 files changed, 0 insertions, 1519 deletions
diff --git a/drivers/media/video/saa7164/saa7164-api.c b/drivers/media/video/saa7164/saa7164-api.c deleted file mode 100644 index c8799fdaae67..000000000000 --- a/drivers/media/video/saa7164/saa7164-api.c +++ /dev/null @@ -1,1519 +0,0 @@ -/* - * Driver for the NXP SAA7164 PCIe bridge - * - * Copyright (c) 2010 Steven Toth <stoth@kernellabs.com> - * - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation; either version 2 of the License, or - * (at your option) any later version. - * - * This program is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * - * GNU General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with this program; if not, write to the Free Software - * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. - */ - -#include <linux/wait.h> -#include <linux/slab.h> - -#include "saa7164.h" - -int saa7164_api_get_load_info(struct saa7164_dev *dev, struct tmFwInfoStruct *i) -{ - int ret; - - if (!(saa_debug & DBGLVL_CPU)) - return 0; - - dprintk(DBGLVL_API, "%s()\n", __func__); - - i->deviceinst = 0; - i->devicespec = 0; - i->mode = 0; - i->status = 0; - - ret = saa7164_cmd_send(dev, 0, GET_CUR, - GET_FW_STATUS_CONTROL, sizeof(struct tmFwInfoStruct), i); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - printk(KERN_INFO "saa7164[%d]-CPU: %d percent", dev->nr, i->CPULoad); - - return ret; -} - -int saa7164_api_collect_debug(struct saa7164_dev *dev) -{ - struct tmComResDebugGetData d; - u8 more = 255; - int ret; - - dprintk(DBGLVL_API, "%s()\n", __func__); - - while (more--) { - - memset(&d, 0, sizeof(d)); - - ret = saa7164_cmd_send(dev, 0, GET_CUR, - GET_DEBUG_DATA_CONTROL, sizeof(d), &d); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", - __func__, ret); - - if (d.dwResult != SAA_OK) - break; - - printk(KERN_INFO "saa7164[%d]-FWMSG: %s", dev->nr, - d.ucDebugData); - } - - return 0; -} - -int saa7164_api_set_debug(struct saa7164_dev *dev, u8 level) -{ - struct tmComResDebugSetLevel lvl; - int ret; - - dprintk(DBGLVL_API, "%s(level=%d)\n", __func__, level); - - /* Retrieve current state */ - ret = saa7164_cmd_send(dev, 0, GET_CUR, - SET_DEBUG_LEVEL_CONTROL, sizeof(lvl), &lvl); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - dprintk(DBGLVL_API, "%s() Was %d\n", __func__, lvl.dwDebugLevel); - - lvl.dwDebugLevel = level; - - /* set new state */ - ret = saa7164_cmd_send(dev, 0, SET_CUR, - SET_DEBUG_LEVEL_CONTROL, sizeof(lvl), &lvl); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - return ret; -} - -int saa7164_api_set_vbi_format(struct saa7164_port *port) -{ - struct saa7164_dev *dev = port->dev; - struct tmComResProbeCommit fmt, rsp; - int ret; - - dprintk(DBGLVL_API, "%s(nr=%d, unitid=0x%x)\n", __func__, - port->nr, port->hwcfg.unitid); - - fmt.bmHint = 0; - fmt.bFormatIndex = 1; - fmt.bFrameIndex = 1; - - /* Probe, see if it can support this format */ - ret = saa7164_cmd_send(port->dev, port->hwcfg.unitid, - SET_CUR, SAA_PROBE_CONTROL, sizeof(fmt), &fmt); - if (ret != SAA_OK) - printk(KERN_ERR "%s() set error, ret = 0x%x\n", __func__, ret); - - /* See of the format change was successful */ - ret = saa7164_cmd_send(port->dev, port->hwcfg.unitid, - GET_CUR, SAA_PROBE_CONTROL, sizeof(rsp), &rsp); - if (ret != SAA_OK) { - printk(KERN_ERR "%s() get error, ret = 0x%x\n", __func__, ret); - } else { - /* Compare requested vs received, should be same */ - if (memcmp(&fmt, &rsp, sizeof(rsp)) == 0) { - dprintk(DBGLVL_API, "SET/PROBE Verified\n"); - - /* Ask the device to select the negotiated format */ - ret = saa7164_cmd_send(port->dev, port->hwcfg.unitid, - SET_CUR, SAA_COMMIT_CONTROL, sizeof(fmt), &fmt); - if (ret != SAA_OK) - printk(KERN_ERR "%s() commit error, ret = 0x%x\n", - __func__, ret); - - ret = saa7164_cmd_send(port->dev, port->hwcfg.unitid, - GET_CUR, SAA_COMMIT_CONTROL, sizeof(rsp), &rsp); - if (ret != SAA_OK) - printk(KERN_ERR "%s() GET commit error, ret = 0x%x\n", - __func__, ret); - - if (memcmp(&fmt, &rsp, sizeof(rsp)) != 0) { - printk(KERN_ERR "%s() memcmp error, ret = 0x%x\n", - __func__, ret); - } else - dprintk(DBGLVL_API, "SET/COMMIT Verified\n"); - - dprintk(DBGLVL_API, "rsp.bmHint = 0x%x\n", rsp.bmHint); - dprintk(DBGLVL_API, "rsp.bFormatIndex = 0x%x\n", - rsp.bFormatIndex); - dprintk(DBGLVL_API, "rsp.bFrameIndex = 0x%x\n", - rsp.bFrameIndex); - } else - printk(KERN_ERR "%s() compare failed\n", __func__); - } - - if (ret == SAA_OK) - dprintk(DBGLVL_API, "%s(nr=%d) Success\n", __func__, port->nr); - - return ret; -} - -int saa7164_api_set_gop_size(struct saa7164_port *port) -{ - struct saa7164_dev *dev = port->dev; - struct tmComResEncVideoGopStructure gs; - int ret; - - dprintk(DBGLVL_ENC, "%s()\n", __func__); - - gs.ucRefFrameDist = port->encoder_params.refdist; - gs.ucGOPSize = port->encoder_params.gop_size; - ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, SET_CUR, - EU_VIDEO_GOP_STRUCTURE_CONTROL, - sizeof(gs), &gs); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - return ret; -} - -int saa7164_api_set_encoder(struct saa7164_port *port) -{ - struct saa7164_dev *dev = port->dev; - struct tmComResEncVideoBitRate vb; - struct tmComResEncAudioBitRate ab; - int ret; - - dprintk(DBGLVL_ENC, "%s() unitid=0x%x\n", __func__, - port->hwcfg.sourceid); - - if (port->encoder_params.stream_type == V4L2_MPEG_STREAM_TYPE_MPEG2_PS) - port->encoder_profile = EU_PROFILE_PS_DVD; - else - port->encoder_profile = EU_PROFILE_TS_HQ; - - ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, SET_CUR, - EU_PROFILE_CONTROL, sizeof(u8), &port->encoder_profile); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - /* Resolution */ - ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, SET_CUR, - EU_PROFILE_CONTROL, sizeof(u8), &port->encoder_profile); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - /* Establish video bitrates */ - if (port->encoder_params.bitrate_mode == - V4L2_MPEG_VIDEO_BITRATE_MODE_CBR) - vb.ucVideoBitRateMode = EU_VIDEO_BIT_RATE_MODE_CONSTANT; - else - vb.ucVideoBitRateMode = EU_VIDEO_BIT_RATE_MODE_VARIABLE_PEAK; - vb.dwVideoBitRate = port->encoder_params.bitrate; - vb.dwVideoBitRatePeak = port->encoder_params.bitrate_peak; - ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, SET_CUR, - EU_VIDEO_BIT_RATE_CONTROL, - sizeof(struct tmComResEncVideoBitRate), - &vb); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - /* Establish audio bitrates */ - ab.ucAudioBitRateMode = 0; - ab.dwAudioBitRate = 384000; - ab.dwAudioBitRatePeak = ab.dwAudioBitRate; - ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, SET_CUR, - EU_AUDIO_BIT_RATE_CONTROL, - sizeof(struct tmComResEncAudioBitRate), - &ab); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, - ret); - - saa7164_api_set_aspect_ratio(port); - saa7164_api_set_gop_size(port); - - return ret; -} - -int saa7164_api_get_encoder(struct saa7164_port *port) -{ - struct saa7164_dev *dev = port->dev; - struct tmComResEncVideoBitRate v; - struct tmComResEncAudioBitRate a; - struct tmComResEncVideoInputAspectRatio ar; - int ret; - - dprintk(DBGLVL_ENC, "%s() unitid=0x%x\n", __func__, - port->hwcfg.sourceid); - - port->encoder_profile = 0; - port->video_format = 0; - port->video_resolution = 0; - port->audio_format = 0; - - ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR, - EU_PROFILE_CONTROL, sizeof(u8), &port->encoder_profile); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR, - EU_VIDEO_RESOLUTION_CONTROL, sizeof(u8), - &port->video_resolution); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR, - EU_VIDEO_FORMAT_CONTROL, sizeof(u8), &port->video_format); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR, - EU_VIDEO_BIT_RATE_CONTROL, sizeof(v), &v); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR, - EU_AUDIO_FORMAT_CONTROL, sizeof(u8), &port->audio_format); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR, - EU_AUDIO_BIT_RATE_CONTROL, sizeof(a), &a); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - /* Aspect Ratio */ - ar.width = 0; - ar.height = 0; - ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR, - EU_VIDEO_INPUT_ASPECT_CONTROL, - sizeof(struct tmComResEncVideoInputAspectRatio), &ar); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - dprintk(DBGLVL_ENC, "encoder_profile = %d\n", port->encoder_profile); - dprintk(DBGLVL_ENC, "video_format = %d\n", port->video_format); - dprintk(DBGLVL_ENC, "audio_format = %d\n", port->audio_format); - dprintk(DBGLVL_ENC, "video_resolution= %d\n", port->video_resolution); - dprintk(DBGLVL_ENC, "v.ucVideoBitRateMode = %d\n", - v.ucVideoBitRateMode); - dprintk(DBGLVL_ENC, "v.dwVideoBitRate = %d\n", - v.dwVideoBitRate); - dprintk(DBGLVL_ENC, "v.dwVideoBitRatePeak = %d\n", - v.dwVideoBitRatePeak); - dprintk(DBGLVL_ENC, "a.ucVideoBitRateMode = %d\n", - a.ucAudioBitRateMode); - dprintk(DBGLVL_ENC, "a.dwVideoBitRate = %d\n", - a.dwAudioBitRate); - dprintk(DBGLVL_ENC, "a.dwVideoBitRatePeak = %d\n", - a.dwAudioBitRatePeak); - dprintk(DBGLVL_ENC, "aspect.width / height = %d:%d\n", - ar.width, ar.height); - - return ret; -} - -int saa7164_api_set_aspect_ratio(struct saa7164_port *port) -{ - struct saa7164_dev *dev = port->dev; - struct tmComResEncVideoInputAspectRatio ar; - int ret; - - dprintk(DBGLVL_ENC, "%s(%d)\n", __func__, - port->encoder_params.ctl_aspect); - - switch (port->encoder_params.ctl_aspect) { - case V4L2_MPEG_VIDEO_ASPECT_1x1: - ar.width = 1; - ar.height = 1; - break; - case V4L2_MPEG_VIDEO_ASPECT_4x3: - ar.width = 4; - ar.height = 3; - break; - case V4L2_MPEG_VIDEO_ASPECT_16x9: - ar.width = 16; - ar.height = 9; - break; - case V4L2_MPEG_VIDEO_ASPECT_221x100: - ar.width = 221; - ar.height = 100; - break; - default: - BUG(); - } - - dprintk(DBGLVL_ENC, "%s(%d) now %d:%d\n", __func__, - port->encoder_params.ctl_aspect, - ar.width, ar.height); - - /* Aspect Ratio */ - ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, SET_CUR, - EU_VIDEO_INPUT_ASPECT_CONTROL, - sizeof(struct tmComResEncVideoInputAspectRatio), &ar); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - return ret; -} - -int saa7164_api_set_usercontrol(struct saa7164_port *port, u8 ctl) -{ - struct saa7164_dev *dev = port->dev; - int ret; - u16 val; - - if (ctl == PU_BRIGHTNESS_CONTROL) - val = port->ctl_brightness; - else - if (ctl == PU_CONTRAST_CONTROL) - val = port->ctl_contrast; - else - if (ctl == PU_HUE_CONTROL) - val = port->ctl_hue; - else - if (ctl == PU_SATURATION_CONTROL) - val = port->ctl_saturation; - else - if (ctl == PU_SHARPNESS_CONTROL) - val = port->ctl_sharpness; - else - return -EINVAL; - - dprintk(DBGLVL_ENC, "%s() unitid=0x%x ctl=%d, val=%d\n", - __func__, port->encunit.vsourceid, ctl, val); - - ret = saa7164_cmd_send(port->dev, port->encunit.vsourceid, SET_CUR, - ctl, sizeof(u16), &val); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - return ret; -} - -int saa7164_api_get_usercontrol(struct saa7164_port *port, u8 ctl) -{ - struct saa7164_dev *dev = port->dev; - int ret; - u16 val; - - ret = saa7164_cmd_send(port->dev, port->encunit.vsourceid, GET_CUR, - ctl, sizeof(u16), &val); - if (ret != SAA_OK) { - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - return ret; - } - - dprintk(DBGLVL_ENC, "%s() ctl=%d, val=%d\n", - __func__, ctl, val); - - if (ctl == PU_BRIGHTNESS_CONTROL) - port->ctl_brightness = val; - else - if (ctl == PU_CONTRAST_CONTROL) - port->ctl_contrast = val; - else - if (ctl == PU_HUE_CONTROL) - port->ctl_hue = val; - else - if (ctl == PU_SATURATION_CONTROL) - port->ctl_saturation = val; - else - if (ctl == PU_SHARPNESS_CONTROL) - port->ctl_sharpness = val; - - return ret; -} - -int saa7164_api_set_videomux(struct saa7164_port *port) -{ - struct saa7164_dev *dev = port->dev; - u8 inputs[] = { 1, 2, 2, 2, 5, 5, 5 }; - int ret; - - dprintk(DBGLVL_ENC, "%s() v_mux=%d a_mux=%d\n", - __func__, port->mux_input, inputs[port->mux_input - 1]); - - /* Audio Mute */ - ret = saa7164_api_audio_mute(port, 1); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - /* Video Mux */ - ret = saa7164_cmd_send(port->dev, port->vidproc.sourceid, SET_CUR, - SU_INPUT_SELECT_CONTROL, sizeof(u8), &port->mux_input); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - /* Audio Mux */ - ret = saa7164_cmd_send(port->dev, port->audfeat.sourceid, SET_CUR, - SU_INPUT_SELECT_CONTROL, sizeof(u8), - &inputs[port->mux_input - 1]); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - /* Audio UnMute */ - ret = saa7164_api_audio_mute(port, 0); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - return ret; -} - -int saa7164_api_audio_mute(struct saa7164_port *port, int mute) -{ - struct saa7164_dev *dev = port->dev; - u8 v = mute; - int ret; - - dprintk(DBGLVL_API, "%s(%d)\n", __func__, mute); - - ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, SET_CUR, - MUTE_CONTROL, sizeof(u8), &v); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - return ret; -} - -/* 0 = silence, 0xff = full */ -int saa7164_api_set_audio_volume(struct saa7164_port *port, s8 level) -{ - struct saa7164_dev *dev = port->dev; - s16 v, min, max; - int ret; - - dprintk(DBGLVL_API, "%s(%d)\n", __func__, level); - - /* Obtain the min/max ranges */ - ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, GET_MIN, - VOLUME_CONTROL, sizeof(u16), &min); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, GET_MAX, - VOLUME_CONTROL, sizeof(u16), &max); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, GET_CUR, - (0x01 << 8) | VOLUME_CONTROL, sizeof(u16), &v); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - dprintk(DBGLVL_API, "%s(%d) min=%d max=%d cur=%d\n", __func__, - level, min, max, v); - - v = level; - if (v < min) - v = min; - if (v > max) - v = max; - - /* Left */ - ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, SET_CUR, - (0x01 << 8) | VOLUME_CONTROL, sizeof(s16), &v); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - /* Right */ - ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, SET_CUR, - (0x02 << 8) | VOLUME_CONTROL, sizeof(s16), &v); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, GET_CUR, - (0x01 << 8) | VOLUME_CONTROL, sizeof(u16), &v); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - dprintk(DBGLVL_API, "%s(%d) min=%d max=%d cur=%d\n", __func__, - level, min, max, v); - - return ret; -} - -int saa7164_api_set_audio_std(struct saa7164_port *port) -{ - struct saa7164_dev *dev = port->dev; - struct tmComResAudioDefaults lvl; - struct tmComResTunerStandard tvaudio; - int ret; - - dprintk(DBGLVL_API, "%s()\n", __func__); - - /* Establish default levels */ - lvl.ucDecoderLevel = TMHW_LEV_ADJ_DECLEV_DEFAULT; - lvl.ucDecoderFM_Level = TMHW_LEV_ADJ_DECLEV_DEFAULT; - lvl.ucMonoLevel = TMHW_LEV_ADJ_MONOLEV_DEFAULT; - lvl.ucNICAM_Level = TMHW_LEV_ADJ_NICLEV_DEFAULT; - lvl.ucSAP_Level = TMHW_LEV_ADJ_SAPLEV_DEFAULT; - lvl.ucADC_Level = TMHW_LEV_ADJ_ADCLEV_DEFAULT; - ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, SET_CUR, - AUDIO_DEFAULT_CONTROL, sizeof(struct tmComResAudioDefaults), - &lvl); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - /* Manually select the appropriate TV audio standard */ - if (port->encodernorm.id & V4L2_STD_NTSC) { - tvaudio.std = TU_STANDARD_NTSC_M; - tvaudio.country = 1; - } else { - tvaudio.std = TU_STANDARD_PAL_I; - tvaudio.country = 44; - } - - ret = saa7164_cmd_send(port->dev, port->tunerunit.unitid, SET_CUR, - TU_STANDARD_CONTROL, sizeof(tvaudio), &tvaudio); - if (ret != SAA_OK) - printk(KERN_ERR "%s() TU_STANDARD_CONTROL error, ret = 0x%x\n", - __func__, ret); - return ret; -} - -int saa7164_api_set_audio_detection(struct saa7164_port *port, int autodetect) -{ - struct saa7164_dev *dev = port->dev; - struct tmComResTunerStandardAuto p; - int ret; - - dprintk(DBGLVL_API, "%s(%d)\n", __func__, autodetect); - - /* Disable TV Audio autodetect if not already set (buggy) */ - if (autodetect) - p.mode = TU_STANDARD_AUTO; - else - p.mode = TU_STANDARD_MANUAL; - ret = saa7164_cmd_send(port->dev, port->tunerunit.unitid, SET_CUR, - TU_STANDARD_AUTO_CONTROL, sizeof(p), &p); - if (ret != SAA_OK) - printk(KERN_ERR - "%s() TU_STANDARD_AUTO_CONTROL error, ret = 0x%x\n", - __func__, ret); - - return ret; -} - -int saa7164_api_get_videomux(struct saa7164_port *port) -{ - struct saa7164_dev *dev = port->dev; - int ret; - - ret = saa7164_cmd_send(port->dev, port->vidproc.sourceid, GET_CUR, - SU_INPUT_SELECT_CONTROL, sizeof(u8), &port->mux_input); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - dprintk(DBGLVL_ENC, "%s() v_mux=%d\n", - __func__, port->mux_input); - - return ret; -} - -int saa7164_api_set_dif(struct saa7164_port *port, u8 reg, u8 val) -{ - struct saa7164_dev *dev = port->dev; - - u16 len = 0; - u8 buf[256]; - int ret; - u8 mas; - - dprintk(DBGLVL_API, "%s(nr=%d type=%d val=%x)\n", __func__, - port->nr, port->type, val); - - if (port->nr == 0) - mas = 0xd0; - else - mas = 0xe0; - - memset(buf, 0, sizeof(buf)); - - buf[0x00] = 0x04; - buf[0x01] = 0x00; - buf[0x02] = 0x00; - buf[0x03] = 0x00; - - buf[0x04] = 0x04; - buf[0x05] = 0x00; - buf[0x06] = 0x00; - buf[0x07] = 0x00; - - buf[0x08] = reg; - buf[0x09] = 0x26; - buf[0x0a] = mas; - buf[0x0b] = 0xb0; - - buf[0x0c] = val; - buf[0x0d] = 0x00; - buf[0x0e] = 0x00; - buf[0x0f] = 0x00; - - ret = saa7164_cmd_send(dev, port->ifunit.unitid, GET_LEN, - EXU_REGISTER_ACCESS_CONTROL, sizeof(len), &len); - if (ret != SAA_OK) { - printk(KERN_ERR "%s() error, ret(1) = 0x%x\n", __func__, ret); - return -EIO; - } - - ret = saa7164_cmd_send(dev, port->ifunit.unitid, SET_CUR, - EXU_REGISTER_ACCESS_CONTROL, len, &buf); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret(2) = 0x%x\n", __func__, ret); -#if 0 - saa7164_dumphex16(dev, buf, 16); -#endif - return ret == SAA_OK ? 0 : -EIO; -} - -/* Disable the IF block AGC controls */ -int saa7164_api_configure_dif(struct saa7164_port *port, u32 std) -{ - struct saa7164_dev *dev = port->dev; - int ret = 0; - u8 agc_disable; - - dprintk(DBGLVL_API, "%s(nr=%d, 0x%x)\n", __func__, port->nr, std); - - if (std & V4L2_STD_NTSC) { - dprintk(DBGLVL_API, " NTSC\n"); - saa7164_api_set_dif(port, 0x00, 0x01); /* Video Standard */ - agc_disable = 0; - } else if (std & V4L2_STD_PAL_I) { - dprintk(DBGLVL_API, " PAL-I\n"); - saa7164_api_set_dif(port, 0x00, 0x08); /* Video Standard */ - agc_disable = 0; - } else if (std & V4L2_STD_PAL_M) { - dprintk(DBGLVL_API, " PAL-M\n"); - saa7164_api_set_dif(port, 0x00, 0x01); /* Video Standard */ - agc_disable = 0; - } else if (std & V4L2_STD_PAL_N) { - dprintk(DBGLVL_API, " PAL-N\n"); - saa7164_api_set_dif(port, 0x00, 0x01); /* Video Standard */ - agc_disable = 0; - } else if (std & V4L2_STD_PAL_Nc) { - dprintk(DBGLVL_API, " PAL-Nc\n"); - saa7164_api_set_dif(port, 0x00, 0x01); /* Video Standard */ - agc_disable = 0; - } else if (std & V4L2_STD_PAL_B) { - dprintk(DBGLVL_API, " PAL-B\n"); - saa7164_api_set_dif(port, 0x00, 0x02); /* Video Standard */ - agc_disable = 0; - } else if (std & V4L2_STD_PAL_DK) { - dprintk(DBGLVL_API, " PAL-DK\n"); - saa7164_api_set_dif(port, 0x00, 0x10); /* Video Standard */ - agc_disable = 0; - } else if (std & V4L2_STD_SECAM_L) { - dprintk(DBGLVL_API, " SECAM-L\n"); - saa7164_api_set_dif(port, 0x00, 0x20); /* Video Standard */ - agc_disable = 0; - } else { - /* Unknown standard, assume DTV */ - dprintk(DBGLVL_API, " Unknown (assuming DTV)\n"); - /* Undefinded Video Standard */ - saa7164_api_set_dif(port, 0x00, 0x80); - agc_disable = 1; - } - - saa7164_api_set_dif(port, 0x48, 0xa0); /* AGC Functions 1 */ - saa7164_api_set_dif(port, 0xc0, agc_disable); /* AGC Output Disable */ - saa7164_api_set_dif(port, 0x7c, 0x04); /* CVBS EQ */ - saa7164_api_set_dif(port, 0x04, 0x01); /* Active */ - msleep(100); - saa7164_api_set_dif(port, 0x04, 0x00); /* Active (again) */ - msleep(100); - - return ret; -} - -/* Ensure the dif is in the correct state for the operating mode - * (analog / dtv). We only configure the diff through the analog encoder - * so when we're in digital mode we need to find the appropriate encoder - * and use it to configure the DIF. - */ -int saa7164_api_initialize_dif(struct saa7164_port *port) -{ - struct saa7164_dev *dev = port->dev; - struct saa7164_port *p = NULL; - int ret = -EINVAL; - u32 std = 0; - - dprintk(DBGLVL_API, "%s(nr=%d type=%d)\n", __func__, - port->nr, port->type); - - if (port->type == SAA7164_MPEG_ENCODER) { - /* Pick any analog standard to init the diff. - * we'll come back during encoder_init' - * and set the correct standard if requried. - */ - std = V4L2_STD_NTSC; - } else - if (port->type == SAA7164_MPEG_DVB) { - if (port->nr == SAA7164_PORT_TS1) - p = &dev->ports[SAA7164_PORT_ENC1]; - else - p = &dev->ports[SAA7164_PORT_ENC2]; - } else - if (port->type == SAA7164_MPEG_VBI) { - std = V4L2_STD_NTSC; - if (port->nr == SAA7164_PORT_VBI1) - p = &dev->ports[SAA7164_PORT_ENC1]; - else - p = &dev->ports[SAA7164_PORT_ENC2]; - } else - BUG(); - - if (p) - ret = saa7164_api_configure_dif(p, std); - - return ret; -} - -int saa7164_api_transition_port(struct saa7164_port *port, u8 mode) -{ - struct saa7164_dev *dev = port->dev; - - int ret; - - dprintk(DBGLVL_API, "%s(nr=%d unitid=0x%x,%d)\n", - __func__, port->nr, port->hwcfg.unitid, mode); - - ret = saa7164_cmd_send(port->dev, port->hwcfg.unitid, SET_CUR, - SAA_STATE_CONTROL, sizeof(mode), &mode); - if (ret != SAA_OK) - printk(KERN_ERR "%s(portnr %d unitid 0x%x) error, ret = 0x%x\n", - __func__, port->nr, port->hwcfg.unitid, ret); - - return ret; -} - -int saa7164_api_get_fw_version(struct saa7164_dev *dev, u32 *version) -{ - int ret; - - ret = saa7164_cmd_send(dev, 0, GET_CUR, - GET_FW_VERSION_CONTROL, sizeof(u32), version); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - return ret; -} - -int saa7164_api_read_eeprom(struct saa7164_dev *dev, u8 *buf, int buflen) -{ - u8 reg[] = { 0x0f, 0x00 }; - - if (buflen < 128) - return -ENOMEM; - - /* Assumption: Hauppauge eeprom is at 0xa0 on on bus 0 */ - /* TODO: Pull the details from the boards struct */ - return saa7164_api_i2c_read(&dev->i2c_bus[0], 0xa0 >> 1, sizeof(reg), - ®[0], 128, buf); -} - -int saa7164_api_configure_port_vbi(struct saa7164_dev *dev, - struct saa7164_port *port) -{ - struct tmComResVBIFormatDescrHeader *fmt = &port->vbi_fmt_ntsc; - - dprintk(DBGLVL_API, " bFormatIndex = 0x%x\n", fmt->bFormatIndex); - dprintk(DBGLVL_API, " VideoStandard = 0x%x\n", fmt->VideoStandard); - dprintk(DBGLVL_API, " StartLine = %d\n", fmt->StartLine); - dprintk(DBGLVL_API, " EndLine = %d\n", fmt->EndLine); - dprintk(DBGLVL_API, " FieldRate = %d\n", fmt->FieldRate); - dprintk(DBGLVL_API, " bNumLines = %d\n", fmt->bNumLines); - - /* Cache the hardware configuration in the port */ - - port->bufcounter = port->hwcfg.BARLocation; - port->pitch = port->hwcfg.BARLocation + (2 * sizeof(u32)); - port->bufsize = port->hwcfg.BARLocation + (3 * sizeof(u32)); - port->bufoffset = port->hwcfg.BARLocation + (4 * sizeof(u32)); - port->bufptr32l = port->hwcfg.BARLocation + - (4 * sizeof(u32)) + - (sizeof(u32) * port->hwcfg.buffercount) + sizeof(u32); - port->bufptr32h = port->hwcfg.BARLocation + - (4 * sizeof(u32)) + - (sizeof(u32) * port->hwcfg.buffercount); - port->bufptr64 = port->hwcfg.BARLocation + - (4 * sizeof(u32)) + - (sizeof(u32) * port->hwcfg.buffercount); - dprintk(DBGLVL_API, " = port->hwcfg.BARLocation = 0x%x\n", - port->hwcfg.BARLocation); - - dprintk(DBGLVL_API, " = VS_FORMAT_VBI (becomes dev->en[%d])\n", - port->nr); - - return 0; -} - -int saa7164_api_configure_port_mpeg2ts(struct saa7164_dev *dev, - struct saa7164_port *port, - struct tmComResTSFormatDescrHeader *tsfmt) -{ - dprintk(DBGLVL_API, " bFormatIndex = 0x%x\n", tsfmt->bFormatIndex); - dprintk(DBGLVL_API, " bDataOffset = 0x%x\n", tsfmt->bDataOffset); - dprintk(DBGLVL_API, " bPacketLength= 0x%x\n", tsfmt->bPacketLength); - dprintk(DBGLVL_API, " bStrideLength= 0x%x\n", tsfmt->bStrideLength); - dprintk(DBGLVL_API, " bguid = (....)\n"); - - /* Cache the hardware configuration in the port */ - - port->bufcounter = port->hwcfg.BARLocation; - port->pitch = port->hwcfg.BARLocation + (2 * sizeof(u32)); - port->bufsize = port->hwcfg.BARLocation + (3 * sizeof(u32)); - port->bufoffset = port->hwcfg.BARLocation + (4 * sizeof(u32)); - port->bufptr32l = port->hwcfg.BARLocation + - (4 * sizeof(u32)) + - (sizeof(u32) * port->hwcfg.buffercount) + sizeof(u32); - port->bufptr32h = port->hwcfg.BARLocation + - (4 * sizeof(u32)) + - (sizeof(u32) * port->hwcfg.buffercount); - port->bufptr64 = port->hwcfg.BARLocation + - (4 * sizeof(u32)) + - (sizeof(u32) * port->hwcfg.buffercount); - dprintk(DBGLVL_API, " = port->hwcfg.BARLocation = 0x%x\n", - port->hwcfg.BARLocation); - - dprintk(DBGLVL_API, " = VS_FORMAT_MPEGTS (becomes dev->ts[%d])\n", - port->nr); - - return 0; -} - -int saa7164_api_configure_port_mpeg2ps(struct saa7164_dev *dev, - struct saa7164_port *port, - struct tmComResPSFormatDescrHeader *fmt) -{ - dprintk(DBGLVL_API, " bFormatIndex = 0x%x\n", fmt->bFormatIndex); - dprintk(DBGLVL_API, " wPacketLength= 0x%x\n", fmt->wPacketLength); - dprintk(DBGLVL_API, " wPackLength= 0x%x\n", fmt->wPackLength); - dprintk(DBGLVL_API, " bPackDataType= 0x%x\n", fmt->bPackDataType); - - /* Cache the hardware configuration in the port */ - /* TODO: CHECK THIS in the port config */ - port->bufcounter = port->hwcfg.BARLocation; - port->pitch = port->hwcfg.BARLocation + (2 * sizeof(u32)); - port->bufsize = port->hwcfg.BARLocation + (3 * sizeof(u32)); - port->bufoffset = port->hwcfg.BARLocation + (4 * sizeof(u32)); - port->bufptr32l = port->hwcfg.BARLocation + - (4 * sizeof(u32)) + - (sizeof(u32) * port->hwcfg.buffercount) + sizeof(u32); - port->bufptr32h = port->hwcfg.BARLocation + - (4 * sizeof(u32)) + - (sizeof(u32) * port->hwcfg.buffercount); - port->bufptr64 = port->hwcfg.BARLocation + - (4 * sizeof(u32)) + - (sizeof(u32) * port->hwcfg.buffercount); - dprintk(DBGLVL_API, " = port->hwcfg.BARLocation = 0x%x\n", - port->hwcfg.BARLocation); - - dprintk(DBGLVL_API, " = VS_FORMAT_MPEGPS (becomes dev->enc[%d])\n", - port->nr); - - return 0; -} - -int saa7164_api_dump_subdevs(struct saa7164_dev *dev, u8 *buf, int len) -{ - struct saa7164_port *tsport = NULL; - struct saa7164_port *encport = NULL; - struct saa7164_port *vbiport = NULL; - u32 idx, next_offset; - int i; - struct tmComResDescrHeader *hdr, *t; - struct tmComResExtDevDescrHeader *exthdr; - struct tmComResPathDescrHeader *pathhdr; - struct tmComResAntTermDescrHeader *anttermhdr; - struct tmComResTunerDescrHeader *tunerunithdr; - struct tmComResDMATermDescrHeader *vcoutputtermhdr; - struct tmComResTSFormatDescrHeader *tsfmt; - struct tmComResPSFormatDescrHeader *psfmt; - struct tmComResSelDescrHeader *psel; - struct tmComResProcDescrHeader *pdh; - struct tmComResAFeatureDescrHeader *afd; - struct tmComResEncoderDescrHeader *edh; - struct tmComResVBIFormatDescrHeader *vbifmt; - u32 currpath = 0; - - dprintk(DBGLVL_API, - "%s(?,?,%d) sizeof(struct tmComResDescrHeader) = %d bytes\n", - __func__, len, (u32)sizeof(struct tmComResDescrHeader)); - - for (idx = 0; idx < (len - sizeof(struct tmComResDescrHeader));) { - - hdr = (struct tmComResDescrHeader *)(buf + idx); - - if (hdr->type != CS_INTERFACE) - return SAA_ERR_NOT_SUPPORTED; - - dprintk(DBGLVL_API, "@ 0x%x =\n", idx); - switch (hdr->subtype) { - case GENERAL_REQUEST: - dprintk(DBGLVL_API, " GENERAL_REQUEST\n"); - break; - case VC_TUNER_PATH: - dprintk(DBGLVL_API, " VC_TUNER_PATH\n"); - pathhdr = (struct tmComResPathDescrHeader *)(buf + idx); - dprintk(DBGLVL_API, " pathid = 0x%x\n", - pathhdr->pathid); - currpath = pathhdr->pathid; - break; - case VC_INPUT_TERMINAL: - dprintk(DBGLVL_API, " VC_INPUT_TERMINAL\n"); - anttermhdr = - (struct tmComResAntTermDescrHeader *)(buf + idx); - dprintk(DBGLVL_API, " terminalid = 0x%x\n", - anttermhdr->terminalid); - dprintk(DBGLVL_API, " terminaltype = 0x%x\n", - anttermhdr->terminaltype); - switch (anttermhdr->terminaltype) { - case ITT_ANTENNA: - dprintk(DBGLVL_API, " = ITT_ANTENNA\n"); - break; - case LINE_CONNECTOR: - dprintk(DBGLVL_API, " = LINE_CONNECTOR\n"); - break; - case SPDIF_CONNECTOR: - dprintk(DBGLVL_API, " = SPDIF_CONNECTOR\n"); - break; - case COMPOSITE_CONNECTOR: - dprintk(DBGLVL_API, - " = COMPOSITE_CONNECTOR\n"); - break; - case SVIDEO_CONNECTOR: - dprintk(DBGLVL_API, " = SVIDEO_CONNECTOR\n"); - break; - case COMPONENT_CONNECTOR: - dprintk(DBGLVL_API, - " = COMPONENT_CONNECTOR\n"); - break; - case STANDARD_DMA: - dprintk(DBGLVL_API, " = STANDARD_DMA\n"); - break; - default: - dprintk(DBGLVL_API, " = undefined (0x%x)\n", - anttermhdr->terminaltype); - } - dprintk(DBGLVL_API, " assocterminal= 0x%x\n", - anttermhdr->assocterminal); - dprintk(DBGLVL_API, " iterminal = 0x%x\n", - anttermhdr->iterminal); - dprintk(DBGLVL_API, " controlsize = 0x%x\n", - anttermhdr->controlsize); - break; - case VC_OUTPUT_TERMINAL: - dprintk(DBGLVL_API, " VC_OUTPUT_TERMINAL\n"); - vcoutputtermhdr = - (struct tmComResDMATermDescrHeader *)(buf + idx); - dprintk(DBGLVL_API, " unitid = 0x%x\n", - vcoutputtermhdr->unitid); - dprintk(DBGLVL_API, " terminaltype = 0x%x\n", - vcoutputtermhdr->terminaltype); - switch (vcoutputtermhdr->terminaltype) { - case ITT_ANTENNA: - dprintk(DBGLVL_API, " = ITT_ANTENNA\n"); - break; - case LINE_CONNECTOR: - dprintk(DBGLVL_API, " = LINE_CONNECTOR\n"); - break; - case SPDIF_CONNECTOR: - dprintk(DBGLVL_API, " = SPDIF_CONNECTOR\n"); - break; - case COMPOSITE_CONNECTOR: - dprintk(DBGLVL_API, - " = COMPOSITE_CONNECTOR\n"); - break; - case SVIDEO_CONNECTOR: - dprintk(DBGLVL_API, " = SVIDEO_CONNECTOR\n"); - break; - case COMPONENT_CONNECTOR: - dprintk(DBGLVL_API, - " = COMPONENT_CONNECTOR\n"); - break; - case STANDARD_DMA: - dprintk(DBGLVL_API, " = STANDARD_DMA\n"); - break; - default: - dprintk(DBGLVL_API, " = undefined (0x%x)\n", - vcoutputtermhdr->terminaltype); - } - dprintk(DBGLVL_API, " assocterminal= 0x%x\n", - vcoutputtermhdr->assocterminal); - dprintk(DBGLVL_API, " sourceid = 0x%x\n", - vcoutputtermhdr->sourceid); - dprintk(DBGLVL_API, " iterminal = 0x%x\n", - vcoutputtermhdr->iterminal); - dprintk(DBGLVL_API, " BARLocation = 0x%x\n", - vcoutputtermhdr->BARLocation); - dprintk(DBGLVL_API, " flags = 0x%x\n", - vcoutputtermhdr->flags); - dprintk(DBGLVL_API, " interruptid = 0x%x\n", - vcoutputtermhdr->interruptid); - dprintk(DBGLVL_API, " buffercount = 0x%x\n", - vcoutputtermhdr->buffercount); - dprintk(DBGLVL_API, " metadatasize = 0x%x\n", - vcoutputtermhdr->metadatasize); - dprintk(DBGLVL_API, " controlsize = 0x%x\n", - vcoutputtermhdr->controlsize); - dprintk(DBGLVL_API, " numformats = 0x%x\n", - vcoutputtermhdr->numformats); - - t = (struct tmComResDescrHeader *) - ((struct tmComResDMATermDescrHeader *)(buf + idx)); - next_offset = idx + (vcoutputtermhdr->len); - for (i = 0; i < vcoutputtermhdr->numformats; i++) { - t = (struct tmComResDescrHeader *) - (buf + next_offset); - switch (t->subtype) { - case VS_FORMAT_MPEG2TS: - tsfmt = - (struct tmComResTSFormatDescrHeader *)t; - if (currpath == 1) - tsport = &dev->ports[SAA7164_PORT_TS1]; - else - tsport = &dev->ports[SAA7164_PORT_TS2]; - memcpy(&tsport->hwcfg, vcoutputtermhdr, - sizeof(*vcoutputtermhdr)); - saa7164_api_configure_port_mpeg2ts(dev, - tsport, tsfmt); - break; - case VS_FORMAT_MPEG2PS: - psfmt = - (struct tmComResPSFormatDescrHeader *)t; - if (currpath == 1) - encport = &dev->ports[SAA7164_PORT_ENC1]; - else - encport = &dev->ports[SAA7164_PORT_ENC2]; - memcpy(&encport->hwcfg, vcoutputtermhdr, - sizeof(*vcoutputtermhdr)); - saa7164_api_configure_port_mpeg2ps(dev, - encport, psfmt); - break; - case VS_FORMAT_VBI: - vbifmt = - (struct tmComResVBIFormatDescrHeader *)t; - if (currpath == 1) - vbiport = &dev->ports[SAA7164_PORT_VBI1]; - else - vbiport = &dev->ports[SAA7164_PORT_VBI2]; - memcpy(&vbiport->hwcfg, vcoutputtermhdr, - sizeof(*vcoutputtermhdr)); - memcpy(&vbiport->vbi_fmt_ntsc, vbifmt, - sizeof(*vbifmt)); - saa7164_api_configure_port_vbi(dev, - vbiport); - break; - case VS_FORMAT_RDS: - dprintk(DBGLVL_API, - " = VS_FORMAT_RDS\n"); - break; - case VS_FORMAT_UNCOMPRESSED: - dprintk(DBGLVL_API, - " = VS_FORMAT_UNCOMPRESSED\n"); - break; - case VS_FORMAT_TYPE: - dprintk(DBGLVL_API, - " = VS_FORMAT_TYPE\n"); - break; - default: - dprintk(DBGLVL_API, - " = undefined (0x%x)\n", - t->subtype); - } - next_offset += t->len; - } - - break; - case TUNER_UNIT: - dprintk(DBGLVL_API, " TUNER_UNIT\n"); - tunerunithdr = - (struct tmComResTunerDescrHeader *)(buf + idx); - dprintk(DBGLVL_API, " unitid = 0x%x\n", - tunerunithdr->unitid); - dprintk(DBGLVL_API, " sourceid = 0x%x\n", - tunerunithdr->sourceid); - dprintk(DBGLVL_API, " iunit = 0x%x\n", - tunerunithdr->iunit); - dprintk(DBGLVL_API, " tuningstandards = 0x%x\n", - tunerunithdr->tuningstandards); - dprintk(DBGLVL_API, " controlsize = 0x%x\n", - tunerunithdr->controlsize); - dprintk(DBGLVL_API, " controls = 0x%x\n", - tunerunithdr->controls); - - if (tunerunithdr->unitid == tunerunithdr->iunit) { - if (currpath == 1) - encport = &dev->ports[SAA7164_PORT_ENC1]; - else - encport = &dev->ports[SAA7164_PORT_ENC2]; - memcpy(&encport->tunerunit, tunerunithdr, - sizeof(struct tmComResTunerDescrHeader)); - dprintk(DBGLVL_API, - " (becomes dev->enc[%d] tuner)\n", - encport->nr); - } - break; - case VC_SELECTOR_UNIT: - psel = (struct tmComResSelDescrHeader *)(buf + idx); - dprintk(DBGLVL_API, " VC_SELECTOR_UNIT\n"); - dprintk(DBGLVL_API, " unitid = 0x%x\n", - psel->unitid); - dprintk(DBGLVL_API, " nrinpins = 0x%x\n", - psel->nrinpins); - dprintk(DBGLVL_API, " sourceid = 0x%x\n", - psel->sourceid); - break; - case VC_PROCESSING_UNIT: - pdh = (struct tmComResProcDescrHeader *)(buf + idx); - dprintk(DBGLVL_API, " VC_PROCESSING_UNIT\n"); - dprintk(DBGLVL_API, " unitid = 0x%x\n", - pdh->unitid); - dprintk(DBGLVL_API, " sourceid = 0x%x\n", - pdh->sourceid); - dprintk(DBGLVL_API, " controlsize = 0x%x\n", - pdh->controlsize); - if (pdh->controlsize == 0x04) { - if (currpath == 1) - encport = &dev->ports[SAA7164_PORT_ENC1]; - else - encport = &dev->ports[SAA7164_PORT_ENC2]; - memcpy(&encport->vidproc, pdh, - sizeof(struct tmComResProcDescrHeader)); - dprintk(DBGLVL_API, " (becomes dev->enc[%d])\n", - encport->nr); - } - break; - case FEATURE_UNIT: - afd = (struct tmComResAFeatureDescrHeader *)(buf + idx); - dprintk(DBGLVL_API, " FEATURE_UNIT\n"); - dprintk(DBGLVL_API, " unitid = 0x%x\n", - afd->unitid); - dprintk(DBGLVL_API, " sourceid = 0x%x\n", - afd->sourceid); - dprintk(DBGLVL_API, " controlsize = 0x%x\n", - afd->controlsize); - if (currpath == 1) - encport = &dev->ports[SAA7164_PORT_ENC1]; - else - encport = &dev->ports[SAA7164_PORT_ENC2]; - memcpy(&encport->audfeat, afd, - sizeof(struct tmComResAFeatureDescrHeader)); - dprintk(DBGLVL_API, " (becomes dev->enc[%d])\n", - encport->nr); - break; - case ENCODER_UNIT: - edh = (struct tmComResEncoderDescrHeader *)(buf + idx); - dprintk(DBGLVL_API, " ENCODER_UNIT\n"); - dprintk(DBGLVL_API, " subtype = 0x%x\n", edh->subtype); - dprintk(DBGLVL_API, " unitid = 0x%x\n", edh->unitid); - dprintk(DBGLVL_API, " vsourceid = 0x%x\n", - edh->vsourceid); - dprintk(DBGLVL_API, " asourceid = 0x%x\n", - edh->asourceid); - dprintk(DBGLVL_API, " iunit = 0x%x\n", edh->iunit); - if (edh->iunit == edh->unitid) { - if (currpath == 1) - encport = &dev->ports[SAA7164_PORT_ENC1]; - else - encport = &dev->ports[SAA7164_PORT_ENC2]; - memcpy(&encport->encunit, edh, - sizeof(struct tmComResEncoderDescrHeader)); - dprintk(DBGLVL_API, - " (becomes dev->enc[%d])\n", - encport->nr); - } - break; - case EXTENSION_UNIT: - dprintk(DBGLVL_API, " EXTENSION_UNIT\n"); - exthdr = (struct tmComResExtDevDescrHeader *)(buf + idx); - dprintk(DBGLVL_API, " unitid = 0x%x\n", - exthdr->unitid); - dprintk(DBGLVL_API, " deviceid = 0x%x\n", - exthdr->deviceid); - dprintk(DBGLVL_API, " devicetype = 0x%x\n", - exthdr->devicetype); - if (exthdr->devicetype & 0x1) - dprintk(DBGLVL_API, " = Decoder Device\n"); - if (exthdr->devicetype & 0x2) - dprintk(DBGLVL_API, " = GPIO Source\n"); - if (exthdr->devicetype & 0x4) - dprintk(DBGLVL_API, " = Video Decoder\n"); - if (exthdr->devicetype & 0x8) - dprintk(DBGLVL_API, " = Audio Decoder\n"); - if (exthdr->devicetype & 0x20) - dprintk(DBGLVL_API, " = Crossbar\n"); - if (exthdr->devicetype & 0x40) - dprintk(DBGLVL_API, " = Tuner\n"); - if (exthdr->devicetype & 0x80) - dprintk(DBGLVL_API, " = IF PLL\n"); - if (exthdr->devicetype & 0x100) - dprintk(DBGLVL_API, " = Demodulator\n"); - if (exthdr->devicetype & 0x200) - dprintk(DBGLVL_API, " = RDS Decoder\n"); - if (exthdr->devicetype & 0x400) - dprintk(DBGLVL_API, " = Encoder\n"); - if (exthdr->devicetype & 0x800) - dprintk(DBGLVL_API, " = IR Decoder\n"); - if (exthdr->devicetype & 0x1000) - dprintk(DBGLVL_API, " = EEPROM\n"); - if (exthdr->devicetype & 0x2000) - dprintk(DBGLVL_API, - " = VBI Decoder\n"); - if (exthdr->devicetype & 0x10000) - dprintk(DBGLVL_API, - " = Streaming Device\n"); - if (exthdr->devicetype & 0x20000) - dprintk(DBGLVL_API, - " = DRM Device\n"); - if (exthdr->devicetype & 0x40000000) - dprintk(DBGLVL_API, - " = Generic Device\n"); - if (exthdr->devicetype & 0x80000000) - dprintk(DBGLVL_API, - " = Config Space Device\n"); - dprintk(DBGLVL_API, " numgpiopins = 0x%x\n", - exthdr->numgpiopins); - dprintk(DBGLVL_API, " numgpiogroups = 0x%x\n", - exthdr->numgpiogroups); - dprintk(DBGLVL_API, " controlsize = 0x%x\n", - exthdr->controlsize); - if (exthdr->devicetype & 0x80) { - if (currpath == 1) - encport = &dev->ports[SAA7164_PORT_ENC1]; - else - encport = &dev->ports[SAA7164_PORT_ENC2]; - memcpy(&encport->ifunit, exthdr, - sizeof(struct tmComResExtDevDescrHeader)); - dprintk(DBGLVL_API, - " (becomes dev->enc[%d])\n", - encport->nr); - } - break; - case PVC_INFRARED_UNIT: - dprintk(DBGLVL_API, " PVC_INFRARED_UNIT\n"); - break; - case DRM_UNIT: - dprintk(DBGLVL_API, " DRM_UNIT\n"); - break; - default: - dprintk(DBGLVL_API, "default %d\n", hdr->subtype); - } - - dprintk(DBGLVL_API, " 1.%x\n", hdr->len); - dprintk(DBGLVL_API, " 2.%x\n", hdr->type); - dprintk(DBGLVL_API, " 3.%x\n", hdr->subtype); - dprintk(DBGLVL_API, " 4.%x\n", hdr->unitid); - - idx += hdr->len; - } - - return 0; -} - -int saa7164_api_enum_subdevs(struct saa7164_dev *dev) -{ - int ret; - u32 buflen = 0; - u8 *buf; - - dprintk(DBGLVL_API, "%s()\n", __func__); - - /* Get the total descriptor length */ - ret = saa7164_cmd_send(dev, 0, GET_LEN, - GET_DESCRIPTORS_CONTROL, sizeof(buflen), &buflen); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - - dprintk(DBGLVL_API, "%s() total descriptor size = %d bytes.\n", - __func__, buflen); - - /* Allocate enough storage for all of the descs */ - buf = kzalloc(buflen, GFP_KERNEL); - if (!buf) - return SAA_ERR_NO_RESOURCES; - - /* Retrieve them */ - ret = saa7164_cmd_send(dev, 0, GET_CUR, - GET_DESCRIPTORS_CONTROL, buflen, buf); - if (ret != SAA_OK) { - printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret); - goto out; - } - - if (saa_debug & DBGLVL_API) - saa7164_dumphex16(dev, buf, (buflen/16)*16); - - saa7164_api_dump_subdevs(dev, buf, buflen); - -out: - kfree(buf); - return ret; -} - -int saa7164_api_i2c_read(struct saa7164_i2c *bus, u8 addr, u32 reglen, u8 *reg, - u32 datalen, u8 *data) -{ - struct saa7164_dev *dev = bus->dev; - u16 len = 0; - int unitid; - u8 buf[256]; - int ret; - - dprintk(DBGLVL_API, "%s()\n", __func__); - - if (reglen > 4) - return -EIO; - - /* Prepare the send buffer */ - /* Bytes 00-03 source register length - * 04-07 source bytes to read - * 08... register address - */ - memset(buf, 0, sizeof(buf)); - memcpy((buf + 2 * sizeof(u32) + 0), reg, reglen); - *((u32 *)(buf + 0 * sizeof(u32))) = reglen; - *((u32 *)(buf + 1 * sizeof(u32))) = datalen; - - unitid = saa7164_i2caddr_to_unitid(bus, addr); - if (unitid < 0) { - printk(KERN_ERR - "%s() error, cannot translate regaddr 0x%x to unitid\n", - __func__, addr); - return -EIO; - } - - ret = saa7164_cmd_send(bus->dev, unitid, GET_LEN, - EXU_REGISTER_ACCESS_CONTROL, sizeof(len), &len); - if (ret != SAA_OK) { - printk(KERN_ERR "%s() error, ret(1) = 0x%x\n", __func__, ret); - return -EIO; - } - - dprintk(DBGLVL_API, "%s() len = %d bytes\n", __func__, len); - - if (saa_debug & DBGLVL_I2C) - saa7164_dumphex16(dev, buf, 2 * 16); - - ret = saa7164_cmd_send(bus->dev, unitid, GET_CUR, - EXU_REGISTER_ACCESS_CONTROL, len, &buf); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret(2) = 0x%x\n", __func__, ret); - else { - if (saa_debug & DBGLVL_I2C) - saa7164_dumphex16(dev, buf, sizeof(buf)); - memcpy(data, (buf + 2 * sizeof(u32) + reglen), datalen); - } - - return ret == SAA_OK ? 0 : -EIO; -} - -/* For a given 8 bit i2c address device, write the buffer */ -int saa7164_api_i2c_write(struct saa7164_i2c *bus, u8 addr, u32 datalen, - u8 *data) -{ - struct saa7164_dev *dev = bus->dev; - u16 len = 0; - int unitid; - int reglen; - u8 buf[256]; - int ret; - - dprintk(DBGLVL_API, "%s()\n", __func__); - - if ((datalen == 0) || (datalen > 232)) - return -EIO; - - memset(buf, 0, sizeof(buf)); - - unitid = saa7164_i2caddr_to_unitid(bus, addr); - if (unitid < 0) { - printk(KERN_ERR - "%s() error, cannot translate regaddr 0x%x to unitid\n", - __func__, addr); - return -EIO; - } - - reglen = saa7164_i2caddr_to_reglen(bus, addr); - if (reglen < 0) { - printk(KERN_ERR - "%s() error, cannot translate regaddr to reglen\n", - __func__); - return -EIO; - } - - ret = saa7164_cmd_send(bus->dev, unitid, GET_LEN, - EXU_REGISTER_ACCESS_CONTROL, sizeof(len), &len); - if (ret != SAA_OK) { - printk(KERN_ERR "%s() error, ret(1) = 0x%x\n", __func__, ret); - return -EIO; - } - - dprintk(DBGLVL_API, "%s() len = %d bytes\n", __func__, len); - - /* Prepare the send buffer */ - /* Bytes 00-03 dest register length - * 04-07 dest bytes to write - * 08... register address - */ - *((u32 *)(buf + 0 * sizeof(u32))) = reglen; - *((u32 *)(buf + 1 * sizeof(u32))) = datalen - reglen; - memcpy((buf + 2 * sizeof(u32)), data, datalen); - - if (saa_debug & DBGLVL_I2C) - saa7164_dumphex16(dev, buf, sizeof(buf)); - - ret = saa7164_cmd_send(bus->dev, unitid, SET_CUR, - EXU_REGISTER_ACCESS_CONTROL, len, &buf); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret(2) = 0x%x\n", __func__, ret); - - return ret == SAA_OK ? 0 : -EIO; -} - -int saa7164_api_modify_gpio(struct saa7164_dev *dev, u8 unitid, - u8 pin, u8 state) -{ - int ret; - struct tmComResGPIO t; - - dprintk(DBGLVL_API, "%s(0x%x, %d, %d)\n", - __func__, unitid, pin, state); - - if ((pin > 7) || (state > 2)) - return SAA_ERR_BAD_PARAMETER; - - t.pin = pin; - t.state = state; - - ret = saa7164_cmd_send(dev, unitid, SET_CUR, - EXU_GPIO_CONTROL, sizeof(t), &t); - if (ret != SAA_OK) - printk(KERN_ERR "%s() error, ret = 0x%x\n", - __func__, ret); - - return ret; -} - -int saa7164_api_set_gpiobit(struct saa7164_dev *dev, u8 unitid, - u8 pin) -{ - return saa7164_api_modify_gpio(dev, unitid, pin, 1); -} - -int saa7164_api_clear_gpiobit(struct saa7164_dev *dev, u8 unitid, - u8 pin) -{ - return saa7164_api_modify_gpio(dev, unitid, pin, 0); -} - |
