linux/drivers/media/video/saa7164/saa7164-api.c
<<
>>
Prefs
   1/*
   2 *  Driver for the NXP SAA7164 PCIe bridge
   3 *
   4 *  Copyright (c) 2010 Steven Toth <stoth@kernellabs.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, or
   9 *  (at your option) any later version.
  10 *
  11 *  This program is distributed in the hope that it will be useful,
  12 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14 *
  15 *  GNU General Public License for more details.
  16 *
  17 *  You should have received a copy of the GNU General Public License
  18 *  along with this program; if not, write to the Free Software
  19 *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  20 */
  21
  22#include <linux/wait.h>
  23#include <linux/slab.h>
  24
  25#include "saa7164.h"
  26
  27int saa7164_api_get_load_info(struct saa7164_dev *dev, struct tmFwInfoStruct *i)
  28{
  29        int ret;
  30
  31        if (!(saa_debug & DBGLVL_CPU))
  32                return 0;
  33
  34        dprintk(DBGLVL_API, "%s()\n", __func__);
  35
  36        i->deviceinst = 0;
  37        i->devicespec = 0;
  38        i->mode = 0;
  39        i->status = 0;
  40
  41        ret = saa7164_cmd_send(dev, 0, GET_CUR,
  42                GET_FW_STATUS_CONTROL, sizeof(struct tmFwInfoStruct), i);
  43        if (ret != SAA_OK)
  44                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
  45
  46        printk(KERN_INFO "saa7164[%d]-CPU: %d percent", dev->nr, i->CPULoad);
  47
  48        return ret;
  49}
  50
  51int saa7164_api_collect_debug(struct saa7164_dev *dev)
  52{
  53        struct tmComResDebugGetData d;
  54        u8 more = 255;
  55        int ret;
  56
  57        dprintk(DBGLVL_API, "%s()\n", __func__);
  58
  59        while (more--) {
  60
  61                memset(&d, 0, sizeof(d));
  62
  63                ret = saa7164_cmd_send(dev, 0, GET_CUR,
  64                        GET_DEBUG_DATA_CONTROL, sizeof(d), &d);
  65                if (ret != SAA_OK)
  66                        printk(KERN_ERR "%s() error, ret = 0x%x\n",
  67                                __func__, ret);
  68
  69                if (d.dwResult != SAA_OK)
  70                        break;
  71
  72                printk(KERN_INFO "saa7164[%d]-FWMSG: %s", dev->nr,
  73                        d.ucDebugData);
  74        }
  75
  76        return 0;
  77}
  78
  79int saa7164_api_set_debug(struct saa7164_dev *dev, u8 level)
  80{
  81        struct tmComResDebugSetLevel lvl;
  82        int ret;
  83
  84        dprintk(DBGLVL_API, "%s(level=%d)\n", __func__, level);
  85
  86        /* Retrieve current state */
  87        ret = saa7164_cmd_send(dev, 0, GET_CUR,
  88                SET_DEBUG_LEVEL_CONTROL, sizeof(lvl), &lvl);
  89        if (ret != SAA_OK)
  90                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
  91
  92        dprintk(DBGLVL_API, "%s() Was %d\n", __func__, lvl.dwDebugLevel);
  93
  94        lvl.dwDebugLevel = level;
  95
  96        /* set new state */
  97        ret = saa7164_cmd_send(dev, 0, SET_CUR,
  98                SET_DEBUG_LEVEL_CONTROL, sizeof(lvl), &lvl);
  99        if (ret != SAA_OK)
 100                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 101
 102        return ret;
 103}
 104
 105int saa7164_api_set_vbi_format(struct saa7164_port *port)
 106{
 107        struct saa7164_dev *dev = port->dev;
 108        struct tmComResProbeCommit fmt, rsp;
 109        int ret;
 110
 111        dprintk(DBGLVL_API, "%s(nr=%d, unitid=0x%x)\n", __func__,
 112                port->nr, port->hwcfg.unitid);
 113
 114        fmt.bmHint = 0;
 115        fmt.bFormatIndex = 1;
 116        fmt.bFrameIndex = 1;
 117
 118        /* Probe, see if it can support this format */
 119        ret = saa7164_cmd_send(port->dev, port->hwcfg.unitid,
 120                SET_CUR, SAA_PROBE_CONTROL, sizeof(fmt), &fmt);
 121        if (ret != SAA_OK)
 122                printk(KERN_ERR "%s() set error, ret = 0x%x\n", __func__, ret);
 123
 124        /* See of the format change was successful */
 125        ret = saa7164_cmd_send(port->dev, port->hwcfg.unitid,
 126                GET_CUR, SAA_PROBE_CONTROL, sizeof(rsp), &rsp);
 127        if (ret != SAA_OK) {
 128                printk(KERN_ERR "%s() get error, ret = 0x%x\n", __func__, ret);
 129        } else {
 130                /* Compare requested vs received, should be same */
 131                if (memcmp(&fmt, &rsp, sizeof(rsp)) == 0) {
 132                        dprintk(DBGLVL_API, "SET/PROBE Verified\n");
 133
 134                        /* Ask the device to select the negotiated format */
 135                        ret = saa7164_cmd_send(port->dev, port->hwcfg.unitid,
 136                                SET_CUR, SAA_COMMIT_CONTROL, sizeof(fmt), &fmt);
 137                        if (ret != SAA_OK)
 138                                printk(KERN_ERR "%s() commit error, ret = 0x%x\n",
 139                                        __func__, ret);
 140
 141                        ret = saa7164_cmd_send(port->dev, port->hwcfg.unitid,
 142                                GET_CUR, SAA_COMMIT_CONTROL, sizeof(rsp), &rsp);
 143                        if (ret != SAA_OK)
 144                                printk(KERN_ERR "%s() GET commit error, ret = 0x%x\n",
 145                                        __func__, ret);
 146
 147                        if (memcmp(&fmt, &rsp, sizeof(rsp)) != 0) {
 148                                printk(KERN_ERR "%s() memcmp error, ret = 0x%x\n",
 149                                        __func__, ret);
 150                        } else
 151                                dprintk(DBGLVL_API, "SET/COMMIT Verified\n");
 152
 153                        dprintk(DBGLVL_API, "rsp.bmHint = 0x%x\n", rsp.bmHint);
 154                        dprintk(DBGLVL_API, "rsp.bFormatIndex = 0x%x\n",
 155                                rsp.bFormatIndex);
 156                        dprintk(DBGLVL_API, "rsp.bFrameIndex = 0x%x\n",
 157                                rsp.bFrameIndex);
 158                } else
 159                        printk(KERN_ERR "%s() compare failed\n", __func__);
 160        }
 161
 162        if (ret == SAA_OK)
 163                dprintk(DBGLVL_API, "%s(nr=%d) Success\n", __func__, port->nr);
 164
 165        return ret;
 166}
 167
 168int saa7164_api_set_gop_size(struct saa7164_port *port)
 169{
 170        struct saa7164_dev *dev = port->dev;
 171        struct tmComResEncVideoGopStructure gs;
 172        int ret;
 173
 174        dprintk(DBGLVL_ENC, "%s()\n", __func__);
 175
 176        gs.ucRefFrameDist = port->encoder_params.refdist;
 177        gs.ucGOPSize = port->encoder_params.gop_size;
 178        ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, SET_CUR,
 179                EU_VIDEO_GOP_STRUCTURE_CONTROL,
 180                sizeof(gs), &gs);
 181        if (ret != SAA_OK)
 182                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 183
 184        return ret;
 185}
 186
 187int saa7164_api_set_encoder(struct saa7164_port *port)
 188{
 189        struct saa7164_dev *dev = port->dev;
 190        struct tmComResEncVideoBitRate vb;
 191        struct tmComResEncAudioBitRate ab;
 192        int ret;
 193
 194        dprintk(DBGLVL_ENC, "%s() unitid=0x%x\n", __func__,
 195                port->hwcfg.sourceid);
 196
 197        if (port->encoder_params.stream_type == V4L2_MPEG_STREAM_TYPE_MPEG2_PS)
 198                port->encoder_profile = EU_PROFILE_PS_DVD;
 199        else
 200                port->encoder_profile = EU_PROFILE_TS_HQ;
 201
 202        ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, SET_CUR,
 203                EU_PROFILE_CONTROL, sizeof(u8), &port->encoder_profile);
 204        if (ret != SAA_OK)
 205                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 206
 207        /* Resolution */
 208        ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, SET_CUR,
 209                EU_PROFILE_CONTROL, sizeof(u8), &port->encoder_profile);
 210        if (ret != SAA_OK)
 211                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 212
 213        /* Establish video bitrates */
 214        if (port->encoder_params.bitrate_mode ==
 215                V4L2_MPEG_VIDEO_BITRATE_MODE_CBR)
 216                vb.ucVideoBitRateMode = EU_VIDEO_BIT_RATE_MODE_CONSTANT;
 217        else
 218                vb.ucVideoBitRateMode = EU_VIDEO_BIT_RATE_MODE_VARIABLE_PEAK;
 219        vb.dwVideoBitRate = port->encoder_params.bitrate;
 220        vb.dwVideoBitRatePeak = port->encoder_params.bitrate_peak;
 221        ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, SET_CUR,
 222                EU_VIDEO_BIT_RATE_CONTROL,
 223                sizeof(struct tmComResEncVideoBitRate),
 224                &vb);
 225        if (ret != SAA_OK)
 226                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 227
 228        /* Establish audio bitrates */
 229        ab.ucAudioBitRateMode = 0;
 230        ab.dwAudioBitRate = 384000;
 231        ab.dwAudioBitRatePeak = ab.dwAudioBitRate;
 232        ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, SET_CUR,
 233                EU_AUDIO_BIT_RATE_CONTROL,
 234                sizeof(struct tmComResEncAudioBitRate),
 235                &ab);
 236        if (ret != SAA_OK)
 237                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__,
 238                        ret);
 239
 240        saa7164_api_set_aspect_ratio(port);
 241        saa7164_api_set_gop_size(port);
 242
 243        return ret;
 244}
 245
 246int saa7164_api_get_encoder(struct saa7164_port *port)
 247{
 248        struct saa7164_dev *dev = port->dev;
 249        struct tmComResEncVideoBitRate v;
 250        struct tmComResEncAudioBitRate a;
 251        struct tmComResEncVideoInputAspectRatio ar;
 252        int ret;
 253
 254        dprintk(DBGLVL_ENC, "%s() unitid=0x%x\n", __func__,
 255                port->hwcfg.sourceid);
 256
 257        port->encoder_profile = 0;
 258        port->video_format = 0;
 259        port->video_resolution = 0;
 260        port->audio_format = 0;
 261
 262        ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR,
 263                EU_PROFILE_CONTROL, sizeof(u8), &port->encoder_profile);
 264        if (ret != SAA_OK)
 265                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 266
 267        ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR,
 268                EU_VIDEO_RESOLUTION_CONTROL, sizeof(u8),
 269                &port->video_resolution);
 270        if (ret != SAA_OK)
 271                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 272
 273        ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR,
 274                EU_VIDEO_FORMAT_CONTROL, sizeof(u8), &port->video_format);
 275        if (ret != SAA_OK)
 276                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 277
 278        ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR,
 279                EU_VIDEO_BIT_RATE_CONTROL, sizeof(v), &v);
 280        if (ret != SAA_OK)
 281                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 282
 283        ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR,
 284                EU_AUDIO_FORMAT_CONTROL, sizeof(u8), &port->audio_format);
 285        if (ret != SAA_OK)
 286                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 287
 288        ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR,
 289                EU_AUDIO_BIT_RATE_CONTROL, sizeof(a), &a);
 290        if (ret != SAA_OK)
 291                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 292
 293        /* Aspect Ratio */
 294        ar.width = 0;
 295        ar.height = 0;
 296        ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, GET_CUR,
 297                EU_VIDEO_INPUT_ASPECT_CONTROL,
 298                sizeof(struct tmComResEncVideoInputAspectRatio), &ar);
 299        if (ret != SAA_OK)
 300                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 301
 302        dprintk(DBGLVL_ENC, "encoder_profile = %d\n", port->encoder_profile);
 303        dprintk(DBGLVL_ENC, "video_format    = %d\n", port->video_format);
 304        dprintk(DBGLVL_ENC, "audio_format    = %d\n", port->audio_format);
 305        dprintk(DBGLVL_ENC, "video_resolution= %d\n", port->video_resolution);
 306        dprintk(DBGLVL_ENC, "v.ucVideoBitRateMode = %d\n",
 307                v.ucVideoBitRateMode);
 308        dprintk(DBGLVL_ENC, "v.dwVideoBitRate     = %d\n",
 309                v.dwVideoBitRate);
 310        dprintk(DBGLVL_ENC, "v.dwVideoBitRatePeak = %d\n",
 311                v.dwVideoBitRatePeak);
 312        dprintk(DBGLVL_ENC, "a.ucVideoBitRateMode = %d\n",
 313                a.ucAudioBitRateMode);
 314        dprintk(DBGLVL_ENC, "a.dwVideoBitRate     = %d\n",
 315                a.dwAudioBitRate);
 316        dprintk(DBGLVL_ENC, "a.dwVideoBitRatePeak = %d\n",
 317                a.dwAudioBitRatePeak);
 318        dprintk(DBGLVL_ENC, "aspect.width / height = %d:%d\n",
 319                ar.width, ar.height);
 320
 321        return ret;
 322}
 323
 324int saa7164_api_set_aspect_ratio(struct saa7164_port *port)
 325{
 326        struct saa7164_dev *dev = port->dev;
 327        struct tmComResEncVideoInputAspectRatio ar;
 328        int ret;
 329
 330        dprintk(DBGLVL_ENC, "%s(%d)\n", __func__,
 331                port->encoder_params.ctl_aspect);
 332
 333        switch (port->encoder_params.ctl_aspect) {
 334        case V4L2_MPEG_VIDEO_ASPECT_1x1:
 335                ar.width = 1;
 336                ar.height = 1;
 337                break;
 338        case V4L2_MPEG_VIDEO_ASPECT_4x3:
 339                ar.width = 4;
 340                ar.height = 3;
 341                break;
 342        case V4L2_MPEG_VIDEO_ASPECT_16x9:
 343                ar.width = 16;
 344                ar.height = 9;
 345                break;
 346        case V4L2_MPEG_VIDEO_ASPECT_221x100:
 347                ar.width = 221;
 348                ar.height = 100;
 349                break;
 350        default:
 351                BUG();
 352        }
 353
 354        dprintk(DBGLVL_ENC, "%s(%d) now %d:%d\n", __func__,
 355                port->encoder_params.ctl_aspect,
 356                ar.width, ar.height);
 357
 358        /* Aspect Ratio */
 359        ret = saa7164_cmd_send(port->dev, port->hwcfg.sourceid, SET_CUR,
 360                EU_VIDEO_INPUT_ASPECT_CONTROL,
 361                sizeof(struct tmComResEncVideoInputAspectRatio), &ar);
 362        if (ret != SAA_OK)
 363                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 364
 365        return ret;
 366}
 367
 368int saa7164_api_set_usercontrol(struct saa7164_port *port, u8 ctl)
 369{
 370        struct saa7164_dev *dev = port->dev;
 371        int ret;
 372        u16 val;
 373
 374        if (ctl == PU_BRIGHTNESS_CONTROL)
 375                val = port->ctl_brightness;
 376        else
 377        if (ctl == PU_CONTRAST_CONTROL)
 378                val = port->ctl_contrast;
 379        else
 380        if (ctl == PU_HUE_CONTROL)
 381                val = port->ctl_hue;
 382        else
 383        if (ctl == PU_SATURATION_CONTROL)
 384                val = port->ctl_saturation;
 385        else
 386        if (ctl == PU_SHARPNESS_CONTROL)
 387                val = port->ctl_sharpness;
 388        else
 389                return -EINVAL;
 390
 391        dprintk(DBGLVL_ENC, "%s() unitid=0x%x ctl=%d, val=%d\n",
 392                __func__, port->encunit.vsourceid, ctl, val);
 393
 394        ret = saa7164_cmd_send(port->dev, port->encunit.vsourceid, SET_CUR,
 395                ctl, sizeof(u16), &val);
 396        if (ret != SAA_OK)
 397                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 398
 399        return ret;
 400}
 401
 402int saa7164_api_get_usercontrol(struct saa7164_port *port, u8 ctl)
 403{
 404        struct saa7164_dev *dev = port->dev;
 405        int ret;
 406        u16 val;
 407
 408        ret = saa7164_cmd_send(port->dev, port->encunit.vsourceid, GET_CUR,
 409                ctl, sizeof(u16), &val);
 410        if (ret != SAA_OK) {
 411                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 412                return ret;
 413        }
 414
 415        dprintk(DBGLVL_ENC, "%s() ctl=%d, val=%d\n",
 416                __func__, ctl, val);
 417
 418        if (ctl == PU_BRIGHTNESS_CONTROL)
 419                port->ctl_brightness = val;
 420        else
 421        if (ctl == PU_CONTRAST_CONTROL)
 422                port->ctl_contrast = val;
 423        else
 424        if (ctl == PU_HUE_CONTROL)
 425                port->ctl_hue = val;
 426        else
 427        if (ctl == PU_SATURATION_CONTROL)
 428                port->ctl_saturation = val;
 429        else
 430        if (ctl == PU_SHARPNESS_CONTROL)
 431                port->ctl_sharpness = val;
 432
 433        return ret;
 434}
 435
 436int saa7164_api_set_videomux(struct saa7164_port *port)
 437{
 438        struct saa7164_dev *dev = port->dev;
 439        u8 inputs[] = { 1, 2, 2, 2, 5, 5, 5 };
 440        int ret;
 441
 442        dprintk(DBGLVL_ENC, "%s() v_mux=%d a_mux=%d\n",
 443                __func__, port->mux_input, inputs[port->mux_input - 1]);
 444
 445        /* Audio Mute */
 446        ret = saa7164_api_audio_mute(port, 1);
 447        if (ret != SAA_OK)
 448                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 449
 450        /* Video Mux */
 451        ret = saa7164_cmd_send(port->dev, port->vidproc.sourceid, SET_CUR,
 452                SU_INPUT_SELECT_CONTROL, sizeof(u8), &port->mux_input);
 453        if (ret != SAA_OK)
 454                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 455
 456        /* Audio Mux */
 457        ret = saa7164_cmd_send(port->dev, port->audfeat.sourceid, SET_CUR,
 458                SU_INPUT_SELECT_CONTROL, sizeof(u8),
 459                &inputs[port->mux_input - 1]);
 460        if (ret != SAA_OK)
 461                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 462
 463        /* Audio UnMute */
 464        ret = saa7164_api_audio_mute(port, 0);
 465        if (ret != SAA_OK)
 466                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 467
 468        return ret;
 469}
 470
 471int saa7164_api_audio_mute(struct saa7164_port *port, int mute)
 472{
 473        struct saa7164_dev *dev = port->dev;
 474        u8 v = mute;
 475        int ret;
 476
 477        dprintk(DBGLVL_API, "%s(%d)\n", __func__, mute);
 478
 479        ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, SET_CUR,
 480                MUTE_CONTROL, sizeof(u8), &v);
 481        if (ret != SAA_OK)
 482                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 483
 484        return ret;
 485}
 486
 487/* 0 = silence, 0xff = full */
 488int saa7164_api_set_audio_volume(struct saa7164_port *port, s8 level)
 489{
 490        struct saa7164_dev *dev = port->dev;
 491        s16 v, min, max;
 492        int ret;
 493
 494        dprintk(DBGLVL_API, "%s(%d)\n", __func__, level);
 495
 496        /* Obtain the min/max ranges */
 497        ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, GET_MIN,
 498                VOLUME_CONTROL, sizeof(u16), &min);
 499        if (ret != SAA_OK)
 500                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 501
 502        ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, GET_MAX,
 503                VOLUME_CONTROL, sizeof(u16), &max);
 504        if (ret != SAA_OK)
 505                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 506
 507        ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, GET_CUR,
 508                (0x01 << 8) | VOLUME_CONTROL, sizeof(u16), &v);
 509        if (ret != SAA_OK)
 510                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 511
 512        dprintk(DBGLVL_API, "%s(%d) min=%d max=%d cur=%d\n", __func__,
 513                level, min, max, v);
 514
 515        v = level;
 516        if (v < min)
 517                v = min;
 518        if (v > max)
 519                v = max;
 520
 521        /* Left */
 522        ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, SET_CUR,
 523                (0x01 << 8) | VOLUME_CONTROL, sizeof(s16), &v);
 524        if (ret != SAA_OK)
 525                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 526
 527        /* Right */
 528        ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, SET_CUR,
 529                (0x02 << 8) | VOLUME_CONTROL, sizeof(s16), &v);
 530        if (ret != SAA_OK)
 531                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 532
 533        ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, GET_CUR,
 534                (0x01 << 8) | VOLUME_CONTROL, sizeof(u16), &v);
 535        if (ret != SAA_OK)
 536                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 537
 538        dprintk(DBGLVL_API, "%s(%d) min=%d max=%d cur=%d\n", __func__,
 539                level, min, max, v);
 540
 541        return ret;
 542}
 543
 544int saa7164_api_set_audio_std(struct saa7164_port *port)
 545{
 546        struct saa7164_dev *dev = port->dev;
 547        struct tmComResAudioDefaults lvl;
 548        struct tmComResTunerStandard tvaudio;
 549        int ret;
 550
 551        dprintk(DBGLVL_API, "%s()\n", __func__);
 552
 553        /* Establish default levels */
 554        lvl.ucDecoderLevel = TMHW_LEV_ADJ_DECLEV_DEFAULT;
 555        lvl.ucDecoderFM_Level = TMHW_LEV_ADJ_DECLEV_DEFAULT;
 556        lvl.ucMonoLevel = TMHW_LEV_ADJ_MONOLEV_DEFAULT;
 557        lvl.ucNICAM_Level = TMHW_LEV_ADJ_NICLEV_DEFAULT;
 558        lvl.ucSAP_Level = TMHW_LEV_ADJ_SAPLEV_DEFAULT;
 559        lvl.ucADC_Level = TMHW_LEV_ADJ_ADCLEV_DEFAULT;
 560        ret = saa7164_cmd_send(port->dev, port->audfeat.unitid, SET_CUR,
 561                AUDIO_DEFAULT_CONTROL, sizeof(struct tmComResAudioDefaults),
 562                &lvl);
 563        if (ret != SAA_OK)
 564                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 565
 566        /* Manually select the appropriate TV audio standard */
 567        if (port->encodernorm.id & V4L2_STD_NTSC) {
 568                tvaudio.std = TU_STANDARD_NTSC_M;
 569                tvaudio.country = 1;
 570        } else {
 571                tvaudio.std = TU_STANDARD_PAL_I;
 572                tvaudio.country = 44;
 573        }
 574
 575        ret = saa7164_cmd_send(port->dev, port->tunerunit.unitid, SET_CUR,
 576                TU_STANDARD_CONTROL, sizeof(tvaudio), &tvaudio);
 577        if (ret != SAA_OK)
 578                printk(KERN_ERR "%s() TU_STANDARD_CONTROL error, ret = 0x%x\n",
 579                        __func__, ret);
 580        return ret;
 581}
 582
 583int saa7164_api_set_audio_detection(struct saa7164_port *port, int autodetect)
 584{
 585        struct saa7164_dev *dev = port->dev;
 586        struct tmComResTunerStandardAuto p;
 587        int ret;
 588
 589        dprintk(DBGLVL_API, "%s(%d)\n", __func__, autodetect);
 590
 591        /* Disable TV Audio autodetect if not already set (buggy) */
 592        if (autodetect)
 593                p.mode = TU_STANDARD_AUTO;
 594        else
 595                p.mode = TU_STANDARD_MANUAL;
 596        ret = saa7164_cmd_send(port->dev, port->tunerunit.unitid, SET_CUR,
 597                TU_STANDARD_AUTO_CONTROL, sizeof(p), &p);
 598        if (ret != SAA_OK)
 599                printk(KERN_ERR
 600                        "%s() TU_STANDARD_AUTO_CONTROL error, ret = 0x%x\n",
 601                        __func__, ret);
 602
 603        return ret;
 604}
 605
 606int saa7164_api_get_videomux(struct saa7164_port *port)
 607{
 608        struct saa7164_dev *dev = port->dev;
 609        int ret;
 610
 611        ret = saa7164_cmd_send(port->dev, port->vidproc.sourceid, GET_CUR,
 612                SU_INPUT_SELECT_CONTROL, sizeof(u8), &port->mux_input);
 613        if (ret != SAA_OK)
 614                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 615
 616        dprintk(DBGLVL_ENC, "%s() v_mux=%d\n",
 617                __func__, port->mux_input);
 618
 619        return ret;
 620}
 621
 622int saa7164_api_set_dif(struct saa7164_port *port, u8 reg, u8 val)
 623{
 624        struct saa7164_dev *dev = port->dev;
 625
 626        u16 len = 0;
 627        u8 buf[256];
 628        int ret;
 629        u8 mas;
 630
 631        dprintk(DBGLVL_API, "%s(nr=%d type=%d val=%x)\n", __func__,
 632                port->nr, port->type, val);
 633
 634        if (port->nr == 0)
 635                mas = 0xd0;
 636        else
 637                mas = 0xe0;
 638
 639        memset(buf, 0, sizeof(buf));
 640
 641        buf[0x00] = 0x04;
 642        buf[0x01] = 0x00;
 643        buf[0x02] = 0x00;
 644        buf[0x03] = 0x00;
 645
 646        buf[0x04] = 0x04;
 647        buf[0x05] = 0x00;
 648        buf[0x06] = 0x00;
 649        buf[0x07] = 0x00;
 650
 651        buf[0x08] = reg;
 652        buf[0x09] = 0x26;
 653        buf[0x0a] = mas;
 654        buf[0x0b] = 0xb0;
 655
 656        buf[0x0c] = val;
 657        buf[0x0d] = 0x00;
 658        buf[0x0e] = 0x00;
 659        buf[0x0f] = 0x00;
 660
 661        ret = saa7164_cmd_send(dev, port->ifunit.unitid, GET_LEN,
 662                EXU_REGISTER_ACCESS_CONTROL, sizeof(len), &len);
 663        if (ret != SAA_OK) {
 664                printk(KERN_ERR "%s() error, ret(1) = 0x%x\n", __func__, ret);
 665                return -EIO;
 666        }
 667
 668        ret = saa7164_cmd_send(dev, port->ifunit.unitid, SET_CUR,
 669                EXU_REGISTER_ACCESS_CONTROL, len, &buf);
 670        if (ret != SAA_OK)
 671                printk(KERN_ERR "%s() error, ret(2) = 0x%x\n", __func__, ret);
 672#if 0
 673        saa7164_dumphex16(dev, buf, 16);
 674#endif
 675        return ret == SAA_OK ? 0 : -EIO;
 676}
 677
 678/* Disable the IF block AGC controls */
 679int saa7164_api_configure_dif(struct saa7164_port *port, u32 std)
 680{
 681        struct saa7164_dev *dev = port->dev;
 682        int ret = 0;
 683        u8 agc_disable;
 684
 685        dprintk(DBGLVL_API, "%s(nr=%d, 0x%x)\n", __func__, port->nr, std);
 686
 687        if (std & V4L2_STD_NTSC) {
 688                dprintk(DBGLVL_API, " NTSC\n");
 689                saa7164_api_set_dif(port, 0x00, 0x01); /* Video Standard */
 690                agc_disable = 0;
 691        } else if (std & V4L2_STD_PAL_I) {
 692                dprintk(DBGLVL_API, " PAL-I\n");
 693                saa7164_api_set_dif(port, 0x00, 0x08); /* Video Standard */
 694                agc_disable = 0;
 695        } else if (std & V4L2_STD_PAL_M) {
 696                dprintk(DBGLVL_API, " PAL-M\n");
 697                saa7164_api_set_dif(port, 0x00, 0x01); /* Video Standard */
 698                agc_disable = 0;
 699        } else if (std & V4L2_STD_PAL_N) {
 700                dprintk(DBGLVL_API, " PAL-N\n");
 701                saa7164_api_set_dif(port, 0x00, 0x01); /* Video Standard */
 702                agc_disable = 0;
 703        } else if (std & V4L2_STD_PAL_Nc) {
 704                dprintk(DBGLVL_API, " PAL-Nc\n");
 705                saa7164_api_set_dif(port, 0x00, 0x01); /* Video Standard */
 706                agc_disable = 0;
 707        } else if (std & V4L2_STD_PAL_B) {
 708                dprintk(DBGLVL_API, " PAL-B\n");
 709                saa7164_api_set_dif(port, 0x00, 0x02); /* Video Standard */
 710                agc_disable = 0;
 711        } else if (std & V4L2_STD_PAL_DK) {
 712                dprintk(DBGLVL_API, " PAL-DK\n");
 713                saa7164_api_set_dif(port, 0x00, 0x10); /* Video Standard */
 714                agc_disable = 0;
 715        } else if (std & V4L2_STD_SECAM_L) {
 716                dprintk(DBGLVL_API, " SECAM-L\n");
 717                saa7164_api_set_dif(port, 0x00, 0x20); /* Video Standard */
 718                agc_disable = 0;
 719        } else {
 720                /* Unknown standard, assume DTV */
 721                dprintk(DBGLVL_API, " Unknown (assuming DTV)\n");
 722                /* Undefinded Video Standard */
 723                saa7164_api_set_dif(port, 0x00, 0x80);
 724                agc_disable = 1;
 725        }
 726
 727        saa7164_api_set_dif(port, 0x48, 0xa0); /* AGC Functions 1 */
 728        saa7164_api_set_dif(port, 0xc0, agc_disable); /* AGC Output Disable */
 729        saa7164_api_set_dif(port, 0x7c, 0x04); /* CVBS EQ */
 730        saa7164_api_set_dif(port, 0x04, 0x01); /* Active */
 731        msleep(100);
 732        saa7164_api_set_dif(port, 0x04, 0x00); /* Active (again) */
 733        msleep(100);
 734
 735        return ret;
 736}
 737
 738/* Ensure the dif is in the correct state for the operating mode
 739 * (analog / dtv). We only configure the diff through the analog encoder
 740 * so when we're in digital mode we need to find the appropriate encoder
 741 * and use it to configure the DIF.
 742 */
 743int saa7164_api_initialize_dif(struct saa7164_port *port)
 744{
 745        struct saa7164_dev *dev = port->dev;
 746        struct saa7164_port *p = 0;
 747        int ret = -EINVAL;
 748        u32 std = 0;
 749
 750        dprintk(DBGLVL_API, "%s(nr=%d type=%d)\n", __func__,
 751                port->nr, port->type);
 752
 753        if (port->type == SAA7164_MPEG_ENCODER) {
 754                /* Pick any analog standard to init the diff.
 755                 * we'll come back during encoder_init'
 756                 * and set the correct standard if requried.
 757                 */
 758                std = V4L2_STD_NTSC;
 759        } else
 760        if (port->type == SAA7164_MPEG_DVB) {
 761                if (port->nr == SAA7164_PORT_TS1)
 762                        p = &dev->ports[SAA7164_PORT_ENC1];
 763                else
 764                        p = &dev->ports[SAA7164_PORT_ENC2];
 765        } else
 766        if (port->type == SAA7164_MPEG_VBI) {
 767                std = V4L2_STD_NTSC;
 768                if (port->nr == SAA7164_PORT_VBI1)
 769                        p = &dev->ports[SAA7164_PORT_ENC1];
 770                else
 771                        p = &dev->ports[SAA7164_PORT_ENC2];
 772        } else
 773                BUG();
 774
 775        if (p)
 776                ret = saa7164_api_configure_dif(p, std);
 777
 778        return ret;
 779}
 780
 781int saa7164_api_transition_port(struct saa7164_port *port, u8 mode)
 782{
 783        struct saa7164_dev *dev = port->dev;
 784
 785        int ret;
 786
 787        dprintk(DBGLVL_API, "%s(nr=%d unitid=0x%x,%d)\n",
 788                __func__, port->nr, port->hwcfg.unitid, mode);
 789
 790        ret = saa7164_cmd_send(port->dev, port->hwcfg.unitid, SET_CUR,
 791                SAA_STATE_CONTROL, sizeof(mode), &mode);
 792        if (ret != SAA_OK)
 793                printk(KERN_ERR "%s(portnr %d unitid 0x%x) error, ret = 0x%x\n",
 794                        __func__, port->nr, port->hwcfg.unitid, ret);
 795
 796        return ret;
 797}
 798
 799int saa7164_api_get_fw_version(struct saa7164_dev *dev, u32 *version)
 800{
 801        int ret;
 802
 803        ret = saa7164_cmd_send(dev, 0, GET_CUR,
 804                GET_FW_VERSION_CONTROL, sizeof(u32), version);
 805        if (ret != SAA_OK)
 806                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
 807
 808        return ret;
 809}
 810
 811int saa7164_api_read_eeprom(struct saa7164_dev *dev, u8 *buf, int buflen)
 812{
 813        u8 reg[] = { 0x0f, 0x00 };
 814
 815        if (buflen < 128)
 816                return -ENOMEM;
 817
 818        /* Assumption: Hauppauge eeprom is at 0xa0 on on bus 0 */
 819        /* TODO: Pull the details from the boards struct */
 820        return saa7164_api_i2c_read(&dev->i2c_bus[0], 0xa0 >> 1, sizeof(reg),
 821                &reg[0], 128, buf);
 822}
 823
 824int saa7164_api_configure_port_vbi(struct saa7164_dev *dev,
 825        struct saa7164_port *port)
 826{
 827        struct tmComResVBIFormatDescrHeader *fmt = &port->vbi_fmt_ntsc;
 828
 829        dprintk(DBGLVL_API, "    bFormatIndex  = 0x%x\n", fmt->bFormatIndex);
 830        dprintk(DBGLVL_API, "    VideoStandard = 0x%x\n", fmt->VideoStandard);
 831        dprintk(DBGLVL_API, "    StartLine     = %d\n", fmt->StartLine);
 832        dprintk(DBGLVL_API, "    EndLine       = %d\n", fmt->EndLine);
 833        dprintk(DBGLVL_API, "    FieldRate     = %d\n", fmt->FieldRate);
 834        dprintk(DBGLVL_API, "    bNumLines     = %d\n", fmt->bNumLines);
 835
 836        /* Cache the hardware configuration in the port */
 837
 838        port->bufcounter = port->hwcfg.BARLocation;
 839        port->pitch = port->hwcfg.BARLocation + (2 * sizeof(u32));
 840        port->bufsize = port->hwcfg.BARLocation + (3 * sizeof(u32));
 841        port->bufoffset = port->hwcfg.BARLocation + (4 * sizeof(u32));
 842        port->bufptr32l = port->hwcfg.BARLocation +
 843                (4 * sizeof(u32)) +
 844                (sizeof(u32) * port->hwcfg.buffercount) + sizeof(u32);
 845        port->bufptr32h = port->hwcfg.BARLocation +
 846                (4 * sizeof(u32)) +
 847                (sizeof(u32) * port->hwcfg.buffercount);
 848        port->bufptr64 = port->hwcfg.BARLocation +
 849                (4 * sizeof(u32)) +
 850                (sizeof(u32) * port->hwcfg.buffercount);
 851        dprintk(DBGLVL_API, "   = port->hwcfg.BARLocation = 0x%x\n",
 852                port->hwcfg.BARLocation);
 853
 854        dprintk(DBGLVL_API, "   = VS_FORMAT_VBI (becomes dev->en[%d])\n",
 855                port->nr);
 856
 857        return 0;
 858}
 859
 860int saa7164_api_configure_port_mpeg2ts(struct saa7164_dev *dev,
 861        struct saa7164_port *port,
 862        struct tmComResTSFormatDescrHeader *tsfmt)
 863{
 864        dprintk(DBGLVL_API, "    bFormatIndex = 0x%x\n", tsfmt->bFormatIndex);
 865        dprintk(DBGLVL_API, "    bDataOffset  = 0x%x\n", tsfmt->bDataOffset);
 866        dprintk(DBGLVL_API, "    bPacketLength= 0x%x\n", tsfmt->bPacketLength);
 867        dprintk(DBGLVL_API, "    bStrideLength= 0x%x\n", tsfmt->bStrideLength);
 868        dprintk(DBGLVL_API, "    bguid        = (....)\n");
 869
 870        /* Cache the hardware configuration in the port */
 871
 872        port->bufcounter = port->hwcfg.BARLocation;
 873        port->pitch = port->hwcfg.BARLocation + (2 * sizeof(u32));
 874        port->bufsize = port->hwcfg.BARLocation + (3 * sizeof(u32));
 875        port->bufoffset = port->hwcfg.BARLocation + (4 * sizeof(u32));
 876        port->bufptr32l = port->hwcfg.BARLocation +
 877                (4 * sizeof(u32)) +
 878                (sizeof(u32) * port->hwcfg.buffercount) + sizeof(u32);
 879        port->bufptr32h = port->hwcfg.BARLocation +
 880                (4 * sizeof(u32)) +
 881                (sizeof(u32) * port->hwcfg.buffercount);
 882        port->bufptr64 = port->hwcfg.BARLocation +
 883                (4 * sizeof(u32)) +
 884                (sizeof(u32) * port->hwcfg.buffercount);
 885        dprintk(DBGLVL_API, "   = port->hwcfg.BARLocation = 0x%x\n",
 886                port->hwcfg.BARLocation);
 887
 888        dprintk(DBGLVL_API, "   = VS_FORMAT_MPEGTS (becomes dev->ts[%d])\n",
 889                port->nr);
 890
 891        return 0;
 892}
 893
 894int saa7164_api_configure_port_mpeg2ps(struct saa7164_dev *dev,
 895        struct saa7164_port *port,
 896        struct tmComResPSFormatDescrHeader *fmt)
 897{
 898        dprintk(DBGLVL_API, "    bFormatIndex = 0x%x\n", fmt->bFormatIndex);
 899        dprintk(DBGLVL_API, "    wPacketLength= 0x%x\n", fmt->wPacketLength);
 900        dprintk(DBGLVL_API, "    wPackLength=   0x%x\n", fmt->wPackLength);
 901        dprintk(DBGLVL_API, "    bPackDataType= 0x%x\n", fmt->bPackDataType);
 902
 903        /* Cache the hardware configuration in the port */
 904        /* TODO: CHECK THIS in the port config */
 905        port->bufcounter = port->hwcfg.BARLocation;
 906        port->pitch = port->hwcfg.BARLocation + (2 * sizeof(u32));
 907        port->bufsize = port->hwcfg.BARLocation + (3 * sizeof(u32));
 908        port->bufoffset = port->hwcfg.BARLocation + (4 * sizeof(u32));
 909        port->bufptr32l = port->hwcfg.BARLocation +
 910                (4 * sizeof(u32)) +
 911                (sizeof(u32) * port->hwcfg.buffercount) + sizeof(u32);
 912        port->bufptr32h = port->hwcfg.BARLocation +
 913                (4 * sizeof(u32)) +
 914                (sizeof(u32) * port->hwcfg.buffercount);
 915        port->bufptr64 = port->hwcfg.BARLocation +
 916                (4 * sizeof(u32)) +
 917                (sizeof(u32) * port->hwcfg.buffercount);
 918        dprintk(DBGLVL_API, "   = port->hwcfg.BARLocation = 0x%x\n",
 919                port->hwcfg.BARLocation);
 920
 921        dprintk(DBGLVL_API, "   = VS_FORMAT_MPEGPS (becomes dev->enc[%d])\n",
 922                port->nr);
 923
 924        return 0;
 925}
 926
 927int saa7164_api_dump_subdevs(struct saa7164_dev *dev, u8 *buf, int len)
 928{
 929        struct saa7164_port *tsport = 0;
 930        struct saa7164_port *encport = 0;
 931        struct saa7164_port *vbiport = 0;
 932        u32 idx, next_offset;
 933        int i;
 934        struct tmComResDescrHeader *hdr, *t;
 935        struct tmComResExtDevDescrHeader *exthdr;
 936        struct tmComResPathDescrHeader *pathhdr;
 937        struct tmComResAntTermDescrHeader *anttermhdr;
 938        struct tmComResTunerDescrHeader *tunerunithdr;
 939        struct tmComResDMATermDescrHeader *vcoutputtermhdr;
 940        struct tmComResTSFormatDescrHeader *tsfmt;
 941        struct tmComResPSFormatDescrHeader *psfmt;
 942        struct tmComResSelDescrHeader *psel;
 943        struct tmComResProcDescrHeader *pdh;
 944        struct tmComResAFeatureDescrHeader *afd;
 945        struct tmComResEncoderDescrHeader *edh;
 946        struct tmComResVBIFormatDescrHeader *vbifmt;
 947        u32 currpath = 0;
 948
 949        dprintk(DBGLVL_API,
 950                "%s(?,?,%d) sizeof(struct tmComResDescrHeader) = %d bytes\n",
 951                __func__, len, (u32)sizeof(struct tmComResDescrHeader));
 952
 953        for (idx = 0; idx < (len - sizeof(struct tmComResDescrHeader));) {
 954
 955                hdr = (struct tmComResDescrHeader *)(buf + idx);
 956
 957                if (hdr->type != CS_INTERFACE)
 958                        return SAA_ERR_NOT_SUPPORTED;
 959
 960                dprintk(DBGLVL_API, "@ 0x%x =\n", idx);
 961                switch (hdr->subtype) {
 962                case GENERAL_REQUEST:
 963                        dprintk(DBGLVL_API, " GENERAL_REQUEST\n");
 964                        break;
 965                case VC_TUNER_PATH:
 966                        dprintk(DBGLVL_API, " VC_TUNER_PATH\n");
 967                        pathhdr = (struct tmComResPathDescrHeader *)(buf + idx);
 968                        dprintk(DBGLVL_API, "  pathid = 0x%x\n",
 969                                pathhdr->pathid);
 970                        currpath = pathhdr->pathid;
 971                        break;
 972                case VC_INPUT_TERMINAL:
 973                        dprintk(DBGLVL_API, " VC_INPUT_TERMINAL\n");
 974                        anttermhdr =
 975                                (struct tmComResAntTermDescrHeader *)(buf + idx);
 976                        dprintk(DBGLVL_API, "  terminalid   = 0x%x\n",
 977                                anttermhdr->terminalid);
 978                        dprintk(DBGLVL_API, "  terminaltype = 0x%x\n",
 979                                anttermhdr->terminaltype);
 980                        switch (anttermhdr->terminaltype) {
 981                        case ITT_ANTENNA:
 982                                dprintk(DBGLVL_API, "   = ITT_ANTENNA\n");
 983                                break;
 984                        case LINE_CONNECTOR:
 985                                dprintk(DBGLVL_API, "   = LINE_CONNECTOR\n");
 986                                break;
 987                        case SPDIF_CONNECTOR:
 988                                dprintk(DBGLVL_API, "   = SPDIF_CONNECTOR\n");
 989                                break;
 990                        case COMPOSITE_CONNECTOR:
 991                                dprintk(DBGLVL_API,
 992                                        "   = COMPOSITE_CONNECTOR\n");
 993                                break;
 994                        case SVIDEO_CONNECTOR:
 995                                dprintk(DBGLVL_API, "   = SVIDEO_CONNECTOR\n");
 996                                break;
 997                        case COMPONENT_CONNECTOR:
 998                                dprintk(DBGLVL_API,
 999                                        "   = COMPONENT_CONNECTOR\n");
1000                                break;
1001                        case STANDARD_DMA:
1002                                dprintk(DBGLVL_API, "   = STANDARD_DMA\n");
1003                                break;
1004                        default:
1005                                dprintk(DBGLVL_API, "   = undefined (0x%x)\n",
1006                                        anttermhdr->terminaltype);
1007                        }
1008                        dprintk(DBGLVL_API, "  assocterminal= 0x%x\n",
1009                                anttermhdr->assocterminal);
1010                        dprintk(DBGLVL_API, "  iterminal    = 0x%x\n",
1011                                anttermhdr->iterminal);
1012                        dprintk(DBGLVL_API, "  controlsize  = 0x%x\n",
1013                                anttermhdr->controlsize);
1014                        break;
1015                case VC_OUTPUT_TERMINAL:
1016                        dprintk(DBGLVL_API, " VC_OUTPUT_TERMINAL\n");
1017                        vcoutputtermhdr =
1018                                (struct tmComResDMATermDescrHeader *)(buf + idx);
1019                        dprintk(DBGLVL_API, "  unitid = 0x%x\n",
1020                                vcoutputtermhdr->unitid);
1021                        dprintk(DBGLVL_API, "  terminaltype = 0x%x\n",
1022                                vcoutputtermhdr->terminaltype);
1023                        switch (vcoutputtermhdr->terminaltype) {
1024                        case ITT_ANTENNA:
1025                                dprintk(DBGLVL_API, "   = ITT_ANTENNA\n");
1026                                break;
1027                        case LINE_CONNECTOR:
1028                                dprintk(DBGLVL_API, "   = LINE_CONNECTOR\n");
1029                                break;
1030                        case SPDIF_CONNECTOR:
1031                                dprintk(DBGLVL_API, "   = SPDIF_CONNECTOR\n");
1032                                break;
1033                        case COMPOSITE_CONNECTOR:
1034                                dprintk(DBGLVL_API,
1035                                        "   = COMPOSITE_CONNECTOR\n");
1036                                break;
1037                        case SVIDEO_CONNECTOR:
1038                                dprintk(DBGLVL_API, "   = SVIDEO_CONNECTOR\n");
1039                                break;
1040                        case COMPONENT_CONNECTOR:
1041                                dprintk(DBGLVL_API,
1042                                        "   = COMPONENT_CONNECTOR\n");
1043                                break;
1044                        case STANDARD_DMA:
1045                                dprintk(DBGLVL_API, "   = STANDARD_DMA\n");
1046                                break;
1047                        default:
1048                                dprintk(DBGLVL_API, "   = undefined (0x%x)\n",
1049                                        vcoutputtermhdr->terminaltype);
1050                        }
1051                        dprintk(DBGLVL_API, "  assocterminal= 0x%x\n",
1052                                vcoutputtermhdr->assocterminal);
1053                        dprintk(DBGLVL_API, "  sourceid     = 0x%x\n",
1054                                vcoutputtermhdr->sourceid);
1055                        dprintk(DBGLVL_API, "  iterminal    = 0x%x\n",
1056                                vcoutputtermhdr->iterminal);
1057                        dprintk(DBGLVL_API, "  BARLocation  = 0x%x\n",
1058                                vcoutputtermhdr->BARLocation);
1059                        dprintk(DBGLVL_API, "  flags        = 0x%x\n",
1060                                vcoutputtermhdr->flags);
1061                        dprintk(DBGLVL_API, "  interruptid  = 0x%x\n",
1062                                vcoutputtermhdr->interruptid);
1063                        dprintk(DBGLVL_API, "  buffercount  = 0x%x\n",
1064                                vcoutputtermhdr->buffercount);
1065                        dprintk(DBGLVL_API, "  metadatasize = 0x%x\n",
1066                                vcoutputtermhdr->metadatasize);
1067                        dprintk(DBGLVL_API, "  controlsize  = 0x%x\n",
1068                                vcoutputtermhdr->controlsize);
1069                        dprintk(DBGLVL_API, "  numformats   = 0x%x\n",
1070                                vcoutputtermhdr->numformats);
1071
1072                        t = (struct tmComResDescrHeader *)
1073                                ((struct tmComResDMATermDescrHeader *)(buf + idx));
1074                        next_offset = idx + (vcoutputtermhdr->len);
1075                        for (i = 0; i < vcoutputtermhdr->numformats; i++) {
1076                                t = (struct tmComResDescrHeader *)
1077                                        (buf + next_offset);
1078                                switch (t->subtype) {
1079                                case VS_FORMAT_MPEG2TS:
1080                                        tsfmt =
1081                                        (struct tmComResTSFormatDescrHeader *)t;
1082                                        if (currpath == 1)
1083                                                tsport = &dev->ports[SAA7164_PORT_TS1];
1084                                        else
1085                                                tsport = &dev->ports[SAA7164_PORT_TS2];
1086                                        memcpy(&tsport->hwcfg, vcoutputtermhdr,
1087                                                sizeof(*vcoutputtermhdr));
1088                                        saa7164_api_configure_port_mpeg2ts(dev,
1089                                                tsport, tsfmt);
1090                                        break;
1091                                case VS_FORMAT_MPEG2PS:
1092                                        psfmt =
1093                                        (struct tmComResPSFormatDescrHeader *)t;
1094                                        if (currpath == 1)
1095                                                encport = &dev->ports[SAA7164_PORT_ENC1];
1096                                        else
1097                                                encport = &dev->ports[SAA7164_PORT_ENC2];
1098                                        memcpy(&encport->hwcfg, vcoutputtermhdr,
1099                                                sizeof(*vcoutputtermhdr));
1100                                        saa7164_api_configure_port_mpeg2ps(dev,
1101                                                encport, psfmt);
1102                                        break;
1103                                case VS_FORMAT_VBI:
1104                                        vbifmt =
1105                                        (struct tmComResVBIFormatDescrHeader *)t;
1106                                        if (currpath == 1)
1107                                                vbiport = &dev->ports[SAA7164_PORT_VBI1];
1108                                        else
1109                                                vbiport = &dev->ports[SAA7164_PORT_VBI2];
1110                                        memcpy(&vbiport->hwcfg, vcoutputtermhdr,
1111                                                sizeof(*vcoutputtermhdr));
1112                                        memcpy(&vbiport->vbi_fmt_ntsc, vbifmt,
1113                                                sizeof(*vbifmt));
1114                                        saa7164_api_configure_port_vbi(dev,
1115                                                vbiport);
1116                                        break;
1117                                case VS_FORMAT_RDS:
1118                                        dprintk(DBGLVL_API,
1119                                                "   = VS_FORMAT_RDS\n");
1120                                        break;
1121                                case VS_FORMAT_UNCOMPRESSED:
1122                                        dprintk(DBGLVL_API,
1123                                        "   = VS_FORMAT_UNCOMPRESSED\n");
1124                                        break;
1125                                case VS_FORMAT_TYPE:
1126                                        dprintk(DBGLVL_API,
1127                                                "   = VS_FORMAT_TYPE\n");
1128                                        break;
1129                                default:
1130                                        dprintk(DBGLVL_API,
1131                                                "   = undefined (0x%x)\n",
1132                                                t->subtype);
1133                                }
1134                                next_offset += t->len;
1135                        }
1136
1137                        break;
1138                case TUNER_UNIT:
1139                        dprintk(DBGLVL_API, " TUNER_UNIT\n");
1140                        tunerunithdr =
1141                                (struct tmComResTunerDescrHeader *)(buf + idx);
1142                        dprintk(DBGLVL_API, "  unitid = 0x%x\n",
1143                                tunerunithdr->unitid);
1144                        dprintk(DBGLVL_API, "  sourceid = 0x%x\n",
1145                                tunerunithdr->sourceid);
1146                        dprintk(DBGLVL_API, "  iunit = 0x%x\n",
1147                                tunerunithdr->iunit);
1148                        dprintk(DBGLVL_API, "  tuningstandards = 0x%x\n",
1149                                tunerunithdr->tuningstandards);
1150                        dprintk(DBGLVL_API, "  controlsize = 0x%x\n",
1151                                tunerunithdr->controlsize);
1152                        dprintk(DBGLVL_API, "  controls = 0x%x\n",
1153                                tunerunithdr->controls);
1154
1155                        if (tunerunithdr->unitid == tunerunithdr->iunit) {
1156                                if (currpath == 1)
1157                                        encport = &dev->ports[SAA7164_PORT_ENC1];
1158                                else
1159                                        encport = &dev->ports[SAA7164_PORT_ENC2];
1160                                memcpy(&encport->tunerunit, tunerunithdr,
1161                                        sizeof(struct tmComResTunerDescrHeader));
1162                                dprintk(DBGLVL_API,
1163                                        "  (becomes dev->enc[%d] tuner)\n",
1164                                        encport->nr);
1165                        }
1166                        break;
1167                case VC_SELECTOR_UNIT:
1168                        psel = (struct tmComResSelDescrHeader *)(buf + idx);
1169                        dprintk(DBGLVL_API, " VC_SELECTOR_UNIT\n");
1170                        dprintk(DBGLVL_API, "  unitid = 0x%x\n",
1171                                psel->unitid);
1172                        dprintk(DBGLVL_API, "  nrinpins = 0x%x\n",
1173                                psel->nrinpins);
1174                        dprintk(DBGLVL_API, "  sourceid = 0x%x\n",
1175                                psel->sourceid);
1176                        break;
1177                case VC_PROCESSING_UNIT:
1178                        pdh = (struct tmComResProcDescrHeader *)(buf + idx);
1179                        dprintk(DBGLVL_API, " VC_PROCESSING_UNIT\n");
1180                        dprintk(DBGLVL_API, "  unitid = 0x%x\n",
1181                                pdh->unitid);
1182                        dprintk(DBGLVL_API, "  sourceid = 0x%x\n",
1183                                pdh->sourceid);
1184                        dprintk(DBGLVL_API, "  controlsize = 0x%x\n",
1185                                pdh->controlsize);
1186                        if (pdh->controlsize == 0x04) {
1187                                if (currpath == 1)
1188                                        encport = &dev->ports[SAA7164_PORT_ENC1];
1189                                else
1190                                        encport = &dev->ports[SAA7164_PORT_ENC2];
1191                                memcpy(&encport->vidproc, pdh,
1192                                        sizeof(struct tmComResProcDescrHeader));
1193                                dprintk(DBGLVL_API, "  (becomes dev->enc[%d])\n",
1194                                        encport->nr);
1195                        }
1196                        break;
1197                case FEATURE_UNIT:
1198                        afd = (struct tmComResAFeatureDescrHeader *)(buf + idx);
1199                        dprintk(DBGLVL_API, " FEATURE_UNIT\n");
1200                        dprintk(DBGLVL_API, "  unitid = 0x%x\n",
1201                                afd->unitid);
1202                        dprintk(DBGLVL_API, "  sourceid = 0x%x\n",
1203                                afd->sourceid);
1204                        dprintk(DBGLVL_API, "  controlsize = 0x%x\n",
1205                                afd->controlsize);
1206                        if (currpath == 1)
1207                                encport = &dev->ports[SAA7164_PORT_ENC1];
1208                        else
1209                                encport = &dev->ports[SAA7164_PORT_ENC2];
1210                        memcpy(&encport->audfeat, afd,
1211                                sizeof(struct tmComResAFeatureDescrHeader));
1212                        dprintk(DBGLVL_API, "  (becomes dev->enc[%d])\n",
1213                                encport->nr);
1214                        break;
1215                case ENCODER_UNIT:
1216                        edh = (struct tmComResEncoderDescrHeader *)(buf + idx);
1217                        dprintk(DBGLVL_API, " ENCODER_UNIT\n");
1218                        dprintk(DBGLVL_API, "  subtype = 0x%x\n", edh->subtype);
1219                        dprintk(DBGLVL_API, "  unitid = 0x%x\n", edh->unitid);
1220                        dprintk(DBGLVL_API, "  vsourceid = 0x%x\n",
1221                        edh->vsourceid);
1222                        dprintk(DBGLVL_API, "  asourceid = 0x%x\n",
1223                                edh->asourceid);
1224                        dprintk(DBGLVL_API, "  iunit = 0x%x\n", edh->iunit);
1225                        if (edh->iunit == edh->unitid) {
1226                                if (currpath == 1)
1227                                        encport = &dev->ports[SAA7164_PORT_ENC1];
1228                                else
1229                                        encport = &dev->ports[SAA7164_PORT_ENC2];
1230                                memcpy(&encport->encunit, edh,
1231                                        sizeof(struct tmComResEncoderDescrHeader));
1232                                dprintk(DBGLVL_API,
1233                                        "  (becomes dev->enc[%d])\n",
1234                                        encport->nr);
1235                        }
1236                        break;
1237                case EXTENSION_UNIT:
1238                        dprintk(DBGLVL_API, " EXTENSION_UNIT\n");
1239                        exthdr = (struct tmComResExtDevDescrHeader *)(buf + idx);
1240                        dprintk(DBGLVL_API, "  unitid = 0x%x\n",
1241                                exthdr->unitid);
1242                        dprintk(DBGLVL_API, "  deviceid = 0x%x\n",
1243                                exthdr->deviceid);
1244                        dprintk(DBGLVL_API, "  devicetype = 0x%x\n",
1245                                exthdr->devicetype);
1246                        if (exthdr->devicetype & 0x1)
1247                                dprintk(DBGLVL_API, "   = Decoder Device\n");
1248                        if (exthdr->devicetype & 0x2)
1249                                dprintk(DBGLVL_API, "   = GPIO Source\n");
1250                        if (exthdr->devicetype & 0x4)
1251                                dprintk(DBGLVL_API, "   = Video Decoder\n");
1252                        if (exthdr->devicetype & 0x8)
1253                                dprintk(DBGLVL_API, "   = Audio Decoder\n");
1254                        if (exthdr->devicetype & 0x20)
1255                                dprintk(DBGLVL_API, "   = Crossbar\n");
1256                        if (exthdr->devicetype & 0x40)
1257                                dprintk(DBGLVL_API, "   = Tuner\n");
1258                        if (exthdr->devicetype & 0x80)
1259                                dprintk(DBGLVL_API, "   = IF PLL\n");
1260                        if (exthdr->devicetype & 0x100)
1261                                dprintk(DBGLVL_API, "   = Demodulator\n");
1262                        if (exthdr->devicetype & 0x200)
1263                                dprintk(DBGLVL_API, "   = RDS Decoder\n");
1264                        if (exthdr->devicetype & 0x400)
1265                                dprintk(DBGLVL_API, "   = Encoder\n");
1266                        if (exthdr->devicetype & 0x800)
1267                                dprintk(DBGLVL_API, "   = IR Decoder\n");
1268                        if (exthdr->devicetype & 0x1000)
1269                                dprintk(DBGLVL_API, "   = EEPROM\n");
1270                        if (exthdr->devicetype & 0x2000)
1271                                dprintk(DBGLVL_API,
1272                                        "   = VBI Decoder\n");
1273                        if (exthdr->devicetype & 0x10000)
1274                                dprintk(DBGLVL_API,
1275                                        "   = Streaming Device\n");
1276                        if (exthdr->devicetype & 0x20000)
1277                                dprintk(DBGLVL_API,
1278                                        "   = DRM Device\n");
1279                        if (exthdr->devicetype & 0x40000000)
1280                                dprintk(DBGLVL_API,
1281                                        "   = Generic Device\n");
1282                        if (exthdr->devicetype & 0x80000000)
1283                                dprintk(DBGLVL_API,
1284                                        "   = Config Space Device\n");
1285                        dprintk(DBGLVL_API, "  numgpiopins = 0x%x\n",
1286                                exthdr->numgpiopins);
1287                        dprintk(DBGLVL_API, "  numgpiogroups = 0x%x\n",
1288                                exthdr->numgpiogroups);
1289                        dprintk(DBGLVL_API, "  controlsize = 0x%x\n",
1290                                exthdr->controlsize);
1291                        if (exthdr->devicetype & 0x80) {
1292                                if (currpath == 1)
1293                                        encport = &dev->ports[SAA7164_PORT_ENC1];
1294                                else
1295                                        encport = &dev->ports[SAA7164_PORT_ENC2];
1296                                memcpy(&encport->ifunit, exthdr,
1297                                        sizeof(struct tmComResExtDevDescrHeader));
1298                                dprintk(DBGLVL_API,
1299                                        "  (becomes dev->enc[%d])\n",
1300                                        encport->nr);
1301                        }
1302                        break;
1303                case PVC_INFRARED_UNIT:
1304                        dprintk(DBGLVL_API, " PVC_INFRARED_UNIT\n");
1305                        break;
1306                case DRM_UNIT:
1307                        dprintk(DBGLVL_API, " DRM_UNIT\n");
1308                        break;
1309                default:
1310                        dprintk(DBGLVL_API, "default %d\n", hdr->subtype);
1311                }
1312
1313                dprintk(DBGLVL_API, " 1.%x\n", hdr->len);
1314                dprintk(DBGLVL_API, " 2.%x\n", hdr->type);
1315                dprintk(DBGLVL_API, " 3.%x\n", hdr->subtype);
1316                dprintk(DBGLVL_API, " 4.%x\n", hdr->unitid);
1317
1318                idx += hdr->len;
1319        }
1320
1321        return 0;
1322}
1323
1324int saa7164_api_enum_subdevs(struct saa7164_dev *dev)
1325{
1326        int ret;
1327        u32 buflen = 0;
1328        u8 *buf;
1329
1330        dprintk(DBGLVL_API, "%s()\n", __func__);
1331
1332        /* Get the total descriptor length */
1333        ret = saa7164_cmd_send(dev, 0, GET_LEN,
1334                GET_DESCRIPTORS_CONTROL, sizeof(buflen), &buflen);
1335        if (ret != SAA_OK)
1336                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
1337
1338        dprintk(DBGLVL_API, "%s() total descriptor size = %d bytes.\n",
1339                __func__, buflen);
1340
1341        /* Allocate enough storage for all of the descs */
1342        buf = kzalloc(buflen, GFP_KERNEL);
1343        if (buf == NULL)
1344                return SAA_ERR_NO_RESOURCES;
1345
1346        /* Retrieve them */
1347        ret = saa7164_cmd_send(dev, 0, GET_CUR,
1348                GET_DESCRIPTORS_CONTROL, buflen, buf);
1349        if (ret != SAA_OK) {
1350                printk(KERN_ERR "%s() error, ret = 0x%x\n", __func__, ret);
1351                goto out;
1352        }
1353
1354        if (saa_debug & DBGLVL_API)
1355                saa7164_dumphex16(dev, buf, (buflen/16)*16);
1356
1357        saa7164_api_dump_subdevs(dev, buf, buflen);
1358
1359out:
1360        kfree(buf);
1361        return ret;
1362}
1363
1364int saa7164_api_i2c_read(struct saa7164_i2c *bus, u8 addr, u32 reglen, u8 *reg,
1365        u32 datalen, u8 *data)
1366{
1367        struct saa7164_dev *dev = bus->dev;
1368        u16 len = 0;
1369        int unitid;
1370        u32 regval;
1371        u8 buf[256];
1372        int ret;
1373
1374        dprintk(DBGLVL_API, "%s()\n", __func__);
1375
1376        if (reglen > 4)
1377                return -EIO;
1378
1379        if (reglen == 1)
1380                regval = *(reg);
1381        else
1382        if (reglen == 2)
1383                regval = ((*(reg) << 8) || *(reg+1));
1384        else
1385        if (reglen == 3)
1386                regval = ((*(reg) << 16) | (*(reg+1) << 8) | *(reg+2));
1387        else
1388        if (reglen == 4)
1389                regval = ((*(reg) << 24) | (*(reg+1) << 16) |
1390                        (*(reg+2) << 8) | *(reg+3));
1391
1392        /* Prepare the send buffer */
1393        /* Bytes 00-03 source register length
1394         *       04-07 source bytes to read
1395         *       08... register address
1396         */
1397        memset(buf, 0, sizeof(buf));
1398        memcpy((buf + 2 * sizeof(u32) + 0), reg, reglen);
1399        *((u32 *)(buf + 0 * sizeof(u32))) = reglen;
1400        *((u32 *)(buf + 1 * sizeof(u32))) = datalen;
1401
1402        unitid = saa7164_i2caddr_to_unitid(bus, addr);
1403        if (unitid < 0) {
1404                printk(KERN_ERR
1405                        "%s() error, cannot translate regaddr 0x%x to unitid\n",
1406                        __func__, addr);
1407                return -EIO;
1408        }
1409
1410        ret = saa7164_cmd_send(bus->dev, unitid, GET_LEN,
1411                EXU_REGISTER_ACCESS_CONTROL, sizeof(len), &len);
1412        if (ret != SAA_OK) {
1413                printk(KERN_ERR "%s() error, ret(1) = 0x%x\n", __func__, ret);
1414                return -EIO;
1415        }
1416
1417        dprintk(DBGLVL_API, "%s() len = %d bytes\n", __func__, len);
1418
1419        if (saa_debug & DBGLVL_I2C)
1420                saa7164_dumphex16(dev, buf, 2 * 16);
1421
1422        ret = saa7164_cmd_send(bus->dev, unitid, GET_CUR,
1423                EXU_REGISTER_ACCESS_CONTROL, len, &buf);
1424        if (ret != SAA_OK)
1425                printk(KERN_ERR "%s() error, ret(2) = 0x%x\n", __func__, ret);
1426        else {
1427                if (saa_debug & DBGLVL_I2C)
1428                        saa7164_dumphex16(dev, buf, sizeof(buf));
1429                memcpy(data, (buf + 2 * sizeof(u32) + reglen), datalen);
1430        }
1431
1432        return ret == SAA_OK ? 0 : -EIO;
1433}
1434
1435/* For a given 8 bit i2c address device, write the buffer */
1436int saa7164_api_i2c_write(struct saa7164_i2c *bus, u8 addr, u32 datalen,
1437        u8 *data)
1438{
1439        struct saa7164_dev *dev = bus->dev;
1440        u16 len = 0;
1441        int unitid;
1442        int reglen;
1443        u8 buf[256];
1444        int ret;
1445
1446        dprintk(DBGLVL_API, "%s()\n", __func__);
1447
1448        if ((datalen == 0) || (datalen > 232))
1449                return -EIO;
1450
1451        memset(buf, 0, sizeof(buf));
1452
1453        unitid = saa7164_i2caddr_to_unitid(bus, addr);
1454        if (unitid < 0) {
1455                printk(KERN_ERR
1456                        "%s() error, cannot translate regaddr 0x%x to unitid\n",
1457                        __func__, addr);
1458                return -EIO;
1459        }
1460
1461        reglen = saa7164_i2caddr_to_reglen(bus, addr);
1462        if (reglen < 0) {
1463                printk(KERN_ERR
1464                        "%s() error, cannot translate regaddr to reglen\n",
1465                        __func__);
1466                return -EIO;
1467        }
1468
1469        ret = saa7164_cmd_send(bus->dev, unitid, GET_LEN,
1470                EXU_REGISTER_ACCESS_CONTROL, sizeof(len), &len);
1471        if (ret != SAA_OK) {
1472                printk(KERN_ERR "%s() error, ret(1) = 0x%x\n", __func__, ret);
1473                return -EIO;
1474        }
1475
1476        dprintk(DBGLVL_API, "%s() len = %d bytes\n", __func__, len);
1477
1478        /* Prepare the send buffer */
1479        /* Bytes 00-03 dest register length
1480         *       04-07 dest bytes to write
1481         *       08... register address
1482         */
1483        *((u32 *)(buf + 0 * sizeof(u32))) = reglen;
1484        *((u32 *)(buf + 1 * sizeof(u32))) = datalen - reglen;
1485        memcpy((buf + 2 * sizeof(u32)), data, datalen);
1486
1487        if (saa_debug & DBGLVL_I2C)
1488                saa7164_dumphex16(dev, buf, sizeof(buf));
1489
1490        ret = saa7164_cmd_send(bus->dev, unitid, SET_CUR,
1491                EXU_REGISTER_ACCESS_CONTROL, len, &buf);
1492        if (ret != SAA_OK)
1493                printk(KERN_ERR "%s() error, ret(2) = 0x%x\n", __func__, ret);
1494
1495        return ret == SAA_OK ? 0 : -EIO;
1496}
1497
1498int saa7164_api_modify_gpio(struct saa7164_dev *dev, u8 unitid,
1499        u8 pin, u8 state)
1500{
1501        int ret;
1502        struct tmComResGPIO t;
1503
1504        dprintk(DBGLVL_API, "%s(0x%x, %d, %d)\n",
1505                __func__, unitid, pin, state);
1506
1507        if ((pin > 7) || (state > 2))
1508                return SAA_ERR_BAD_PARAMETER;
1509
1510        t.pin = pin;
1511        t.state = state;
1512
1513        ret = saa7164_cmd_send(dev, unitid, SET_CUR,
1514                EXU_GPIO_CONTROL, sizeof(t), &t);
1515        if (ret != SAA_OK)
1516                printk(KERN_ERR "%s() error, ret = 0x%x\n",
1517                        __func__, ret);
1518
1519        return ret;
1520}
1521
1522int saa7164_api_set_gpiobit(struct saa7164_dev *dev, u8 unitid,
1523        u8 pin)
1524{
1525        return saa7164_api_modify_gpio(dev, unitid, pin, 1);
1526}
1527
1528int saa7164_api_clear_gpiobit(struct saa7164_dev *dev, u8 unitid,
1529        u8 pin)
1530{
1531        return saa7164_api_modify_gpio(dev, unitid, pin, 0);
1532}
1533
1534