root/drivers/media/dvb-frontends/drx39xyj/drxj.c

/* [<][>][^][v][top][bottom][index][help] */

DEFINITIONS

This source file includes following definitions.
  1. frac28
  2. log1_times100
  3. frac_times1e6
  4. is_handled_by_aud_tr_if
  5. drxbsp_i2c_write_read
  6. drxdap_fasi_read_block
  7. drxdap_fasi_read_reg16
  8. drxdap_fasi_read_reg32
  9. drxdap_fasi_write_block
  10. drxdap_fasi_write_reg16
  11. drxdap_fasi_read_modify_write_reg16
  12. drxdap_fasi_write_reg32
  13. drxj_dap_rm_write_reg16short
  14. drxj_dap_read_modify_write_reg16
  15. drxj_dap_read_aud_reg16
  16. drxj_dap_read_reg16
  17. drxj_dap_write_aud_reg16
  18. drxj_dap_write_reg16
  19. drxj_dap_atomic_read_write_block
  20. drxj_dap_atomic_read_reg32
  21. hi_cfg_command
  22. hi_command
  23. init_hi
  24. get_device_capabilities
  25. power_up_device
  26. ctrl_set_cfg_mpeg_output
  27. set_mpegtei_handling
  28. bit_reverse_mpeg_output
  29. set_mpeg_start_width
  30. ctrl_set_uio_cfg
  31. ctrl_uio_write
  32. ctrl_i2c_bridge
  33. smart_ant_init
  34. scu_command
  35. drxj_dap_scu_atomic_read_write_block
  36. drxj_dap_scu_atomic_read_reg16
  37. drxj_dap_scu_atomic_write_reg16
  38. adc_sync_measurement
  39. adc_synchronization
  40. init_agc
  41. set_frequency
  42. get_acc_pkt_err
  43. set_agc_rf
  44. set_agc_if
  45. set_iqm_af
  46. power_down_vsb
  47. set_vsb_leak_n_gain
  48. set_vsb
  49. get_vsb_post_rs_pck_err
  50. get_vs_bpost_viterbi_ber
  51. get_vs_bpre_viterbi_ber
  52. get_vsbmer
  53. power_down_qam
  54. set_qam_measurement
  55. set_qam16
  56. set_qam32
  57. set_qam64
  58. set_qam128
  59. set_qam256
  60. set_qam
  61. qam_flip_spec
  62. qam64auto
  63. qam256auto
  64. set_qam_channel
  65. get_qamrs_err_count
  66. get_sig_strength
  67. ctrl_get_qam_sig_quality
  68. power_down_atv
  69. power_down_aud
  70. set_orx_nsu_aox
  71. ctrl_set_oob
  72. ctrl_set_channel
  73. ctrl_sig_quality
  74. ctrl_lock_status
  75. ctrl_set_standard
  76. drxj_reset_mode
  77. ctrl_power_mode
  78. ctrl_set_cfg_pre_saw
  79. ctrl_set_cfg_afe_gain
  80. drxj_open
  81. drxj_close
  82. drx_u_code_compute_crc
  83. drx_check_firmware
  84. drx_ctrl_u_code
  85. drxj_set_lna_state
  86. drx39xxj_set_powerstate
  87. drx39xxj_read_status
  88. drx39xxj_read_ber
  89. drx39xxj_read_signal_strength
  90. drx39xxj_read_snr
  91. drx39xxj_read_ucblocks
  92. drx39xxj_set_frontend
  93. drx39xxj_sleep
  94. drx39xxj_i2c_gate_ctrl
  95. drx39xxj_init
  96. drx39xxj_set_lna
  97. drx39xxj_get_tune_settings
  98. drx39xxj_release
  99. drx39xxj_attach

   1 /*
   2   Copyright (c), 2004-2005,2007-2010 Trident Microsystems, Inc.
   3   All rights reserved.
   4 
   5   Redistribution and use in source and binary forms, with or without
   6   modification, are permitted provided that the following conditions are met:
   7 
   8   * Redistributions of source code must retain the above copyright notice,
   9     this list of conditions and the following disclaimer.
  10   * Redistributions in binary form must reproduce the above copyright notice,
  11     this list of conditions and the following disclaimer in the documentation
  12         and/or other materials provided with the distribution.
  13   * Neither the name of Trident Microsystems nor Hauppauge Computer Works
  14     nor the names of its contributors may be used to endorse or promote
  15         products derived from this software without specific prior written
  16         permission.
  17 
  18   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  19   AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  20   IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  21   ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
  22   LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  23   CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  24   SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  25   INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  26   CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  27   ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  28   POSSIBILITY OF SUCH DAMAGE.
  29 
  30   DRXJ specific implementation of DRX driver
  31   authors: Dragan Savic, Milos Nikolic, Mihajlo Katona, Tao Ding, Paul Janssen
  32 
  33   The Linux DVB Driver for Micronas DRX39xx family (drx3933j) was
  34   written by Devin Heitmueller <devin.heitmueller@kernellabs.com>
  35 
  36   This program is free software; you can redistribute it and/or modify
  37   it under the terms of the GNU General Public License as published by
  38   the Free Software Foundation; either version 2 of the License, or
  39   (at your option) any later version.
  40 
  41   This program is distributed in the hope that it will be useful,
  42   but WITHOUT ANY WARRANTY; without even the implied warranty of
  43   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  44 
  45   GNU General Public License for more details.
  46 
  47   You should have received a copy of the GNU General Public License
  48   along with this program; if not, write to the Free Software
  49   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  50 */
  51 
  52 /*-----------------------------------------------------------------------------
  53 INCLUDE FILES
  54 ----------------------------------------------------------------------------*/
  55 
  56 #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
  57 
  58 #include <linux/module.h>
  59 #include <linux/init.h>
  60 #include <linux/string.h>
  61 #include <linux/slab.h>
  62 #include <asm/div64.h>
  63 
  64 #include <media/dvb_frontend.h>
  65 #include "drx39xxj.h"
  66 
  67 #include "drxj.h"
  68 #include "drxj_map.h"
  69 
  70 /*============================================================================*/
  71 /*=== DEFINES ================================================================*/
  72 /*============================================================================*/
  73 
  74 #define DRX39XX_MAIN_FIRMWARE "dvb-fe-drxj-mc-1.0.8.fw"
  75 
  76 /*
  77 * \brief Maximum u32 value.
  78 */
  79 #ifndef MAX_U32
  80 #define MAX_U32  ((u32) (0xFFFFFFFFL))
  81 #endif
  82 
  83 /* Customer configurable hardware settings, etc */
  84 #ifndef MPEG_SERIAL_OUTPUT_PIN_DRIVE_STRENGTH
  85 #define MPEG_SERIAL_OUTPUT_PIN_DRIVE_STRENGTH 0x02
  86 #endif
  87 
  88 #ifndef MPEG_PARALLEL_OUTPUT_PIN_DRIVE_STRENGTH
  89 #define MPEG_PARALLEL_OUTPUT_PIN_DRIVE_STRENGTH 0x02
  90 #endif
  91 
  92 #ifndef MPEG_OUTPUT_CLK_DRIVE_STRENGTH
  93 #define MPEG_OUTPUT_CLK_DRIVE_STRENGTH 0x06
  94 #endif
  95 
  96 #ifndef OOB_CRX_DRIVE_STRENGTH
  97 #define OOB_CRX_DRIVE_STRENGTH 0x02
  98 #endif
  99 
 100 #ifndef OOB_DRX_DRIVE_STRENGTH
 101 #define OOB_DRX_DRIVE_STRENGTH 0x02
 102 #endif
 103 /*** START DJCOMBO patches to DRXJ registermap constants *********************/
 104 /*** registermap 200706071303 from drxj **************************************/
 105 #define   ATV_TOP_CR_AMP_TH_FM                                              0x0
 106 #define   ATV_TOP_CR_AMP_TH_L                                               0xA
 107 #define   ATV_TOP_CR_AMP_TH_LP                                              0xA
 108 #define   ATV_TOP_CR_AMP_TH_BG                                              0x8
 109 #define   ATV_TOP_CR_AMP_TH_DK                                              0x8
 110 #define   ATV_TOP_CR_AMP_TH_I                                               0x8
 111 #define     ATV_TOP_CR_CONT_CR_D_MN                                         0x18
 112 #define     ATV_TOP_CR_CONT_CR_D_FM                                         0x0
 113 #define     ATV_TOP_CR_CONT_CR_D_L                                          0x20
 114 #define     ATV_TOP_CR_CONT_CR_D_LP                                         0x20
 115 #define     ATV_TOP_CR_CONT_CR_D_BG                                         0x18
 116 #define     ATV_TOP_CR_CONT_CR_D_DK                                         0x18
 117 #define     ATV_TOP_CR_CONT_CR_D_I                                          0x18
 118 #define     ATV_TOP_CR_CONT_CR_I_MN                                         0x80
 119 #define     ATV_TOP_CR_CONT_CR_I_FM                                         0x0
 120 #define     ATV_TOP_CR_CONT_CR_I_L                                          0x80
 121 #define     ATV_TOP_CR_CONT_CR_I_LP                                         0x80
 122 #define     ATV_TOP_CR_CONT_CR_I_BG                                         0x80
 123 #define     ATV_TOP_CR_CONT_CR_I_DK                                         0x80
 124 #define     ATV_TOP_CR_CONT_CR_I_I                                          0x80
 125 #define     ATV_TOP_CR_CONT_CR_P_MN                                         0x4
 126 #define     ATV_TOP_CR_CONT_CR_P_FM                                         0x0
 127 #define     ATV_TOP_CR_CONT_CR_P_L                                          0x4
 128 #define     ATV_TOP_CR_CONT_CR_P_LP                                         0x4
 129 #define     ATV_TOP_CR_CONT_CR_P_BG                                         0x4
 130 #define     ATV_TOP_CR_CONT_CR_P_DK                                         0x4
 131 #define     ATV_TOP_CR_CONT_CR_P_I                                          0x4
 132 #define   ATV_TOP_CR_OVM_TH_MN                                              0xA0
 133 #define   ATV_TOP_CR_OVM_TH_FM                                              0x0
 134 #define   ATV_TOP_CR_OVM_TH_L                                               0xA0
 135 #define   ATV_TOP_CR_OVM_TH_LP                                              0xA0
 136 #define   ATV_TOP_CR_OVM_TH_BG                                              0xA0
 137 #define   ATV_TOP_CR_OVM_TH_DK                                              0xA0
 138 #define   ATV_TOP_CR_OVM_TH_I                                               0xA0
 139 #define     ATV_TOP_EQU0_EQU_C0_FM                                          0x0
 140 #define     ATV_TOP_EQU0_EQU_C0_L                                           0x3
 141 #define     ATV_TOP_EQU0_EQU_C0_LP                                          0x3
 142 #define     ATV_TOP_EQU0_EQU_C0_BG                                          0x7
 143 #define     ATV_TOP_EQU0_EQU_C0_DK                                          0x0
 144 #define     ATV_TOP_EQU0_EQU_C0_I                                           0x3
 145 #define     ATV_TOP_EQU1_EQU_C1_FM                                          0x0
 146 #define     ATV_TOP_EQU1_EQU_C1_L                                           0x1F6
 147 #define     ATV_TOP_EQU1_EQU_C1_LP                                          0x1F6
 148 #define     ATV_TOP_EQU1_EQU_C1_BG                                          0x197
 149 #define     ATV_TOP_EQU1_EQU_C1_DK                                          0x198
 150 #define     ATV_TOP_EQU1_EQU_C1_I                                           0x1F6
 151 #define     ATV_TOP_EQU2_EQU_C2_FM                                          0x0
 152 #define     ATV_TOP_EQU2_EQU_C2_L                                           0x28
 153 #define     ATV_TOP_EQU2_EQU_C2_LP                                          0x28
 154 #define     ATV_TOP_EQU2_EQU_C2_BG                                          0xC5
 155 #define     ATV_TOP_EQU2_EQU_C2_DK                                          0xB0
 156 #define     ATV_TOP_EQU2_EQU_C2_I                                           0x28
 157 #define     ATV_TOP_EQU3_EQU_C3_FM                                          0x0
 158 #define     ATV_TOP_EQU3_EQU_C3_L                                           0x192
 159 #define     ATV_TOP_EQU3_EQU_C3_LP                                          0x192
 160 #define     ATV_TOP_EQU3_EQU_C3_BG                                          0x12E
 161 #define     ATV_TOP_EQU3_EQU_C3_DK                                          0x18E
 162 #define     ATV_TOP_EQU3_EQU_C3_I                                           0x192
 163 #define     ATV_TOP_STD_MODE_MN                                             0x0
 164 #define     ATV_TOP_STD_MODE_FM                                             0x1
 165 #define     ATV_TOP_STD_MODE_L                                              0x0
 166 #define     ATV_TOP_STD_MODE_LP                                             0x0
 167 #define     ATV_TOP_STD_MODE_BG                                             0x0
 168 #define     ATV_TOP_STD_MODE_DK                                             0x0
 169 #define     ATV_TOP_STD_MODE_I                                              0x0
 170 #define     ATV_TOP_STD_VID_POL_MN                                          0x0
 171 #define     ATV_TOP_STD_VID_POL_FM                                          0x0
 172 #define     ATV_TOP_STD_VID_POL_L                                           0x2
 173 #define     ATV_TOP_STD_VID_POL_LP                                          0x2
 174 #define     ATV_TOP_STD_VID_POL_BG                                          0x0
 175 #define     ATV_TOP_STD_VID_POL_DK                                          0x0
 176 #define     ATV_TOP_STD_VID_POL_I                                           0x0
 177 #define   ATV_TOP_VID_AMP_MN                                                0x380
 178 #define   ATV_TOP_VID_AMP_FM                                                0x0
 179 #define   ATV_TOP_VID_AMP_L                                                 0xF50
 180 #define   ATV_TOP_VID_AMP_LP                                                0xF50
 181 #define   ATV_TOP_VID_AMP_BG                                                0x380
 182 #define   ATV_TOP_VID_AMP_DK                                                0x394
 183 #define   ATV_TOP_VID_AMP_I                                                 0x3D8
 184 #define   IQM_CF_OUT_ENA_OFDM__M                                            0x4
 185 #define     IQM_FS_ADJ_SEL_B_QAM                                            0x1
 186 #define     IQM_FS_ADJ_SEL_B_OFF                                            0x0
 187 #define     IQM_FS_ADJ_SEL_B_VSB                                            0x2
 188 #define     IQM_RC_ADJ_SEL_B_OFF                                            0x0
 189 #define     IQM_RC_ADJ_SEL_B_QAM                                            0x1
 190 #define     IQM_RC_ADJ_SEL_B_VSB                                            0x2
 191 /*** END DJCOMBO patches to DRXJ registermap *********************************/
 192 
 193 #include "drx_driver_version.h"
 194 
 195 /* #define DRX_DEBUG */
 196 #ifdef DRX_DEBUG
 197 #include <stdio.h>
 198 #endif
 199 
 200 /*-----------------------------------------------------------------------------
 201 ENUMS
 202 ----------------------------------------------------------------------------*/
 203 
 204 /*-----------------------------------------------------------------------------
 205 DEFINES
 206 ----------------------------------------------------------------------------*/
 207 #ifndef DRXJ_WAKE_UP_KEY
 208 #define DRXJ_WAKE_UP_KEY (demod->my_i2c_dev_addr->i2c_addr)
 209 #endif
 210 
 211 /*
 212 * \def DRXJ_DEF_I2C_ADDR
 213 * \brief Default I2C address of a demodulator instance.
 214 */
 215 #define DRXJ_DEF_I2C_ADDR (0x52)
 216 
 217 /*
 218 * \def DRXJ_DEF_DEMOD_DEV_ID
 219 * \brief Default device identifier of a demodultor instance.
 220 */
 221 #define DRXJ_DEF_DEMOD_DEV_ID      (1)
 222 
 223 /*
 224 * \def DRXJ_SCAN_TIMEOUT
 225 * \brief Timeout value for waiting on demod lock during channel scan (millisec).
 226 */
 227 #define DRXJ_SCAN_TIMEOUT    1000
 228 
 229 /*
 230 * \def HI_I2C_DELAY
 231 * \brief HI timing delay for I2C timing (in nano seconds)
 232 *
 233 *  Used to compute HI_CFG_DIV
 234 */
 235 #define HI_I2C_DELAY    42
 236 
 237 /*
 238 * \def HI_I2C_BRIDGE_DELAY
 239 * \brief HI timing delay for I2C timing (in nano seconds)
 240 *
 241 *  Used to compute HI_CFG_BDL
 242 */
 243 #define HI_I2C_BRIDGE_DELAY   750
 244 
 245 /*
 246 * \brief Time Window for MER and SER Measurement in Units of Segment duration.
 247 */
 248 #define VSB_TOP_MEASUREMENT_PERIOD  64
 249 #define SYMBOLS_PER_SEGMENT         832
 250 
 251 /*
 252 * \brief bit rate and segment rate constants used for SER and BER.
 253 */
 254 /* values taken from the QAM microcode */
 255 #define DRXJ_QAM_SL_SIG_POWER_QAM_UNKNOWN 0
 256 #define DRXJ_QAM_SL_SIG_POWER_QPSK        32768
 257 #define DRXJ_QAM_SL_SIG_POWER_QAM8        24576
 258 #define DRXJ_QAM_SL_SIG_POWER_QAM16       40960
 259 #define DRXJ_QAM_SL_SIG_POWER_QAM32       20480
 260 #define DRXJ_QAM_SL_SIG_POWER_QAM64       43008
 261 #define DRXJ_QAM_SL_SIG_POWER_QAM128      20992
 262 #define DRXJ_QAM_SL_SIG_POWER_QAM256      43520
 263 /*
 264 * \brief Min supported symbolrates.
 265 */
 266 #ifndef DRXJ_QAM_SYMBOLRATE_MIN
 267 #define DRXJ_QAM_SYMBOLRATE_MIN          (520000)
 268 #endif
 269 
 270 /*
 271 * \brief Max supported symbolrates.
 272 */
 273 #ifndef DRXJ_QAM_SYMBOLRATE_MAX
 274 #define DRXJ_QAM_SYMBOLRATE_MAX         (7233000)
 275 #endif
 276 
 277 /*
 278 * \def DRXJ_QAM_MAX_WAITTIME
 279 * \brief Maximal wait time for QAM auto constellation in ms
 280 */
 281 #ifndef DRXJ_QAM_MAX_WAITTIME
 282 #define DRXJ_QAM_MAX_WAITTIME 900
 283 #endif
 284 
 285 #ifndef DRXJ_QAM_FEC_LOCK_WAITTIME
 286 #define DRXJ_QAM_FEC_LOCK_WAITTIME 150
 287 #endif
 288 
 289 #ifndef DRXJ_QAM_DEMOD_LOCK_EXT_WAITTIME
 290 #define DRXJ_QAM_DEMOD_LOCK_EXT_WAITTIME 200
 291 #endif
 292 
 293 /*
 294 * \def SCU status and results
 295 * \brief SCU
 296 */
 297 #define DRX_SCU_READY               0
 298 #define DRXJ_MAX_WAITTIME           100 /* ms */
 299 #define FEC_RS_MEASUREMENT_PERIOD   12894       /* 1 sec */
 300 #define FEC_RS_MEASUREMENT_PRESCALE 1   /* n sec */
 301 
 302 /*
 303 * \def DRX_AUD_MAX_DEVIATION
 304 * \brief Needed for calculation of prescale feature in AUD
 305 */
 306 #ifndef DRXJ_AUD_MAX_FM_DEVIATION
 307 #define DRXJ_AUD_MAX_FM_DEVIATION  100  /* kHz */
 308 #endif
 309 
 310 /*
 311 * \brief Needed for calculation of NICAM prescale feature in AUD
 312 */
 313 #ifndef DRXJ_AUD_MAX_NICAM_PRESCALE
 314 #define DRXJ_AUD_MAX_NICAM_PRESCALE  (9)        /* dB */
 315 #endif
 316 
 317 /*
 318 * \brief Needed for calculation of NICAM prescale feature in AUD
 319 */
 320 #ifndef DRXJ_AUD_MAX_WAITTIME
 321 #define DRXJ_AUD_MAX_WAITTIME  250      /* ms */
 322 #endif
 323 
 324 /* ATV config changed flags */
 325 #define DRXJ_ATV_CHANGED_COEF          (0x00000001UL)
 326 #define DRXJ_ATV_CHANGED_PEAK_FLT      (0x00000008UL)
 327 #define DRXJ_ATV_CHANGED_NOISE_FLT     (0x00000010UL)
 328 #define DRXJ_ATV_CHANGED_OUTPUT        (0x00000020UL)
 329 #define DRXJ_ATV_CHANGED_SIF_ATT       (0x00000040UL)
 330 
 331 /* UIO define */
 332 #define DRX_UIO_MODE_FIRMWARE_SMA DRX_UIO_MODE_FIRMWARE0
 333 #define DRX_UIO_MODE_FIRMWARE_SAW DRX_UIO_MODE_FIRMWARE1
 334 
 335 /*
 336  * MICROCODE RELATED DEFINES
 337  */
 338 
 339 /* Magic word for checking correct Endianness of microcode data */
 340 #define DRX_UCODE_MAGIC_WORD         ((((u16)'H')<<8)+((u16)'L'))
 341 
 342 /* CRC flag in ucode header, flags field. */
 343 #define DRX_UCODE_CRC_FLAG           (0x0001)
 344 
 345 /*
 346  * Maximum size of buffer used to verify the microcode.
 347  * Must be an even number
 348  */
 349 #define DRX_UCODE_MAX_BUF_SIZE       (DRXDAP_MAX_RCHUNKSIZE)
 350 
 351 #if DRX_UCODE_MAX_BUF_SIZE & 1
 352 #error DRX_UCODE_MAX_BUF_SIZE must be an even number
 353 #endif
 354 
 355 /*
 356  * Power mode macros
 357  */
 358 
 359 #define DRX_ISPOWERDOWNMODE(mode) ((mode == DRX_POWER_MODE_9) || \
 360                                        (mode == DRX_POWER_MODE_10) || \
 361                                        (mode == DRX_POWER_MODE_11) || \
 362                                        (mode == DRX_POWER_MODE_12) || \
 363                                        (mode == DRX_POWER_MODE_13) || \
 364                                        (mode == DRX_POWER_MODE_14) || \
 365                                        (mode == DRX_POWER_MODE_15) || \
 366                                        (mode == DRX_POWER_MODE_16) || \
 367                                        (mode == DRX_POWER_DOWN))
 368 
 369 /* Pin safe mode macro */
 370 #define DRXJ_PIN_SAFE_MODE 0x0000
 371 /*============================================================================*/
 372 /*=== GLOBAL VARIABLEs =======================================================*/
 373 /*============================================================================*/
 374 /*
 375 */
 376 
 377 /*
 378 * \brief Temporary register definitions.
 379 *        (register definitions that are not yet available in register master)
 380 */
 381 
 382 /*****************************************************************************/
 383 /* Audio block 0x103 is write only. To avoid shadowing in driver accessing   */
 384 /* RAM addresses directly. This must be READ ONLY to avoid problems.         */
 385 /* Writing to the interface addresses are more than only writing the RAM     */
 386 /* locations                                                                 */
 387 /*****************************************************************************/
 388 /*
 389 * \brief RAM location of MODUS registers
 390 */
 391 #define AUD_DEM_RAM_MODUS_HI__A              0x10204A3
 392 #define AUD_DEM_RAM_MODUS_HI__M              0xF000
 393 
 394 #define AUD_DEM_RAM_MODUS_LO__A              0x10204A4
 395 #define AUD_DEM_RAM_MODUS_LO__M              0x0FFF
 396 
 397 /*
 398 * \brief RAM location of I2S config registers
 399 */
 400 #define AUD_DEM_RAM_I2S_CONFIG1__A           0x10204B1
 401 #define AUD_DEM_RAM_I2S_CONFIG2__A           0x10204B2
 402 
 403 /*
 404 * \brief RAM location of DCO config registers
 405 */
 406 #define AUD_DEM_RAM_DCO_B_HI__A              0x1020461
 407 #define AUD_DEM_RAM_DCO_B_LO__A              0x1020462
 408 #define AUD_DEM_RAM_DCO_A_HI__A              0x1020463
 409 #define AUD_DEM_RAM_DCO_A_LO__A              0x1020464
 410 
 411 /*
 412 * \brief RAM location of Threshold registers
 413 */
 414 #define AUD_DEM_RAM_NICAM_THRSHLD__A         0x102045A
 415 #define AUD_DEM_RAM_A2_THRSHLD__A            0x10204BB
 416 #define AUD_DEM_RAM_BTSC_THRSHLD__A          0x10204A6
 417 
 418 /*
 419 * \brief RAM location of Carrier Threshold registers
 420 */
 421 #define AUD_DEM_RAM_CM_A_THRSHLD__A          0x10204AF
 422 #define AUD_DEM_RAM_CM_B_THRSHLD__A          0x10204B0
 423 
 424 /*
 425 * \brief FM Matrix register fix
 426 */
 427 #ifdef AUD_DEM_WR_FM_MATRIX__A
 428 #undef  AUD_DEM_WR_FM_MATRIX__A
 429 #endif
 430 #define AUD_DEM_WR_FM_MATRIX__A              0x105006F
 431 
 432 /*============================================================================*/
 433 /*
 434 * \brief Defines required for audio
 435 */
 436 #define AUD_VOLUME_ZERO_DB                      115
 437 #define AUD_VOLUME_DB_MIN                       -60
 438 #define AUD_VOLUME_DB_MAX                       12
 439 #define AUD_CARRIER_STRENGTH_QP_0DB             0x4000
 440 #define AUD_CARRIER_STRENGTH_QP_0DB_LOG10T100   421
 441 #define AUD_MAX_AVC_REF_LEVEL                   15
 442 #define AUD_I2S_FREQUENCY_MAX                   48000UL
 443 #define AUD_I2S_FREQUENCY_MIN                   12000UL
 444 #define AUD_RDS_ARRAY_SIZE                      18
 445 
 446 /*
 447 * \brief Needed for calculation of prescale feature in AUD
 448 */
 449 #ifndef DRX_AUD_MAX_FM_DEVIATION
 450 #define DRX_AUD_MAX_FM_DEVIATION  (100) /* kHz */
 451 #endif
 452 
 453 /*
 454 * \brief Needed for calculation of NICAM prescale feature in AUD
 455 */
 456 #ifndef DRX_AUD_MAX_NICAM_PRESCALE
 457 #define DRX_AUD_MAX_NICAM_PRESCALE  (9) /* dB */
 458 #endif
 459 
 460 /*============================================================================*/
 461 /* Values for I2S Master/Slave pin configurations */
 462 #define SIO_PDR_I2S_CL_CFG_MODE__MASTER      0x0004
 463 #define SIO_PDR_I2S_CL_CFG_DRIVE__MASTER     0x0008
 464 #define SIO_PDR_I2S_CL_CFG_MODE__SLAVE       0x0004
 465 #define SIO_PDR_I2S_CL_CFG_DRIVE__SLAVE      0x0000
 466 
 467 #define SIO_PDR_I2S_DA_CFG_MODE__MASTER      0x0003
 468 #define SIO_PDR_I2S_DA_CFG_DRIVE__MASTER     0x0008
 469 #define SIO_PDR_I2S_DA_CFG_MODE__SLAVE       0x0003
 470 #define SIO_PDR_I2S_DA_CFG_DRIVE__SLAVE      0x0008
 471 
 472 #define SIO_PDR_I2S_WS_CFG_MODE__MASTER      0x0004
 473 #define SIO_PDR_I2S_WS_CFG_DRIVE__MASTER     0x0008
 474 #define SIO_PDR_I2S_WS_CFG_MODE__SLAVE       0x0004
 475 #define SIO_PDR_I2S_WS_CFG_DRIVE__SLAVE      0x0000
 476 
 477 /*============================================================================*/
 478 /*=== REGISTER ACCESS MACROS =================================================*/
 479 /*============================================================================*/
 480 
 481 /*
 482 * This macro is used to create byte arrays for block writes.
 483 * Block writes speed up I2C traffic between host and demod.
 484 * The macro takes care of the required byte order in a 16 bits word.
 485 * x -> lowbyte(x), highbyte(x)
 486 */
 487 #define DRXJ_16TO8(x) ((u8) (((u16)x) & 0xFF)), \
 488                        ((u8)((((u16)x)>>8)&0xFF))
 489 /*
 490 * This macro is used to convert byte array to 16 bit register value for block read.
 491 * Block read speed up I2C traffic between host and demod.
 492 * The macro takes care of the required byte order in a 16 bits word.
 493 */
 494 #define DRXJ_8TO16(x) ((u16) (x[0] | (x[1] << 8)))
 495 
 496 /*============================================================================*/
 497 /*=== MISC DEFINES ===========================================================*/
 498 /*============================================================================*/
 499 
 500 /*============================================================================*/
 501 /*=== HI COMMAND RELATED DEFINES =============================================*/
 502 /*============================================================================*/
 503 
 504 /*
 505 * \brief General maximum number of retries for ucode command interfaces
 506 */
 507 #define DRXJ_MAX_RETRIES (100)
 508 
 509 /*============================================================================*/
 510 /*=== STANDARD RELATED MACROS ================================================*/
 511 /*============================================================================*/
 512 
 513 #define DRXJ_ISATVSTD(std) ((std == DRX_STANDARD_PAL_SECAM_BG) || \
 514                                (std == DRX_STANDARD_PAL_SECAM_DK) || \
 515                                (std == DRX_STANDARD_PAL_SECAM_I) || \
 516                                (std == DRX_STANDARD_PAL_SECAM_L) || \
 517                                (std == DRX_STANDARD_PAL_SECAM_LP) || \
 518                                (std == DRX_STANDARD_NTSC) || \
 519                                (std == DRX_STANDARD_FM))
 520 
 521 #define DRXJ_ISQAMSTD(std) ((std == DRX_STANDARD_ITU_A) || \
 522                                (std == DRX_STANDARD_ITU_B) || \
 523                                (std == DRX_STANDARD_ITU_C) || \
 524                                (std == DRX_STANDARD_ITU_D))
 525 
 526 /*-----------------------------------------------------------------------------
 527 GLOBAL VARIABLES
 528 ----------------------------------------------------------------------------*/
 529 /*
 530  * DRXJ DAP structures
 531  */
 532 
 533 static int drxdap_fasi_read_block(struct i2c_device_addr *dev_addr,
 534                                       u32 addr,
 535                                       u16 datasize,
 536                                       u8 *data, u32 flags);
 537 
 538 
 539 static int drxj_dap_read_modify_write_reg16(struct i2c_device_addr *dev_addr,
 540                                                  u32 waddr,
 541                                                  u32 raddr,
 542                                                  u16 wdata, u16 *rdata);
 543 
 544 static int drxj_dap_read_reg16(struct i2c_device_addr *dev_addr,
 545                                       u32 addr,
 546                                       u16 *data, u32 flags);
 547 
 548 static int drxdap_fasi_read_reg32(struct i2c_device_addr *dev_addr,
 549                                       u32 addr,
 550                                       u32 *data, u32 flags);
 551 
 552 static int drxdap_fasi_write_block(struct i2c_device_addr *dev_addr,
 553                                        u32 addr,
 554                                        u16 datasize,
 555                                        u8 *data, u32 flags);
 556 
 557 static int drxj_dap_write_reg16(struct i2c_device_addr *dev_addr,
 558                                        u32 addr,
 559                                        u16 data, u32 flags);
 560 
 561 static int drxdap_fasi_write_reg32(struct i2c_device_addr *dev_addr,
 562                                        u32 addr,
 563                                        u32 data, u32 flags);
 564 
 565 static struct drxj_data drxj_data_g = {
 566         false,                  /* has_lna : true if LNA (aka PGA) present      */
 567         false,                  /* has_oob : true if OOB supported              */
 568         false,                  /* has_ntsc: true if NTSC supported             */
 569         false,                  /* has_btsc: true if BTSC supported             */
 570         false,                  /* has_smatx: true if SMA_TX pin is available   */
 571         false,                  /* has_smarx: true if SMA_RX pin is available   */
 572         false,                  /* has_gpio : true if GPIO pin is available     */
 573         false,                  /* has_irqn : true if IRQN pin is available     */
 574         0,                      /* mfx A1/A2/A... */
 575 
 576         /* tuner settings */
 577         false,                  /* tuner mirrors RF signal    */
 578         /* standard/channel settings */
 579         DRX_STANDARD_UNKNOWN,   /* current standard           */
 580         DRX_CONSTELLATION_AUTO, /* constellation              */
 581         0,                      /* frequency in KHz           */
 582         DRX_BANDWIDTH_UNKNOWN,  /* curr_bandwidth              */
 583         DRX_MIRROR_NO,          /* mirror                     */
 584 
 585         /* signal quality information: */
 586         /* default values taken from the QAM Programming guide */
 587         /*   fec_bits_desired should not be less than 4000000    */
 588         4000000,                /* fec_bits_desired    */
 589         5,                      /* fec_vd_plen         */
 590         4,                      /* qam_vd_prescale     */
 591         0xFFFF,                 /* qamVDPeriod       */
 592         204 * 8,                /* fec_rs_plen annex A */
 593         1,                      /* fec_rs_prescale     */
 594         FEC_RS_MEASUREMENT_PERIOD,      /* fec_rs_period     */
 595         true,                   /* reset_pkt_err_acc    */
 596         0,                      /* pkt_err_acc_start    */
 597 
 598         /* HI configuration */
 599         0,                      /* hi_cfg_timing_div    */
 600         0,                      /* hi_cfg_bridge_delay  */
 601         0,                      /* hi_cfg_wake_up_key    */
 602         0,                      /* hi_cfg_ctrl         */
 603         0,                      /* HICfgTimeout      */
 604         /* UIO configuration */
 605         DRX_UIO_MODE_DISABLE,   /* uio_sma_rx_mode      */
 606         DRX_UIO_MODE_DISABLE,   /* uio_sma_tx_mode      */
 607         DRX_UIO_MODE_DISABLE,   /* uioASELMode       */
 608         DRX_UIO_MODE_DISABLE,   /* uio_irqn_mode       */
 609         /* FS setting */
 610         0UL,                    /* iqm_fs_rate_ofs      */
 611         false,                  /* pos_image          */
 612         /* RC setting */
 613         0UL,                    /* iqm_rc_rate_ofs      */
 614         /* AUD information */
 615 /*   false,                  * flagSetAUDdone    */
 616 /*   false,                  * detectedRDS       */
 617 /*   true,                   * flagASDRequest    */
 618 /*   false,                  * flagHDevClear     */
 619 /*   false,                  * flagHDevSet       */
 620 /*   (u16) 0xFFF,          * rdsLastCount      */
 621 
 622         /* ATV configuration */
 623         0UL,                    /* flags cfg changes */
 624         /* shadow of ATV_TOP_EQU0__A */
 625         {-5,
 626          ATV_TOP_EQU0_EQU_C0_FM,
 627          ATV_TOP_EQU0_EQU_C0_L,
 628          ATV_TOP_EQU0_EQU_C0_LP,
 629          ATV_TOP_EQU0_EQU_C0_BG,
 630          ATV_TOP_EQU0_EQU_C0_DK,
 631          ATV_TOP_EQU0_EQU_C0_I},
 632         /* shadow of ATV_TOP_EQU1__A */
 633         {-50,
 634          ATV_TOP_EQU1_EQU_C1_FM,
 635          ATV_TOP_EQU1_EQU_C1_L,
 636          ATV_TOP_EQU1_EQU_C1_LP,
 637          ATV_TOP_EQU1_EQU_C1_BG,
 638          ATV_TOP_EQU1_EQU_C1_DK,
 639          ATV_TOP_EQU1_EQU_C1_I},
 640         /* shadow of ATV_TOP_EQU2__A */
 641         {210,
 642          ATV_TOP_EQU2_EQU_C2_FM,
 643          ATV_TOP_EQU2_EQU_C2_L,
 644          ATV_TOP_EQU2_EQU_C2_LP,
 645          ATV_TOP_EQU2_EQU_C2_BG,
 646          ATV_TOP_EQU2_EQU_C2_DK,
 647          ATV_TOP_EQU2_EQU_C2_I},
 648         /* shadow of ATV_TOP_EQU3__A */
 649         {-160,
 650          ATV_TOP_EQU3_EQU_C3_FM,
 651          ATV_TOP_EQU3_EQU_C3_L,
 652          ATV_TOP_EQU3_EQU_C3_LP,
 653          ATV_TOP_EQU3_EQU_C3_BG,
 654          ATV_TOP_EQU3_EQU_C3_DK,
 655          ATV_TOP_EQU3_EQU_C3_I},
 656         false,                  /* flag: true=bypass             */
 657         ATV_TOP_VID_PEAK__PRE,  /* shadow of ATV_TOP_VID_PEAK__A */
 658         ATV_TOP_NOISE_TH__PRE,  /* shadow of ATV_TOP_NOISE_TH__A */
 659         true,                   /* flag CVBS output enable       */
 660         false,                  /* flag SIF output enable        */
 661         DRXJ_SIF_ATTENUATION_0DB,       /* current SIF att setting       */
 662         {                       /* qam_rf_agc_cfg */
 663          DRX_STANDARD_ITU_B,    /* standard            */
 664          DRX_AGC_CTRL_AUTO,     /* ctrl_mode            */
 665          0,                     /* output_level         */
 666          0,                     /* min_output_level      */
 667          0xFFFF,                /* max_output_level      */
 668          0x0000,                /* speed               */
 669          0x0000,                /* top                 */
 670          0x0000                 /* c.o.c.              */
 671          },
 672         {                       /* qam_if_agc_cfg */
 673          DRX_STANDARD_ITU_B,    /* standard            */
 674          DRX_AGC_CTRL_AUTO,     /* ctrl_mode            */
 675          0,                     /* output_level         */
 676          0,                     /* min_output_level      */
 677          0xFFFF,                /* max_output_level      */
 678          0x0000,                /* speed               */
 679          0x0000,                /* top    (don't care) */
 680          0x0000                 /* c.o.c. (don't care) */
 681          },
 682         {                       /* vsb_rf_agc_cfg */
 683          DRX_STANDARD_8VSB,     /* standard       */
 684          DRX_AGC_CTRL_AUTO,     /* ctrl_mode       */
 685          0,                     /* output_level    */
 686          0,                     /* min_output_level */
 687          0xFFFF,                /* max_output_level */
 688          0x0000,                /* speed          */
 689          0x0000,                /* top    (don't care) */
 690          0x0000                 /* c.o.c. (don't care) */
 691          },
 692         {                       /* vsb_if_agc_cfg */
 693          DRX_STANDARD_8VSB,     /* standard       */
 694          DRX_AGC_CTRL_AUTO,     /* ctrl_mode       */
 695          0,                     /* output_level    */
 696          0,                     /* min_output_level */
 697          0xFFFF,                /* max_output_level */
 698          0x0000,                /* speed          */
 699          0x0000,                /* top    (don't care) */
 700          0x0000                 /* c.o.c. (don't care) */
 701          },
 702         0,                      /* qam_pga_cfg */
 703         0,                      /* vsb_pga_cfg */
 704         {                       /* qam_pre_saw_cfg */
 705          DRX_STANDARD_ITU_B,    /* standard  */
 706          0,                     /* reference */
 707          false                  /* use_pre_saw */
 708          },
 709         {                       /* vsb_pre_saw_cfg */
 710          DRX_STANDARD_8VSB,     /* standard  */
 711          0,                     /* reference */
 712          false                  /* use_pre_saw */
 713          },
 714 
 715         /* Version information */
 716 #ifndef _CH_
 717         {
 718          "01234567890",         /* human readable version microcode             */
 719          "01234567890"          /* human readable version device specific code  */
 720          },
 721         {
 722          {                      /* struct drx_version for microcode                   */
 723           DRX_MODULE_UNKNOWN,
 724           (char *)(NULL),
 725           0,
 726           0,
 727           0,
 728           (char *)(NULL)
 729           },
 730          {                      /* struct drx_version for device specific code */
 731           DRX_MODULE_UNKNOWN,
 732           (char *)(NULL),
 733           0,
 734           0,
 735           0,
 736           (char *)(NULL)
 737           }
 738          },
 739         {
 740          {                      /* struct drx_version_list for microcode */
 741           (struct drx_version *) (NULL),
 742           (struct drx_version_list *) (NULL)
 743           },
 744          {                      /* struct drx_version_list for device specific code */
 745           (struct drx_version *) (NULL),
 746           (struct drx_version_list *) (NULL)
 747           }
 748          },
 749 #endif
 750         false,                  /* smart_ant_inverted */
 751         /* Tracking filter setting for OOB  */
 752         {
 753          12000,
 754          9300,
 755          6600,
 756          5280,
 757          3700,
 758          3000,
 759          2000,
 760          0},
 761         false,                  /* oob_power_on           */
 762         0,                      /* mpeg_ts_static_bitrate  */
 763         false,                  /* disable_te_ihandling   */
 764         false,                  /* bit_reverse_mpeg_outout */
 765         DRXJ_MPEGOUTPUT_CLOCK_RATE_AUTO,        /* mpeg_output_clock_rate */
 766         DRXJ_MPEG_START_WIDTH_1CLKCYC,  /* mpeg_start_width */
 767 
 768         /* Pre SAW & Agc configuration for ATV */
 769         {
 770          DRX_STANDARD_NTSC,     /* standard     */
 771          7,                     /* reference    */
 772          true                   /* use_pre_saw    */
 773          },
 774         {                       /* ATV RF-AGC */
 775          DRX_STANDARD_NTSC,     /* standard              */
 776          DRX_AGC_CTRL_AUTO,     /* ctrl_mode              */
 777          0,                     /* output_level           */
 778          0,                     /* min_output_level (d.c.) */
 779          0,                     /* max_output_level (d.c.) */
 780          3,                     /* speed                 */
 781          9500,                  /* top                   */
 782          4000                   /* cut-off current       */
 783          },
 784         {                       /* ATV IF-AGC */
 785          DRX_STANDARD_NTSC,     /* standard              */
 786          DRX_AGC_CTRL_AUTO,     /* ctrl_mode              */
 787          0,                     /* output_level           */
 788          0,                     /* min_output_level (d.c.) */
 789          0,                     /* max_output_level (d.c.) */
 790          3,                     /* speed                 */
 791          2400,                  /* top                   */
 792          0                      /* c.o.c.         (d.c.) */
 793          },
 794         140,                    /* ATV PGA config */
 795         0,                      /* curr_symbol_rate */
 796 
 797         false,                  /* pdr_safe_mode     */
 798         SIO_PDR_GPIO_CFG__PRE,  /* pdr_safe_restore_val_gpio  */
 799         SIO_PDR_VSYNC_CFG__PRE, /* pdr_safe_restore_val_v_sync */
 800         SIO_PDR_SMA_RX_CFG__PRE,        /* pdr_safe_restore_val_sma_rx */
 801         SIO_PDR_SMA_TX_CFG__PRE,        /* pdr_safe_restore_val_sma_tx */
 802 
 803         4,                      /* oob_pre_saw            */
 804         DRXJ_OOB_LO_POW_MINUS10DB,      /* oob_lo_pow             */
 805         {
 806          false                  /* aud_data, only first member */
 807          },
 808 };
 809 
 810 /*
 811 * \var drxj_default_addr_g
 812 * \brief Default I2C address and device identifier.
 813 */
 814 static struct i2c_device_addr drxj_default_addr_g = {
 815         DRXJ_DEF_I2C_ADDR,      /* i2c address */
 816         DRXJ_DEF_DEMOD_DEV_ID   /* device id */
 817 };
 818 
 819 /*
 820 * \var drxj_default_comm_attr_g
 821 * \brief Default common attributes of a drxj demodulator instance.
 822 */
 823 static struct drx_common_attr drxj_default_comm_attr_g = {
 824         NULL,                   /* ucode file           */
 825         true,                   /* ucode verify switch  */
 826         {0},                    /* version record       */
 827 
 828         44000,                  /* IF in kHz in case no tuner instance is used  */
 829         (151875 - 0),           /* system clock frequency in kHz                */
 830         0,                      /* oscillator frequency kHz                     */
 831         0,                      /* oscillator deviation in ppm, signed          */
 832         false,                  /* If true mirror frequency spectrum            */
 833         {
 834          /* MPEG output configuration */
 835          true,                  /* If true, enable MPEG output   */
 836          false,                 /* If true, insert RS byte       */
 837          false,                 /* If true, parallel out otherwise serial */
 838          false,                 /* If true, invert DATA signals  */
 839          false,                 /* If true, invert ERR signal    */
 840          false,                 /* If true, invert STR signals   */
 841          false,                 /* If true, invert VAL signals   */
 842          false,                 /* If true, invert CLK signals   */
 843          true,                  /* If true, static MPEG clockrate will
 844                                    be used, otherwise clockrate will
 845                                    adapt to the bitrate of the TS */
 846          19392658UL,            /* Maximum bitrate in b/s in case
 847                                    static clockrate is selected */
 848          DRX_MPEG_STR_WIDTH_1   /* MPEG Start width in clock cycles */
 849          },
 850         /* Initilisations below can be omitted, they require no user input and
 851            are initially 0, NULL or false. The compiler will initialize them to these
 852            values when omitted.  */
 853         false,                  /* is_opened */
 854 
 855         /* SCAN */
 856         NULL,                   /* no scan params yet               */
 857         0,                      /* current scan index               */
 858         0,                      /* next scan frequency              */
 859         false,                  /* scan ready flag                  */
 860         0,                      /* max channels to scan             */
 861         0,                      /* nr of channels scanned           */
 862         NULL,                   /* default scan function            */
 863         NULL,                   /* default context pointer          */
 864         0,                      /* millisec to wait for demod lock  */
 865         DRXJ_DEMOD_LOCK,        /* desired lock               */
 866         false,
 867 
 868         /* Power management */
 869         DRX_POWER_UP,
 870 
 871         /* Tuner */
 872         1,                      /* nr of I2C port to which tuner is    */
 873         0L,                     /* minimum RF input frequency, in kHz  */
 874         0L,                     /* maximum RF input frequency, in kHz  */
 875         false,                  /* Rf Agc Polarity                     */
 876         false,                  /* If Agc Polarity                     */
 877         false,                  /* tuner slow mode                     */
 878 
 879         {                       /* current channel (all 0)             */
 880          0UL                    /* channel.frequency */
 881          },
 882         DRX_STANDARD_UNKNOWN,   /* current standard */
 883         DRX_STANDARD_UNKNOWN,   /* previous standard */
 884         DRX_STANDARD_UNKNOWN,   /* di_cache_standard   */
 885         false,                  /* use_bootloader */
 886         0UL,                    /* capabilities */
 887         0                       /* mfx */
 888 };
 889 
 890 /*
 891 * \var drxj_default_demod_g
 892 * \brief Default drxj demodulator instance.
 893 */
 894 static struct drx_demod_instance drxj_default_demod_g = {
 895         &drxj_default_addr_g,   /* i2c address & device id */
 896         &drxj_default_comm_attr_g,      /* demod common attributes */
 897         &drxj_data_g            /* demod device specific attributes */
 898 };
 899 
 900 /*
 901 * \brief Default audio data structure for DRK demodulator instance.
 902 *
 903 * This structure is DRXK specific.
 904 *
 905 */
 906 static struct drx_aud_data drxj_default_aud_data_g = {
 907         false,                  /* audio_is_active */
 908         DRX_AUD_STANDARD_AUTO,  /* audio_standard  */
 909 
 910         /* i2sdata */
 911         {
 912          false,                 /* output_enable   */
 913          48000,                 /* frequency      */
 914          DRX_I2S_MODE_MASTER,   /* mode           */
 915          DRX_I2S_WORDLENGTH_32, /* word_length     */
 916          DRX_I2S_POLARITY_RIGHT,        /* polarity       */
 917          DRX_I2S_FORMAT_WS_WITH_DATA    /* format         */
 918          },
 919         /* volume            */
 920         {
 921          true,                  /* mute;          */
 922          0,                     /* volume         */
 923          DRX_AUD_AVC_OFF,       /* avc_mode        */
 924          0,                     /* avc_ref_level    */
 925          DRX_AUD_AVC_MAX_GAIN_12DB,     /* avc_max_gain     */
 926          DRX_AUD_AVC_MAX_ATTEN_24DB,    /* avc_max_atten    */
 927          0,                     /* strength_left   */
 928          0                      /* strength_right  */
 929          },
 930         DRX_AUD_AUTO_SOUND_SELECT_ON_CHANGE_ON, /* auto_sound */
 931         /*  ass_thresholds */
 932         {
 933          440,                   /* A2    */
 934          12,                    /* BTSC  */
 935          700,                   /* NICAM */
 936          },
 937         /* carrier */
 938         {
 939          /* a */
 940          {
 941           42,                   /* thres */
 942           DRX_NO_CARRIER_NOISE, /* opt   */
 943           0,                    /* shift */
 944           0                     /* dco   */
 945           },
 946          /* b */
 947          {
 948           42,                   /* thres */
 949           DRX_NO_CARRIER_MUTE,  /* opt   */
 950           0,                    /* shift */
 951           0                     /* dco   */
 952           },
 953 
 954          },
 955         /* mixer */
 956         {
 957          DRX_AUD_SRC_STEREO_OR_A,       /* source_i2s */
 958          DRX_AUD_I2S_MATRIX_STEREO,     /* matrix_i2s */
 959          DRX_AUD_FM_MATRIX_SOUND_A      /* matrix_fm  */
 960          },
 961         DRX_AUD_DEVIATION_NORMAL,       /* deviation */
 962         DRX_AUD_AVSYNC_OFF,     /* av_sync */
 963 
 964         /* prescale */
 965         {
 966          DRX_AUD_MAX_FM_DEVIATION,      /* fm_deviation */
 967          DRX_AUD_MAX_NICAM_PRESCALE     /* nicam_gain */
 968          },
 969         DRX_AUD_FM_DEEMPH_75US, /* deemph */
 970         DRX_BTSC_STEREO,        /* btsc_detect */
 971         0,                      /* rds_data_counter */
 972         false                   /* rds_data_present */
 973 };
 974 
 975 /*-----------------------------------------------------------------------------
 976 STRUCTURES
 977 ----------------------------------------------------------------------------*/
 978 struct drxjeq_stat {
 979         u16 eq_mse;
 980         u8 eq_mode;
 981         u8 eq_ctrl;
 982         u8 eq_stat;
 983 };
 984 
 985 /* HI command */
 986 struct drxj_hi_cmd {
 987         u16 cmd;
 988         u16 param1;
 989         u16 param2;
 990         u16 param3;
 991         u16 param4;
 992         u16 param5;
 993         u16 param6;
 994 };
 995 
 996 /*============================================================================*/
 997 /*=== MICROCODE RELATED STRUCTURES ===========================================*/
 998 /*============================================================================*/
 999 
1000 /*
1001  * struct drxu_code_block_hdr - Structure of the microcode block headers
1002  *
1003  * @addr:       Destination address of the data in this block
1004  * @size:       Size of the block data following this header counted in
1005  *              16 bits words
1006  * @CRC:        CRC value of the data block, only valid if CRC flag is
1007  *              set.
1008  */
1009 struct drxu_code_block_hdr {
1010         u32 addr;
1011         u16 size;
1012         u16 flags;
1013         u16 CRC;
1014 };
1015 
1016 /*-----------------------------------------------------------------------------
1017 FUNCTIONS
1018 ----------------------------------------------------------------------------*/
1019 /* Some prototypes */
1020 static int
1021 hi_command(struct i2c_device_addr *dev_addr,
1022            const struct drxj_hi_cmd *cmd, u16 *result);
1023 
1024 static int
1025 ctrl_lock_status(struct drx_demod_instance *demod, enum drx_lock_status *lock_stat);
1026 
1027 static int
1028 ctrl_power_mode(struct drx_demod_instance *demod, enum drx_power_mode *mode);
1029 
1030 static int power_down_aud(struct drx_demod_instance *demod);
1031 
1032 static int
1033 ctrl_set_cfg_pre_saw(struct drx_demod_instance *demod, struct drxj_cfg_pre_saw *pre_saw);
1034 
1035 static int
1036 ctrl_set_cfg_afe_gain(struct drx_demod_instance *demod, struct drxj_cfg_afe_gain *afe_gain);
1037 
1038 /*============================================================================*/
1039 /*============================================================================*/
1040 /*==                          HELPER FUNCTIONS                              ==*/
1041 /*============================================================================*/
1042 /*============================================================================*/
1043 
1044 
1045 /*============================================================================*/
1046 
1047 /*
1048 * \fn u32 frac28(u32 N, u32 D)
1049 * \brief Compute: (1<<28)*N/D
1050 * \param N 32 bits
1051 * \param D 32 bits
1052 * \return (1<<28)*N/D
1053 * This function is used to avoid floating-point calculations as they may
1054 * not be present on the target platform.
1055 
1056 * frac28 performs an unsigned 28/28 bits division to 32-bit fixed point
1057 * fraction used for setting the Frequency Shifter registers.
1058 * N and D can hold numbers up to width: 28-bits.
1059 * The 4 bits integer part and the 28 bits fractional part are calculated.
1060 
1061 * Usage condition: ((1<<28)*n)/d < ((1<<32)-1) => (n/d) < 15.999
1062 
1063 * N: 0...(1<<28)-1 = 268435454
1064 * D: 0...(1<<28)-1
1065 * Q: 0...(1<<32)-1
1066 */
1067 static u32 frac28(u32 N, u32 D)
1068 {
1069         int i = 0;
1070         u32 Q1 = 0;
1071         u32 R0 = 0;
1072 
1073         R0 = (N % D) << 4;      /* 32-28 == 4 shifts possible at max */
1074         Q1 = N / D;             /* integer part, only the 4 least significant bits
1075                                    will be visible in the result */
1076 
1077         /* division using radix 16, 7 nibbles in the result */
1078         for (i = 0; i < 7; i++) {
1079                 Q1 = (Q1 << 4) | R0 / D;
1080                 R0 = (R0 % D) << 4;
1081         }
1082         /* rounding */
1083         if ((R0 >> 3) >= D)
1084                 Q1++;
1085 
1086         return Q1;
1087 }
1088 
1089 /*
1090 * \fn u32 log1_times100( u32 x)
1091 * \brief Compute: 100*log10(x)
1092 * \param x 32 bits
1093 * \return 100*log10(x)
1094 *
1095 * 100*log10(x)
1096 * = 100*(log2(x)/log2(10)))
1097 * = (100*(2^15)*log2(x))/((2^15)*log2(10))
1098 * = ((200*(2^15)*log2(x))/((2^15)*log2(10)))/2
1099 * = ((200*(2^15)*(log2(x/y)+log2(y)))/((2^15)*log2(10)))/2
1100 * = ((200*(2^15)*log2(x/y))+(200*(2^15)*log2(y)))/((2^15)*log2(10)))/2
1101 *
1102 * where y = 2^k and 1<= (x/y) < 2
1103 */
1104 
1105 static u32 log1_times100(u32 x)
1106 {
1107         static const u8 scale = 15;
1108         static const u8 index_width = 5;
1109         /*
1110            log2lut[n] = (1<<scale) * 200 * log2( 1.0 + ( (1.0/(1<<INDEXWIDTH)) * n ))
1111            0 <= n < ((1<<INDEXWIDTH)+1)
1112          */
1113 
1114         static const u32 log2lut[] = {
1115                 0,              /* 0.000000 */
1116                 290941,         /* 290941.300628 */
1117                 573196,         /* 573196.476418 */
1118                 847269,         /* 847269.179851 */
1119                 1113620,        /* 1113620.489452 */
1120                 1372674,        /* 1372673.576986 */
1121                 1624818,        /* 1624817.752104 */
1122                 1870412,        /* 1870411.981536 */
1123                 2109788,        /* 2109787.962654 */
1124                 2343253,        /* 2343252.817465 */
1125                 2571091,        /* 2571091.461923 */
1126                 2793569,        /* 2793568.696416 */
1127                 3010931,        /* 3010931.055901 */
1128                 3223408,        /* 3223408.452106 */
1129                 3431216,        /* 3431215.635215 */
1130                 3634553,        /* 3634553.498355 */
1131                 3833610,        /* 3833610.244726 */
1132                 4028562,        /* 4028562.434393 */
1133                 4219576,        /* 4219575.925308 */
1134                 4406807,        /* 4406806.721144 */
1135                 4590402,        /* 4590401.736809 */
1136                 4770499,        /* 4770499.491025 */
1137                 4947231,        /* 4947230.734179 */
1138                 5120719,        /* 5120719.018555 */
1139                 5291081,        /* 5291081.217197 */
1140                 5458428,        /* 5458427.996830 */
1141                 5622864,        /* 5622864.249668 */
1142                 5784489,        /* 5784489.488298 */
1143                 5943398,        /* 5943398.207380 */
1144                 6099680,        /* 6099680.215452 */
1145                 6253421,        /* 6253420.939751 */
1146                 6404702,        /* 6404701.706649 */
1147                 6553600,        /* 6553600.000000 */
1148         };
1149 
1150         u8 i = 0;
1151         u32 y = 0;
1152         u32 d = 0;
1153         u32 k = 0;
1154         u32 r = 0;
1155 
1156         if (x == 0)
1157                 return 0;
1158 
1159         /* Scale x (normalize) */
1160         /* computing y in log(x/y) = log(x) - log(y) */
1161         if ((x & (((u32) (-1)) << (scale + 1))) == 0) {
1162                 for (k = scale; k > 0; k--) {
1163                         if (x & (((u32) 1) << scale))
1164                                 break;
1165                         x <<= 1;
1166                 }
1167         } else {
1168                 for (k = scale; k < 31; k++) {
1169                         if ((x & (((u32) (-1)) << (scale + 1))) == 0)
1170                                 break;
1171                         x >>= 1;
1172                 }
1173         }
1174         /*
1175            Now x has binary point between bit[scale] and bit[scale-1]
1176            and 1.0 <= x < 2.0 */
1177 
1178         /* correction for division: log(x) = log(x/y)+log(y) */
1179         y = k * ((((u32) 1) << scale) * 200);
1180 
1181         /* remove integer part */
1182         x &= ((((u32) 1) << scale) - 1);
1183         /* get index */
1184         i = (u8) (x >> (scale - index_width));
1185         /* compute delta (x-a) */
1186         d = x & ((((u32) 1) << (scale - index_width)) - 1);
1187         /* compute log, multiplication ( d* (.. )) must be within range ! */
1188         y += log2lut[i] +
1189             ((d * (log2lut[i + 1] - log2lut[i])) >> (scale - index_width));
1190         /* Conver to log10() */
1191         y /= 108853;            /* (log2(10) << scale) */
1192         r = (y >> 1);
1193         /* rounding */
1194         if (y & ((u32)1))
1195                 r++;
1196 
1197         return r;
1198 
1199 }
1200 
1201 /*
1202 * \fn u32 frac_times1e6( u16 N, u32 D)
1203 * \brief Compute: (N/D) * 1000000.
1204 * \param N nominator 16-bits.
1205 * \param D denominator 32-bits.
1206 * \return u32
1207 * \retval ((N/D) * 1000000), 32 bits
1208 *
1209 * No check on D=0!
1210 */
1211 static u32 frac_times1e6(u32 N, u32 D)
1212 {
1213         u32 remainder = 0;
1214         u32 frac = 0;
1215 
1216         /*
1217            frac = (N * 1000000) / D
1218            To let it fit in a 32 bits computation:
1219            frac = (N * (1000000 >> 4)) / (D >> 4)
1220            This would result in a problem in case D < 16 (div by 0).
1221            So we do it more elaborate as shown below.
1222          */
1223         frac = (((u32) N) * (1000000 >> 4)) / D;
1224         frac <<= 4;
1225         remainder = (((u32) N) * (1000000 >> 4)) % D;
1226         remainder <<= 4;
1227         frac += remainder / D;
1228         remainder = remainder % D;
1229         if ((remainder * 2) > D)
1230                 frac++;
1231 
1232         return frac;
1233 }
1234 
1235 /*============================================================================*/
1236 
1237 
1238 /*
1239 * \brief Values for NICAM prescaler gain. Computed from dB to integer
1240 *        and rounded. For calc used formula: 16*10^(prescaleGain[dB]/20).
1241 *
1242 */
1243 #if 0
1244 /* Currently, unused as we lack support for analog TV */
1245 static const u16 nicam_presc_table_val[43] = {
1246         1, 1, 1, 1, 2, 2, 2, 2, 3, 3, 3, 4, 4,
1247         5, 5, 6, 6, 7, 8, 9, 10, 11, 13, 14, 16,
1248         18, 20, 23, 25, 28, 32, 36, 40, 45,
1249         51, 57, 64, 71, 80, 90, 101, 113, 127
1250 };
1251 #endif
1252 
1253 /*============================================================================*/
1254 /*==                        END HELPER FUNCTIONS                            ==*/
1255 /*============================================================================*/
1256 
1257 /*============================================================================*/
1258 /*============================================================================*/
1259 /*==                      DRXJ DAP FUNCTIONS                                ==*/
1260 /*============================================================================*/
1261 /*============================================================================*/
1262 
1263 /*
1264    This layer takes care of some device specific register access protocols:
1265    -conversion to short address format
1266    -access to audio block
1267    This layer is placed between the drx_dap_fasi and the rest of the drxj
1268    specific implementation. This layer can use address map knowledge whereas
1269    dap_fasi may not use memory map knowledge.
1270 
1271    * For audio currently only 16 bits read and write register access is
1272      supported. More is not needed. RMW and 32 or 8 bit access on audio
1273      registers will have undefined behaviour. Flags (RMW, CRC reset, broadcast
1274      single/multi master) will be ignored.
1275 
1276    TODO: check ignoring single/multimaster is ok for AUD access ?
1277 */
1278 
1279 #define DRXJ_ISAUDWRITE(addr) (((((addr)>>16)&1) == 1) ? true : false)
1280 #define DRXJ_DAP_AUDTRIF_TIMEOUT 80     /* millisec */
1281 /*============================================================================*/
1282 
1283 /*
1284 * \fn bool is_handled_by_aud_tr_if( u32 addr )
1285 * \brief Check if this address is handled by the audio token ring interface.
1286 * \param addr
1287 * \return bool
1288 * \retval true  Yes, handled by audio token ring interface
1289 * \retval false No, not handled by audio token ring interface
1290 *
1291 */
1292 static
1293 bool is_handled_by_aud_tr_if(u32 addr)
1294 {
1295         bool retval = false;
1296 
1297         if ((DRXDAP_FASI_ADDR2BLOCK(addr) == 4) &&
1298             (DRXDAP_FASI_ADDR2BANK(addr) > 1) &&
1299             (DRXDAP_FASI_ADDR2BANK(addr) < 6)) {
1300                 retval = true;
1301         }
1302 
1303         return retval;
1304 }
1305 
1306 /*============================================================================*/
1307 
1308 int drxbsp_i2c_write_read(struct i2c_device_addr *w_dev_addr,
1309                                  u16 w_count,
1310                                  u8 *wData,
1311                                  struct i2c_device_addr *r_dev_addr,
1312                                  u16 r_count, u8 *r_data)
1313 {
1314         struct drx39xxj_state *state;
1315         struct i2c_msg msg[2];
1316         unsigned int num_msgs;
1317 
1318         if (w_dev_addr == NULL) {
1319                 /* Read only */
1320                 state = r_dev_addr->user_data;
1321                 msg[0].addr = r_dev_addr->i2c_addr >> 1;
1322                 msg[0].flags = I2C_M_RD;
1323                 msg[0].buf = r_data;
1324                 msg[0].len = r_count;
1325                 num_msgs = 1;
1326         } else if (r_dev_addr == NULL) {
1327                 /* Write only */
1328                 state = w_dev_addr->user_data;
1329                 msg[0].addr = w_dev_addr->i2c_addr >> 1;
1330                 msg[0].flags = 0;
1331                 msg[0].buf = wData;
1332                 msg[0].len = w_count;
1333                 num_msgs = 1;
1334         } else {
1335                 /* Both write and read */
1336                 state = w_dev_addr->user_data;
1337                 msg[0].addr = w_dev_addr->i2c_addr >> 1;
1338                 msg[0].flags = 0;
1339                 msg[0].buf = wData;
1340                 msg[0].len = w_count;
1341                 msg[1].addr = r_dev_addr->i2c_addr >> 1;
1342                 msg[1].flags = I2C_M_RD;
1343                 msg[1].buf = r_data;
1344                 msg[1].len = r_count;
1345                 num_msgs = 2;
1346         }
1347 
1348         if (state->i2c == NULL) {
1349                 pr_err("i2c was zero, aborting\n");
1350                 return 0;
1351         }
1352         if (i2c_transfer(state->i2c, msg, num_msgs) != num_msgs) {
1353                 pr_warn("drx3933: I2C write/read failed\n");
1354                 return -EREMOTEIO;
1355         }
1356 
1357 #ifdef DJH_DEBUG
1358         if (w_dev_addr == NULL || r_dev_addr == NULL)
1359                 return 0;
1360 
1361         state = w_dev_addr->user_data;
1362 
1363         if (state->i2c == NULL)
1364                 return 0;
1365 
1366         msg[0].addr = w_dev_addr->i2c_addr;
1367         msg[0].flags = 0;
1368         msg[0].buf = wData;
1369         msg[0].len = w_count;
1370         msg[1].addr = r_dev_addr->i2c_addr;
1371         msg[1].flags = I2C_M_RD;
1372         msg[1].buf = r_data;
1373         msg[1].len = r_count;
1374         num_msgs = 2;
1375 
1376         pr_debug("drx3933 i2c operation addr=%x i2c=%p, wc=%x rc=%x\n",
1377                w_dev_addr->i2c_addr, state->i2c, w_count, r_count);
1378 
1379         if (i2c_transfer(state->i2c, msg, 2) != 2) {
1380                 pr_warn("drx3933: I2C write/read failed\n");
1381                 return -EREMOTEIO;
1382         }
1383 #endif
1384         return 0;
1385 }
1386 
1387 /*============================================================================*/
1388 
1389 /*****************************
1390 *
1391 * int drxdap_fasi_read_block (
1392 *      struct i2c_device_addr *dev_addr,      -- address of I2C device
1393 *      u32 addr,         -- address of chip register/memory
1394 *      u16            datasize,     -- number of bytes to read
1395 *      u8 *data,         -- data to receive
1396 *      u32 flags)        -- special device flags
1397 *
1398 * Read block data from chip address. Because the chip is word oriented,
1399 * the number of bytes to read must be even.
1400 *
1401 * Make sure that the buffer to receive the data is large enough.
1402 *
1403 * Although this function expects an even number of bytes, it is still byte
1404 * oriented, and the data read back is NOT translated to the endianness of
1405 * the target platform.
1406 *
1407 * Output:
1408 * - 0     if reading was successful
1409 *                  in that case: data read is in *data.
1410 * - -EIO  if anything went wrong
1411 *
1412 ******************************/
1413 
1414 static int drxdap_fasi_read_block(struct i2c_device_addr *dev_addr,
1415                                          u32 addr,
1416                                          u16 datasize,
1417                                          u8 *data, u32 flags)
1418 {
1419         u8 buf[4];
1420         u16 bufx;
1421         int rc;
1422         u16 overhead_size = 0;
1423 
1424         /* Check parameters ******************************************************* */
1425         if (dev_addr == NULL)
1426                 return -EINVAL;
1427 
1428         overhead_size = (IS_I2C_10BIT(dev_addr->i2c_addr) ? 2 : 1) +
1429             (DRXDAP_FASI_LONG_FORMAT(addr) ? 4 : 2);
1430 
1431         if ((DRXDAP_FASI_OFFSET_TOO_LARGE(addr)) ||
1432             ((!(DRXDAPFASI_LONG_ADDR_ALLOWED)) &&
1433              DRXDAP_FASI_LONG_FORMAT(addr)) ||
1434             (overhead_size > (DRXDAP_MAX_WCHUNKSIZE)) ||
1435             ((datasize != 0) && (data == NULL)) || ((datasize & 1) == 1)) {
1436                 return -EINVAL;
1437         }
1438 
1439         /* ReadModifyWrite & mode flag bits are not allowed */
1440         flags &= (~DRXDAP_FASI_RMW & ~DRXDAP_FASI_MODEFLAGS);
1441 #if DRXDAP_SINGLE_MASTER
1442         flags |= DRXDAP_FASI_SINGLE_MASTER;
1443 #endif
1444 
1445         /* Read block from I2C **************************************************** */
1446         do {
1447                 u16 todo = (datasize < DRXDAP_MAX_RCHUNKSIZE ?
1448                               datasize : DRXDAP_MAX_RCHUNKSIZE);
1449 
1450                 bufx = 0;
1451 
1452                 addr &= ~DRXDAP_FASI_FLAGS;
1453                 addr |= flags;
1454 
1455 #if ((DRXDAPFASI_LONG_ADDR_ALLOWED == 1) && (DRXDAPFASI_SHORT_ADDR_ALLOWED == 1))
1456                 /* short format address preferred but long format otherwise */
1457                 if (DRXDAP_FASI_LONG_FORMAT(addr)) {
1458 #endif
1459 #if (DRXDAPFASI_LONG_ADDR_ALLOWED == 1)
1460                         buf[bufx++] = (u8) (((addr << 1) & 0xFF) | 0x01);
1461                         buf[bufx++] = (u8) ((addr >> 16) & 0xFF);
1462                         buf[bufx++] = (u8) ((addr >> 24) & 0xFF);
1463                         buf[bufx++] = (u8) ((addr >> 7) & 0xFF);
1464 #endif
1465 #if ((DRXDAPFASI_LONG_ADDR_ALLOWED == 1) && (DRXDAPFASI_SHORT_ADDR_ALLOWED == 1))
1466                 } else {
1467 #endif
1468 #if (DRXDAPFASI_SHORT_ADDR_ALLOWED == 1)
1469                         buf[bufx++] = (u8) ((addr << 1) & 0xFF);
1470                         buf[bufx++] =
1471                             (u8) (((addr >> 16) & 0x0F) |
1472                                     ((addr >> 18) & 0xF0));
1473 #endif
1474 #if ((DRXDAPFASI_LONG_ADDR_ALLOWED == 1) && (DRXDAPFASI_SHORT_ADDR_ALLOWED == 1))
1475                 }
1476 #endif
1477 
1478 #if DRXDAP_SINGLE_MASTER
1479                 /*
1480                  * In single master mode, split the read and write actions.
1481                  * No special action is needed for write chunks here.
1482                  */
1483                 rc = drxbsp_i2c_write_read(dev_addr, bufx, buf,
1484                                            NULL, 0, NULL);
1485                 if (rc == 0)
1486                         rc = drxbsp_i2c_write_read(NULL, 0, NULL, dev_addr, todo, data);
1487 #else
1488                 /* In multi master mode, do everything in one RW action */
1489                 rc = drxbsp_i2c_write_read(dev_addr, bufx, buf, dev_addr, todo,
1490                                           data);
1491 #endif
1492                 data += todo;
1493                 addr += (todo >> 1);
1494                 datasize -= todo;
1495         } while (datasize && rc == 0);
1496 
1497         return rc;
1498 }
1499 
1500 
1501 /*****************************
1502 *
1503 * int drxdap_fasi_read_reg16 (
1504 *     struct i2c_device_addr *dev_addr, -- address of I2C device
1505 *     u32 addr,    -- address of chip register/memory
1506 *     u16 *data,    -- data to receive
1507 *     u32 flags)   -- special device flags
1508 *
1509 * Read one 16-bit register or memory location. The data received back is
1510 * converted back to the target platform's endianness.
1511 *
1512 * Output:
1513 * - 0     if reading was successful
1514 *                  in that case: read data is at *data
1515 * - -EIO  if anything went wrong
1516 *
1517 ******************************/
1518 
1519 static int drxdap_fasi_read_reg16(struct i2c_device_addr *dev_addr,
1520                                          u32 addr,
1521                                          u16 *data, u32 flags)
1522 {
1523         u8 buf[sizeof(*data)];
1524         int rc;
1525 
1526         if (!data)
1527                 return -EINVAL;
1528 
1529         rc = drxdap_fasi_read_block(dev_addr, addr, sizeof(*data), buf, flags);
1530         *data = buf[0] + (((u16) buf[1]) << 8);
1531         return rc;
1532 }
1533 
1534 /*****************************
1535 *
1536 * int drxdap_fasi_read_reg32 (
1537 *     struct i2c_device_addr *dev_addr, -- address of I2C device
1538 *     u32 addr,    -- address of chip register/memory
1539 *     u32 *data,    -- data to receive
1540 *     u32 flags)   -- special device flags
1541 *
1542 * Read one 32-bit register or memory location. The data received back is
1543 * converted back to the target platform's endianness.
1544 *
1545 * Output:
1546 * - 0     if reading was successful
1547 *                  in that case: read data is at *data
1548 * - -EIO  if anything went wrong
1549 *
1550 ******************************/
1551 
1552 static int drxdap_fasi_read_reg32(struct i2c_device_addr *dev_addr,
1553                                          u32 addr,
1554                                          u32 *data, u32 flags)
1555 {
1556         u8 buf[sizeof(*data)];
1557         int rc;
1558 
1559         if (!data)
1560                 return -EINVAL;
1561 
1562         rc = drxdap_fasi_read_block(dev_addr, addr, sizeof(*data), buf, flags);
1563         *data = (((u32) buf[0]) << 0) +
1564             (((u32) buf[1]) << 8) +
1565             (((u32) buf[2]) << 16) + (((u32) buf[3]) << 24);
1566         return rc;
1567 }
1568 
1569 /*****************************
1570 *
1571 * int drxdap_fasi_write_block (
1572 *      struct i2c_device_addr *dev_addr,    -- address of I2C device
1573 *      u32 addr,       -- address of chip register/memory
1574 *      u16            datasize,   -- number of bytes to read
1575 *      u8 *data,       -- data to receive
1576 *      u32 flags)      -- special device flags
1577 *
1578 * Write block data to chip address. Because the chip is word oriented,
1579 * the number of bytes to write must be even.
1580 *
1581 * Although this function expects an even number of bytes, it is still byte
1582 * oriented, and the data being written is NOT translated from the endianness of
1583 * the target platform.
1584 *
1585 * Output:
1586 * - 0     if writing was successful
1587 * - -EIO  if anything went wrong
1588 *
1589 ******************************/
1590 
1591 static int drxdap_fasi_write_block(struct i2c_device_addr *dev_addr,
1592                                           u32 addr,
1593                                           u16 datasize,
1594                                           u8 *data, u32 flags)
1595 {
1596         u8 buf[DRXDAP_MAX_WCHUNKSIZE];
1597         int st = -EIO;
1598         int first_err = 0;
1599         u16 overhead_size = 0;
1600         u16 block_size = 0;
1601 
1602         /* Check parameters ******************************************************* */
1603         if (dev_addr == NULL)
1604                 return -EINVAL;
1605 
1606         overhead_size = (IS_I2C_10BIT(dev_addr->i2c_addr) ? 2 : 1) +
1607             (DRXDAP_FASI_LONG_FORMAT(addr) ? 4 : 2);
1608 
1609         if ((DRXDAP_FASI_OFFSET_TOO_LARGE(addr)) ||
1610             ((!(DRXDAPFASI_LONG_ADDR_ALLOWED)) &&
1611              DRXDAP_FASI_LONG_FORMAT(addr)) ||
1612             (overhead_size > (DRXDAP_MAX_WCHUNKSIZE)) ||
1613             ((datasize != 0) && (data == NULL)) || ((datasize & 1) == 1))
1614                 return -EINVAL;
1615 
1616         flags &= DRXDAP_FASI_FLAGS;
1617         flags &= ~DRXDAP_FASI_MODEFLAGS;
1618 #if DRXDAP_SINGLE_MASTER
1619         flags |= DRXDAP_FASI_SINGLE_MASTER;
1620 #endif
1621 
1622         /* Write block to I2C ***************************************************** */
1623         block_size = ((DRXDAP_MAX_WCHUNKSIZE) - overhead_size) & ~1;
1624         do {
1625                 u16 todo = 0;
1626                 u16 bufx = 0;
1627 
1628                 /* Buffer device address */
1629                 addr &= ~DRXDAP_FASI_FLAGS;
1630                 addr |= flags;
1631 #if (((DRXDAPFASI_LONG_ADDR_ALLOWED) == 1) && ((DRXDAPFASI_SHORT_ADDR_ALLOWED) == 1))
1632                 /* short format address preferred but long format otherwise */
1633                 if (DRXDAP_FASI_LONG_FORMAT(addr)) {
1634 #endif
1635 #if ((DRXDAPFASI_LONG_ADDR_ALLOWED) == 1)
1636                         buf[bufx++] = (u8) (((addr << 1) & 0xFF) | 0x01);
1637                         buf[bufx++] = (u8) ((addr >> 16) & 0xFF);
1638                         buf[bufx++] = (u8) ((addr >> 24) & 0xFF);
1639                         buf[bufx++] = (u8) ((addr >> 7) & 0xFF);
1640 #endif
1641 #if (((DRXDAPFASI_LONG_ADDR_ALLOWED) == 1) && ((DRXDAPFASI_SHORT_ADDR_ALLOWED) == 1))
1642                 } else {
1643 #endif
1644 #if ((DRXDAPFASI_SHORT_ADDR_ALLOWED) == 1)
1645                         buf[bufx++] = (u8) ((addr << 1) & 0xFF);
1646                         buf[bufx++] =
1647                             (u8) (((addr >> 16) & 0x0F) |
1648                                     ((addr >> 18) & 0xF0));
1649 #endif
1650 #if (((DRXDAPFASI_LONG_ADDR_ALLOWED) == 1) && ((DRXDAPFASI_SHORT_ADDR_ALLOWED) == 1))
1651                 }
1652 #endif
1653 
1654                 /*
1655                    In single master mode block_size can be 0. In such a case this I2C
1656                    sequense will be visible: (1) write address {i2c addr,
1657                    4 bytes chip address} (2) write data {i2c addr, 4 bytes data }
1658                    (3) write address (4) write data etc...
1659                    Address must be rewritten because HI is reset after data transport and
1660                    expects an address.
1661                  */
1662                 todo = (block_size < datasize ? block_size : datasize);
1663                 if (todo == 0) {
1664                         u16 overhead_size_i2c_addr = 0;
1665                         u16 data_block_size = 0;
1666 
1667                         overhead_size_i2c_addr =
1668                             (IS_I2C_10BIT(dev_addr->i2c_addr) ? 2 : 1);
1669                         data_block_size =
1670                             (DRXDAP_MAX_WCHUNKSIZE - overhead_size_i2c_addr) & ~1;
1671 
1672                         /* write device address */
1673                         st = drxbsp_i2c_write_read(dev_addr,
1674                                                   (u16) (bufx),
1675                                                   buf,
1676                                                   (struct i2c_device_addr *)(NULL),
1677                                                   0, (u8 *)(NULL));
1678 
1679                         if ((st != 0) && (first_err == 0)) {
1680                                 /* at the end, return the first error encountered */
1681                                 first_err = st;
1682                         }
1683                         bufx = 0;
1684                         todo =
1685                             (data_block_size <
1686                              datasize ? data_block_size : datasize);
1687                 }
1688                 memcpy(&buf[bufx], data, todo);
1689                 /* write (address if can do and) data */
1690                 st = drxbsp_i2c_write_read(dev_addr,
1691                                           (u16) (bufx + todo),
1692                                           buf,
1693                                           (struct i2c_device_addr *)(NULL),
1694                                           0, (u8 *)(NULL));
1695 
1696                 if ((st != 0) && (first_err == 0)) {
1697                         /* at the end, return the first error encountered */
1698                         first_err = st;
1699                 }
1700                 datasize -= todo;
1701                 data += todo;
1702                 addr += (todo >> 1);
1703         } while (datasize);
1704 
1705         return first_err;
1706 }
1707 
1708 /*****************************
1709 *
1710 * int drxdap_fasi_write_reg16 (
1711 *     struct i2c_device_addr *dev_addr, -- address of I2C device
1712 *     u32 addr,    -- address of chip register/memory
1713 *     u16            data,    -- data to send
1714 *     u32 flags)   -- special device flags
1715 *
1716 * Write one 16-bit register or memory location. The data being written is
1717 * converted from the target platform's endianness to little endian.
1718 *
1719 * Output:
1720 * - 0     if writing was successful
1721 * - -EIO  if anything went wrong
1722 *
1723 ******************************/
1724 
1725 static int drxdap_fasi_write_reg16(struct i2c_device_addr *dev_addr,
1726                                           u32 addr,
1727                                           u16 data, u32 flags)
1728 {
1729         u8 buf[sizeof(data)];
1730 
1731         buf[0] = (u8) ((data >> 0) & 0xFF);
1732         buf[1] = (u8) ((data >> 8) & 0xFF);
1733 
1734         return drxdap_fasi_write_block(dev_addr, addr, sizeof(data), buf, flags);
1735 }
1736 
1737 /*****************************
1738 *
1739 * int drxdap_fasi_read_modify_write_reg16 (
1740 *      struct i2c_device_addr *dev_addr,   -- address of I2C device
1741 *      u32 waddr,     -- address of chip register/memory
1742 *      u32 raddr,     -- chip address to read back from
1743 *      u16            wdata,     -- data to send
1744 *      u16 *rdata)     -- data to receive back
1745 *
1746 * Write 16-bit data, then read back the original contents of that location.
1747 * Requires long addressing format to be allowed.
1748 *
1749 * Before sending data, the data is converted to little endian. The
1750 * data received back is converted back to the target platform's endianness.
1751 *
1752 * WARNING: This function is only guaranteed to work if there is one
1753 * master on the I2C bus.
1754 *
1755 * Output:
1756 * - 0     if reading was successful
1757 *                  in that case: read back data is at *rdata
1758 * - -EIO  if anything went wrong
1759 *
1760 ******************************/
1761 
1762 static int drxdap_fasi_read_modify_write_reg16(struct i2c_device_addr *dev_addr,
1763                                                     u32 waddr,
1764                                                     u32 raddr,
1765                                                     u16 wdata, u16 *rdata)
1766 {
1767         int rc = -EIO;
1768 
1769 #if (DRXDAPFASI_LONG_ADDR_ALLOWED == 1)
1770         if (rdata == NULL)
1771                 return -EINVAL;
1772 
1773         rc = drxdap_fasi_write_reg16(dev_addr, waddr, wdata, DRXDAP_FASI_RMW);
1774         if (rc == 0)
1775                 rc = drxdap_fasi_read_reg16(dev_addr, raddr, rdata, 0);
1776 #endif
1777 
1778         return rc;
1779 }
1780 
1781 /*****************************
1782 *
1783 * int drxdap_fasi_write_reg32 (
1784 *     struct i2c_device_addr *dev_addr, -- address of I2C device
1785 *     u32 addr,    -- address of chip register/memory
1786 *     u32            data,    -- data to send
1787 *     u32 flags)   -- special device flags
1788 *
1789 * Write one 32-bit register or memory location. The data being written is
1790 * converted from the target platform's endianness to little endian.
1791 *
1792 * Output:
1793 * - 0     if writing was successful
1794 * - -EIO  if anything went wrong
1795 *
1796 ******************************/
1797 
1798 static int drxdap_fasi_write_reg32(struct i2c_device_addr *dev_addr,
1799                                           u32 addr,
1800                                           u32 data, u32 flags)
1801 {
1802         u8 buf[sizeof(data)];
1803 
1804         buf[0] = (u8) ((data >> 0) & 0xFF);
1805         buf[1] = (u8) ((data >> 8) & 0xFF);
1806         buf[2] = (u8) ((data >> 16) & 0xFF);
1807         buf[3] = (u8) ((data >> 24) & 0xFF);
1808 
1809         return drxdap_fasi_write_block(dev_addr, addr, sizeof(data), buf, flags);
1810 }
1811 
1812 /*============================================================================*/
1813 
1814 /*
1815 * \fn int drxj_dap_rm_write_reg16short
1816 * \brief Read modify write 16 bits audio register using short format only.
1817 * \param dev_addr
1818 * \param waddr    Address to write to
1819 * \param raddr    Address to read from (usually SIO_HI_RA_RAM_S0_RMWBUF__A)
1820 * \param wdata    Data to write
1821 * \param rdata    Buffer for data to read
1822 * \return int
1823 * \retval 0 Success
1824 * \retval -EIO Timeout, I2C error, illegal bank
1825 *
1826 * 16 bits register read modify write access using short addressing format only.
1827 * Requires knowledge of the registermap, thus device dependent.
1828 * Using DAP FASI directly to avoid endless recursion of RMWs to audio registers.
1829 *
1830 */
1831 
1832 /* TODO correct define should be #if ( DRXDAPFASI_SHORT_ADDR_ALLOWED==1 )
1833    See comments drxj_dap_read_modify_write_reg16 */
1834 #if (DRXDAPFASI_LONG_ADDR_ALLOWED == 0)
1835 static int drxj_dap_rm_write_reg16short(struct i2c_device_addr *dev_addr,
1836                                               u32 waddr,
1837                                               u32 raddr,
1838                                               u16 wdata, u16 *rdata)
1839 {
1840         int rc;
1841 
1842         if (rdata == NULL)
1843                 return -EINVAL;
1844 
1845         /* Set RMW flag */
1846         rc = drxdap_fasi_write_reg16(dev_addr,
1847                                               SIO_HI_RA_RAM_S0_FLG_ACC__A,
1848                                               SIO_HI_RA_RAM_S0_FLG_ACC_S0_RWM__M,
1849                                               0x0000);
1850         if (rc == 0) {
1851                 /* Write new data: triggers RMW */
1852                 rc = drxdap_fasi_write_reg16(dev_addr, waddr, wdata,
1853                                                       0x0000);
1854         }
1855         if (rc == 0) {
1856                 /* Read old data */
1857                 rc = drxdap_fasi_read_reg16(dev_addr, raddr, rdata,
1858                                                      0x0000);
1859         }
1860         if (rc == 0) {
1861                 /* Reset RMW flag */
1862                 rc = drxdap_fasi_write_reg16(dev_addr,
1863                                                       SIO_HI_RA_RAM_S0_FLG_ACC__A,
1864                                                       0, 0x0000);
1865         }
1866 
1867         return rc;
1868 }
1869 #endif
1870 
1871 /*============================================================================*/
1872 
1873 static int drxj_dap_read_modify_write_reg16(struct i2c_device_addr *dev_addr,
1874                                                  u32 waddr,
1875                                                  u32 raddr,
1876                                                  u16 wdata, u16 *rdata)
1877 {
1878         /* TODO: correct short/long addressing format decision,
1879            now long format has higher prio then short because short also
1880            needs virt bnks (not impl yet) for certain audio registers */
1881 #if (DRXDAPFASI_LONG_ADDR_ALLOWED == 1)
1882         return drxdap_fasi_read_modify_write_reg16(dev_addr,
1883                                                           waddr,
1884                                                           raddr, wdata, rdata);
1885 #else
1886         return drxj_dap_rm_write_reg16short(dev_addr, waddr, raddr, wdata, rdata);
1887 #endif
1888 }
1889 
1890 
1891 /*============================================================================*/
1892 
1893 /*
1894 * \fn int drxj_dap_read_aud_reg16
1895 * \brief Read 16 bits audio register
1896 * \param dev_addr
1897 * \param addr
1898 * \param data
1899 * \return int
1900 * \retval 0 Success
1901 * \retval -EIO Timeout, I2C error, illegal bank
1902 *
1903 * 16 bits register read access via audio token ring interface.
1904 *
1905 */
1906 static int drxj_dap_read_aud_reg16(struct i2c_device_addr *dev_addr,
1907                                          u32 addr, u16 *data)
1908 {
1909         u32 start_timer = 0;
1910         u32 current_timer = 0;
1911         u32 delta_timer = 0;
1912         u16 tr_status = 0;
1913         int stat = -EIO;
1914 
1915         /* No read possible for bank 3, return with error */
1916         if (DRXDAP_FASI_ADDR2BANK(addr) == 3) {
1917                 stat = -EINVAL;
1918         } else {
1919                 const u32 write_bit = ((dr_xaddr_t) 1) << 16;
1920 
1921                 /* Force reset write bit */
1922                 addr &= (~write_bit);
1923 
1924                 /* Set up read */
1925                 start_timer = jiffies_to_msecs(jiffies);
1926                 do {
1927                         /* RMW to aud TR IF until request is granted or timeout */
1928                         stat = drxj_dap_read_modify_write_reg16(dev_addr,
1929                                                              addr,
1930                                                              SIO_HI_RA_RAM_S0_RMWBUF__A,
1931                                                              0x0000, &tr_status);
1932 
1933                         if (stat != 0)
1934                                 break;
1935 
1936                         current_timer = jiffies_to_msecs(jiffies);
1937                         delta_timer = current_timer - start_timer;
1938                         if (delta_timer > DRXJ_DAP_AUDTRIF_TIMEOUT) {
1939                                 stat = -EIO;
1940                                 break;
1941                         }
1942 
1943                 } while (((tr_status & AUD_TOP_TR_CTR_FIFO_LOCK__M) ==
1944                           AUD_TOP_TR_CTR_FIFO_LOCK_LOCKED) ||
1945                          ((tr_status & AUD_TOP_TR_CTR_FIFO_FULL__M) ==
1946                           AUD_TOP_TR_CTR_FIFO_FULL_FULL));
1947         }                       /* if ( DRXDAP_FASI_ADDR2BANK(addr)!=3 ) */
1948 
1949         /* Wait for read ready status or timeout */
1950         if (stat == 0) {
1951                 start_timer = jiffies_to_msecs(jiffies);
1952 
1953                 while ((tr_status & AUD_TOP_TR_CTR_FIFO_RD_RDY__M) !=
1954                        AUD_TOP_TR_CTR_FIFO_RD_RDY_READY) {
1955                         stat = drxj_dap_read_reg16(dev_addr,
1956                                                   AUD_TOP_TR_CTR__A,
1957                                                   &tr_status, 0x0000);
1958                         if (stat != 0)
1959                                 break;
1960 
1961                         current_timer = jiffies_to_msecs(jiffies);
1962                         delta_timer = current_timer - start_timer;
1963                         if (delta_timer > DRXJ_DAP_AUDTRIF_TIMEOUT) {
1964                                 stat = -EIO;
1965                                 break;
1966                         }
1967                 }               /* while ( ... ) */
1968         }
1969 
1970         /* Read value */
1971         if (stat == 0)
1972                 stat = drxj_dap_read_modify_write_reg16(dev_addr,
1973                                                      AUD_TOP_TR_RD_REG__A,
1974                                                      SIO_HI_RA_RAM_S0_RMWBUF__A,
1975                                                      0x0000, data);
1976         return stat;
1977 }
1978 
1979 /*============================================================================*/
1980 
1981 static int drxj_dap_read_reg16(struct i2c_device_addr *dev_addr,
1982                                       u32 addr,
1983                                       u16 *data, u32 flags)
1984 {
1985         int stat = -EIO;
1986 
1987         /* Check param */
1988         if ((dev_addr == NULL) || (data == NULL))
1989                 return -EINVAL;
1990 
1991         if (is_handled_by_aud_tr_if(addr))
1992                 stat = drxj_dap_read_aud_reg16(dev_addr, addr, data);
1993         else
1994                 stat = drxdap_fasi_read_reg16(dev_addr, addr, data, flags);
1995 
1996         return stat;
1997 }
1998 /*============================================================================*/
1999 
2000 /*
2001 * \fn int drxj_dap_write_aud_reg16
2002 * \brief Write 16 bits audio register
2003 * \param dev_addr
2004 * \param addr
2005 * \param data
2006 * \return int
2007 * \retval 0 Success
2008 * \retval -EIO Timeout, I2C error, illegal bank
2009 *
2010 * 16 bits register write access via audio token ring interface.
2011 *
2012 */
2013 static int drxj_dap_write_aud_reg16(struct i2c_device_addr *dev_addr,
2014                                           u32 addr, u16 data)
2015 {
2016         int stat = -EIO;
2017 
2018         /* No write possible for bank 2, return with error */
2019         if (DRXDAP_FASI_ADDR2BANK(addr) == 2) {
2020                 stat = -EINVAL;
2021         } else {
2022                 u32 start_timer = 0;
2023                 u32 current_timer = 0;
2024                 u32 delta_timer = 0;
2025                 u16 tr_status = 0;
2026                 const u32 write_bit = ((dr_xaddr_t) 1) << 16;
2027 
2028                 /* Force write bit */
2029                 addr |= write_bit;
2030                 start_timer = jiffies_to_msecs(jiffies);
2031                 do {
2032                         /* RMW to aud TR IF until request is granted or timeout */
2033                         stat = drxj_dap_read_modify_write_reg16(dev_addr,
2034                                                              addr,
2035                                                              SIO_HI_RA_RAM_S0_RMWBUF__A,
2036                                                              data, &tr_status);
2037                         if (stat != 0)
2038                                 break;
2039 
2040                         current_timer = jiffies_to_msecs(jiffies);
2041                         delta_timer = current_timer - start_timer;
2042                         if (delta_timer > DRXJ_DAP_AUDTRIF_TIMEOUT) {
2043                                 stat = -EIO;
2044                                 break;
2045                         }
2046 
2047                 } while (((tr_status & AUD_TOP_TR_CTR_FIFO_LOCK__M) ==
2048                           AUD_TOP_TR_CTR_FIFO_LOCK_LOCKED) ||
2049                          ((tr_status & AUD_TOP_TR_CTR_FIFO_FULL__M) ==
2050                           AUD_TOP_TR_CTR_FIFO_FULL_FULL));
2051 
2052         }                       /* if ( DRXDAP_FASI_ADDR2BANK(addr)!=2 ) */
2053 
2054         return stat;
2055 }
2056 
2057 /*============================================================================*/
2058 
2059 static int drxj_dap_write_reg16(struct i2c_device_addr *dev_addr,
2060                                        u32 addr,
2061                                        u16 data, u32 flags)
2062 {
2063         int stat = -EIO;
2064 
2065         /* Check param */
2066         if (dev_addr == NULL)
2067                 return -EINVAL;
2068 
2069         if (is_handled_by_aud_tr_if(addr))
2070                 stat = drxj_dap_write_aud_reg16(dev_addr, addr, data);
2071         else
2072                 stat = drxdap_fasi_write_reg16(dev_addr,
2073                                                             addr, data, flags);
2074 
2075         return stat;
2076 }
2077 
2078 /*============================================================================*/
2079 
2080 /* Free data ram in SIO HI */
2081 #define SIO_HI_RA_RAM_USR_BEGIN__A 0x420040
2082 #define SIO_HI_RA_RAM_USR_END__A   0x420060
2083 
2084 #define DRXJ_HI_ATOMIC_BUF_START (SIO_HI_RA_RAM_USR_BEGIN__A)
2085 #define DRXJ_HI_ATOMIC_BUF_END   (SIO_HI_RA_RAM_USR_BEGIN__A + 7)
2086 #define DRXJ_HI_ATOMIC_READ      SIO_HI_RA_RAM_PAR_3_ACP_RW_READ
2087 #define DRXJ_HI_ATOMIC_WRITE     SIO_HI_RA_RAM_PAR_3_ACP_RW_WRITE
2088 
2089 /*
2090 * \fn int drxj_dap_atomic_read_write_block()
2091 * \brief Basic access routine for atomic read or write access
2092 * \param dev_addr  pointer to i2c dev address
2093 * \param addr     destination/source address
2094 * \param datasize size of data buffer in bytes
2095 * \param data     pointer to data buffer
2096 * \return int
2097 * \retval 0 Success
2098 * \retval -EIO Timeout, I2C error, illegal bank
2099 *
2100 */
2101 static
2102 int drxj_dap_atomic_read_write_block(struct i2c_device_addr *dev_addr,
2103                                           u32 addr,
2104                                           u16 datasize,
2105                                           u8 *data, bool read_flag)
2106 {
2107         struct drxj_hi_cmd hi_cmd;
2108         int rc;
2109         u16 word;
2110         u16 dummy = 0;
2111         u16 i = 0;
2112 
2113         /* Parameter check */
2114         if (!data || !dev_addr || ((datasize % 2)) || ((datasize / 2) > 8))
2115                 return -EINVAL;
2116 
2117         /* Set up HI parameters to read or write n bytes */
2118         hi_cmd.cmd = SIO_HI_RA_RAM_CMD_ATOMIC_COPY;
2119         hi_cmd.param1 =
2120             (u16) ((DRXDAP_FASI_ADDR2BLOCK(DRXJ_HI_ATOMIC_BUF_START) << 6) +
2121                      DRXDAP_FASI_ADDR2BANK(DRXJ_HI_ATOMIC_BUF_START));
2122         hi_cmd.param2 =
2123             (u16) DRXDAP_FASI_ADDR2OFFSET(DRXJ_HI_ATOMIC_BUF_START);
2124         hi_cmd.param3 = (u16) ((datasize / 2) - 1);
2125         if (!read_flag)
2126                 hi_cmd.param3 |= DRXJ_HI_ATOMIC_WRITE;
2127         else
2128                 hi_cmd.param3 |= DRXJ_HI_ATOMIC_READ;
2129         hi_cmd.param4 = (u16) ((DRXDAP_FASI_ADDR2BLOCK(addr) << 6) +
2130                                 DRXDAP_FASI_ADDR2BANK(addr));
2131         hi_cmd.param5 = (u16) DRXDAP_FASI_ADDR2OFFSET(addr);
2132 
2133         if (!read_flag) {
2134                 /* write data to buffer */
2135                 for (i = 0; i < (datasize / 2); i++) {
2136 
2137                         word = ((u16) data[2 * i]);
2138                         word += (((u16) data[(2 * i) + 1]) << 8);
2139                         drxj_dap_write_reg16(dev_addr,
2140                                              (DRXJ_HI_ATOMIC_BUF_START + i),
2141                                             word, 0);
2142                 }
2143         }
2144 
2145         rc = hi_command(dev_addr, &hi_cmd, &dummy);
2146         if (rc != 0) {
2147                 pr_err("error %d\n", rc);
2148                 goto rw_error;
2149         }
2150 
2151         if (read_flag) {
2152                 /* read data from buffer */
2153                 for (i = 0; i < (datasize / 2); i++) {
2154                         rc = drxj_dap_read_reg16(dev_addr,
2155                                                  (DRXJ_HI_ATOMIC_BUF_START + i),
2156                                                  &word, 0);
2157                         if (rc) {
2158                                 pr_err("error %d\n", rc);
2159                                 goto rw_error;
2160                         }
2161                         data[2 * i] = (u8) (word & 0xFF);
2162                         data[(2 * i) + 1] = (u8) (word >> 8);
2163                 }
2164         }
2165 
2166         return 0;
2167 
2168 rw_error:
2169         return rc;
2170 
2171 }
2172 
2173 /*============================================================================*/
2174 
2175 /*
2176 * \fn int drxj_dap_atomic_read_reg32()
2177 * \brief Atomic read of 32 bits words
2178 */
2179 static
2180 int drxj_dap_atomic_read_reg32(struct i2c_device_addr *dev_addr,
2181                                      u32 addr,
2182                                      u32 *data, u32 flags)
2183 {
2184         u8 buf[sizeof(*data)] = { 0 };
2185         int rc = -EIO;
2186         u32 word = 0;
2187 
2188         if (!data)
2189                 return -EINVAL;
2190 
2191         rc = drxj_dap_atomic_read_write_block(dev_addr, addr,
2192                                               sizeof(*data), buf, true);
2193 
2194         if (rc < 0)
2195                 return 0;
2196 
2197         word = (u32) buf[3];
2198         word <<= 8;
2199         word |= (u32) buf[2];
2200         word <<= 8;
2201         word |= (u32) buf[1];
2202         word <<= 8;
2203         word |= (u32) buf[0];
2204 
2205         *data = word;
2206 
2207         return rc;
2208 }
2209 
2210 /*============================================================================*/
2211 
2212 /*============================================================================*/
2213 /*==                        END DRXJ DAP FUNCTIONS                          ==*/
2214 /*============================================================================*/
2215 
2216 /*============================================================================*/
2217 /*============================================================================*/
2218 /*==                      HOST INTERFACE FUNCTIONS                          ==*/
2219 /*============================================================================*/
2220 /*============================================================================*/
2221 
2222 /*
2223 * \fn int hi_cfg_command()
2224 * \brief Configure HI with settings stored in the demod structure.
2225 * \param demod Demodulator.
2226 * \return int.
2227 *
2228 * This routine was created because to much orthogonal settings have
2229 * been put into one HI API function (configure). Especially the I2C bridge
2230 * enable/disable should not need re-configuration of the HI.
2231 *
2232 */
2233 static int hi_cfg_command(const struct drx_demod_instance *demod)
2234 {
2235         struct drxj_data *ext_attr = (struct drxj_data *) (NULL);
2236         struct drxj_hi_cmd hi_cmd;
2237         u16 result = 0;
2238         int rc;
2239 
2240         ext_attr = (struct drxj_data *) demod->my_ext_attr;
2241 
2242         hi_cmd.cmd = SIO_HI_RA_RAM_CMD_CONFIG;
2243         hi_cmd.param1 = SIO_HI_RA_RAM_PAR_1_PAR1_SEC_KEY;
2244         hi_cmd.param2 = ext_attr->hi_cfg_timing_div;
2245         hi_cmd.param3 = ext_attr->hi_cfg_bridge_delay;
2246         hi_cmd.param4 = ext_attr->hi_cfg_wake_up_key;
2247         hi_cmd.param5 = ext_attr->hi_cfg_ctrl;
2248         hi_cmd.param6 = ext_attr->hi_cfg_transmit;
2249 
2250         rc = hi_command(demod->my_i2c_dev_addr, &hi_cmd, &result);
2251         if (rc != 0) {
2252                 pr_err("error %d\n", rc);
2253                 goto rw_error;
2254         }
2255 
2256         /* Reset power down flag (set one call only) */
2257         ext_attr->hi_cfg_ctrl &= (~(SIO_HI_RA_RAM_PAR_5_CFG_SLEEP_ZZZ));
2258 
2259         return 0;
2260 
2261 rw_error:
2262         return rc;
2263 }
2264 
2265 /*
2266 * \fn int hi_command()
2267 * \brief Configure HI with settings stored in the demod structure.
2268 * \param dev_addr I2C address.
2269 * \param cmd HI command.
2270 * \param result HI command result.
2271 * \return int.
2272 *
2273 * Sends command to HI
2274 *
2275 */
2276 static int
2277 hi_command(struct i2c_device_addr *dev_addr, const struct drxj_hi_cmd *cmd, u16 *result)
2278 {
2279         u16 wait_cmd = 0;
2280         u16 nr_retries = 0;
2281         bool powerdown_cmd = false;
2282         int rc;
2283 
2284         /* Write parameters */
2285         switch (cmd->cmd) {
2286 
2287         case SIO_HI_RA_RAM_CMD_CONFIG:
2288         case SIO_HI_RA_RAM_CMD_ATOMIC_COPY:
2289                 rc = drxj_dap_write_reg16(dev_addr, SIO_HI_RA_RAM_PAR_6__A, cmd->param6, 0);
2290                 if (rc != 0) {
2291                         pr_err("error %d\n", rc);
2292                         goto rw_error;
2293                 }
2294                 rc = drxj_dap_write_reg16(dev_addr, SIO_HI_RA_RAM_PAR_5__A, cmd->param5, 0);
2295                 if (rc != 0) {
2296                         pr_err("error %d\n", rc);
2297                         goto rw_error;
2298                 }
2299                 rc = drxj_dap_write_reg16(dev_addr, SIO_HI_RA_RAM_PAR_4__A, cmd->param4, 0);
2300                 if (rc != 0) {
2301                         pr_err("error %d\n", rc);
2302                         goto rw_error;
2303                 }
2304                 rc = drxj_dap_write_reg16(dev_addr, SIO_HI_RA_RAM_PAR_3__A, cmd->param3, 0);
2305                 if (rc != 0) {
2306                         pr_err("error %d\n", rc);
2307                         goto rw_error;
2308                 }
2309                 /* fallthrough */
2310         case SIO_HI_RA_RAM_CMD_BRDCTRL:
2311                 rc = drxj_dap_write_reg16(dev_addr, SIO_HI_RA_RAM_PAR_2__A, cmd->param2, 0);
2312                 if (rc != 0) {
2313                         pr_err("error %d\n", rc);
2314                         goto rw_error;
2315                 }
2316                 rc = drxj_dap_write_reg16(dev_addr, SIO_HI_RA_RAM_PAR_1__A, cmd->param1, 0);
2317                 if (rc != 0) {
2318                         pr_err("error %d\n", rc);
2319                         goto rw_error;
2320                 }
2321                 /* fallthrough */
2322         case SIO_HI_RA_RAM_CMD_NULL:
2323                 /* No parameters */
2324                 break;
2325 
2326         default:
2327                 return -EINVAL;
2328                 break;
2329         }
2330 
2331         /* Write command */
2332         rc = drxj_dap_write_reg16(dev_addr, SIO_HI_RA_RAM_CMD__A, cmd->cmd, 0);
2333         if (rc != 0) {
2334                 pr_err("error %d\n", rc);
2335                 goto rw_error;
2336         }
2337 
2338         if ((cmd->cmd) == SIO_HI_RA_RAM_CMD_RESET)
2339                 msleep(1);
2340 
2341         /* Detect power down to omit reading result */
2342         powerdown_cmd = (bool) ((cmd->cmd == SIO_HI_RA_RAM_CMD_CONFIG) &&
2343                                   (((cmd->
2344                                      param5) & SIO_HI_RA_RAM_PAR_5_CFG_SLEEP__M)
2345                                    == SIO_HI_RA_RAM_PAR_5_CFG_SLEEP_ZZZ));
2346         if (!powerdown_cmd) {
2347                 /* Wait until command rdy */
2348                 do {
2349                         nr_retries++;
2350                         if (nr_retries > DRXJ_MAX_RETRIES) {
2351                                 pr_err("timeout\n");
2352                                 goto rw_error;
2353                         }
2354 
2355                         rc = drxj_dap_read_reg16(dev_addr, SIO_HI_RA_RAM_CMD__A, &wait_cmd, 0);
2356                         if (rc != 0) {
2357                                 pr_err("error %d\n", rc);
2358                                 goto rw_error;
2359                         }
2360                 } while (wait_cmd != 0);
2361 
2362                 /* Read result */
2363                 rc = drxj_dap_read_reg16(dev_addr, SIO_HI_RA_RAM_RES__A, result, 0);
2364                 if (rc != 0) {
2365                         pr_err("error %d\n", rc);
2366                         goto rw_error;
2367                 }
2368 
2369         }
2370         /* if ( powerdown_cmd == true ) */
2371         return 0;
2372 rw_error:
2373         return rc;
2374 }
2375 
2376 /*
2377 * \fn int init_hi( const struct drx_demod_instance *demod )
2378 * \brief Initialise and configurate HI.
2379 * \param demod pointer to demod data.
2380 * \return int Return status.
2381 * \retval 0 Success.
2382 * \retval -EIO Failure.
2383 *
2384 * Needs to know Psys (System Clock period) and Posc (Osc Clock period)
2385 * Need to store configuration in driver because of the way I2C
2386 * bridging is controlled.
2387 *
2388 */
2389 static int init_hi(const struct drx_demod_instance *demod)
2390 {
2391         struct drxj_data *ext_attr = (struct drxj_data *) (NULL);
2392         struct drx_common_attr *common_attr = (struct drx_common_attr *) (NULL);
2393         struct i2c_device_addr *dev_addr = (struct i2c_device_addr *)(NULL);
2394         int rc;
2395 
2396         ext_attr = (struct drxj_data *) demod->my_ext_attr;
2397         common_attr = (struct drx_common_attr *) demod->my_common_attr;
2398         dev_addr = demod->my_i2c_dev_addr;
2399 
2400         /* PATCH for bug 5003, HI ucode v3.1.0 */
2401         rc = drxj_dap_write_reg16(dev_addr, 0x4301D7, 0x801, 0);
2402         if (rc != 0) {
2403                 pr_err("error %d\n", rc);
2404                 goto rw_error;
2405         }
2406 
2407         /* Timing div, 250ns/Psys */
2408         /* Timing div, = ( delay (nano seconds) * sysclk (kHz) )/ 1000 */
2409         ext_attr->hi_cfg_timing_div =
2410             (u16) ((common_attr->sys_clock_freq / 1000) * HI_I2C_DELAY) / 1000;
2411         /* Clipping */
2412         if ((ext_attr->hi_cfg_timing_div) > SIO_HI_RA_RAM_PAR_2_CFG_DIV__M)
2413                 ext_attr->hi_cfg_timing_div = SIO_HI_RA_RAM_PAR_2_CFG_DIV__M;
2414         /* Bridge delay, uses oscilator clock */
2415         /* Delay = ( delay (nano seconds) * oscclk (kHz) )/ 1000 */
2416         /* SDA brdige delay */
2417         ext_attr->hi_cfg_bridge_delay =
2418             (u16) ((common_attr->osc_clock_freq / 1000) * HI_I2C_BRIDGE_DELAY) /
2419             1000;
2420         /* Clipping */
2421         if ((ext_attr->hi_cfg_bridge_delay) > SIO_HI_RA_RAM_PAR_3_CFG_DBL_SDA__M)
2422                 ext_attr->hi_cfg_bridge_delay = SIO_HI_RA_RAM_PAR_3_CFG_DBL_SDA__M;
2423         /* SCL bridge delay, same as SDA for now */
2424         ext_attr->hi_cfg_bridge_delay += ((ext_attr->hi_cfg_bridge_delay) <<
2425                                       SIO_HI_RA_RAM_PAR_3_CFG_DBL_SCL__B);
2426         /* Wakeup key, setting the read flag (as suggest in the documentation) does
2427            not always result into a working solution (barebones worked VI2C failed).
2428            Not setting the bit works in all cases . */
2429         ext_attr->hi_cfg_wake_up_key = DRXJ_WAKE_UP_KEY;
2430         /* port/bridge/power down ctrl */
2431         ext_attr->hi_cfg_ctrl = (SIO_HI_RA_RAM_PAR_5_CFG_SLV0_SLAVE);
2432         /* transit mode time out delay and watch dog divider */
2433         ext_attr->hi_cfg_transmit = SIO_HI_RA_RAM_PAR_6__PRE;
2434 
2435         rc = hi_cfg_command(demod);
2436         if (rc != 0) {
2437                 pr_err("error %d\n", rc);
2438                 goto rw_error;
2439         }
2440 
2441         return 0;
2442 
2443 rw_error:
2444         return rc;
2445 }
2446 
2447 /*============================================================================*/
2448 /*==                   END HOST INTERFACE FUNCTIONS                         ==*/
2449 /*============================================================================*/
2450 
2451 /*============================================================================*/
2452 /*============================================================================*/
2453 /*==                        AUXILIARY FUNCTIONS                             ==*/
2454 /*============================================================================*/
2455 /*============================================================================*/
2456 
2457 /*
2458 * \fn int get_device_capabilities()
2459 * \brief Get and store device capabilities.
2460 * \param demod  Pointer to demodulator instance.
2461 * \return int.
2462 * \return 0    Success
2463 * \retval -EIO Failure
2464 *
2465 * Depending on pulldowns on MDx pins the following internals are set:
2466 *  * common_attr->osc_clock_freq
2467 *  * ext_attr->has_lna
2468 *  * ext_attr->has_ntsc
2469 *  * ext_attr->has_btsc
2470 *  * ext_attr->has_oob
2471 *
2472 */
2473 static int get_device_capabilities(struct drx_demod_instance *demod)
2474 {
2475         struct drx_common_attr *common_attr = (struct drx_common_attr *) (NULL);
2476         struct drxj_data *ext_attr = (struct drxj_data *) NULL;
2477         struct i2c_device_addr *dev_addr = (struct i2c_device_addr *)(NULL);
2478         u16 sio_pdr_ohw_cfg = 0;
2479         u32 sio_top_jtagid_lo = 0;
2480         u16 bid = 0;
2481         int rc;
2482 
2483         common_attr = (struct drx_common_attr *) demod->my_common_attr;
2484         ext_attr = (struct drxj_data *) demod->my_ext_attr;
2485         dev_addr = demod->my_i2c_dev_addr;
2486 
2487         rc = drxj_dap_write_reg16(dev_addr, SIO_TOP_COMM_KEY__A, SIO_TOP_COMM_KEY_KEY, 0);
2488         if (rc != 0) {
2489                 pr_err("error %d\n", rc);
2490                 goto rw_error;
2491         }
2492         rc = drxj_dap_read_reg16(dev_addr, SIO_PDR_OHW_CFG__A, &sio_pdr_ohw_cfg, 0);
2493         if (rc != 0) {
2494                 pr_err("error %d\n", rc);
2495                 goto rw_error;
2496         }
2497         rc = drxj_dap_write_reg16(dev_addr, SIO_TOP_COMM_KEY__A, SIO_TOP_COMM_KEY__PRE, 0);
2498         if (rc != 0) {
2499                 pr_err("error %d\n", rc);
2500                 goto rw_error;
2501         }
2502 
2503         switch ((sio_pdr_ohw_cfg & SIO_PDR_OHW_CFG_FREF_SEL__M)) {
2504         case 0:
2505                 /* ignore (bypass ?) */
2506                 break;
2507         case 1:
2508                 /* 27 MHz */
2509                 common_attr->osc_clock_freq = 27000;
2510                 break;
2511         case 2:
2512                 /* 20.25 MHz */
2513                 common_attr->osc_clock_freq = 20250;
2514                 break;
2515         case 3:
2516                 /* 4 MHz */
2517                 common_attr->osc_clock_freq = 4000;
2518                 break;
2519         default:
2520                 return -EIO;
2521         }
2522 
2523         /*
2524            Determine device capabilities
2525            Based on pinning v47
2526          */
2527         rc = drxdap_fasi_read_reg32(dev_addr, SIO_TOP_JTAGID_LO__A, &sio_top_jtagid_lo, 0);
2528         if (rc != 0) {
2529                 pr_err("error %d\n", rc);
2530                 goto rw_error;
2531         }
2532         ext_attr->mfx = (u8) ((sio_top_jtagid_lo >> 29) & 0xF);
2533 
2534         switch ((sio_top_jtagid_lo >> 12) & 0xFF) {
2535         case 0x31:
2536                 rc = drxj_dap_write_reg16(dev_addr, SIO_TOP_COMM_KEY__A, SIO_TOP_COMM_KEY_KEY, 0);
2537                 if (rc != 0) {
2538                         pr_err("error %d\n", rc);
2539                         goto rw_error;
2540                 }
2541                 rc = drxj_dap_read_reg16(dev_addr, SIO_PDR_UIO_IN_HI__A, &bid, 0);
2542                 if (rc != 0) {
2543                         pr_err("error %d\n", rc);
2544                         goto rw_error;
2545                 }
2546                 bid = (bid >> 10) & 0xf;
2547                 rc = drxj_dap_write_reg16(dev_addr, SIO_TOP_COMM_KEY__A, SIO_TOP_COMM_KEY__PRE, 0);
2548                 if (rc != 0) {
2549                         pr_err("error %d\n", rc);
2550                         goto rw_error;
2551                 }
2552 
2553                 ext_attr->has_lna = true;
2554                 ext_attr->has_ntsc = false;
2555                 ext_attr->has_btsc = false;
2556                 ext_attr->has_oob = false;
2557                 ext_attr->has_smatx = true;
2558                 ext_attr->has_smarx = false;
2559                 ext_attr->has_gpio = false;
2560                 ext_attr->has_irqn = false;
2561                 break;
2562         case 0x33:
2563                 ext_attr->has_lna = false;
2564                 ext_attr->has_ntsc = false;
2565                 ext_attr->has_btsc = false;
2566                 ext_attr->has_oob = false;
2567                 ext_attr->has_smatx = true;
2568                 ext_attr->has_smarx = false;
2569                 ext_attr->has_gpio = false;
2570                 ext_attr->has_irqn = false;
2571                 break;
2572         case 0x45:
2573                 ext_attr->has_lna = true;
2574                 ext_attr->has_ntsc = true;
2575                 ext_attr->has_btsc = false;
2576                 ext_attr->has_oob = false;
2577                 ext_attr->has_smatx = true;
2578                 ext_attr->has_smarx = true;
2579                 ext_attr->has_gpio = true;
2580                 ext_attr->has_irqn = false;
2581                 break;
2582         case 0x46:
2583                 ext_attr->has_lna = false;
2584                 ext_attr->has_ntsc = true;
2585                 ext_attr->has_btsc = false;
2586                 ext_attr->has_oob = false;
2587                 ext_attr->has_smatx = true;
2588                 ext_attr->has_smarx = true;
2589                 ext_attr->has_gpio = true;
2590                 ext_attr->has_irqn = false;
2591                 break;
2592         case 0x41:
2593                 ext_attr->has_lna = true;
2594                 ext_attr->has_ntsc = true;
2595                 ext_attr->has_btsc = true;
2596                 ext_attr->has_oob = false;
2597                 ext_attr->has_smatx = true;
2598                 ext_attr->has_smarx = true;
2599                 ext_attr->has_gpio = true;
2600                 ext_attr->has_irqn = false;
2601                 break;
2602         case 0x43:
2603                 ext_attr->has_lna = false;
2604                 ext_attr->has_ntsc = true;
2605                 ext_attr->has_btsc = true;
2606                 ext_attr->has_oob = false;
2607                 ext_attr->has_smatx = true;
2608                 ext_attr->has_smarx = true;
2609                 ext_attr->has_gpio = true;
2610                 ext_attr->has_irqn = false;
2611                 break;
2612         case 0x32:
2613                 ext_attr->has_lna = true;
2614                 ext_attr->has_ntsc = false;
2615                 ext_attr->has_btsc = false;
2616                 ext_attr->has_oob = true;
2617                 ext_attr->has_smatx = true;
2618                 ext_attr->has_smarx = true;
2619                 ext_attr->has_gpio = true;
2620                 ext_attr->has_irqn = true;
2621                 break;
2622         case 0x34:
2623                 ext_attr->has_lna = false;
2624                 ext_attr->has_ntsc = true;
2625                 ext_attr->has_btsc = true;
2626                 ext_attr->has_oob = true;
2627                 ext_attr->has_smatx = true;
2628                 ext_attr->has_smarx = true;
2629                 ext_attr->has_gpio = true;
2630                 ext_attr->has_irqn = true;
2631                 break;
2632         case 0x42:
2633                 ext_attr->has_lna = true;
2634                 ext_attr->has_ntsc = true;
2635                 ext_attr->has_btsc = true;
2636                 ext_attr->has_oob = true;
2637                 ext_attr->has_smatx = true;
2638                 ext_attr->has_smarx = true;
2639                 ext_attr->has_gpio = true;
2640                 ext_attr->has_irqn = true;
2641                 break;
2642         case 0x44:
2643                 ext_attr->has_lna = false;
2644                 ext_attr->has_ntsc = true;
2645                 ext_attr->has_btsc = true;
2646                 ext_attr->has_oob = true;
2647                 ext_attr->has_smatx = true;
2648                 ext_attr->has_smarx = true;
2649                 ext_attr->has_gpio = true;
2650                 ext_attr->has_irqn = true;
2651                 break;
2652         default:
2653                 /* Unknown device variant */
2654                 return -EIO;
2655                 break;
2656         }
2657 
2658         return 0;
2659 rw_error:
2660         return rc;
2661 }
2662 
2663 /*
2664 * \fn int power_up_device()
2665 * \brief Power up device.
2666 * \param demod  Pointer to demodulator instance.
2667 * \return int.
2668 * \return 0    Success
2669 * \retval -EIO Failure, I2C or max retries reached
2670 *
2671 */
2672 
2673 #ifndef DRXJ_MAX_RETRIES_POWERUP
2674 #define DRXJ_MAX_RETRIES_POWERUP 10
2675 #endif
2676 
2677 static int power_up_device(struct drx_demod_instance *demod)
2678 {
2679         struct i2c_device_addr *dev_addr = (struct i2c_device_addr *)(NULL);
2680         u8 data = 0;
2681         u16 retry_count = 0;
2682         struct i2c_device_addr wake_up_addr;
2683 
2684         dev_addr = demod->my_i2c_dev_addr;
2685         wake_up_addr.i2c_addr = DRXJ_WAKE_UP_KEY;
2686         wake_up_addr.i2c_dev_id = dev_addr->i2c_dev_id;
2687         wake_up_addr.user_data = dev_addr->user_data;
2688         /*
2689          * I2C access may fail in this case: no ack
2690          * dummy write must be used to wake uop device, dummy read must be used to
2691          * reset HI state machine (avoiding actual writes)
2692          */
2693         do {
2694                 data = 0;
2695                 drxbsp_i2c_write_read(&wake_up_addr, 1, &data,
2696                                       (struct i2c_device_addr *)(NULL), 0,
2697                                      (u8 *)(NULL));
2698                 msleep(10);
2699                 retry_count++;
2700         } while ((drxbsp_i2c_write_read
2701                   ((struct i2c_device_addr *) (NULL), 0, (u8 *)(NULL), dev_addr, 1,
2702                    &data)
2703                   != 0) && (retry_count < DRXJ_MAX_RETRIES_POWERUP));
2704 
2705         /* Need some recovery time .... */
2706         msleep(10);
2707 
2708         if (retry_count == DRXJ_MAX_RETRIES_POWERUP)
2709                 return -EIO;
2710 
2711         return 0;
2712 }
2713 
2714 /*----------------------------------------------------------------------------*/
2715 /* MPEG Output Configuration Functions - begin                                */
2716 /*----------------------------------------------------------------------------*/
2717 /*
2718 * \fn int ctrl_set_cfg_mpeg_output()
2719 * \brief Set MPEG output configuration of the device.
2720 * \param devmod  Pointer to demodulator instance.
2721 * \param cfg_data Pointer to mpeg output configuaration.
2722 * \return int.
2723 *
2724 *  Configure MPEG output parameters.
2725 *
2726 */
2727 static int
2728 ctrl_set_cfg_mpeg_output(struct drx_demod_instance *demod, struct drx_cfg_mpeg_output *cfg_data)
2729 {
2730         struct i2c_device_addr *dev_addr = (struct i2c_device_addr *)(NULL);
2731         struct drxj_data *ext_attr = (struct drxj_data *) (NULL);
2732         struct drx_common_attr *common_attr = (struct drx_common_attr *) (NULL);
2733         int rc;
2734         u16 fec_oc_reg_mode = 0;
2735         u16 fec_oc_reg_ipr_mode = 0;
2736         u16 fec_oc_reg_ipr_invert = 0;
2737         u32 max_bit_rate = 0;
2738         u32 rcn_rate = 0;
2739         u32 nr_bits = 0;
2740         u16 sio_pdr_md_cfg = 0;
2741         /* data mask for the output data byte */
2742         u16 invert_data_mask =
2743             FEC_OC_IPR_INVERT_MD7__M | FEC_OC_IPR_INVERT_MD6__M |
2744             FEC_OC_IPR_INVERT_MD5__M | FEC_OC_IPR_INVERT_MD4__M |
2745             FEC_OC_IPR_INVERT_MD3__M | FEC_OC_IPR_INVERT_MD2__M |
2746             FEC_OC_IPR_INVERT_MD1__M | FEC_OC_IPR_INVERT_MD0__M;
2747 
2748         /* check arguments */
2749         if ((demod == NULL) || (cfg_data == NULL))
2750                 return -EINVAL;
2751 
2752         dev_addr = demod->my_i2c_dev_addr;
2753         ext_attr = (struct drxj_data *) demod->my_ext_attr;
2754         common_attr = (struct drx_common_attr *) demod->my_common_attr;
2755 
2756         if (cfg_data->enable_mpeg_output == true) {
2757                 /* quick and dirty patch to set MPEG in case current std is not
2758                    producing MPEG */
2759                 switch (ext_attr->standard) {
2760                 case DRX_STANDARD_8VSB:
2761                 case DRX_STANDARD_ITU_A:
2762                 case DRX_STANDARD_ITU_B:
2763                 case DRX_STANDARD_ITU_C:
2764                         break;
2765                 default:
2766                         return 0;
2767                 }
2768 
2769                 rc = drxj_dap_write_reg16(dev_addr, FEC_OC_OCR_INVERT__A, 0, 0);
2770                 if (rc != 0) {
2771                         pr_err("error %d\n", rc);
2772                         goto rw_error;
2773                 }
2774                 switch (ext_attr->standard) {
2775                 case DRX_STANDARD_8VSB:
2776                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_FCT_USAGE__A, 7, 0);
2777                         if (rc != 0) {
2778                                 pr_err("error %d\n", rc);
2779                                 goto rw_error;
2780                         }       /* 2048 bytes fifo ram */
2781                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_TMD_CTL_UPD_RATE__A, 10, 0);
2782                         if (rc != 0) {
2783                                 pr_err("error %d\n", rc);
2784                                 goto rw_error;
2785                         }
2786                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_TMD_INT_UPD_RATE__A, 10, 0);
2787                         if (rc != 0) {
2788                                 pr_err("error %d\n", rc);
2789                                 goto rw_error;
2790                         }
2791                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_AVR_PARM_A__A, 5, 0);
2792                         if (rc != 0) {
2793                                 pr_err("error %d\n", rc);
2794                                 goto rw_error;
2795                         }
2796                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_AVR_PARM_B__A, 7, 0);
2797                         if (rc != 0) {
2798                                 pr_err("error %d\n", rc);
2799                                 goto rw_error;
2800                         }
2801                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_RCN_GAIN__A, 10, 0);
2802                         if (rc != 0) {
2803                                 pr_err("error %d\n", rc);
2804                                 goto rw_error;
2805                         }
2806                         /* Low Water Mark for synchronization  */
2807                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_SNC_LWM__A, 3, 0);
2808                         if (rc != 0) {
2809                                 pr_err("error %d\n", rc);
2810                                 goto rw_error;
2811                         }
2812                         /* High Water Mark for synchronization */
2813                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_SNC_HWM__A, 5, 0);
2814                         if (rc != 0) {
2815                                 pr_err("error %d\n", rc);
2816                                 goto rw_error;
2817                         }
2818                         break;
2819                 case DRX_STANDARD_ITU_A:
2820                 case DRX_STANDARD_ITU_C:
2821                         switch (ext_attr->constellation) {
2822                         case DRX_CONSTELLATION_QAM256:
2823                                 nr_bits = 8;
2824                                 break;
2825                         case DRX_CONSTELLATION_QAM128:
2826                                 nr_bits = 7;
2827                                 break;
2828                         case DRX_CONSTELLATION_QAM64:
2829                                 nr_bits = 6;
2830                                 break;
2831                         case DRX_CONSTELLATION_QAM32:
2832                                 nr_bits = 5;
2833                                 break;
2834                         case DRX_CONSTELLATION_QAM16:
2835                                 nr_bits = 4;
2836                                 break;
2837                         default:
2838                                 return -EIO;
2839                         }       /* ext_attr->constellation */
2840                         /* max_bit_rate = symbol_rate * nr_bits * coef */
2841                         /* coef = 188/204                          */
2842                         max_bit_rate =
2843                             (ext_attr->curr_symbol_rate / 8) * nr_bits * 188;
2844                         /* fall-through - as b/c Annex A/C need following settings */
2845                 case DRX_STANDARD_ITU_B:
2846                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_FCT_USAGE__A, FEC_OC_FCT_USAGE__PRE, 0);
2847                         if (rc != 0) {
2848                                 pr_err("error %d\n", rc);
2849                                 goto rw_error;
2850                         }
2851                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_TMD_CTL_UPD_RATE__A, FEC_OC_TMD_CTL_UPD_RATE__PRE, 0);
2852                         if (rc != 0) {
2853                                 pr_err("error %d\n", rc);
2854                                 goto rw_error;
2855                         }
2856                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_TMD_INT_UPD_RATE__A, 5, 0);
2857                         if (rc != 0) {
2858                                 pr_err("error %d\n", rc);
2859                                 goto rw_error;
2860                         }
2861                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_AVR_PARM_A__A, FEC_OC_AVR_PARM_A__PRE, 0);
2862                         if (rc != 0) {
2863                                 pr_err("error %d\n", rc);
2864                                 goto rw_error;
2865                         }
2866                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_AVR_PARM_B__A, FEC_OC_AVR_PARM_B__PRE, 0);
2867                         if (rc != 0) {
2868                                 pr_err("error %d\n", rc);
2869                                 goto rw_error;
2870                         }
2871                         if (cfg_data->static_clk == true) {
2872                                 rc = drxj_dap_write_reg16(dev_addr, FEC_OC_RCN_GAIN__A, 0xD, 0);
2873                                 if (rc != 0) {
2874                                         pr_err("error %d\n", rc);
2875                                         goto rw_error;
2876                                 }
2877                         } else {
2878                                 rc = drxj_dap_write_reg16(dev_addr, FEC_OC_RCN_GAIN__A, FEC_OC_RCN_GAIN__PRE, 0);
2879                                 if (rc != 0) {
2880                                         pr_err("error %d\n", rc);
2881                                         goto rw_error;
2882                                 }
2883                         }
2884                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_SNC_LWM__A, 2, 0);
2885                         if (rc != 0) {
2886                                 pr_err("error %d\n", rc);
2887                                 goto rw_error;
2888                         }
2889                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_SNC_HWM__A, 12, 0);
2890                         if (rc != 0) {
2891                                 pr_err("error %d\n", rc);
2892                                 goto rw_error;
2893                         }
2894                         break;
2895                 default:
2896                         break;
2897                 }               /* switch (standard) */
2898 
2899                 /* Check insertion of the Reed-Solomon parity bytes */
2900                 rc = drxj_dap_read_reg16(dev_addr, FEC_OC_MODE__A, &fec_oc_reg_mode, 0);
2901                 if (rc != 0) {
2902                         pr_err("error %d\n", rc);
2903                         goto rw_error;
2904                 }
2905                 rc = drxj_dap_read_reg16(dev_addr, FEC_OC_IPR_MODE__A, &fec_oc_reg_ipr_mode, 0);
2906                 if (rc != 0) {
2907                         pr_err("error %d\n", rc);
2908                         goto rw_error;
2909                 }
2910                 if (cfg_data->insert_rs_byte == true) {
2911                         /* enable parity symbol forward */
2912                         fec_oc_reg_mode |= FEC_OC_MODE_PARITY__M;
2913                         /* MVAL disable during parity bytes */
2914                         fec_oc_reg_ipr_mode |= FEC_OC_IPR_MODE_MVAL_DIS_PAR__M;
2915                         switch (ext_attr->standard) {
2916                         case DRX_STANDARD_8VSB:
2917                                 rcn_rate = 0x004854D3;
2918                                 break;
2919                         case DRX_STANDARD_ITU_B:
2920                                 fec_oc_reg_mode |= FEC_OC_MODE_TRANSPARENT__M;
2921                                 switch (ext_attr->constellation) {
2922                                 case DRX_CONSTELLATION_QAM256:
2923                                         rcn_rate = 0x008945E7;
2924                                         break;
2925                                 case DRX_CONSTELLATION_QAM64:
2926                                         rcn_rate = 0x005F64D4;
2927                                         break;
2928                                 default:
2929                                         return -EIO;
2930                                 }
2931                                 break;
2932                         case DRX_STANDARD_ITU_A:
2933                         case DRX_STANDARD_ITU_C:
2934                                 /* insert_rs_byte = true -> coef = 188/188 -> 1, RS bits are in MPEG output */
2935                                 rcn_rate =
2936                                     (frac28
2937                                      (max_bit_rate,
2938                                       (u32) (common_attr->sys_clock_freq / 8))) /
2939                                     188;
2940                                 break;
2941                         default:
2942                                 return -EIO;
2943                         }       /* ext_attr->standard */
2944                 } else {        /* insert_rs_byte == false */
2945 
2946                         /* disable parity symbol forward */
2947                         fec_oc_reg_mode &= (~FEC_OC_MODE_PARITY__M);
2948                         /* MVAL enable during parity bytes */
2949                         fec_oc_reg_ipr_mode &= (~FEC_OC_IPR_MODE_MVAL_DIS_PAR__M);
2950                         switch (ext_attr->standard) {
2951                         case DRX_STANDARD_8VSB:
2952                                 rcn_rate = 0x0041605C;
2953                                 break;
2954                         case DRX_STANDARD_ITU_B:
2955                                 fec_oc_reg_mode &= (~FEC_OC_MODE_TRANSPARENT__M);
2956                                 switch (ext_attr->constellation) {
2957                                 case DRX_CONSTELLATION_QAM256:
2958                                         rcn_rate = 0x0082D6A0;
2959                                         break;
2960                                 case DRX_CONSTELLATION_QAM64:
2961                                         rcn_rate = 0x005AEC1A;
2962                                         break;
2963                                 default:
2964                                         return -EIO;
2965                                 }
2966                                 break;
2967                         case DRX_STANDARD_ITU_A:
2968                         case DRX_STANDARD_ITU_C:
2969                                 /* insert_rs_byte = false -> coef = 188/204, RS bits not in MPEG output */
2970                                 rcn_rate =
2971                                     (frac28
2972                                      (max_bit_rate,
2973                                       (u32) (common_attr->sys_clock_freq / 8))) /
2974                                     204;
2975                                 break;
2976                         default:
2977                                 return -EIO;
2978                         }       /* ext_attr->standard */
2979                 }
2980 
2981                 if (cfg_data->enable_parallel == true) {        /* MPEG data output is parallel -> clear ipr_mode[0] */
2982                         fec_oc_reg_ipr_mode &= (~(FEC_OC_IPR_MODE_SERIAL__M));
2983                 } else {        /* MPEG data output is serial -> set ipr_mode[0] */
2984                         fec_oc_reg_ipr_mode |= FEC_OC_IPR_MODE_SERIAL__M;
2985                 }
2986 
2987                 /* Control slective inversion of output bits */
2988                 if (cfg_data->invert_data == true)
2989                         fec_oc_reg_ipr_invert |= invert_data_mask;
2990                 else
2991                         fec_oc_reg_ipr_invert &= (~(invert_data_mask));
2992 
2993                 if (cfg_data->invert_err == true)
2994                         fec_oc_reg_ipr_invert |= FEC_OC_IPR_INVERT_MERR__M;
2995                 else
2996                         fec_oc_reg_ipr_invert &= (~(FEC_OC_IPR_INVERT_MERR__M));
2997 
2998                 if (cfg_data->invert_str == true)
2999                         fec_oc_reg_ipr_invert |= FEC_OC_IPR_INVERT_MSTRT__M;
3000                 else
3001                         fec_oc_reg_ipr_invert &= (~(FEC_OC_IPR_INVERT_MSTRT__M));
3002 
3003                 if (cfg_data->invert_val == true)
3004                         fec_oc_reg_ipr_invert |= FEC_OC_IPR_INVERT_MVAL__M;
3005                 else
3006                         fec_oc_reg_ipr_invert &= (~(FEC_OC_IPR_INVERT_MVAL__M));
3007 
3008                 if (cfg_data->invert_clk == true)
3009                         fec_oc_reg_ipr_invert |= FEC_OC_IPR_INVERT_MCLK__M;
3010                 else
3011                         fec_oc_reg_ipr_invert &= (~(FEC_OC_IPR_INVERT_MCLK__M));
3012 
3013 
3014                 if (cfg_data->static_clk == true) {     /* Static mode */
3015                         u32 dto_rate = 0;
3016                         u32 bit_rate = 0;
3017                         u16 fec_oc_dto_burst_len = 0;
3018                         u16 fec_oc_dto_period = 0;
3019 
3020                         fec_oc_dto_burst_len = FEC_OC_DTO_BURST_LEN__PRE;
3021 
3022                         switch (ext_attr->standard) {
3023                         case DRX_STANDARD_8VSB:
3024                                 fec_oc_dto_period = 4;
3025                                 if (cfg_data->insert_rs_byte == true)
3026                                         fec_oc_dto_burst_len = 208;
3027                                 break;
3028                         case DRX_STANDARD_ITU_A:
3029                                 {
3030                                         u32 symbol_rate_th = 6400000;
3031                                         if (cfg_data->insert_rs_byte == true) {
3032                                                 fec_oc_dto_burst_len = 204;
3033                                                 symbol_rate_th = 5900000;
3034                                         }
3035                                         if (ext_attr->curr_symbol_rate >=
3036                                             symbol_rate_th) {
3037                                                 fec_oc_dto_period = 0;
3038                                         } else {
3039                                                 fec_oc_dto_period = 1;
3040                                         }
3041                                 }
3042                                 break;
3043                         case DRX_STANDARD_ITU_B:
3044                                 fec_oc_dto_period = 1;
3045                                 if (cfg_data->insert_rs_byte == true)
3046                                         fec_oc_dto_burst_len = 128;
3047                                 break;
3048                         case DRX_STANDARD_ITU_C:
3049                                 fec_oc_dto_period = 1;
3050                                 if (cfg_data->insert_rs_byte == true)
3051                                         fec_oc_dto_burst_len = 204;
3052                                 break;
3053                         default:
3054                                 return -EIO;
3055                         }
3056                         bit_rate =
3057                             common_attr->sys_clock_freq * 1000 / (fec_oc_dto_period +
3058                                                                2);
3059                         dto_rate =
3060                             frac28(bit_rate, common_attr->sys_clock_freq * 1000);
3061                         dto_rate >>= 3;
3062                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_DTO_RATE_HI__A, (u16)((dto_rate >> 16) & FEC_OC_DTO_RATE_HI__M), 0);
3063                         if (rc != 0) {
3064                                 pr_err("error %d\n", rc);
3065                                 goto rw_error;
3066                         }
3067                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_DTO_RATE_LO__A, (u16)(dto_rate & FEC_OC_DTO_RATE_LO_RATE_LO__M), 0);
3068                         if (rc != 0) {
3069                                 pr_err("error %d\n", rc);
3070                                 goto rw_error;
3071                         }
3072                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_DTO_MODE__A, FEC_OC_DTO_MODE_DYNAMIC__M | FEC_OC_DTO_MODE_OFFSET_ENABLE__M, 0);
3073                         if (rc != 0) {
3074                                 pr_err("error %d\n", rc);
3075                                 goto rw_error;
3076                         }
3077                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_FCT_MODE__A, FEC_OC_FCT_MODE_RAT_ENA__M | FEC_OC_FCT_MODE_VIRT_ENA__M, 0);
3078                         if (rc != 0) {
3079                                 pr_err("error %d\n", rc);
3080                                 goto rw_error;
3081                         }
3082                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_DTO_BURST_LEN__A, fec_oc_dto_burst_len, 0);
3083                         if (rc != 0) {
3084                                 pr_err("error %d\n", rc);
3085                                 goto rw_error;
3086                         }
3087                         if (ext_attr->mpeg_output_clock_rate != DRXJ_MPEGOUTPUT_CLOCK_RATE_AUTO)
3088                                 fec_oc_dto_period = ext_attr->mpeg_output_clock_rate - 1;
3089                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_DTO_PERIOD__A, fec_oc_dto_period, 0);
3090                         if (rc != 0) {
3091                                 pr_err("error %d\n", rc);
3092                                 goto rw_error;
3093                         }
3094                 } else {        /* Dynamic mode */
3095 
3096                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_DTO_MODE__A, FEC_OC_DTO_MODE_DYNAMIC__M, 0);
3097                         if (rc != 0) {
3098                                 pr_err("error %d\n", rc);
3099                                 goto rw_error;
3100                         }
3101                         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_FCT_MODE__A, 0, 0);
3102                         if (rc != 0) {
3103                                 pr_err("error %d\n", rc);
3104                                 goto rw_error;
3105                         }
3106                 }
3107 
3108                 rc = drxdap_fasi_write_reg32(dev_addr, FEC_OC_RCN_CTL_RATE_LO__A, rcn_rate, 0);
3109                 if (rc != 0) {
3110                         pr_err("error %d\n", rc);
3111                         goto rw_error;
3112                 }
3113 
3114                 /* Write appropriate registers with requested configuration */
3115                 rc = drxj_dap_write_reg16(dev_addr, FEC_OC_MODE__A, fec_oc_reg_mode, 0);
3116                 if (rc != 0) {
3117                         pr_err("error %d\n", rc);
3118                         goto rw_error;
3119                 }
3120                 rc = drxj_dap_write_reg16(dev_addr, FEC_OC_IPR_MODE__A, fec_oc_reg_ipr_mode, 0);
3121                 if (rc != 0) {
3122                         pr_err("error %d\n", rc);
3123                         goto rw_error;
3124                 }
3125                 rc = drxj_dap_write_reg16(dev_addr, FEC_OC_IPR_INVERT__A, fec_oc_reg_ipr_invert, 0);
3126                 if (rc != 0) {
3127                         pr_err("error %d\n", rc);
3128                         goto rw_error;
3129                 }
3130 
3131                 /* enabling for both parallel and serial now */
3132                 /*  Write magic word to enable pdr reg write */
3133                 rc = drxj_dap_write_reg16(dev_addr, SIO_TOP_COMM_KEY__A, 0xFABA, 0);
3134                 if (rc != 0) {
3135                         pr_err("error %d\n", rc);
3136                         goto rw_error;
3137                 }
3138                 /*  Set MPEG TS pads to outputmode */
3139                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MSTRT_CFG__A, 0x0013, 0);
3140                 if (rc != 0) {
3141                         pr_err("error %d\n", rc);
3142                         goto rw_error;
3143                 }
3144                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MERR_CFG__A, 0x0013, 0);
3145                 if (rc != 0) {
3146                         pr_err("error %d\n", rc);
3147                         goto rw_error;
3148                 }
3149                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MCLK_CFG__A, MPEG_OUTPUT_CLK_DRIVE_STRENGTH << SIO_PDR_MCLK_CFG_DRIVE__B | 0x03 << SIO_PDR_MCLK_CFG_MODE__B, 0);
3150                 if (rc != 0) {
3151                         pr_err("error %d\n", rc);
3152                         goto rw_error;
3153                 }
3154                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MVAL_CFG__A, 0x0013, 0);
3155                 if (rc != 0) {
3156                         pr_err("error %d\n", rc);
3157                         goto rw_error;
3158                 }
3159                 sio_pdr_md_cfg =
3160                     MPEG_SERIAL_OUTPUT_PIN_DRIVE_STRENGTH <<
3161                     SIO_PDR_MD0_CFG_DRIVE__B | 0x03 << SIO_PDR_MD0_CFG_MODE__B;
3162                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD0_CFG__A, sio_pdr_md_cfg, 0);
3163                 if (rc != 0) {
3164                         pr_err("error %d\n", rc);
3165                         goto rw_error;
3166                 }
3167                 if (cfg_data->enable_parallel == true) {        /* MPEG data output is parallel -> set MD1 to MD7 to output mode */
3168                         sio_pdr_md_cfg =
3169                             MPEG_PARALLEL_OUTPUT_PIN_DRIVE_STRENGTH <<
3170                             SIO_PDR_MD0_CFG_DRIVE__B | 0x03 <<
3171                             SIO_PDR_MD0_CFG_MODE__B;
3172                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD0_CFG__A, sio_pdr_md_cfg, 0);
3173                         if (rc != 0) {
3174                                 pr_err("error %d\n", rc);
3175                                 goto rw_error;
3176                         }
3177                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD1_CFG__A, sio_pdr_md_cfg, 0);
3178                         if (rc != 0) {
3179                                 pr_err("error %d\n", rc);
3180                                 goto rw_error;
3181                         }
3182                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD2_CFG__A, sio_pdr_md_cfg, 0);
3183                         if (rc != 0) {
3184                                 pr_err("error %d\n", rc);
3185                                 goto rw_error;
3186                         }
3187                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD3_CFG__A, sio_pdr_md_cfg, 0);
3188                         if (rc != 0) {
3189                                 pr_err("error %d\n", rc);
3190                                 goto rw_error;
3191                         }
3192                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD4_CFG__A, sio_pdr_md_cfg, 0);
3193                         if (rc != 0) {
3194                                 pr_err("error %d\n", rc);
3195                                 goto rw_error;
3196                         }
3197                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD5_CFG__A, sio_pdr_md_cfg, 0);
3198                         if (rc != 0) {
3199                                 pr_err("error %d\n", rc);
3200                                 goto rw_error;
3201                         }
3202                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD6_CFG__A, sio_pdr_md_cfg, 0);
3203                         if (rc != 0) {
3204                                 pr_err("error %d\n", rc);
3205                                 goto rw_error;
3206                         }
3207                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD7_CFG__A, sio_pdr_md_cfg, 0);
3208                         if (rc != 0) {
3209                                 pr_err("error %d\n", rc);
3210                                 goto rw_error;
3211                         }
3212                 } else {        /* MPEG data output is serial -> set MD1 to MD7 to tri-state */
3213                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD1_CFG__A, 0x0000, 0);
3214                         if (rc != 0) {
3215                                 pr_err("error %d\n", rc);
3216                                 goto rw_error;
3217                         }
3218                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD2_CFG__A, 0x0000, 0);
3219                         if (rc != 0) {
3220                                 pr_err("error %d\n", rc);
3221                                 goto rw_error;
3222                         }
3223                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD3_CFG__A, 0x0000, 0);
3224                         if (rc != 0) {
3225                                 pr_err("error %d\n", rc);
3226                                 goto rw_error;
3227                         }
3228                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD4_CFG__A, 0x0000, 0);
3229                         if (rc != 0) {
3230                                 pr_err("error %d\n", rc);
3231                                 goto rw_error;
3232                         }
3233                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD5_CFG__A, 0x0000, 0);
3234                         if (rc != 0) {
3235                                 pr_err("error %d\n", rc);
3236                                 goto rw_error;
3237                         }
3238                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD6_CFG__A, 0x0000, 0);
3239                         if (rc != 0) {
3240                                 pr_err("error %d\n", rc);
3241                                 goto rw_error;
3242                         }
3243                         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD7_CFG__A, 0x0000, 0);
3244                         if (rc != 0) {
3245                                 pr_err("error %d\n", rc);
3246                                 goto rw_error;
3247                         }
3248                 }
3249                 /*  Enable Monitor Bus output over MPEG pads and ctl input */
3250                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MON_CFG__A, 0x0000, 0);
3251                 if (rc != 0) {
3252                         pr_err("error %d\n", rc);
3253                         goto rw_error;
3254                 }
3255                 /*  Write nomagic word to enable pdr reg write */
3256                 rc = drxj_dap_write_reg16(dev_addr, SIO_TOP_COMM_KEY__A, 0x0000, 0);
3257                 if (rc != 0) {
3258                         pr_err("error %d\n", rc);
3259                         goto rw_error;
3260                 }
3261         } else {
3262                 /*  Write magic word to enable pdr reg write */
3263                 rc = drxj_dap_write_reg16(dev_addr, SIO_TOP_COMM_KEY__A, 0xFABA, 0);
3264                 if (rc != 0) {
3265                         pr_err("error %d\n", rc);
3266                         goto rw_error;
3267                 }
3268                 /*  Set MPEG TS pads to inputmode */
3269                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MSTRT_CFG__A, 0x0000, 0);
3270                 if (rc != 0) {
3271                         pr_err("error %d\n", rc);
3272                         goto rw_error;
3273                 }
3274                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MERR_CFG__A, 0x0000, 0);
3275                 if (rc != 0) {
3276                         pr_err("error %d\n", rc);
3277                         goto rw_error;
3278                 }
3279                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MCLK_CFG__A, 0x0000, 0);
3280                 if (rc != 0) {
3281                         pr_err("error %d\n", rc);
3282                         goto rw_error;
3283                 }
3284                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MVAL_CFG__A, 0x0000, 0);
3285                 if (rc != 0) {
3286                         pr_err("error %d\n", rc);
3287                         goto rw_error;
3288                 }
3289                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD0_CFG__A, 0x0000, 0);
3290                 if (rc != 0) {
3291                         pr_err("error %d\n", rc);
3292                         goto rw_error;
3293                 }
3294                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD1_CFG__A, 0x0000, 0);
3295                 if (rc != 0) {
3296                         pr_err("error %d\n", rc);
3297                         goto rw_error;
3298                 }
3299                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD2_CFG__A, 0x0000, 0);
3300                 if (rc != 0) {
3301                         pr_err("error %d\n", rc);
3302                         goto rw_error;
3303                 }
3304                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD3_CFG__A, 0x0000, 0);
3305                 if (rc != 0) {
3306                         pr_err("error %d\n", rc);
3307                         goto rw_error;
3308                 }
3309                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD4_CFG__A, 0x0000, 0);
3310                 if (rc != 0) {
3311                         pr_err("error %d\n", rc);
3312                         goto rw_error;
3313                 }
3314                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD5_CFG__A, 0x0000, 0);
3315                 if (rc != 0) {
3316                         pr_err("error %d\n", rc);
3317                         goto rw_error;
3318                 }
3319                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD6_CFG__A, 0x0000, 0);
3320                 if (rc != 0) {
3321                         pr_err("error %d\n", rc);
3322                         goto rw_error;
3323                 }
3324                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MD7_CFG__A, 0x0000, 0);
3325                 if (rc != 0) {
3326                         pr_err("error %d\n", rc);
3327                         goto rw_error;
3328                 }
3329                 /* Enable Monitor Bus output over MPEG pads and ctl input */
3330                 rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_MON_CFG__A, 0x0000, 0);
3331                 if (rc != 0) {
3332                         pr_err("error %d\n", rc);
3333                         goto rw_error;
3334                 }
3335                 /* Write nomagic word to enable pdr reg write */
3336                 rc = drxj_dap_write_reg16(dev_addr, SIO_TOP_COMM_KEY__A, 0x0000, 0);
3337                 if (rc != 0) {
3338                         pr_err("error %d\n", rc);
3339                         goto rw_error;
3340                 }
3341         }
3342 
3343         /* save values for restore after re-acquire */
3344         common_attr->mpeg_cfg.enable_mpeg_output = cfg_data->enable_mpeg_output;
3345 
3346         return 0;
3347 rw_error:
3348         return rc;
3349 }
3350 
3351 /*----------------------------------------------------------------------------*/
3352 
3353 
3354 /*----------------------------------------------------------------------------*/
3355 /* MPEG Output Configuration Functions - end                                  */
3356 /*----------------------------------------------------------------------------*/
3357 
3358 /*----------------------------------------------------------------------------*/
3359 /* miscellaneous configurations - begin                           */
3360 /*----------------------------------------------------------------------------*/
3361 
3362 /*
3363 * \fn int set_mpegtei_handling()
3364 * \brief Activate MPEG TEI handling settings.
3365 * \param devmod  Pointer to demodulator instance.
3366 * \return int.
3367 *
3368 * This routine should be called during a set channel of QAM/VSB
3369 *
3370 */
3371 static int set_mpegtei_handling(struct drx_demod_instance *demod)
3372 {
3373         struct drxj_data *ext_attr = (struct drxj_data *) (NULL);
3374         struct i2c_device_addr *dev_addr = (struct i2c_device_addr *)(NULL);
3375         int rc;
3376         u16 fec_oc_dpr_mode = 0;
3377         u16 fec_oc_snc_mode = 0;
3378         u16 fec_oc_ems_mode = 0;
3379 
3380         dev_addr = demod->my_i2c_dev_addr;
3381         ext_attr = (struct drxj_data *) demod->my_ext_attr;
3382 
3383         rc = drxj_dap_read_reg16(dev_addr, FEC_OC_DPR_MODE__A, &fec_oc_dpr_mode, 0);
3384         if (rc != 0) {
3385                 pr_err("error %d\n", rc);
3386                 goto rw_error;
3387         }
3388         rc = drxj_dap_read_reg16(dev_addr, FEC_OC_SNC_MODE__A, &fec_oc_snc_mode, 0);
3389         if (rc != 0) {
3390                 pr_err("error %d\n", rc);
3391                 goto rw_error;
3392         }
3393         rc = drxj_dap_read_reg16(dev_addr, FEC_OC_EMS_MODE__A, &fec_oc_ems_mode, 0);
3394         if (rc != 0) {
3395                 pr_err("error %d\n", rc);
3396                 goto rw_error;
3397         }
3398 
3399         /* reset to default, allow TEI bit to be changed */
3400         fec_oc_dpr_mode &= (~FEC_OC_DPR_MODE_ERR_DISABLE__M);
3401         fec_oc_snc_mode &= (~(FEC_OC_SNC_MODE_ERROR_CTL__M |
3402                            FEC_OC_SNC_MODE_CORR_DISABLE__M));
3403         fec_oc_ems_mode &= (~FEC_OC_EMS_MODE_MODE__M);
3404 
3405         if (ext_attr->disable_te_ihandling) {
3406                 /* do not change TEI bit */
3407                 fec_oc_dpr_mode |= FEC_OC_DPR_MODE_ERR_DISABLE__M;
3408                 fec_oc_snc_mode |= FEC_OC_SNC_MODE_CORR_DISABLE__M |
3409                     ((0x2) << (FEC_OC_SNC_MODE_ERROR_CTL__B));
3410                 fec_oc_ems_mode |= ((0x01) << (FEC_OC_EMS_MODE_MODE__B));
3411         }
3412 
3413         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_DPR_MODE__A, fec_oc_dpr_mode, 0);
3414         if (rc != 0) {
3415                 pr_err("error %d\n", rc);
3416                 goto rw_error;
3417         }
3418         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_SNC_MODE__A, fec_oc_snc_mode, 0);
3419         if (rc != 0) {
3420                 pr_err("error %d\n", rc);
3421                 goto rw_error;
3422         }
3423         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_EMS_MODE__A, fec_oc_ems_mode, 0);
3424         if (rc != 0) {
3425                 pr_err("error %d\n", rc);
3426                 goto rw_error;
3427         }
3428 
3429         return 0;
3430 rw_error:
3431         return rc;
3432 }
3433 
3434 /*----------------------------------------------------------------------------*/
3435 /*
3436 * \fn int bit_reverse_mpeg_output()
3437 * \brief Set MPEG output bit-endian settings.
3438 * \param devmod  Pointer to demodulator instance.
3439 * \return int.
3440 *
3441 * This routine should be called during a set channel of QAM/VSB
3442 *
3443 */
3444 static int bit_reverse_mpeg_output(struct drx_demod_instance *demod)
3445 {
3446         struct drxj_data *ext_attr = (struct drxj_data *) (NULL);
3447         struct i2c_device_addr *dev_addr = (struct i2c_device_addr *)(NULL);
3448         int rc;
3449         u16 fec_oc_ipr_mode = 0;
3450 
3451         dev_addr = demod->my_i2c_dev_addr;
3452         ext_attr = (struct drxj_data *) demod->my_ext_attr;
3453 
3454         rc = drxj_dap_read_reg16(dev_addr, FEC_OC_IPR_MODE__A, &fec_oc_ipr_mode, 0);
3455         if (rc != 0) {
3456                 pr_err("error %d\n", rc);
3457                 goto rw_error;
3458         }
3459 
3460         /* reset to default (normal bit order) */
3461         fec_oc_ipr_mode &= (~FEC_OC_IPR_MODE_REVERSE_ORDER__M);
3462 
3463         if (ext_attr->bit_reverse_mpeg_outout)
3464                 fec_oc_ipr_mode |= FEC_OC_IPR_MODE_REVERSE_ORDER__M;
3465 
3466         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_IPR_MODE__A, fec_oc_ipr_mode, 0);
3467         if (rc != 0) {
3468                 pr_err("error %d\n", rc);
3469                 goto rw_error;
3470         }
3471 
3472         return 0;
3473 rw_error:
3474         return rc;
3475 }
3476 
3477 /*----------------------------------------------------------------------------*/
3478 /*
3479 * \fn int set_mpeg_start_width()
3480 * \brief Set MPEG start width.
3481 * \param devmod  Pointer to demodulator instance.
3482 * \return int.
3483 *
3484 * This routine should be called during a set channel of QAM/VSB
3485 *
3486 */
3487 static int set_mpeg_start_width(struct drx_demod_instance *demod)
3488 {
3489         struct drxj_data *ext_attr = (struct drxj_data *) (NULL);
3490         struct i2c_device_addr *dev_addr = (struct i2c_device_addr *)(NULL);
3491         struct drx_common_attr *common_attr = (struct drx_common_attr *) NULL;
3492         int rc;
3493         u16 fec_oc_comm_mb = 0;
3494 
3495         dev_addr = demod->my_i2c_dev_addr;
3496         ext_attr = (struct drxj_data *) demod->my_ext_attr;
3497         common_attr = demod->my_common_attr;
3498 
3499         if ((common_attr->mpeg_cfg.static_clk == true)
3500             && (common_attr->mpeg_cfg.enable_parallel == false)) {
3501                 rc = drxj_dap_read_reg16(dev_addr, FEC_OC_COMM_MB__A, &fec_oc_comm_mb, 0);
3502                 if (rc != 0) {
3503                         pr_err("error %d\n", rc);
3504                         goto rw_error;
3505                 }
3506                 fec_oc_comm_mb &= ~FEC_OC_COMM_MB_CTL_ON;
3507                 if (ext_attr->mpeg_start_width == DRXJ_MPEG_START_WIDTH_8CLKCYC)
3508                         fec_oc_comm_mb |= FEC_OC_COMM_MB_CTL_ON;
3509                 rc = drxj_dap_write_reg16(dev_addr, FEC_OC_COMM_MB__A, fec_oc_comm_mb, 0);
3510                 if (rc != 0) {
3511                         pr_err("error %d\n", rc);
3512                         goto rw_error;
3513                 }
3514         }
3515 
3516         return 0;
3517 rw_error:
3518         return rc;
3519 }
3520 
3521 /*----------------------------------------------------------------------------*/
3522 /* miscellaneous configurations - end                             */
3523 /*----------------------------------------------------------------------------*/
3524 
3525 /*----------------------------------------------------------------------------*/
3526 /* UIO Configuration Functions - begin                                        */
3527 /*----------------------------------------------------------------------------*/
3528 /*
3529 * \fn int ctrl_set_uio_cfg()
3530 * \brief Configure modus oprandi UIO.
3531 * \param demod Pointer to demodulator instance.
3532 * \param uio_cfg Pointer to a configuration setting for a certain UIO.
3533 * \return int.
3534 */
3535 static int ctrl_set_uio_cfg(struct drx_demod_instance *demod, struct drxuio_cfg *uio_cfg)
3536 {
3537         struct drxj_data *ext_attr = (struct drxj_data *) (NULL);
3538         int rc;
3539 
3540         if ((uio_cfg == NULL) || (demod == NULL))
3541                 return -EINVAL;
3542 
3543         ext_attr = (struct drxj_data *) demod->my_ext_attr;
3544 
3545         /*  Write magic word to enable pdr reg write               */
3546         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_TOP_COMM_KEY__A, SIO_TOP_COMM_KEY_KEY, 0);
3547         if (rc != 0) {
3548                 pr_err("error %d\n", rc);
3549                 goto rw_error;
3550         }
3551         switch (uio_cfg->uio) {
3552       /*====================================================================*/
3553         case DRX_UIO1:
3554                 /* DRX_UIO1: SMA_TX UIO-1 */
3555                 if (!ext_attr->has_smatx)
3556                         return -EIO;
3557                 switch (uio_cfg->mode) {
3558                 case DRX_UIO_MODE_FIRMWARE_SMA: /* fall through */
3559                 case DRX_UIO_MODE_FIRMWARE_SAW: /* fall through */
3560                 case DRX_UIO_MODE_READWRITE:
3561                         ext_attr->uio_sma_tx_mode = uio_cfg->mode;
3562                         break;
3563                 case DRX_UIO_MODE_DISABLE:
3564                         ext_attr->uio_sma_tx_mode = uio_cfg->mode;
3565                         /* pad configuration register is set 0 - input mode */
3566                         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_SMA_TX_CFG__A, 0, 0);
3567                         if (rc != 0) {
3568                                 pr_err("error %d\n", rc);
3569                                 goto rw_error;
3570                         }
3571                         break;
3572                 default:
3573                         return -EINVAL;
3574                 }               /* switch ( uio_cfg->mode ) */
3575                 break;
3576       /*====================================================================*/
3577         case DRX_UIO2:
3578                 /* DRX_UIO2: SMA_RX UIO-2 */
3579                 if (!ext_attr->has_smarx)
3580                         return -EIO;
3581                 switch (uio_cfg->mode) {
3582                 case DRX_UIO_MODE_FIRMWARE0:    /* fall through */
3583                 case DRX_UIO_MODE_READWRITE:
3584                         ext_attr->uio_sma_rx_mode = uio_cfg->mode;
3585                         break;
3586                 case DRX_UIO_MODE_DISABLE:
3587                         ext_attr->uio_sma_rx_mode = uio_cfg->mode;
3588                         /* pad configuration register is set 0 - input mode */
3589                         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_SMA_RX_CFG__A, 0, 0);
3590                         if (rc != 0) {
3591                                 pr_err("error %d\n", rc);
3592                                 goto rw_error;
3593                         }
3594                         break;
3595                 default:
3596                         return -EINVAL;
3597                         break;
3598                 }               /* switch ( uio_cfg->mode ) */
3599                 break;
3600       /*====================================================================*/
3601         case DRX_UIO3:
3602                 /* DRX_UIO3: GPIO UIO-3 */
3603                 if (!ext_attr->has_gpio)
3604                         return -EIO;
3605                 switch (uio_cfg->mode) {
3606                 case DRX_UIO_MODE_FIRMWARE0:    /* fall through */
3607                 case DRX_UIO_MODE_READWRITE:
3608                         ext_attr->uio_gpio_mode = uio_cfg->mode;
3609                         break;
3610                 case DRX_UIO_MODE_DISABLE:
3611                         ext_attr->uio_gpio_mode = uio_cfg->mode;
3612                         /* pad configuration register is set 0 - input mode */
3613                         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_GPIO_CFG__A, 0, 0);
3614                         if (rc != 0) {
3615                                 pr_err("error %d\n", rc);
3616                                 goto rw_error;
3617                         }
3618                         break;
3619                 default:
3620                         return -EINVAL;
3621                         break;
3622                 }               /* switch ( uio_cfg->mode ) */
3623                 break;
3624       /*====================================================================*/
3625         case DRX_UIO4:
3626                 /* DRX_UIO4: IRQN UIO-4 */
3627                 if (!ext_attr->has_irqn)
3628                         return -EIO;
3629                 switch (uio_cfg->mode) {
3630                 case DRX_UIO_MODE_READWRITE:
3631                         ext_attr->uio_irqn_mode = uio_cfg->mode;
3632                         break;
3633                 case DRX_UIO_MODE_DISABLE:
3634                         /* pad configuration register is set 0 - input mode */
3635                         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_IRQN_CFG__A, 0, 0);
3636                         if (rc != 0) {
3637                                 pr_err("error %d\n", rc);
3638                                 goto rw_error;
3639                         }
3640                         ext_attr->uio_irqn_mode = uio_cfg->mode;
3641                         break;
3642                 case DRX_UIO_MODE_FIRMWARE0:    /* fall through */
3643                 default:
3644                         return -EINVAL;
3645                         break;
3646                 }               /* switch ( uio_cfg->mode ) */
3647                 break;
3648       /*====================================================================*/
3649         default:
3650                 return -EINVAL;
3651         }                       /* switch ( uio_cfg->uio ) */
3652 
3653         /*  Write magic word to disable pdr reg write               */
3654         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_TOP_COMM_KEY__A, 0x0000, 0);
3655         if (rc != 0) {
3656                 pr_err("error %d\n", rc);
3657                 goto rw_error;
3658         }
3659 
3660         return 0;
3661 rw_error:
3662         return rc;
3663 }
3664 
3665 /*
3666 * \fn int ctrl_uio_write()
3667 * \brief Write to a UIO.
3668 * \param demod Pointer to demodulator instance.
3669 * \param uio_data Pointer to data container for a certain UIO.
3670 * \return int.
3671 */
3672 static int
3673 ctrl_uio_write(struct drx_demod_instance *demod, struct drxuio_data *uio_data)
3674 {
3675         struct drxj_data *ext_attr = (struct drxj_data *) (NULL);
3676         int rc;
3677         u16 pin_cfg_value = 0;
3678         u16 value = 0;
3679 
3680         if ((uio_data == NULL) || (demod == NULL))
3681                 return -EINVAL;
3682 
3683         ext_attr = (struct drxj_data *) demod->my_ext_attr;
3684 
3685         /*  Write magic word to enable pdr reg write               */
3686         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_TOP_COMM_KEY__A, SIO_TOP_COMM_KEY_KEY, 0);
3687         if (rc != 0) {
3688                 pr_err("error %d\n", rc);
3689                 goto rw_error;
3690         }
3691         switch (uio_data->uio) {
3692       /*====================================================================*/
3693         case DRX_UIO1:
3694                 /* DRX_UIO1: SMA_TX UIO-1 */
3695                 if (!ext_attr->has_smatx)
3696                         return -EIO;
3697                 if ((ext_attr->uio_sma_tx_mode != DRX_UIO_MODE_READWRITE)
3698                     && (ext_attr->uio_sma_tx_mode != DRX_UIO_MODE_FIRMWARE_SAW)) {
3699                         return -EIO;
3700                 }
3701                 pin_cfg_value = 0;
3702                 /* io_pad_cfg register (8 bit reg.) MSB bit is 1 (default value) */
3703                 pin_cfg_value |= 0x0113;
3704                 /* io_pad_cfg_mode output mode is drive always */
3705                 /* io_pad_cfg_drive is set to power 2 (23 mA) */
3706 
3707                 /* write to io pad configuration register - output mode */
3708                 rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_SMA_TX_CFG__A, pin_cfg_value, 0);
3709                 if (rc != 0) {
3710                         pr_err("error %d\n", rc);
3711                         goto rw_error;
3712                 }
3713 
3714                 /* use corresponding bit in io data output registar */
3715                 rc = drxj_dap_read_reg16(demod->my_i2c_dev_addr, SIO_PDR_UIO_OUT_LO__A, &value, 0);
3716                 if (rc != 0) {
3717                         pr_err("error %d\n", rc);
3718                         goto rw_error;
3719                 }
3720                 if (!uio_data->value)
3721                         value &= 0x7FFF;        /* write zero to 15th bit - 1st UIO */
3722                 else
3723                         value |= 0x8000;        /* write one to 15th bit - 1st UIO */
3724 
3725                 /* write back to io data output register */
3726                 rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_UIO_OUT_LO__A, value, 0);
3727                 if (rc != 0) {
3728                         pr_err("error %d\n", rc);
3729                         goto rw_error;
3730                 }
3731                 break;
3732    /*======================================================================*/
3733         case DRX_UIO2:
3734                 /* DRX_UIO2: SMA_RX UIO-2 */
3735                 if (!ext_attr->has_smarx)
3736                         return -EIO;
3737                 if (ext_attr->uio_sma_rx_mode != DRX_UIO_MODE_READWRITE)
3738                         return -EIO;
3739 
3740                 pin_cfg_value = 0;
3741                 /* io_pad_cfg register (8 bit reg.) MSB bit is 1 (default value) */
3742                 pin_cfg_value |= 0x0113;
3743                 /* io_pad_cfg_mode output mode is drive always */
3744                 /* io_pad_cfg_drive is set to power 2 (23 mA) */
3745 
3746                 /* write to io pad configuration register - output mode */
3747                 rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_SMA_RX_CFG__A, pin_cfg_value, 0);
3748                 if (rc != 0) {
3749                         pr_err("error %d\n", rc);
3750                         goto rw_error;
3751                 }
3752 
3753                 /* use corresponding bit in io data output registar */
3754                 rc = drxj_dap_read_reg16(demod->my_i2c_dev_addr, SIO_PDR_UIO_OUT_LO__A, &value, 0);
3755                 if (rc != 0) {
3756                         pr_err("error %d\n", rc);
3757                         goto rw_error;
3758                 }
3759                 if (!uio_data->value)
3760                         value &= 0xBFFF;        /* write zero to 14th bit - 2nd UIO */
3761                 else
3762                         value |= 0x4000;        /* write one to 14th bit - 2nd UIO */
3763 
3764                 /* write back to io data output register */
3765                 rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_UIO_OUT_LO__A, value, 0);
3766                 if (rc != 0) {
3767                         pr_err("error %d\n", rc);
3768                         goto rw_error;
3769                 }
3770                 break;
3771    /*====================================================================*/
3772         case DRX_UIO3:
3773                 /* DRX_UIO3: ASEL UIO-3 */
3774                 if (!ext_attr->has_gpio)
3775                         return -EIO;
3776                 if (ext_attr->uio_gpio_mode != DRX_UIO_MODE_READWRITE)
3777                         return -EIO;
3778 
3779                 pin_cfg_value = 0;
3780                 /* io_pad_cfg register (8 bit reg.) MSB bit is 1 (default value) */
3781                 pin_cfg_value |= 0x0113;
3782                 /* io_pad_cfg_mode output mode is drive always */
3783                 /* io_pad_cfg_drive is set to power 2 (23 mA) */
3784 
3785                 /* write to io pad configuration register - output mode */
3786                 rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_GPIO_CFG__A, pin_cfg_value, 0);
3787                 if (rc != 0) {
3788                         pr_err("error %d\n", rc);
3789                         goto rw_error;
3790                 }
3791 
3792                 /* use corresponding bit in io data output registar */
3793                 rc = drxj_dap_read_reg16(demod->my_i2c_dev_addr, SIO_PDR_UIO_OUT_HI__A, &value, 0);
3794                 if (rc != 0) {
3795                         pr_err("error %d\n", rc);
3796                         goto rw_error;
3797                 }
3798                 if (!uio_data->value)
3799                         value &= 0xFFFB;        /* write zero to 2nd bit - 3rd UIO */
3800                 else
3801                         value |= 0x0004;        /* write one to 2nd bit - 3rd UIO */
3802 
3803                 /* write back to io data output register */
3804                 rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_UIO_OUT_HI__A, value, 0);
3805                 if (rc != 0) {
3806                         pr_err("error %d\n", rc);
3807                         goto rw_error;
3808                 }
3809                 break;
3810    /*=====================================================================*/
3811         case DRX_UIO4:
3812                 /* DRX_UIO4: IRQN UIO-4 */
3813                 if (!ext_attr->has_irqn)
3814                         return -EIO;
3815 
3816                 if (ext_attr->uio_irqn_mode != DRX_UIO_MODE_READWRITE)
3817                         return -EIO;
3818 
3819                 pin_cfg_value = 0;
3820                 /* io_pad_cfg register (8 bit reg.) MSB bit is 1 (default value) */
3821                 pin_cfg_value |= 0x0113;
3822                 /* io_pad_cfg_mode output mode is drive always */
3823                 /* io_pad_cfg_drive is set to power 2 (23 mA) */
3824 
3825                 /* write to io pad configuration register - output mode */
3826                 rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_IRQN_CFG__A, pin_cfg_value, 0);
3827                 if (rc != 0) {
3828                         pr_err("error %d\n", rc);
3829                         goto rw_error;
3830                 }
3831 
3832                 /* use corresponding bit in io data output registar */
3833                 rc = drxj_dap_read_reg16(demod->my_i2c_dev_addr, SIO_PDR_UIO_OUT_LO__A, &value, 0);
3834                 if (rc != 0) {
3835                         pr_err("error %d\n", rc);
3836                         goto rw_error;
3837                 }
3838                 if (uio_data->value == false)
3839                         value &= 0xEFFF;        /* write zero to 12th bit - 4th UIO */
3840                 else
3841                         value |= 0x1000;        /* write one to 12th bit - 4th UIO */
3842 
3843                 /* write back to io data output register */
3844                 rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_UIO_OUT_LO__A, value, 0);
3845                 if (rc != 0) {
3846                         pr_err("error %d\n", rc);
3847                         goto rw_error;
3848                 }
3849                 break;
3850       /*=====================================================================*/
3851         default:
3852                 return -EINVAL;
3853         }                       /* switch ( uio_data->uio ) */
3854 
3855         /*  Write magic word to disable pdr reg write               */
3856         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_TOP_COMM_KEY__A, 0x0000, 0);
3857         if (rc != 0) {
3858                 pr_err("error %d\n", rc);
3859                 goto rw_error;
3860         }
3861 
3862         return 0;
3863 rw_error:
3864         return rc;
3865 }
3866 
3867 /*---------------------------------------------------------------------------*/
3868 /* UIO Configuration Functions - end                                         */
3869 /*---------------------------------------------------------------------------*/
3870 
3871 /*----------------------------------------------------------------------------*/
3872 /* I2C Bridge Functions - begin                                               */
3873 /*----------------------------------------------------------------------------*/
3874 /*
3875 * \fn int ctrl_i2c_bridge()
3876 * \brief Open or close the I2C switch to tuner.
3877 * \param demod Pointer to demodulator instance.
3878 * \param bridge_closed Pointer to bool indication if bridge is closed not.
3879 * \return int.
3880 
3881 */
3882 static int
3883 ctrl_i2c_bridge(struct drx_demod_instance *demod, bool *bridge_closed)
3884 {
3885         struct drxj_hi_cmd hi_cmd;
3886         u16 result = 0;
3887 
3888         /* check arguments */
3889         if (bridge_closed == NULL)
3890                 return -EINVAL;
3891 
3892         hi_cmd.cmd = SIO_HI_RA_RAM_CMD_BRDCTRL;
3893         hi_cmd.param1 = SIO_HI_RA_RAM_PAR_1_PAR1_SEC_KEY;
3894         if (*bridge_closed)
3895                 hi_cmd.param2 = SIO_HI_RA_RAM_PAR_2_BRD_CFG_CLOSED;
3896         else
3897                 hi_cmd.param2 = SIO_HI_RA_RAM_PAR_2_BRD_CFG_OPEN;
3898 
3899         return hi_command(demod->my_i2c_dev_addr, &hi_cmd, &result);
3900 }
3901 
3902 /*----------------------------------------------------------------------------*/
3903 /* I2C Bridge Functions - end                                                 */
3904 /*----------------------------------------------------------------------------*/
3905 
3906 /*----------------------------------------------------------------------------*/
3907 /* Smart antenna Functions - begin                                            */
3908 /*----------------------------------------------------------------------------*/
3909 /*
3910 * \fn int smart_ant_init()
3911 * \brief Initialize Smart Antenna.
3912 * \param pointer to struct drx_demod_instance.
3913 * \return int.
3914 *
3915 */
3916 static int smart_ant_init(struct drx_demod_instance *demod)
3917 {
3918         struct drxj_data *ext_attr = NULL;
3919         struct i2c_device_addr *dev_addr = NULL;
3920         struct drxuio_cfg uio_cfg = { DRX_UIO1, DRX_UIO_MODE_FIRMWARE_SMA };
3921         int rc;
3922         u16 data = 0;
3923 
3924         dev_addr = demod->my_i2c_dev_addr;
3925         ext_attr = (struct drxj_data *) demod->my_ext_attr;
3926 
3927         /*  Write magic word to enable pdr reg write               */
3928         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_TOP_COMM_KEY__A, SIO_TOP_COMM_KEY_KEY, 0);
3929         if (rc != 0) {
3930                 pr_err("error %d\n", rc);
3931                 goto rw_error;
3932         }
3933         /* init smart antenna */
3934         rc = drxj_dap_read_reg16(dev_addr, SIO_SA_TX_COMMAND__A, &data, 0);
3935         if (rc != 0) {
3936                 pr_err("error %d\n", rc);
3937                 goto rw_error;
3938         }
3939         if (ext_attr->smart_ant_inverted) {
3940                 rc = drxj_dap_write_reg16(dev_addr, SIO_SA_TX_COMMAND__A, (data | SIO_SA_TX_COMMAND_TX_INVERT__M) | SIO_SA_TX_COMMAND_TX_ENABLE__M, 0);
3941                 if (rc != 0) {
3942                         pr_err("error %d\n", rc);
3943                         goto rw_error;
3944                 }
3945         } else {
3946                 rc = drxj_dap_write_reg16(dev_addr, SIO_SA_TX_COMMAND__A, (data & (~SIO_SA_TX_COMMAND_TX_INVERT__M)) | SIO_SA_TX_COMMAND_TX_ENABLE__M, 0);
3947                 if (rc != 0) {
3948                         pr_err("error %d\n", rc);
3949                         goto rw_error;
3950                 }
3951         }
3952 
3953         /* config SMA_TX pin to smart antenna mode */
3954         rc = ctrl_set_uio_cfg(demod, &uio_cfg);
3955         if (rc != 0) {
3956                 pr_err("error %d\n", rc);
3957                 goto rw_error;
3958         }
3959         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_SMA_TX_CFG__A, 0x13, 0);
3960         if (rc != 0) {
3961                 pr_err("error %d\n", rc);
3962                 goto rw_error;
3963         }
3964         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_PDR_SMA_TX_GPIO_FNC__A, 0x03, 0);
3965         if (rc != 0) {
3966                 pr_err("error %d\n", rc);
3967                 goto rw_error;
3968         }
3969 
3970         /*  Write magic word to disable pdr reg write               */
3971         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, SIO_TOP_COMM_KEY__A, 0x0000, 0);
3972         if (rc != 0) {
3973                 pr_err("error %d\n", rc);
3974                 goto rw_error;
3975         }
3976 
3977         return 0;
3978 rw_error:
3979         return rc;
3980 }
3981 
3982 static int scu_command(struct i2c_device_addr *dev_addr, struct drxjscu_cmd *cmd)
3983 {
3984         int rc;
3985         u16 cur_cmd = 0;
3986         unsigned long timeout;
3987 
3988         /* Check param */
3989         if (cmd == NULL)
3990                 return -EINVAL;
3991 
3992         /* Wait until SCU command interface is ready to receive command */
3993         rc = drxj_dap_read_reg16(dev_addr, SCU_RAM_COMMAND__A, &cur_cmd, 0);
3994         if (rc != 0) {
3995                 pr_err("error %d\n", rc);
3996                 goto rw_error;
3997         }
3998         if (cur_cmd != DRX_SCU_READY)
3999                 return -EIO;
4000 
4001         switch (cmd->parameter_len) {
4002         case 5:
4003                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_PARAM_4__A, *(cmd->parameter + 4), 0);
4004                 if (rc != 0) {
4005                         pr_err("error %d\n", rc);
4006                         goto rw_error;
4007                 }       /* fallthrough */
4008         case 4:
4009                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_PARAM_3__A, *(cmd->parameter + 3), 0);
4010                 if (rc != 0) {
4011                         pr_err("error %d\n", rc);
4012                         goto rw_error;
4013                 }       /* fallthrough */
4014         case 3:
4015                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_PARAM_2__A, *(cmd->parameter + 2), 0);
4016                 if (rc != 0) {
4017                         pr_err("error %d\n", rc);
4018                         goto rw_error;
4019                 }       /* fallthrough */
4020         case 2:
4021                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_PARAM_1__A, *(cmd->parameter + 1), 0);
4022                 if (rc != 0) {
4023                         pr_err("error %d\n", rc);
4024                         goto rw_error;
4025                 }       /* fallthrough */
4026         case 1:
4027                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_PARAM_0__A, *(cmd->parameter + 0), 0);
4028                 if (rc != 0) {
4029                         pr_err("error %d\n", rc);
4030                         goto rw_error;
4031                 }       /* fallthrough */
4032         case 0:
4033                 /* do nothing */
4034                 break;
4035         default:
4036                 /* this number of parameters is not supported */
4037                 return -EIO;
4038         }
4039         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_COMMAND__A, cmd->command, 0);
4040         if (rc != 0) {
4041                 pr_err("error %d\n", rc);
4042                 goto rw_error;
4043         }
4044 
4045         /* Wait until SCU has processed command */
4046         timeout = jiffies + msecs_to_jiffies(DRXJ_MAX_WAITTIME);
4047         while (time_is_after_jiffies(timeout)) {
4048                 rc = drxj_dap_read_reg16(dev_addr, SCU_RAM_COMMAND__A, &cur_cmd, 0);
4049                 if (rc != 0) {
4050                         pr_err("error %d\n", rc);
4051                         goto rw_error;
4052                 }
4053                 if (cur_cmd == DRX_SCU_READY)
4054                         break;
4055                 usleep_range(1000, 2000);
4056         }
4057 
4058         if (cur_cmd != DRX_SCU_READY)
4059                 return -EIO;
4060 
4061         /* read results */
4062         if ((cmd->result_len > 0) && (cmd->result != NULL)) {
4063                 s16 err;
4064 
4065                 switch (cmd->result_len) {
4066                 case 4:
4067                         rc = drxj_dap_read_reg16(dev_addr, SCU_RAM_PARAM_3__A, cmd->result + 3, 0);
4068                         if (rc != 0) {
4069                                 pr_err("error %d\n", rc);
4070                                 goto rw_error;
4071                         }       /* fallthrough */
4072                 case 3:
4073                         rc = drxj_dap_read_reg16(dev_addr, SCU_RAM_PARAM_2__A, cmd->result + 2, 0);
4074                         if (rc != 0) {
4075                                 pr_err("error %d\n", rc);
4076                                 goto rw_error;
4077                         }       /* fallthrough */
4078                 case 2:
4079                         rc = drxj_dap_read_reg16(dev_addr, SCU_RAM_PARAM_1__A, cmd->result + 1, 0);
4080                         if (rc != 0) {
4081                                 pr_err("error %d\n", rc);
4082                                 goto rw_error;
4083                         }       /* fallthrough */
4084                 case 1:
4085                         rc = drxj_dap_read_reg16(dev_addr, SCU_RAM_PARAM_0__A, cmd->result + 0, 0);
4086                         if (rc != 0) {
4087                                 pr_err("error %d\n", rc);
4088                                 goto rw_error;
4089                         }       /* fallthrough */
4090                 case 0:
4091                         /* do nothing */
4092                         break;
4093                 default:
4094                         /* this number of parameters is not supported */
4095                         return -EIO;
4096                 }
4097 
4098                 /* Check if an error was reported by SCU */
4099                 err = cmd->result[0];
4100 
4101                 /* check a few fixed error codes */
4102                 if ((err == (s16) SCU_RAM_PARAM_0_RESULT_UNKSTD)
4103                     || (err == (s16) SCU_RAM_PARAM_0_RESULT_UNKCMD)
4104                     || (err == (s16) SCU_RAM_PARAM_0_RESULT_INVPAR)
4105                     || (err == (s16) SCU_RAM_PARAM_0_RESULT_SIZE)
4106                     ) {
4107                         return -EINVAL;
4108                 }
4109                 /* here it is assumed that negative means error, and positive no error */
4110                 else if (err < 0)
4111                         return -EIO;
4112                 else
4113                         return 0;
4114         }
4115 
4116         return 0;
4117 
4118 rw_error:
4119         return rc;
4120 }
4121 
4122 /*
4123 * \fn int DRXJ_DAP_SCUAtomicReadWriteBlock()
4124 * \brief Basic access routine for SCU atomic read or write access
4125 * \param dev_addr  pointer to i2c dev address
4126 * \param addr     destination/source address
4127 * \param datasize size of data buffer in bytes
4128 * \param data     pointer to data buffer
4129 * \return int
4130 * \retval 0 Success
4131 * \retval -EIO Timeout, I2C error, illegal bank
4132 *
4133 */
4134 #define ADDR_AT_SCU_SPACE(x) ((x - 0x82E000) * 2)
4135 static
4136 int drxj_dap_scu_atomic_read_write_block(struct i2c_device_addr *dev_addr, u32 addr, u16 datasize,      /* max 30 bytes because the limit of SCU parameter */
4137                                               u8 *data, bool read_flag)
4138 {
4139         struct drxjscu_cmd scu_cmd;
4140         int rc;
4141         u16 set_param_parameters[18];
4142         u16 cmd_result[15];
4143 
4144         /* Parameter check */
4145         if (!data || !dev_addr || (datasize % 2) || ((datasize / 2) > 16))
4146                 return -EINVAL;
4147 
4148         set_param_parameters[1] = (u16) ADDR_AT_SCU_SPACE(addr);
4149         if (read_flag) {                /* read */
4150                 set_param_parameters[0] = ((~(0x0080)) & datasize);
4151                 scu_cmd.parameter_len = 2;
4152                 scu_cmd.result_len = datasize / 2 + 2;
4153         } else {
4154                 int i = 0;
4155 
4156                 set_param_parameters[0] = 0x0080 | datasize;
4157                 for (i = 0; i < (datasize / 2); i++) {
4158                         set_param_parameters[i + 2] =
4159                             (data[2 * i] | (data[(2 * i) + 1] << 8));
4160                 }
4161                 scu_cmd.parameter_len = datasize / 2 + 2;
4162                 scu_cmd.result_len = 1;
4163         }
4164 
4165         scu_cmd.command =
4166             SCU_RAM_COMMAND_STANDARD_TOP |
4167             SCU_RAM_COMMAND_CMD_AUX_SCU_ATOMIC_ACCESS;
4168         scu_cmd.result = cmd_result;
4169         scu_cmd.parameter = set_param_parameters;
4170         rc = scu_command(dev_addr, &scu_cmd);
4171         if (rc != 0) {
4172                 pr_err("error %d\n", rc);
4173                 goto rw_error;
4174         }
4175 
4176         if (read_flag) {
4177                 int i = 0;
4178                 /* read data from buffer */
4179                 for (i = 0; i < (datasize / 2); i++) {
4180                         data[2 * i] = (u8) (scu_cmd.result[i + 2] & 0xFF);
4181                         data[(2 * i) + 1] = (u8) (scu_cmd.result[i + 2] >> 8);
4182                 }
4183         }
4184 
4185         return 0;
4186 
4187 rw_error:
4188         return rc;
4189 
4190 }
4191 
4192 /*============================================================================*/
4193 
4194 /*
4195 * \fn int DRXJ_DAP_AtomicReadReg16()
4196 * \brief Atomic read of 16 bits words
4197 */
4198 static
4199 int drxj_dap_scu_atomic_read_reg16(struct i2c_device_addr *dev_addr,
4200                                          u32 addr,
4201                                          u16 *data, u32 flags)
4202 {
4203         u8 buf[2] = { 0 };
4204         int rc = -EIO;
4205         u16 word = 0;
4206 
4207         if (!data)
4208                 return -EINVAL;
4209 
4210         rc = drxj_dap_scu_atomic_read_write_block(dev_addr, addr, 2, buf, true);
4211         if (rc < 0)
4212                 return rc;
4213 
4214         word = (u16) (buf[0] + (buf[1] << 8));
4215 
4216         *data = word;
4217 
4218         return rc;
4219 }
4220 
4221 /*============================================================================*/
4222 /*
4223 * \fn int drxj_dap_scu_atomic_write_reg16()
4224 * \brief Atomic read of 16 bits words
4225 */
4226 static
4227 int drxj_dap_scu_atomic_write_reg16(struct i2c_device_addr *dev_addr,
4228                                           u32 addr,
4229                                           u16 data, u32 flags)
4230 {
4231         u8 buf[2];
4232         int rc = -EIO;
4233 
4234         buf[0] = (u8) (data & 0xff);
4235         buf[1] = (u8) ((data >> 8) & 0xff);
4236 
4237         rc = drxj_dap_scu_atomic_read_write_block(dev_addr, addr, 2, buf, false);
4238 
4239         return rc;
4240 }
4241 
4242 /* -------------------------------------------------------------------------- */
4243 /*
4244 * \brief Measure result of ADC synchronisation
4245 * \param demod demod instance
4246 * \param count (returned) count
4247 * \return int.
4248 * \retval 0    Success
4249 * \retval -EIO Failure: I2C error
4250 *
4251 */
4252 static int adc_sync_measurement(struct drx_demod_instance *demod, u16 *count)
4253 {
4254         struct i2c_device_addr *dev_addr = NULL;
4255         int rc;
4256         u16 data = 0;
4257 
4258         dev_addr = demod->my_i2c_dev_addr;
4259 
4260         /* Start measurement */
4261         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_COMM_EXEC__A, IQM_AF_COMM_EXEC_ACTIVE, 0);
4262         if (rc != 0) {
4263                 pr_err("error %d\n", rc);
4264                 goto rw_error;
4265         }
4266         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_START_LOCK__A, 1, 0);
4267         if (rc != 0) {
4268                 pr_err("error %d\n", rc);
4269                 goto rw_error;
4270         }
4271 
4272         /* Wait at least 3*128*(1/sysclk) <<< 1 millisec */
4273         msleep(1);
4274 
4275         *count = 0;
4276         rc = drxj_dap_read_reg16(dev_addr, IQM_AF_PHASE0__A, &data, 0);
4277         if (rc != 0) {
4278                 pr_err("error %d\n", rc);
4279                 goto rw_error;
4280         }
4281         if (data == 127)
4282                 *count = *count + 1;
4283         rc = drxj_dap_read_reg16(dev_addr, IQM_AF_PHASE1__A, &data, 0);
4284         if (rc != 0) {
4285                 pr_err("error %d\n", rc);
4286                 goto rw_error;
4287         }
4288         if (data == 127)
4289                 *count = *count + 1;
4290         rc = drxj_dap_read_reg16(dev_addr, IQM_AF_PHASE2__A, &data, 0);
4291         if (rc != 0) {
4292                 pr_err("error %d\n", rc);
4293                 goto rw_error;
4294         }
4295         if (data == 127)
4296                 *count = *count + 1;
4297 
4298         return 0;
4299 rw_error:
4300         return rc;
4301 }
4302 
4303 /*
4304 * \brief Synchronize analog and digital clock domains
4305 * \param demod demod instance
4306 * \return int.
4307 * \retval 0    Success
4308 * \retval -EIO Failure: I2C error or failure to synchronize
4309 *
4310 * An IQM reset will also reset the results of this synchronization.
4311 * After an IQM reset this routine needs to be called again.
4312 *
4313 */
4314 
4315 static int adc_synchronization(struct drx_demod_instance *demod)
4316 {
4317         struct i2c_device_addr *dev_addr = NULL;
4318         int rc;
4319         u16 count = 0;
4320 
4321         dev_addr = demod->my_i2c_dev_addr;
4322 
4323         rc = adc_sync_measurement(demod, &count);
4324         if (rc != 0) {
4325                 pr_err("error %d\n", rc);
4326                 goto rw_error;
4327         }
4328 
4329         if (count == 1) {
4330                 /* Try sampling on a different edge */
4331                 u16 clk_neg = 0;
4332 
4333                 rc = drxj_dap_read_reg16(dev_addr, IQM_AF_CLKNEG__A, &clk_neg, 0);
4334                 if (rc != 0) {
4335                         pr_err("error %d\n", rc);
4336                         goto rw_error;
4337                 }
4338 
4339                 clk_neg ^= IQM_AF_CLKNEG_CLKNEGDATA__M;
4340                 rc = drxj_dap_write_reg16(dev_addr, IQM_AF_CLKNEG__A, clk_neg, 0);
4341                 if (rc != 0) {
4342                         pr_err("error %d\n", rc);
4343                         goto rw_error;
4344                 }
4345 
4346                 rc = adc_sync_measurement(demod, &count);
4347                 if (rc != 0) {
4348                         pr_err("error %d\n", rc);
4349                         goto rw_error;
4350                 }
4351         }
4352 
4353         /* TODO: implement fallback scenarios */
4354         if (count < 2)
4355                 return -EIO;
4356 
4357         return 0;
4358 rw_error:
4359         return rc;
4360 }
4361 
4362 /*============================================================================*/
4363 /*==                      END AUXILIARY FUNCTIONS                           ==*/
4364 /*============================================================================*/
4365 
4366 /*============================================================================*/
4367 /*============================================================================*/
4368 /*==                8VSB & QAM COMMON DATAPATH FUNCTIONS                    ==*/
4369 /*============================================================================*/
4370 /*============================================================================*/
4371 /*
4372 * \fn int init_agc ()
4373 * \brief Initialize AGC for all standards.
4374 * \param demod instance of demodulator.
4375 * \param channel pointer to channel data.
4376 * \return int.
4377 */
4378 static int init_agc(struct drx_demod_instance *demod)
4379 {
4380         struct i2c_device_addr *dev_addr = NULL;
4381         struct drx_common_attr *common_attr = NULL;
4382         struct drxj_data *ext_attr = NULL;
4383         struct drxj_cfg_agc *p_agc_rf_settings = NULL;
4384         struct drxj_cfg_agc *p_agc_if_settings = NULL;
4385         int rc;
4386         u16 ingain_tgt_max = 0;
4387         u16 clp_dir_to = 0;
4388         u16 sns_sum_max = 0;
4389         u16 clp_sum_max = 0;
4390         u16 sns_dir_to = 0;
4391         u16 ki_innergain_min = 0;
4392         u16 agc_ki = 0;
4393         u16 ki_max = 0;
4394         u16 if_iaccu_hi_tgt_min = 0;
4395         u16 data = 0;
4396         u16 agc_ki_dgain = 0;
4397         u16 ki_min = 0;
4398         u16 clp_ctrl_mode = 0;
4399         u16 agc_rf = 0;
4400         u16 agc_if = 0;
4401 
4402         dev_addr = demod->my_i2c_dev_addr;
4403         common_attr = (struct drx_common_attr *) demod->my_common_attr;
4404         ext_attr = (struct drxj_data *) demod->my_ext_attr;
4405 
4406         switch (ext_attr->standard) {
4407         case DRX_STANDARD_8VSB:
4408                 clp_sum_max = 1023;
4409                 clp_dir_to = (u16) (-9);
4410                 sns_sum_max = 1023;
4411                 sns_dir_to = (u16) (-9);
4412                 ki_innergain_min = (u16) (-32768);
4413                 ki_max = 0x032C;
4414                 agc_ki_dgain = 0xC;
4415                 if_iaccu_hi_tgt_min = 2047;
4416                 ki_min = 0x0117;
4417                 ingain_tgt_max = 16383;
4418                 clp_ctrl_mode = 0;
4419                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_KI_MINGAIN__A, 0x7fff, 0);
4420                 if (rc != 0) {
4421                         pr_err("error %d\n", rc);
4422                         goto rw_error;
4423                 }
4424                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_KI_MAXGAIN__A, 0x0, 0);
4425                 if (rc != 0) {
4426                         pr_err("error %d\n", rc);
4427                         goto rw_error;
4428                 }
4429                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_CLP_SUM__A, 0, 0);
4430                 if (rc != 0) {
4431                         pr_err("error %d\n", rc);
4432                         goto rw_error;
4433                 }
4434                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_CLP_CYCCNT__A, 0, 0);
4435                 if (rc != 0) {
4436                         pr_err("error %d\n", rc);
4437                         goto rw_error;
4438                 }
4439                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_CLP_DIR_WD__A, 0, 0);
4440                 if (rc != 0) {
4441                         pr_err("error %d\n", rc);
4442                         goto rw_error;
4443                 }
4444                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_CLP_DIR_STP__A, 1, 0);
4445                 if (rc != 0) {
4446                         pr_err("error %d\n", rc);
4447                         goto rw_error;
4448                 }
4449                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_SNS_SUM__A, 0, 0);
4450                 if (rc != 0) {
4451                         pr_err("error %d\n", rc);
4452                         goto rw_error;
4453                 }
4454                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_SNS_CYCCNT__A, 0, 0);
4455                 if (rc != 0) {
4456                         pr_err("error %d\n", rc);
4457                         goto rw_error;
4458                 }
4459                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_SNS_DIR_WD__A, 0, 0);
4460                 if (rc != 0) {
4461                         pr_err("error %d\n", rc);
4462                         goto rw_error;
4463                 }
4464                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_SNS_DIR_STP__A, 1, 0);
4465                 if (rc != 0) {
4466                         pr_err("error %d\n", rc);
4467                         goto rw_error;
4468                 }
4469                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_INGAIN__A, 1024, 0);
4470                 if (rc != 0) {
4471                         pr_err("error %d\n", rc);
4472                         goto rw_error;
4473                 }
4474                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_VSB_AGC_POW_TGT__A, 22600, 0);
4475                 if (rc != 0) {
4476                         pr_err("error %d\n", rc);
4477                         goto rw_error;
4478                 }
4479                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_INGAIN_TGT__A, 13200, 0);
4480                 if (rc != 0) {
4481                         pr_err("error %d\n", rc);
4482                         goto rw_error;
4483                 }
4484                 p_agc_if_settings = &(ext_attr->vsb_if_agc_cfg);
4485                 p_agc_rf_settings = &(ext_attr->vsb_rf_agc_cfg);
4486                 break;
4487 #ifndef DRXJ_VSB_ONLY
4488         case DRX_STANDARD_ITU_A:
4489         case DRX_STANDARD_ITU_C:
4490         case DRX_STANDARD_ITU_B:
4491                 ingain_tgt_max = 5119;
4492                 clp_sum_max = 1023;
4493                 clp_dir_to = (u16) (-5);
4494                 sns_sum_max = 127;
4495                 sns_dir_to = (u16) (-3);
4496                 ki_innergain_min = 0;
4497                 ki_max = 0x0657;
4498                 if_iaccu_hi_tgt_min = 2047;
4499                 agc_ki_dgain = 0x7;
4500                 ki_min = 0x0117;
4501                 clp_ctrl_mode = 0;
4502                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_KI_MINGAIN__A, 0x7fff, 0);
4503                 if (rc != 0) {
4504                         pr_err("error %d\n", rc);
4505                         goto rw_error;
4506                 }
4507                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_KI_MAXGAIN__A, 0x0, 0);
4508                 if (rc != 0) {
4509                         pr_err("error %d\n", rc);
4510                         goto rw_error;
4511                 }
4512                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_CLP_SUM__A, 0, 0);
4513                 if (rc != 0) {
4514                         pr_err("error %d\n", rc);
4515                         goto rw_error;
4516                 }
4517                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_CLP_CYCCNT__A, 0, 0);
4518                 if (rc != 0) {
4519                         pr_err("error %d\n", rc);
4520                         goto rw_error;
4521                 }
4522                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_CLP_DIR_WD__A, 0, 0);
4523                 if (rc != 0) {
4524                         pr_err("error %d\n", rc);
4525                         goto rw_error;
4526                 }
4527                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_CLP_DIR_STP__A, 1, 0);
4528                 if (rc != 0) {
4529                         pr_err("error %d\n", rc);
4530                         goto rw_error;
4531                 }
4532                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_SNS_SUM__A, 0, 0);
4533                 if (rc != 0) {
4534                         pr_err("error %d\n", rc);
4535                         goto rw_error;
4536                 }
4537                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_SNS_CYCCNT__A, 0, 0);
4538                 if (rc != 0) {
4539                         pr_err("error %d\n", rc);
4540                         goto rw_error;
4541                 }
4542                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_SNS_DIR_WD__A, 0, 0);
4543                 if (rc != 0) {
4544                         pr_err("error %d\n", rc);
4545                         goto rw_error;
4546                 }
4547                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_SNS_DIR_STP__A, 1, 0);
4548                 if (rc != 0) {
4549                         pr_err("error %d\n", rc);
4550                         goto rw_error;
4551                 }
4552                 p_agc_if_settings = &(ext_attr->qam_if_agc_cfg);
4553                 p_agc_rf_settings = &(ext_attr->qam_rf_agc_cfg);
4554                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_INGAIN_TGT__A, p_agc_if_settings->top, 0);
4555                 if (rc != 0) {
4556                         pr_err("error %d\n", rc);
4557                         goto rw_error;
4558                 }
4559 
4560                 rc = drxj_dap_read_reg16(dev_addr, SCU_RAM_AGC_KI__A, &agc_ki, 0);
4561                 if (rc != 0) {
4562                         pr_err("error %d\n", rc);
4563                         goto rw_error;
4564                 }
4565                 agc_ki &= 0xf000;
4566                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_KI__A, agc_ki, 0);
4567                 if (rc != 0) {
4568                         pr_err("error %d\n", rc);
4569                         goto rw_error;
4570                 }
4571                 break;
4572 #endif
4573         default:
4574                 return -EINVAL;
4575         }
4576 
4577         /* for new AGC interface */
4578         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_INGAIN_TGT_MIN__A, p_agc_if_settings->top, 0);
4579         if (rc != 0) {
4580                 pr_err("error %d\n", rc);
4581                 goto rw_error;
4582         }
4583         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_INGAIN__A, p_agc_if_settings->top, 0);
4584         if (rc != 0) {
4585                 pr_err("error %d\n", rc);
4586                 goto rw_error;
4587         }       /* Gain fed from inner to outer AGC */
4588         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_INGAIN_TGT_MAX__A, ingain_tgt_max, 0);
4589         if (rc != 0) {
4590                 pr_err("error %d\n", rc);
4591                 goto rw_error;
4592         }
4593         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_IF_IACCU_HI_TGT_MIN__A, if_iaccu_hi_tgt_min, 0);
4594         if (rc != 0) {
4595                 pr_err("error %d\n", rc);
4596                 goto rw_error;
4597         }
4598         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_IF_IACCU_HI__A, 0, 0);
4599         if (rc != 0) {
4600                 pr_err("error %d\n", rc);
4601                 goto rw_error;
4602         }       /* set to p_agc_settings->top before */
4603         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_IF_IACCU_LO__A, 0, 0);
4604         if (rc != 0) {
4605                 pr_err("error %d\n", rc);
4606                 goto rw_error;
4607         }
4608         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_RF_IACCU_HI__A, 0, 0);
4609         if (rc != 0) {
4610                 pr_err("error %d\n", rc);
4611                 goto rw_error;
4612         }
4613         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_RF_IACCU_LO__A, 0, 0);
4614         if (rc != 0) {
4615                 pr_err("error %d\n", rc);
4616                 goto rw_error;
4617         }
4618         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_RF_MAX__A, 32767, 0);
4619         if (rc != 0) {
4620                 pr_err("error %d\n", rc);
4621                 goto rw_error;
4622         }
4623         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_CLP_SUM_MAX__A, clp_sum_max, 0);
4624         if (rc != 0) {
4625                 pr_err("error %d\n", rc);
4626                 goto rw_error;
4627         }
4628         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_SNS_SUM_MAX__A, sns_sum_max, 0);
4629         if (rc != 0) {
4630                 pr_err("error %d\n", rc);
4631                 goto rw_error;
4632         }
4633         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_KI_INNERGAIN_MIN__A, ki_innergain_min, 0);
4634         if (rc != 0) {
4635                 pr_err("error %d\n", rc);
4636                 goto rw_error;
4637         }
4638         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_FAST_SNS_CTRL_DELAY__A, 50, 0);
4639         if (rc != 0) {
4640                 pr_err("error %d\n", rc);
4641                 goto rw_error;
4642         }
4643         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_KI_CYCLEN__A, 500, 0);
4644         if (rc != 0) {
4645                 pr_err("error %d\n", rc);
4646                 goto rw_error;
4647         }
4648         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_SNS_CYCLEN__A, 500, 0);
4649         if (rc != 0) {
4650                 pr_err("error %d\n", rc);
4651                 goto rw_error;
4652         }
4653         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_KI_MAXMINGAIN_TH__A, 20, 0);
4654         if (rc != 0) {
4655                 pr_err("error %d\n", rc);
4656                 goto rw_error;
4657         }
4658         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_KI_MIN__A, ki_min, 0);
4659         if (rc != 0) {
4660                 pr_err("error %d\n", rc);
4661                 goto rw_error;
4662         }
4663         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_KI_MAX__A, ki_max, 0);
4664         if (rc != 0) {
4665                 pr_err("error %d\n", rc);
4666                 goto rw_error;
4667         }
4668         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_KI_RED__A, 0, 0);
4669         if (rc != 0) {
4670                 pr_err("error %d\n", rc);
4671                 goto rw_error;
4672         }
4673         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_CLP_SUM_MIN__A, 8, 0);
4674         if (rc != 0) {
4675                 pr_err("error %d\n", rc);
4676                 goto rw_error;
4677         }
4678         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_CLP_CYCLEN__A, 500, 0);
4679         if (rc != 0) {
4680                 pr_err("error %d\n", rc);
4681                 goto rw_error;
4682         }
4683         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_CLP_DIR_TO__A, clp_dir_to, 0);
4684         if (rc != 0) {
4685                 pr_err("error %d\n", rc);
4686                 goto rw_error;
4687         }
4688         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_SNS_SUM_MIN__A, 8, 0);
4689         if (rc != 0) {
4690                 pr_err("error %d\n", rc);
4691                 goto rw_error;
4692         }
4693         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_SNS_DIR_TO__A, sns_dir_to, 0);
4694         if (rc != 0) {
4695                 pr_err("error %d\n", rc);
4696                 goto rw_error;
4697         }
4698         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_FAST_CLP_CTRL_DELAY__A, 50, 0);
4699         if (rc != 0) {
4700                 pr_err("error %d\n", rc);
4701                 goto rw_error;
4702         }
4703         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_CLP_CTRL_MODE__A, clp_ctrl_mode, 0);
4704         if (rc != 0) {
4705                 pr_err("error %d\n", rc);
4706                 goto rw_error;
4707         }
4708 
4709         agc_rf = 0x800 + p_agc_rf_settings->cut_off_current;
4710         if (common_attr->tuner_rf_agc_pol == true)
4711                 agc_rf = 0x87ff - agc_rf;
4712 
4713         agc_if = 0x800;
4714         if (common_attr->tuner_if_agc_pol == true)
4715                 agc_rf = 0x87ff - agc_rf;
4716 
4717         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_AGC_RF__A, agc_rf, 0);
4718         if (rc != 0) {
4719                 pr_err("error %d\n", rc);
4720                 goto rw_error;
4721         }
4722         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_AGC_IF__A, agc_if, 0);
4723         if (rc != 0) {
4724                 pr_err("error %d\n", rc);
4725                 goto rw_error;
4726         }
4727 
4728         /* Set/restore Ki DGAIN factor */
4729         rc = drxj_dap_read_reg16(dev_addr, SCU_RAM_AGC_KI__A, &data, 0);
4730         if (rc != 0) {
4731                 pr_err("error %d\n", rc);
4732                 goto rw_error;
4733         }
4734         data &= ~SCU_RAM_AGC_KI_DGAIN__M;
4735         data |= (agc_ki_dgain << SCU_RAM_AGC_KI_DGAIN__B);
4736         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_AGC_KI__A, data, 0);
4737         if (rc != 0) {
4738                 pr_err("error %d\n", rc);
4739                 goto rw_error;
4740         }
4741 
4742         return 0;
4743 rw_error:
4744         return rc;
4745 }
4746 
4747 /*
4748 * \fn int set_frequency ()
4749 * \brief Set frequency shift.
4750 * \param demod instance of demodulator.
4751 * \param channel pointer to channel data.
4752 * \param tuner_freq_offset residual frequency from tuner.
4753 * \return int.
4754 */
4755 static int
4756 set_frequency(struct drx_demod_instance *demod,
4757               struct drx_channel *channel, s32 tuner_freq_offset)
4758 {
4759         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
4760         struct drxj_data *ext_attr = demod->my_ext_attr;
4761         int rc;
4762         s32 sampling_frequency = 0;
4763         s32 frequency_shift = 0;
4764         s32 if_freq_actual = 0;
4765         s32 rf_freq_residual = -1 * tuner_freq_offset;
4766         s32 adc_freq = 0;
4767         s32 intermediate_freq = 0;
4768         u32 iqm_fs_rate_ofs = 0;
4769         bool adc_flip = true;
4770         bool select_pos_image = false;
4771         bool rf_mirror;
4772         bool tuner_mirror;
4773         bool image_to_select = true;
4774         s32 fm_frequency_shift = 0;
4775 
4776         rf_mirror = (ext_attr->mirror == DRX_MIRROR_YES) ? true : false;
4777         tuner_mirror = demod->my_common_attr->mirror_freq_spect ? false : true;
4778         /*
4779            Program frequency shifter
4780            No need to account for mirroring on RF
4781          */
4782         switch (ext_attr->standard) {
4783         case DRX_STANDARD_ITU_A:
4784         case DRX_STANDARD_ITU_C:
4785         case DRX_STANDARD_PAL_SECAM_LP:
4786         case DRX_STANDARD_8VSB:
4787                 select_pos_image = true;
4788                 break;
4789         case DRX_STANDARD_FM:
4790                 /* After IQM FS sound carrier must appear at 4 Mhz in spect.
4791                    Sound carrier is already 3Mhz above centre frequency due
4792                    to tuner setting so now add an extra shift of 1MHz... */
4793                 fm_frequency_shift = 1000;
4794                 /*fall through */
4795         case DRX_STANDARD_ITU_B:
4796         case DRX_STANDARD_NTSC:
4797         case DRX_STANDARD_PAL_SECAM_BG:
4798         case DRX_STANDARD_PAL_SECAM_DK:
4799         case DRX_STANDARD_PAL_SECAM_I:
4800         case DRX_STANDARD_PAL_SECAM_L:
4801                 select_pos_image = false;
4802                 break;
4803         default:
4804                 return -EINVAL;
4805         }
4806         intermediate_freq = demod->my_common_attr->intermediate_freq;
4807         sampling_frequency = demod->my_common_attr->sys_clock_freq / 3;
4808         if (tuner_mirror)
4809                 if_freq_actual = intermediate_freq + rf_freq_residual + fm_frequency_shift;
4810         else
4811                 if_freq_actual = intermediate_freq - rf_freq_residual - fm_frequency_shift;
4812         if (if_freq_actual > sampling_frequency / 2) {
4813                 /* adc mirrors */
4814                 adc_freq = sampling_frequency - if_freq_actual;
4815                 adc_flip = true;
4816         } else {
4817                 /* adc doesn't mirror */
4818                 adc_freq = if_freq_actual;
4819                 adc_flip = false;
4820         }
4821 
4822         frequency_shift = adc_freq;
4823         image_to_select =
4824             (bool) (rf_mirror ^ tuner_mirror ^ adc_flip ^ select_pos_image);
4825         iqm_fs_rate_ofs = frac28(frequency_shift, sampling_frequency);
4826 
4827         if (image_to_select)
4828                 iqm_fs_rate_ofs = ~iqm_fs_rate_ofs + 1;
4829 
4830         /* Program frequency shifter with tuner offset compensation */
4831         /* frequency_shift += tuner_freq_offset; TODO */
4832         rc = drxdap_fasi_write_reg32(dev_addr, IQM_FS_RATE_OFS_LO__A, iqm_fs_rate_ofs, 0);
4833         if (rc != 0) {
4834                 pr_err("error %d\n", rc);
4835                 goto rw_error;
4836         }
4837         ext_attr->iqm_fs_rate_ofs = iqm_fs_rate_ofs;
4838         ext_attr->pos_image = (bool) (rf_mirror ^ tuner_mirror ^ select_pos_image);
4839 
4840         return 0;
4841 rw_error:
4842         return rc;
4843 }
4844 
4845 /*
4846 * \fn int get_acc_pkt_err()
4847 * \brief Retrieve signal strength for VSB and QAM.
4848 * \param demod Pointer to demod instance
4849 * \param packet_err Pointer to packet error
4850 * \return int.
4851 * \retval 0 sig_strength contains valid data.
4852 * \retval -EINVAL sig_strength is NULL.
4853 * \retval -EIO Erroneous data, sig_strength contains invalid data.
4854 */
4855 #ifdef DRXJ_SIGNAL_ACCUM_ERR
4856 static int get_acc_pkt_err(struct drx_demod_instance *demod, u16 *packet_err)
4857 {
4858         int rc;
4859         static u16 pkt_err;
4860         static u16 last_pkt_err;
4861         u16 data = 0;
4862         struct drxj_data *ext_attr = NULL;
4863         struct i2c_device_addr *dev_addr = NULL;
4864 
4865         ext_attr = (struct drxj_data *) demod->my_ext_attr;
4866         dev_addr = demod->my_i2c_dev_addr;
4867 
4868         rc = drxj_dap_read_reg16(dev_addr, SCU_RAM_FEC_ACCUM_PKT_FAILURES__A, &data, 0);
4869         if (rc != 0) {
4870                 pr_err("error %d\n", rc);
4871                 goto rw_error;
4872         }
4873         if (ext_attr->reset_pkt_err_acc) {
4874                 last_pkt_err = data;
4875                 pkt_err = 0;
4876                 ext_attr->reset_pkt_err_acc = false;
4877         }
4878 
4879         if (data < last_pkt_err) {
4880                 pkt_err += 0xffff - last_pkt_err;
4881                 pkt_err += data;
4882         } else {
4883                 pkt_err += (data - last_pkt_err);
4884         }
4885         *packet_err = pkt_err;
4886         last_pkt_err = data;
4887 
4888         return 0;
4889 rw_error:
4890         return rc;
4891 }
4892 #endif
4893 
4894 
4895 /*============================================================================*/
4896 
4897 /*
4898 * \fn int set_agc_rf ()
4899 * \brief Configure RF AGC
4900 * \param demod instance of demodulator.
4901 * \param agc_settings AGC configuration structure
4902 * \return int.
4903 */
4904 static int
4905 set_agc_rf(struct drx_demod_instance *demod, struct drxj_cfg_agc *agc_settings, bool atomic)
4906 {
4907         struct i2c_device_addr *dev_addr = NULL;
4908         struct drxj_data *ext_attr = NULL;
4909         struct drxj_cfg_agc *p_agc_settings = NULL;
4910         struct drx_common_attr *common_attr = NULL;
4911         int rc;
4912         drx_write_reg16func_t scu_wr16 = NULL;
4913         drx_read_reg16func_t scu_rr16 = NULL;
4914 
4915         common_attr = (struct drx_common_attr *) demod->my_common_attr;
4916         dev_addr = demod->my_i2c_dev_addr;
4917         ext_attr = (struct drxj_data *) demod->my_ext_attr;
4918 
4919         if (atomic) {
4920                 scu_rr16 = drxj_dap_scu_atomic_read_reg16;
4921                 scu_wr16 = drxj_dap_scu_atomic_write_reg16;
4922         } else {
4923                 scu_rr16 = drxj_dap_read_reg16;
4924                 scu_wr16 = drxj_dap_write_reg16;
4925         }
4926 
4927         /* Configure AGC only if standard is currently active */
4928         if ((ext_attr->standard == agc_settings->standard) ||
4929             (DRXJ_ISQAMSTD(ext_attr->standard) &&
4930              DRXJ_ISQAMSTD(agc_settings->standard)) ||
4931             (DRXJ_ISATVSTD(ext_attr->standard) &&
4932              DRXJ_ISATVSTD(agc_settings->standard))) {
4933                 u16 data = 0;
4934 
4935                 switch (agc_settings->ctrl_mode) {
4936                 case DRX_AGC_CTRL_AUTO:
4937 
4938                         /* Enable RF AGC DAC */
4939                         rc = drxj_dap_read_reg16(dev_addr, IQM_AF_STDBY__A, &data, 0);
4940                         if (rc != 0) {
4941                                 pr_err("error %d\n", rc);
4942                                 goto rw_error;
4943                         }
4944                         data |= IQM_AF_STDBY_STDBY_TAGC_RF_A2_ACTIVE;
4945                         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_STDBY__A, data, 0);
4946                         if (rc != 0) {
4947                                 pr_err("error %d\n", rc);
4948                                 goto rw_error;
4949                         }
4950 
4951                         /* Enable SCU RF AGC loop */
4952                         rc = (*scu_rr16)(dev_addr, SCU_RAM_AGC_KI__A, &data, 0);
4953                         if (rc != 0) {
4954                                 pr_err("error %d\n", rc);
4955                                 goto rw_error;
4956                         }
4957                         data &= ~SCU_RAM_AGC_KI_RF__M;
4958                         if (ext_attr->standard == DRX_STANDARD_8VSB)
4959                                 data |= (2 << SCU_RAM_AGC_KI_RF__B);
4960                         else if (DRXJ_ISQAMSTD(ext_attr->standard))
4961                                 data |= (5 << SCU_RAM_AGC_KI_RF__B);
4962                         else
4963                                 data |= (4 << SCU_RAM_AGC_KI_RF__B);
4964 
4965                         if (common_attr->tuner_rf_agc_pol)
4966                                 data |= SCU_RAM_AGC_KI_INV_RF_POL__M;
4967                         else
4968                                 data &= ~SCU_RAM_AGC_KI_INV_RF_POL__M;
4969                         rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_KI__A, data, 0);
4970                         if (rc != 0) {
4971                                 pr_err("error %d\n", rc);
4972                                 goto rw_error;
4973                         }
4974 
4975                         /* Set speed ( using complementary reduction value ) */
4976                         rc = (*scu_rr16)(dev_addr, SCU_RAM_AGC_KI_RED__A, &data, 0);
4977                         if (rc != 0) {
4978                                 pr_err("error %d\n", rc);
4979                                 goto rw_error;
4980                         }
4981                         data &= ~SCU_RAM_AGC_KI_RED_RAGC_RED__M;
4982                         rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_KI_RED__A, (~(agc_settings->speed << SCU_RAM_AGC_KI_RED_RAGC_RED__B) & SCU_RAM_AGC_KI_RED_RAGC_RED__M) | data, 0);
4983                         if (rc != 0) {
4984                                 pr_err("error %d\n", rc);
4985                                 goto rw_error;
4986                         }
4987 
4988                         if (agc_settings->standard == DRX_STANDARD_8VSB)
4989                                 p_agc_settings = &(ext_attr->vsb_if_agc_cfg);
4990                         else if (DRXJ_ISQAMSTD(agc_settings->standard))
4991                                 p_agc_settings = &(ext_attr->qam_if_agc_cfg);
4992                         else if (DRXJ_ISATVSTD(agc_settings->standard))
4993                                 p_agc_settings = &(ext_attr->atv_if_agc_cfg);
4994                         else
4995                                 return -EINVAL;
4996 
4997                         /* Set TOP, only if IF-AGC is in AUTO mode */
4998                         if (p_agc_settings->ctrl_mode == DRX_AGC_CTRL_AUTO) {
4999                                 rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_IF_IACCU_HI_TGT_MAX__A, agc_settings->top, 0);
5000                                 if (rc != 0) {
5001                                         pr_err("error %d\n", rc);
5002                                         goto rw_error;
5003                                 }
5004                                 rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_IF_IACCU_HI_TGT__A, agc_settings->top, 0);
5005                                 if (rc != 0) {
5006                                         pr_err("error %d\n", rc);
5007                                         goto rw_error;
5008                                 }
5009                         }
5010 
5011                         /* Cut-Off current */
5012                         rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_RF_IACCU_HI_CO__A, agc_settings->cut_off_current, 0);
5013                         if (rc != 0) {
5014                                 pr_err("error %d\n", rc);
5015                                 goto rw_error;
5016                         }
5017                         break;
5018                 case DRX_AGC_CTRL_USER:
5019 
5020                         /* Enable RF AGC DAC */
5021                         rc = drxj_dap_read_reg16(dev_addr, IQM_AF_STDBY__A, &data, 0);
5022                         if (rc != 0) {
5023                                 pr_err("error %d\n", rc);
5024                                 goto rw_error;
5025                         }
5026                         data |= IQM_AF_STDBY_STDBY_TAGC_RF_A2_ACTIVE;
5027                         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_STDBY__A, data, 0);
5028                         if (rc != 0) {
5029                                 pr_err("error %d\n", rc);
5030                                 goto rw_error;
5031                         }
5032 
5033                         /* Disable SCU RF AGC loop */
5034                         rc = (*scu_rr16)(dev_addr, SCU_RAM_AGC_KI__A, &data, 0);
5035                         if (rc != 0) {
5036                                 pr_err("error %d\n", rc);
5037                                 goto rw_error;
5038                         }
5039                         data &= ~SCU_RAM_AGC_KI_RF__M;
5040                         if (common_attr->tuner_rf_agc_pol)
5041                                 data |= SCU_RAM_AGC_KI_INV_RF_POL__M;
5042                         else
5043                                 data &= ~SCU_RAM_AGC_KI_INV_RF_POL__M;
5044                         rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_KI__A, data, 0);
5045                         if (rc != 0) {
5046                                 pr_err("error %d\n", rc);
5047                                 goto rw_error;
5048                         }
5049 
5050                         /* Write value to output pin */
5051                         rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_RF_IACCU_HI__A, agc_settings->output_level, 0);
5052                         if (rc != 0) {
5053                                 pr_err("error %d\n", rc);
5054                                 goto rw_error;
5055                         }
5056                         break;
5057                 case DRX_AGC_CTRL_OFF:
5058 
5059                         /* Disable RF AGC DAC */
5060                         rc = drxj_dap_read_reg16(dev_addr, IQM_AF_STDBY__A, &data, 0);
5061                         if (rc != 0) {
5062                                 pr_err("error %d\n", rc);
5063                                 goto rw_error;
5064                         }
5065                         data &= (~IQM_AF_STDBY_STDBY_TAGC_RF_A2_ACTIVE);
5066                         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_STDBY__A, data, 0);
5067                         if (rc != 0) {
5068                                 pr_err("error %d\n", rc);
5069                                 goto rw_error;
5070                         }
5071 
5072                         /* Disable SCU RF AGC loop */
5073                         rc = (*scu_rr16)(dev_addr, SCU_RAM_AGC_KI__A, &data, 0);
5074                         if (rc != 0) {
5075                                 pr_err("error %d\n", rc);
5076                                 goto rw_error;
5077                         }
5078                         data &= ~SCU_RAM_AGC_KI_RF__M;
5079                         rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_KI__A, data, 0);
5080                         if (rc != 0) {
5081                                 pr_err("error %d\n", rc);
5082                                 goto rw_error;
5083                         }
5084                         break;
5085                 default:
5086                         return -EINVAL;
5087                 }               /* switch ( agcsettings->ctrl_mode ) */
5088         }
5089 
5090         /* Store rf agc settings */
5091         switch (agc_settings->standard) {
5092         case DRX_STANDARD_8VSB:
5093                 ext_attr->vsb_rf_agc_cfg = *agc_settings;
5094                 break;
5095 #ifndef DRXJ_VSB_ONLY
5096         case DRX_STANDARD_ITU_A:
5097         case DRX_STANDARD_ITU_B:
5098         case DRX_STANDARD_ITU_C:
5099                 ext_attr->qam_rf_agc_cfg = *agc_settings;
5100                 break;
5101 #endif
5102         default:
5103                 return -EIO;
5104         }
5105 
5106         return 0;
5107 rw_error:
5108         return rc;
5109 }
5110 
5111 /*
5112 * \fn int set_agc_if ()
5113 * \brief Configure If AGC
5114 * \param demod instance of demodulator.
5115 * \param agc_settings AGC configuration structure
5116 * \return int.
5117 */
5118 static int
5119 set_agc_if(struct drx_demod_instance *demod, struct drxj_cfg_agc *agc_settings, bool atomic)
5120 {
5121         struct i2c_device_addr *dev_addr = NULL;
5122         struct drxj_data *ext_attr = NULL;
5123         struct drxj_cfg_agc *p_agc_settings = NULL;
5124         struct drx_common_attr *common_attr = NULL;
5125         drx_write_reg16func_t scu_wr16 = NULL;
5126         drx_read_reg16func_t scu_rr16 = NULL;
5127         int rc;
5128 
5129         common_attr = (struct drx_common_attr *) demod->my_common_attr;
5130         dev_addr = demod->my_i2c_dev_addr;
5131         ext_attr = (struct drxj_data *) demod->my_ext_attr;
5132 
5133         if (atomic) {
5134                 scu_rr16 = drxj_dap_scu_atomic_read_reg16;
5135                 scu_wr16 = drxj_dap_scu_atomic_write_reg16;
5136         } else {
5137                 scu_rr16 = drxj_dap_read_reg16;
5138                 scu_wr16 = drxj_dap_write_reg16;
5139         }
5140 
5141         /* Configure AGC only if standard is currently active */
5142         if ((ext_attr->standard == agc_settings->standard) ||
5143             (DRXJ_ISQAMSTD(ext_attr->standard) &&
5144              DRXJ_ISQAMSTD(agc_settings->standard)) ||
5145             (DRXJ_ISATVSTD(ext_attr->standard) &&
5146              DRXJ_ISATVSTD(agc_settings->standard))) {
5147                 u16 data = 0;
5148 
5149                 switch (agc_settings->ctrl_mode) {
5150                 case DRX_AGC_CTRL_AUTO:
5151                         /* Enable IF AGC DAC */
5152                         rc = drxj_dap_read_reg16(dev_addr, IQM_AF_STDBY__A, &data, 0);
5153                         if (rc != 0) {
5154                                 pr_err("error %d\n", rc);
5155                                 goto rw_error;
5156                         }
5157                         data |= IQM_AF_STDBY_STDBY_TAGC_IF_A2_ACTIVE;
5158                         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_STDBY__A, data, 0);
5159                         if (rc != 0) {
5160                                 pr_err("error %d\n", rc);
5161                                 goto rw_error;
5162                         }
5163 
5164                         /* Enable SCU IF AGC loop */
5165                         rc = (*scu_rr16)(dev_addr, SCU_RAM_AGC_KI__A, &data, 0);
5166                         if (rc != 0) {
5167                                 pr_err("error %d\n", rc);
5168                                 goto rw_error;
5169                         }
5170                         data &= ~SCU_RAM_AGC_KI_IF_AGC_DISABLE__M;
5171                         data &= ~SCU_RAM_AGC_KI_IF__M;
5172                         if (ext_attr->standard == DRX_STANDARD_8VSB)
5173                                 data |= (3 << SCU_RAM_AGC_KI_IF__B);
5174                         else if (DRXJ_ISQAMSTD(ext_attr->standard))
5175                                 data |= (6 << SCU_RAM_AGC_KI_IF__B);
5176                         else
5177                                 data |= (5 << SCU_RAM_AGC_KI_IF__B);
5178 
5179                         if (common_attr->tuner_if_agc_pol)
5180                                 data |= SCU_RAM_AGC_KI_INV_IF_POL__M;
5181                         else
5182                                 data &= ~SCU_RAM_AGC_KI_INV_IF_POL__M;
5183                         rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_KI__A, data, 0);
5184                         if (rc != 0) {
5185                                 pr_err("error %d\n", rc);
5186                                 goto rw_error;
5187                         }
5188 
5189                         /* Set speed (using complementary reduction value) */
5190                         rc = (*scu_rr16)(dev_addr, SCU_RAM_AGC_KI_RED__A, &data, 0);
5191                         if (rc != 0) {
5192                                 pr_err("error %d\n", rc);
5193                                 goto rw_error;
5194                         }
5195                         data &= ~SCU_RAM_AGC_KI_RED_IAGC_RED__M;
5196                         rc = (*scu_wr16) (dev_addr, SCU_RAM_AGC_KI_RED__A, (~(agc_settings->speed << SCU_RAM_AGC_KI_RED_IAGC_RED__B) & SCU_RAM_AGC_KI_RED_IAGC_RED__M) | data, 0);
5197                         if (rc != 0) {
5198                                 pr_err("error %d\n", rc);
5199                                 goto rw_error;
5200                         }
5201 
5202                         if (agc_settings->standard == DRX_STANDARD_8VSB)
5203                                 p_agc_settings = &(ext_attr->vsb_rf_agc_cfg);
5204                         else if (DRXJ_ISQAMSTD(agc_settings->standard))
5205                                 p_agc_settings = &(ext_attr->qam_rf_agc_cfg);
5206                         else if (DRXJ_ISATVSTD(agc_settings->standard))
5207                                 p_agc_settings = &(ext_attr->atv_rf_agc_cfg);
5208                         else
5209                                 return -EINVAL;
5210 
5211                         /* Restore TOP */
5212                         if (p_agc_settings->ctrl_mode == DRX_AGC_CTRL_AUTO) {
5213                                 rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_IF_IACCU_HI_TGT_MAX__A, p_agc_settings->top, 0);
5214                                 if (rc != 0) {
5215                                         pr_err("error %d\n", rc);
5216                                         goto rw_error;
5217                                 }
5218                                 rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_IF_IACCU_HI_TGT__A, p_agc_settings->top, 0);
5219                                 if (rc != 0) {
5220                                         pr_err("error %d\n", rc);
5221                                         goto rw_error;
5222                                 }
5223                         } else {
5224                                 rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_IF_IACCU_HI_TGT_MAX__A, 0, 0);
5225                                 if (rc != 0) {
5226                                         pr_err("error %d\n", rc);
5227                                         goto rw_error;
5228                                 }
5229                                 rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_IF_IACCU_HI_TGT__A, 0, 0);
5230                                 if (rc != 0) {
5231                                         pr_err("error %d\n", rc);
5232                                         goto rw_error;
5233                                 }
5234                         }
5235                         break;
5236 
5237                 case DRX_AGC_CTRL_USER:
5238 
5239                         /* Enable IF AGC DAC */
5240                         rc = drxj_dap_read_reg16(dev_addr, IQM_AF_STDBY__A, &data, 0);
5241                         if (rc != 0) {
5242                                 pr_err("error %d\n", rc);
5243                                 goto rw_error;
5244                         }
5245                         data |= IQM_AF_STDBY_STDBY_TAGC_IF_A2_ACTIVE;
5246                         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_STDBY__A, data, 0);
5247                         if (rc != 0) {
5248                                 pr_err("error %d\n", rc);
5249                                 goto rw_error;
5250                         }
5251 
5252                         /* Disable SCU IF AGC loop */
5253                         rc = (*scu_rr16)(dev_addr, SCU_RAM_AGC_KI__A, &data, 0);
5254                         if (rc != 0) {
5255                                 pr_err("error %d\n", rc);
5256                                 goto rw_error;
5257                         }
5258                         data &= ~SCU_RAM_AGC_KI_IF_AGC_DISABLE__M;
5259                         data |= SCU_RAM_AGC_KI_IF_AGC_DISABLE__M;
5260                         if (common_attr->tuner_if_agc_pol)
5261                                 data |= SCU_RAM_AGC_KI_INV_IF_POL__M;
5262                         else
5263                                 data &= ~SCU_RAM_AGC_KI_INV_IF_POL__M;
5264                         rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_KI__A, data, 0);
5265                         if (rc != 0) {
5266                                 pr_err("error %d\n", rc);
5267                                 goto rw_error;
5268                         }
5269 
5270                         /* Write value to output pin */
5271                         rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_IF_IACCU_HI_TGT_MAX__A, agc_settings->output_level, 0);
5272                         if (rc != 0) {
5273                                 pr_err("error %d\n", rc);
5274                                 goto rw_error;
5275                         }
5276                         break;
5277 
5278                 case DRX_AGC_CTRL_OFF:
5279 
5280                         /* Disable If AGC DAC */
5281                         rc = drxj_dap_read_reg16(dev_addr, IQM_AF_STDBY__A, &data, 0);
5282                         if (rc != 0) {
5283                                 pr_err("error %d\n", rc);
5284                                 goto rw_error;
5285                         }
5286                         data &= (~IQM_AF_STDBY_STDBY_TAGC_IF_A2_ACTIVE);
5287                         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_STDBY__A, data, 0);
5288                         if (rc != 0) {
5289                                 pr_err("error %d\n", rc);
5290                                 goto rw_error;
5291                         }
5292 
5293                         /* Disable SCU IF AGC loop */
5294                         rc = (*scu_rr16)(dev_addr, SCU_RAM_AGC_KI__A, &data, 0);
5295                         if (rc != 0) {
5296                                 pr_err("error %d\n", rc);
5297                                 goto rw_error;
5298                         }
5299                         data &= ~SCU_RAM_AGC_KI_IF_AGC_DISABLE__M;
5300                         data |= SCU_RAM_AGC_KI_IF_AGC_DISABLE__M;
5301                         rc = (*scu_wr16)(dev_addr, SCU_RAM_AGC_KI__A, data, 0);
5302                         if (rc != 0) {
5303                                 pr_err("error %d\n", rc);
5304                                 goto rw_error;
5305                         }
5306                         break;
5307                 default:
5308                         return -EINVAL;
5309                 }               /* switch ( agcsettings->ctrl_mode ) */
5310 
5311                 /* always set the top to support configurations without if-loop */
5312                 rc = (*scu_wr16) (dev_addr, SCU_RAM_AGC_INGAIN_TGT_MIN__A, agc_settings->top, 0);
5313                 if (rc != 0) {
5314                         pr_err("error %d\n", rc);
5315                         goto rw_error;
5316                 }
5317         }
5318 
5319         /* Store if agc settings */
5320         switch (agc_settings->standard) {
5321         case DRX_STANDARD_8VSB:
5322                 ext_attr->vsb_if_agc_cfg = *agc_settings;
5323                 break;
5324 #ifndef DRXJ_VSB_ONLY
5325         case DRX_STANDARD_ITU_A:
5326         case DRX_STANDARD_ITU_B:
5327         case DRX_STANDARD_ITU_C:
5328                 ext_attr->qam_if_agc_cfg = *agc_settings;
5329                 break;
5330 #endif
5331         default:
5332                 return -EIO;
5333         }
5334 
5335         return 0;
5336 rw_error:
5337         return rc;
5338 }
5339 
5340 /*
5341 * \fn int set_iqm_af ()
5342 * \brief Configure IQM AF registers
5343 * \param demod instance of demodulator.
5344 * \param active
5345 * \return int.
5346 */
5347 static int set_iqm_af(struct drx_demod_instance *demod, bool active)
5348 {
5349         u16 data = 0;
5350         struct i2c_device_addr *dev_addr = NULL;
5351         int rc;
5352 
5353         dev_addr = demod->my_i2c_dev_addr;
5354 
5355         /* Configure IQM */
5356         rc = drxj_dap_read_reg16(dev_addr, IQM_AF_STDBY__A, &data, 0);
5357         if (rc != 0) {
5358                 pr_err("error %d\n", rc);
5359                 goto rw_error;
5360         }
5361         if (!active)
5362                 data &= ((~IQM_AF_STDBY_STDBY_ADC_A2_ACTIVE) & (~IQM_AF_STDBY_STDBY_AMP_A2_ACTIVE) & (~IQM_AF_STDBY_STDBY_PD_A2_ACTIVE) & (~IQM_AF_STDBY_STDBY_TAGC_IF_A2_ACTIVE) & (~IQM_AF_STDBY_STDBY_TAGC_RF_A2_ACTIVE));
5363         else
5364                 data |= (IQM_AF_STDBY_STDBY_ADC_A2_ACTIVE | IQM_AF_STDBY_STDBY_AMP_A2_ACTIVE | IQM_AF_STDBY_STDBY_PD_A2_ACTIVE | IQM_AF_STDBY_STDBY_TAGC_IF_A2_ACTIVE | IQM_AF_STDBY_STDBY_TAGC_RF_A2_ACTIVE);
5365         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_STDBY__A, data, 0);
5366         if (rc != 0) {
5367                 pr_err("error %d\n", rc);
5368                 goto rw_error;
5369         }
5370 
5371         return 0;
5372 rw_error:
5373         return rc;
5374 }
5375 
5376 /*============================================================================*/
5377 /*==              END 8VSB & QAM COMMON DATAPATH FUNCTIONS                  ==*/
5378 /*============================================================================*/
5379 
5380 /*============================================================================*/
5381 /*============================================================================*/
5382 /*==                       8VSB DATAPATH FUNCTIONS                          ==*/
5383 /*============================================================================*/
5384 /*============================================================================*/
5385 
5386 /*
5387 * \fn int power_down_vsb ()
5388 * \brief Powr down QAM related blocks.
5389 * \param demod instance of demodulator.
5390 * \param channel pointer to channel data.
5391 * \return int.
5392 */
5393 static int power_down_vsb(struct drx_demod_instance *demod, bool primary)
5394 {
5395         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
5396         struct drxjscu_cmd cmd_scu = { /* command     */ 0,
5397                 /* parameter_len */ 0,
5398                 /* result_len    */ 0,
5399                 /* *parameter   */ NULL,
5400                 /* *result      */ NULL
5401         };
5402         struct drx_cfg_mpeg_output cfg_mpeg_output;
5403         int rc;
5404         u16 cmd_result = 0;
5405 
5406         /*
5407            STOP demodulator
5408            reset of FEC and VSB HW
5409          */
5410         cmd_scu.command = SCU_RAM_COMMAND_STANDARD_VSB |
5411             SCU_RAM_COMMAND_CMD_DEMOD_STOP;
5412         cmd_scu.parameter_len = 0;
5413         cmd_scu.result_len = 1;
5414         cmd_scu.parameter = NULL;
5415         cmd_scu.result = &cmd_result;
5416         rc = scu_command(dev_addr, &cmd_scu);
5417         if (rc != 0) {
5418                 pr_err("error %d\n", rc);
5419                 goto rw_error;
5420         }
5421 
5422         /* stop all comm_exec */
5423         rc = drxj_dap_write_reg16(dev_addr, FEC_COMM_EXEC__A, FEC_COMM_EXEC_STOP, 0);
5424         if (rc != 0) {
5425                 pr_err("error %d\n", rc);
5426                 goto rw_error;
5427         }
5428         rc = drxj_dap_write_reg16(dev_addr, VSB_COMM_EXEC__A, VSB_COMM_EXEC_STOP, 0);
5429         if (rc != 0) {
5430                 pr_err("error %d\n", rc);
5431                 goto rw_error;
5432         }
5433         if (primary) {
5434                 rc = drxj_dap_write_reg16(dev_addr, IQM_COMM_EXEC__A, IQM_COMM_EXEC_STOP, 0);
5435                 if (rc != 0) {
5436                         pr_err("error %d\n", rc);
5437                         goto rw_error;
5438                 }
5439                 rc = set_iqm_af(demod, false);
5440                 if (rc != 0) {
5441                         pr_err("error %d\n", rc);
5442                         goto rw_error;
5443                 }
5444         } else {
5445                 rc = drxj_dap_write_reg16(dev_addr, IQM_FS_COMM_EXEC__A, IQM_FS_COMM_EXEC_STOP, 0);
5446                 if (rc != 0) {
5447                         pr_err("error %d\n", rc);
5448                         goto rw_error;
5449                 }
5450                 rc = drxj_dap_write_reg16(dev_addr, IQM_FD_COMM_EXEC__A, IQM_FD_COMM_EXEC_STOP, 0);
5451                 if (rc != 0) {
5452                         pr_err("error %d\n", rc);
5453                         goto rw_error;
5454                 }
5455                 rc = drxj_dap_write_reg16(dev_addr, IQM_RC_COMM_EXEC__A, IQM_RC_COMM_EXEC_STOP, 0);
5456                 if (rc != 0) {
5457                         pr_err("error %d\n", rc);
5458                         goto rw_error;
5459                 }
5460                 rc = drxj_dap_write_reg16(dev_addr, IQM_RT_COMM_EXEC__A, IQM_RT_COMM_EXEC_STOP, 0);
5461                 if (rc != 0) {
5462                         pr_err("error %d\n", rc);
5463                         goto rw_error;
5464                 }
5465                 rc = drxj_dap_write_reg16(dev_addr, IQM_CF_COMM_EXEC__A, IQM_CF_COMM_EXEC_STOP, 0);
5466                 if (rc != 0) {
5467                         pr_err("error %d\n", rc);
5468                         goto rw_error;
5469                 }
5470         }
5471 
5472         cfg_mpeg_output.enable_mpeg_output = false;
5473         rc = ctrl_set_cfg_mpeg_output(demod, &cfg_mpeg_output);
5474         if (rc != 0) {
5475                 pr_err("error %d\n", rc);
5476                 goto rw_error;
5477         }
5478 
5479         return 0;
5480 rw_error:
5481         return rc;
5482 }
5483 
5484 /*
5485 * \fn int set_vsb_leak_n_gain ()
5486 * \brief Set ATSC demod.
5487 * \param demod instance of demodulator.
5488 * \return int.
5489 */
5490 static int set_vsb_leak_n_gain(struct drx_demod_instance *demod)
5491 {
5492         struct i2c_device_addr *dev_addr = NULL;
5493         int rc;
5494 
5495         static const u8 vsb_ffe_leak_gain_ram0[] = {
5496                 DRXJ_16TO8(0x8),        /* FFETRAINLKRATIO1  */
5497                 DRXJ_16TO8(0x8),        /* FFETRAINLKRATIO2  */
5498                 DRXJ_16TO8(0x8),        /* FFETRAINLKRATIO3  */
5499                 DRXJ_16TO8(0xf),        /* FFETRAINLKRATIO4  */
5500                 DRXJ_16TO8(0xf),        /* FFETRAINLKRATIO5  */
5501                 DRXJ_16TO8(0xf),        /* FFETRAINLKRATIO6  */
5502                 DRXJ_16TO8(0xf),        /* FFETRAINLKRATIO7  */
5503                 DRXJ_16TO8(0xf),        /* FFETRAINLKRATIO8  */
5504                 DRXJ_16TO8(0xf),        /* FFETRAINLKRATIO9  */
5505                 DRXJ_16TO8(0x8),        /* FFETRAINLKRATIO10  */
5506                 DRXJ_16TO8(0x8),        /* FFETRAINLKRATIO11 */
5507                 DRXJ_16TO8(0x8),        /* FFETRAINLKRATIO12 */
5508                 DRXJ_16TO8(0x10),       /* FFERCA1TRAINLKRATIO1 */
5509                 DRXJ_16TO8(0x10),       /* FFERCA1TRAINLKRATIO2 */
5510                 DRXJ_16TO8(0x10),       /* FFERCA1TRAINLKRATIO3 */
5511                 DRXJ_16TO8(0x20),       /* FFERCA1TRAINLKRATIO4 */
5512                 DRXJ_16TO8(0x20),       /* FFERCA1TRAINLKRATIO5 */
5513                 DRXJ_16TO8(0x20),       /* FFERCA1TRAINLKRATIO6 */
5514                 DRXJ_16TO8(0x20),       /* FFERCA1TRAINLKRATIO7 */
5515                 DRXJ_16TO8(0x20),       /* FFERCA1TRAINLKRATIO8 */
5516                 DRXJ_16TO8(0x20),       /* FFERCA1TRAINLKRATIO9 */
5517                 DRXJ_16TO8(0x10),       /* FFERCA1TRAINLKRATIO10 */
5518                 DRXJ_16TO8(0x10),       /* FFERCA1TRAINLKRATIO11 */
5519                 DRXJ_16TO8(0x10),       /* FFERCA1TRAINLKRATIO12 */
5520                 DRXJ_16TO8(0x10),       /* FFERCA1DATALKRATIO1 */
5521                 DRXJ_16TO8(0x10),       /* FFERCA1DATALKRATIO2 */
5522                 DRXJ_16TO8(0x10),       /* FFERCA1DATALKRATIO3 */
5523                 DRXJ_16TO8(0x20),       /* FFERCA1DATALKRATIO4 */
5524                 DRXJ_16TO8(0x20),       /* FFERCA1DATALKRATIO5 */
5525                 DRXJ_16TO8(0x20),       /* FFERCA1DATALKRATIO6 */
5526                 DRXJ_16TO8(0x20),       /* FFERCA1DATALKRATIO7 */
5527                 DRXJ_16TO8(0x20),       /* FFERCA1DATALKRATIO8 */
5528                 DRXJ_16TO8(0x20),       /* FFERCA1DATALKRATIO9 */
5529                 DRXJ_16TO8(0x10),       /* FFERCA1DATALKRATIO10 */
5530                 DRXJ_16TO8(0x10),       /* FFERCA1DATALKRATIO11 */
5531                 DRXJ_16TO8(0x10),       /* FFERCA1DATALKRATIO12 */
5532                 DRXJ_16TO8(0x10),       /* FFERCA2TRAINLKRATIO1 */
5533                 DRXJ_16TO8(0x10),       /* FFERCA2TRAINLKRATIO2 */
5534                 DRXJ_16TO8(0x10),       /* FFERCA2TRAINLKRATIO3 */
5535                 DRXJ_16TO8(0x20),       /* FFERCA2TRAINLKRATIO4 */
5536                 DRXJ_16TO8(0x20),       /* FFERCA2TRAINLKRATIO5 */
5537                 DRXJ_16TO8(0x20),       /* FFERCA2TRAINLKRATIO6 */
5538                 DRXJ_16TO8(0x20),       /* FFERCA2TRAINLKRATIO7 */
5539                 DRXJ_16TO8(0x20),       /* FFERCA2TRAINLKRATIO8 */
5540                 DRXJ_16TO8(0x20),       /* FFERCA2TRAINLKRATIO9 */
5541                 DRXJ_16TO8(0x10),       /* FFERCA2TRAINLKRATIO10 */
5542                 DRXJ_16TO8(0x10),       /* FFERCA2TRAINLKRATIO11 */
5543                 DRXJ_16TO8(0x10),       /* FFERCA2TRAINLKRATIO12 */
5544                 DRXJ_16TO8(0x10),       /* FFERCA2DATALKRATIO1 */
5545                 DRXJ_16TO8(0x10),       /* FFERCA2DATALKRATIO2 */
5546                 DRXJ_16TO8(0x10),       /* FFERCA2DATALKRATIO3 */
5547                 DRXJ_16TO8(0x20),       /* FFERCA2DATALKRATIO4 */
5548                 DRXJ_16TO8(0x20),       /* FFERCA2DATALKRATIO5 */
5549                 DRXJ_16TO8(0x20),       /* FFERCA2DATALKRATIO6 */
5550                 DRXJ_16TO8(0x20),       /* FFERCA2DATALKRATIO7 */
5551                 DRXJ_16TO8(0x20),       /* FFERCA2DATALKRATIO8 */
5552                 DRXJ_16TO8(0x20),       /* FFERCA2DATALKRATIO9 */
5553                 DRXJ_16TO8(0x10),       /* FFERCA2DATALKRATIO10 */
5554                 DRXJ_16TO8(0x10),       /* FFERCA2DATALKRATIO11 */
5555                 DRXJ_16TO8(0x10),       /* FFERCA2DATALKRATIO12 */
5556                 DRXJ_16TO8(0x07),       /* FFEDDM1TRAINLKRATIO1 */
5557                 DRXJ_16TO8(0x07),       /* FFEDDM1TRAINLKRATIO2 */
5558                 DRXJ_16TO8(0x07),       /* FFEDDM1TRAINLKRATIO3 */
5559                 DRXJ_16TO8(0x0e),       /* FFEDDM1TRAINLKRATIO4 */
5560                 DRXJ_16TO8(0x0e),       /* FFEDDM1TRAINLKRATIO5 */
5561                 DRXJ_16TO8(0x0e),       /* FFEDDM1TRAINLKRATIO6 */
5562                 DRXJ_16TO8(0x0e),       /* FFEDDM1TRAINLKRATIO7 */
5563                 DRXJ_16TO8(0x0e),       /* FFEDDM1TRAINLKRATIO8 */
5564                 DRXJ_16TO8(0x0e),       /* FFEDDM1TRAINLKRATIO9 */
5565                 DRXJ_16TO8(0x07),       /* FFEDDM1TRAINLKRATIO10 */
5566                 DRXJ_16TO8(0x07),       /* FFEDDM1TRAINLKRATIO11 */
5567                 DRXJ_16TO8(0x07),       /* FFEDDM1TRAINLKRATIO12 */
5568                 DRXJ_16TO8(0x07),       /* FFEDDM1DATALKRATIO1 */
5569                 DRXJ_16TO8(0x07),       /* FFEDDM1DATALKRATIO2 */
5570                 DRXJ_16TO8(0x07),       /* FFEDDM1DATALKRATIO3 */
5571                 DRXJ_16TO8(0x0e),       /* FFEDDM1DATALKRATIO4 */
5572                 DRXJ_16TO8(0x0e),       /* FFEDDM1DATALKRATIO5 */
5573                 DRXJ_16TO8(0x0e),       /* FFEDDM1DATALKRATIO6 */
5574                 DRXJ_16TO8(0x0e),       /* FFEDDM1DATALKRATIO7 */
5575                 DRXJ_16TO8(0x0e),       /* FFEDDM1DATALKRATIO8 */
5576                 DRXJ_16TO8(0x0e),       /* FFEDDM1DATALKRATIO9 */
5577                 DRXJ_16TO8(0x07),       /* FFEDDM1DATALKRATIO10 */
5578                 DRXJ_16TO8(0x07),       /* FFEDDM1DATALKRATIO11 */
5579                 DRXJ_16TO8(0x07),       /* FFEDDM1DATALKRATIO12 */
5580                 DRXJ_16TO8(0x06),       /* FFEDDM2TRAINLKRATIO1 */
5581                 DRXJ_16TO8(0x06),       /* FFEDDM2TRAINLKRATIO2 */
5582                 DRXJ_16TO8(0x06),       /* FFEDDM2TRAINLKRATIO3 */
5583                 DRXJ_16TO8(0x0c),       /* FFEDDM2TRAINLKRATIO4 */
5584                 DRXJ_16TO8(0x0c),       /* FFEDDM2TRAINLKRATIO5 */
5585                 DRXJ_16TO8(0x0c),       /* FFEDDM2TRAINLKRATIO6 */
5586                 DRXJ_16TO8(0x0c),       /* FFEDDM2TRAINLKRATIO7 */
5587                 DRXJ_16TO8(0x0c),       /* FFEDDM2TRAINLKRATIO8 */
5588                 DRXJ_16TO8(0x0c),       /* FFEDDM2TRAINLKRATIO9 */
5589                 DRXJ_16TO8(0x06),       /* FFEDDM2TRAINLKRATIO10 */
5590                 DRXJ_16TO8(0x06),       /* FFEDDM2TRAINLKRATIO11 */
5591                 DRXJ_16TO8(0x06),       /* FFEDDM2TRAINLKRATIO12 */
5592                 DRXJ_16TO8(0x06),       /* FFEDDM2DATALKRATIO1 */
5593                 DRXJ_16TO8(0x06),       /* FFEDDM2DATALKRATIO2 */
5594                 DRXJ_16TO8(0x06),       /* FFEDDM2DATALKRATIO3 */
5595                 DRXJ_16TO8(0x0c),       /* FFEDDM2DATALKRATIO4 */
5596                 DRXJ_16TO8(0x0c),       /* FFEDDM2DATALKRATIO5 */
5597                 DRXJ_16TO8(0x0c),       /* FFEDDM2DATALKRATIO6 */
5598                 DRXJ_16TO8(0x0c),       /* FFEDDM2DATALKRATIO7 */
5599                 DRXJ_16TO8(0x0c),       /* FFEDDM2DATALKRATIO8 */
5600                 DRXJ_16TO8(0x0c),       /* FFEDDM2DATALKRATIO9 */
5601                 DRXJ_16TO8(0x06),       /* FFEDDM2DATALKRATIO10 */
5602                 DRXJ_16TO8(0x06),       /* FFEDDM2DATALKRATIO11 */
5603                 DRXJ_16TO8(0x06),       /* FFEDDM2DATALKRATIO12 */
5604                 DRXJ_16TO8(0x2020),     /* FIRTRAINGAIN1 */
5605                 DRXJ_16TO8(0x2020),     /* FIRTRAINGAIN2 */
5606                 DRXJ_16TO8(0x2020),     /* FIRTRAINGAIN3 */
5607                 DRXJ_16TO8(0x4040),     /* FIRTRAINGAIN4 */
5608                 DRXJ_16TO8(0x4040),     /* FIRTRAINGAIN5 */
5609                 DRXJ_16TO8(0x4040),     /* FIRTRAINGAIN6 */
5610                 DRXJ_16TO8(0x4040),     /* FIRTRAINGAIN7 */
5611                 DRXJ_16TO8(0x4040),     /* FIRTRAINGAIN8 */
5612                 DRXJ_16TO8(0x4040),     /* FIRTRAINGAIN9 */
5613                 DRXJ_16TO8(0x2020),     /* FIRTRAINGAIN10 */
5614                 DRXJ_16TO8(0x2020),     /* FIRTRAINGAIN11 */
5615                 DRXJ_16TO8(0x2020),     /* FIRTRAINGAIN12 */
5616                 DRXJ_16TO8(0x0808),     /* FIRRCA1GAIN1 */
5617                 DRXJ_16TO8(0x0808),     /* FIRRCA1GAIN2 */
5618                 DRXJ_16TO8(0x0808),     /* FIRRCA1GAIN3 */
5619                 DRXJ_16TO8(0x1010),     /* FIRRCA1GAIN4 */
5620                 DRXJ_16TO8(0x1010),     /* FIRRCA1GAIN5 */
5621                 DRXJ_16TO8(0x1010),     /* FIRRCA1GAIN6 */
5622                 DRXJ_16TO8(0x1010),     /* FIRRCA1GAIN7 */
5623                 DRXJ_16TO8(0x1010)      /* FIRRCA1GAIN8 */
5624         };
5625 
5626         static const u8 vsb_ffe_leak_gain_ram1[] = {
5627                 DRXJ_16TO8(0x1010),     /* FIRRCA1GAIN9 */
5628                 DRXJ_16TO8(0x0808),     /* FIRRCA1GAIN10 */
5629                 DRXJ_16TO8(0x0808),     /* FIRRCA1GAIN11 */
5630                 DRXJ_16TO8(0x0808),     /* FIRRCA1GAIN12 */
5631                 DRXJ_16TO8(0x0808),     /* FIRRCA2GAIN1 */
5632                 DRXJ_16TO8(0x0808),     /* FIRRCA2GAIN2 */
5633                 DRXJ_16TO8(0x0808),     /* FIRRCA2GAIN3 */
5634                 DRXJ_16TO8(0x1010),     /* FIRRCA2GAIN4 */
5635                 DRXJ_16TO8(0x1010),     /* FIRRCA2GAIN5 */
5636                 DRXJ_16TO8(0x1010),     /* FIRRCA2GAIN6 */
5637                 DRXJ_16TO8(0x1010),     /* FIRRCA2GAIN7 */
5638                 DRXJ_16TO8(0x1010),     /* FIRRCA2GAIN8 */
5639                 DRXJ_16TO8(0x1010),     /* FIRRCA2GAIN9 */
5640                 DRXJ_16TO8(0x0808),     /* FIRRCA2GAIN10 */
5641                 DRXJ_16TO8(0x0808),     /* FIRRCA2GAIN11 */
5642                 DRXJ_16TO8(0x0808),     /* FIRRCA2GAIN12 */
5643                 DRXJ_16TO8(0x0303),     /* FIRDDM1GAIN1 */
5644                 DRXJ_16TO8(0x0303),     /* FIRDDM1GAIN2 */
5645                 DRXJ_16TO8(0x0303),     /* FIRDDM1GAIN3 */
5646                 DRXJ_16TO8(0x0606),     /* FIRDDM1GAIN4 */
5647                 DRXJ_16TO8(0x0606),     /* FIRDDM1GAIN5 */
5648                 DRXJ_16TO8(0x0606),     /* FIRDDM1GAIN6 */
5649                 DRXJ_16TO8(0x0606),     /* FIRDDM1GAIN7 */
5650                 DRXJ_16TO8(0x0606),     /* FIRDDM1GAIN8 */
5651                 DRXJ_16TO8(0x0606),     /* FIRDDM1GAIN9 */
5652                 DRXJ_16TO8(0x0303),     /* FIRDDM1GAIN10 */
5653                 DRXJ_16TO8(0x0303),     /* FIRDDM1GAIN11 */
5654                 DRXJ_16TO8(0x0303),     /* FIRDDM1GAIN12 */
5655                 DRXJ_16TO8(0x0303),     /* FIRDDM2GAIN1 */
5656                 DRXJ_16TO8(0x0303),     /* FIRDDM2GAIN2 */
5657                 DRXJ_16TO8(0x0303),     /* FIRDDM2GAIN3 */
5658                 DRXJ_16TO8(0x0505),     /* FIRDDM2GAIN4 */
5659                 DRXJ_16TO8(0x0505),     /* FIRDDM2GAIN5 */
5660                 DRXJ_16TO8(0x0505),     /* FIRDDM2GAIN6 */
5661                 DRXJ_16TO8(0x0505),     /* FIRDDM2GAIN7 */
5662                 DRXJ_16TO8(0x0505),     /* FIRDDM2GAIN8 */
5663                 DRXJ_16TO8(0x0505),     /* FIRDDM2GAIN9 */
5664                 DRXJ_16TO8(0x0303),     /* FIRDDM2GAIN10 */
5665                 DRXJ_16TO8(0x0303),     /* FIRDDM2GAIN11 */
5666                 DRXJ_16TO8(0x0303),     /* FIRDDM2GAIN12 */
5667                 DRXJ_16TO8(0x001f),     /* DFETRAINLKRATIO */
5668                 DRXJ_16TO8(0x01ff),     /* DFERCA1TRAINLKRATIO */
5669                 DRXJ_16TO8(0x01ff),     /* DFERCA1DATALKRATIO */
5670                 DRXJ_16TO8(0x004f),     /* DFERCA2TRAINLKRATIO */
5671                 DRXJ_16TO8(0x004f),     /* DFERCA2DATALKRATIO */
5672                 DRXJ_16TO8(0x01ff),     /* DFEDDM1TRAINLKRATIO */
5673                 DRXJ_16TO8(0x01ff),     /* DFEDDM1DATALKRATIO */
5674                 DRXJ_16TO8(0x0352),     /* DFEDDM2TRAINLKRATIO */
5675                 DRXJ_16TO8(0x0352),     /* DFEDDM2DATALKRATIO */
5676                 DRXJ_16TO8(0x0000),     /* DFETRAINGAIN */
5677                 DRXJ_16TO8(0x2020),     /* DFERCA1GAIN */
5678                 DRXJ_16TO8(0x1010),     /* DFERCA2GAIN */
5679                 DRXJ_16TO8(0x1818),     /* DFEDDM1GAIN */
5680                 DRXJ_16TO8(0x1212)      /* DFEDDM2GAIN */
5681         };
5682 
5683         dev_addr = demod->my_i2c_dev_addr;
5684         rc = drxdap_fasi_write_block(dev_addr, VSB_SYSCTRL_RAM0_FFETRAINLKRATIO1__A, sizeof(vsb_ffe_leak_gain_ram0), ((u8 *)vsb_ffe_leak_gain_ram0), 0);
5685         if (rc != 0) {
5686                 pr_err("error %d\n", rc);
5687                 goto rw_error;
5688         }
5689         rc = drxdap_fasi_write_block(dev_addr, VSB_SYSCTRL_RAM1_FIRRCA1GAIN9__A, sizeof(vsb_ffe_leak_gain_ram1), ((u8 *)vsb_ffe_leak_gain_ram1), 0);
5690         if (rc != 0) {
5691                 pr_err("error %d\n", rc);
5692                 goto rw_error;
5693         }
5694 
5695         return 0;
5696 rw_error:
5697         return rc;
5698 }
5699 
5700 /*
5701 * \fn int set_vsb()
5702 * \brief Set 8VSB demod.
5703 * \param demod instance of demodulator.
5704 * \return int.
5705 *
5706 */
5707 static int set_vsb(struct drx_demod_instance *demod)
5708 {
5709         struct i2c_device_addr *dev_addr = NULL;
5710         int rc;
5711         struct drx_common_attr *common_attr = NULL;
5712         struct drxjscu_cmd cmd_scu;
5713         struct drxj_data *ext_attr = NULL;
5714         u16 cmd_result = 0;
5715         u16 cmd_param = 0;
5716         static const u8 vsb_taps_re[] = {
5717                 DRXJ_16TO8(-2), /* re0  */
5718                 DRXJ_16TO8(4),  /* re1  */
5719                 DRXJ_16TO8(1),  /* re2  */
5720                 DRXJ_16TO8(-4), /* re3  */
5721                 DRXJ_16TO8(1),  /* re4  */
5722                 DRXJ_16TO8(4),  /* re5  */
5723                 DRXJ_16TO8(-3), /* re6  */
5724                 DRXJ_16TO8(-3), /* re7  */
5725                 DRXJ_16TO8(6),  /* re8  */
5726                 DRXJ_16TO8(1),  /* re9  */
5727                 DRXJ_16TO8(-9), /* re10 */
5728                 DRXJ_16TO8(3),  /* re11 */
5729                 DRXJ_16TO8(12), /* re12 */
5730                 DRXJ_16TO8(-9), /* re13 */
5731                 DRXJ_16TO8(-15),        /* re14 */
5732                 DRXJ_16TO8(17), /* re15 */
5733                 DRXJ_16TO8(19), /* re16 */
5734                 DRXJ_16TO8(-29),        /* re17 */
5735                 DRXJ_16TO8(-22),        /* re18 */
5736                 DRXJ_16TO8(45), /* re19 */
5737                 DRXJ_16TO8(25), /* re20 */
5738                 DRXJ_16TO8(-70),        /* re21 */
5739                 DRXJ_16TO8(-28),        /* re22 */
5740                 DRXJ_16TO8(111),        /* re23 */
5741                 DRXJ_16TO8(30), /* re24 */
5742                 DRXJ_16TO8(-201),       /* re25 */
5743                 DRXJ_16TO8(-31),        /* re26 */
5744                 DRXJ_16TO8(629) /* re27 */
5745         };
5746 
5747         dev_addr = demod->my_i2c_dev_addr;
5748         common_attr = (struct drx_common_attr *) demod->my_common_attr;
5749         ext_attr = (struct drxj_data *) demod->my_ext_attr;
5750 
5751         /* stop all comm_exec */
5752         rc = drxj_dap_write_reg16(dev_addr, FEC_COMM_EXEC__A, FEC_COMM_EXEC_STOP, 0);
5753         if (rc != 0) {
5754                 pr_err("error %d\n", rc);
5755                 goto rw_error;
5756         }
5757         rc = drxj_dap_write_reg16(dev_addr, VSB_COMM_EXEC__A, VSB_COMM_EXEC_STOP, 0);
5758         if (rc != 0) {
5759                 pr_err("error %d\n", rc);
5760                 goto rw_error;
5761         }
5762         rc = drxj_dap_write_reg16(dev_addr, IQM_FS_COMM_EXEC__A, IQM_FS_COMM_EXEC_STOP, 0);
5763         if (rc != 0) {
5764                 pr_err("error %d\n", rc);
5765                 goto rw_error;
5766         }
5767         rc = drxj_dap_write_reg16(dev_addr, IQM_FD_COMM_EXEC__A, IQM_FD_COMM_EXEC_STOP, 0);
5768         if (rc != 0) {
5769                 pr_err("error %d\n", rc);
5770                 goto rw_error;
5771         }
5772         rc = drxj_dap_write_reg16(dev_addr, IQM_RC_COMM_EXEC__A, IQM_RC_COMM_EXEC_STOP, 0);
5773         if (rc != 0) {
5774                 pr_err("error %d\n", rc);
5775                 goto rw_error;
5776         }
5777         rc = drxj_dap_write_reg16(dev_addr, IQM_RT_COMM_EXEC__A, IQM_RT_COMM_EXEC_STOP, 0);
5778         if (rc != 0) {
5779                 pr_err("error %d\n", rc);
5780                 goto rw_error;
5781         }
5782         rc = drxj_dap_write_reg16(dev_addr, IQM_CF_COMM_EXEC__A, IQM_CF_COMM_EXEC_STOP, 0);
5783         if (rc != 0) {
5784                 pr_err("error %d\n", rc);
5785                 goto rw_error;
5786         }
5787 
5788         /* reset demodulator */
5789         cmd_scu.command = SCU_RAM_COMMAND_STANDARD_VSB
5790             | SCU_RAM_COMMAND_CMD_DEMOD_RESET;
5791         cmd_scu.parameter_len = 0;
5792         cmd_scu.result_len = 1;
5793         cmd_scu.parameter = NULL;
5794         cmd_scu.result = &cmd_result;
5795         rc = scu_command(dev_addr, &cmd_scu);
5796         if (rc != 0) {
5797                 pr_err("error %d\n", rc);
5798                 goto rw_error;
5799         }
5800 
5801         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_DCF_BYPASS__A, 1, 0);
5802         if (rc != 0) {
5803                 pr_err("error %d\n", rc);
5804                 goto rw_error;
5805         }
5806         rc = drxj_dap_write_reg16(dev_addr, IQM_FS_ADJ_SEL__A, IQM_FS_ADJ_SEL_B_VSB, 0);
5807         if (rc != 0) {
5808                 pr_err("error %d\n", rc);
5809                 goto rw_error;
5810         }
5811         rc = drxj_dap_write_reg16(dev_addr, IQM_RC_ADJ_SEL__A, IQM_RC_ADJ_SEL_B_VSB, 0);
5812         if (rc != 0) {
5813                 pr_err("error %d\n", rc);
5814                 goto rw_error;
5815         }
5816         ext_attr->iqm_rc_rate_ofs = 0x00AD0D79;
5817         rc = drxdap_fasi_write_reg32(dev_addr, IQM_RC_RATE_OFS_LO__A, ext_attr->iqm_rc_rate_ofs, 0);
5818         if (rc != 0) {
5819                 pr_err("error %d\n", rc);
5820                 goto rw_error;
5821         }
5822         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_CFAGC_GAINSHIFT__A, 4, 0);
5823         if (rc != 0) {
5824                 pr_err("error %d\n", rc);
5825                 goto rw_error;
5826         }
5827         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_CYGN1TRK__A, 1, 0);
5828         if (rc != 0) {
5829                 pr_err("error %d\n", rc);
5830                 goto rw_error;
5831         }
5832 
5833         rc = drxj_dap_write_reg16(dev_addr, IQM_RC_CROUT_ENA__A, 1, 0);
5834         if (rc != 0) {
5835                 pr_err("error %d\n", rc);
5836                 goto rw_error;
5837         }
5838         rc = drxj_dap_write_reg16(dev_addr, IQM_RC_STRETCH__A, 28, 0);
5839         if (rc != 0) {
5840                 pr_err("error %d\n", rc);
5841                 goto rw_error;
5842         }
5843         rc = drxj_dap_write_reg16(dev_addr, IQM_RT_ACTIVE__A, 0, 0);
5844         if (rc != 0) {
5845                 pr_err("error %d\n", rc);
5846                 goto rw_error;
5847         }
5848         rc = drxj_dap_write_reg16(dev_addr, IQM_CF_SYMMETRIC__A, 0, 0);
5849         if (rc != 0) {
5850                 pr_err("error %d\n", rc);
5851                 goto rw_error;
5852         }
5853         rc = drxj_dap_write_reg16(dev_addr, IQM_CF_MIDTAP__A, 3, 0);
5854         if (rc != 0) {
5855                 pr_err("error %d\n", rc);
5856                 goto rw_error;
5857         }
5858         rc = drxj_dap_write_reg16(dev_addr, IQM_CF_OUT_ENA__A, IQM_CF_OUT_ENA_VSB__M, 0);
5859         if (rc != 0) {
5860                 pr_err("error %d\n", rc);
5861                 goto rw_error;
5862         }
5863         rc = drxj_dap_write_reg16(dev_addr, IQM_CF_SCALE__A, 1393, 0);
5864         if (rc != 0) {
5865                 pr_err("error %d\n", rc);
5866                 goto rw_error;
5867         }
5868         rc = drxj_dap_write_reg16(dev_addr, IQM_CF_SCALE_SH__A, 0, 0);
5869         if (rc != 0) {
5870                 pr_err("error %d\n", rc);
5871                 goto rw_error;
5872         }
5873         rc = drxj_dap_write_reg16(dev_addr, IQM_CF_POW_MEAS_LEN__A, 1, 0);
5874         if (rc != 0) {
5875                 pr_err("error %d\n", rc);
5876                 goto rw_error;
5877         }
5878 
5879         rc = drxdap_fasi_write_block(dev_addr, IQM_CF_TAP_RE0__A, sizeof(vsb_taps_re), ((u8 *)vsb_taps_re), 0);
5880         if (rc != 0) {
5881                 pr_err("error %d\n", rc);
5882                 goto rw_error;
5883         }
5884         rc = drxdap_fasi_write_block(dev_addr, IQM_CF_TAP_IM0__A, sizeof(vsb_taps_re), ((u8 *)vsb_taps_re), 0);
5885         if (rc != 0) {
5886                 pr_err("error %d\n", rc);
5887                 goto rw_error;
5888         }
5889 
5890         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_BNTHRESH__A, 330, 0);
5891         if (rc != 0) {
5892                 pr_err("error %d\n", rc);
5893                 goto rw_error;
5894         }       /* set higher threshold */
5895         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_CLPLASTNUM__A, 90, 0);
5896         if (rc != 0) {
5897                 pr_err("error %d\n", rc);
5898                 goto rw_error;
5899         }       /* burst detection on   */
5900         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_SNRTH_RCA1__A, 0x0042, 0);
5901         if (rc != 0) {
5902                 pr_err("error %d\n", rc);
5903                 goto rw_error;
5904         }       /* drop thresholds by 1 dB */
5905         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_SNRTH_RCA2__A, 0x0053, 0);
5906         if (rc != 0) {
5907                 pr_err("error %d\n", rc);
5908                 goto rw_error;
5909         }       /* drop thresholds by 2 dB */
5910         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_EQCTRL__A, 0x1, 0);
5911         if (rc != 0) {
5912                 pr_err("error %d\n", rc);
5913                 goto rw_error;
5914         }       /* cma on               */
5915         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_GPIO__A, 0, 0);
5916         if (rc != 0) {
5917                 pr_err("error %d\n", rc);
5918                 goto rw_error;
5919         }       /* GPIO               */
5920 
5921         /* Initialize the FEC Subsystem */
5922         rc = drxj_dap_write_reg16(dev_addr, FEC_TOP_ANNEX__A, FEC_TOP_ANNEX_D, 0);
5923         if (rc != 0) {
5924                 pr_err("error %d\n", rc);
5925                 goto rw_error;
5926         }
5927         {
5928                 u16 fec_oc_snc_mode = 0;
5929                 rc = drxj_dap_read_reg16(dev_addr, FEC_OC_SNC_MODE__A, &fec_oc_snc_mode, 0);
5930                 if (rc != 0) {
5931                         pr_err("error %d\n", rc);
5932                         goto rw_error;
5933                 }
5934                 /* output data even when not locked */
5935                 rc = drxj_dap_write_reg16(dev_addr, FEC_OC_SNC_MODE__A, fec_oc_snc_mode | FEC_OC_SNC_MODE_UNLOCK_ENABLE__M, 0);
5936                 if (rc != 0) {
5937                         pr_err("error %d\n", rc);
5938                         goto rw_error;
5939                 }
5940         }
5941 
5942         /* set clip */
5943         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_CLP_LEN__A, 0, 0);
5944         if (rc != 0) {
5945                 pr_err("error %d\n", rc);
5946                 goto rw_error;
5947         }
5948         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_CLP_TH__A, 470, 0);
5949         if (rc != 0) {
5950                 pr_err("error %d\n", rc);
5951                 goto rw_error;
5952         }
5953         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_SNS_LEN__A, 0, 0);
5954         if (rc != 0) {
5955                 pr_err("error %d\n", rc);
5956                 goto rw_error;
5957         }
5958         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_SNRTH_PT__A, 0xD4, 0);
5959         if (rc != 0) {
5960                 pr_err("error %d\n", rc);
5961                 goto rw_error;
5962         }
5963         /* no transparent, no A&C framing; parity is set in mpegoutput */
5964         {
5965                 u16 fec_oc_reg_mode = 0;
5966                 rc = drxj_dap_read_reg16(dev_addr, FEC_OC_MODE__A, &fec_oc_reg_mode, 0);
5967                 if (rc != 0) {
5968                         pr_err("error %d\n", rc);
5969                         goto rw_error;
5970                 }
5971                 rc = drxj_dap_write_reg16(dev_addr, FEC_OC_MODE__A, fec_oc_reg_mode & (~(FEC_OC_MODE_TRANSPARENT__M | FEC_OC_MODE_CLEAR__M | FEC_OC_MODE_RETAIN_FRAMING__M)), 0);
5972                 if (rc != 0) {
5973                         pr_err("error %d\n", rc);
5974                         goto rw_error;
5975                 }
5976         }
5977 
5978         rc = drxj_dap_write_reg16(dev_addr, FEC_DI_TIMEOUT_LO__A, 0, 0);
5979         if (rc != 0) {
5980                 pr_err("error %d\n", rc);
5981                 goto rw_error;
5982         }       /* timeout counter for restarting */
5983         rc = drxj_dap_write_reg16(dev_addr, FEC_DI_TIMEOUT_HI__A, 3, 0);
5984         if (rc != 0) {
5985                 pr_err("error %d\n", rc);
5986                 goto rw_error;
5987         }
5988         rc = drxj_dap_write_reg16(dev_addr, FEC_RS_MODE__A, 0, 0);
5989         if (rc != 0) {
5990                 pr_err("error %d\n", rc);
5991                 goto rw_error;
5992         }       /* bypass disabled */
5993         /* initialize RS packet error measurement parameters */
5994         rc = drxj_dap_write_reg16(dev_addr, FEC_RS_MEASUREMENT_PERIOD__A, FEC_RS_MEASUREMENT_PERIOD, 0);
5995         if (rc != 0) {
5996                 pr_err("error %d\n", rc);
5997                 goto rw_error;
5998         }
5999         rc = drxj_dap_write_reg16(dev_addr, FEC_RS_MEASUREMENT_PRESCALE__A, FEC_RS_MEASUREMENT_PRESCALE, 0);
6000         if (rc != 0) {
6001                 pr_err("error %d\n", rc);
6002                 goto rw_error;
6003         }
6004 
6005         /* init measurement period of MER/SER */
6006         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_MEASUREMENT_PERIOD__A, VSB_TOP_MEASUREMENT_PERIOD, 0);
6007         if (rc != 0) {
6008                 pr_err("error %d\n", rc);
6009                 goto rw_error;
6010         }
6011         rc = drxdap_fasi_write_reg32(dev_addr, SCU_RAM_FEC_ACCUM_CW_CORRECTED_LO__A, 0, 0);
6012         if (rc != 0) {
6013                 pr_err("error %d\n", rc);
6014                 goto rw_error;
6015         }
6016         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_FEC_MEAS_COUNT__A, 0, 0);
6017         if (rc != 0) {
6018                 pr_err("error %d\n", rc);
6019                 goto rw_error;
6020         }
6021         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_FEC_ACCUM_PKT_FAILURES__A, 0, 0);
6022         if (rc != 0) {
6023                 pr_err("error %d\n", rc);
6024                 goto rw_error;
6025         }
6026 
6027         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_CKGN1TRK__A, 128, 0);
6028         if (rc != 0) {
6029                 pr_err("error %d\n", rc);
6030                 goto rw_error;
6031         }
6032         /* B-Input to ADC, PGA+filter in standby */
6033         if (!ext_attr->has_lna) {
6034                 rc = drxj_dap_write_reg16(dev_addr, IQM_AF_AMUX__A, 0x02, 0);
6035                 if (rc != 0) {
6036                         pr_err("error %d\n", rc);
6037                         goto rw_error;
6038                 }
6039         }
6040 
6041         /* turn on IQMAF. It has to be in front of setAgc**() */
6042         rc = set_iqm_af(demod, true);
6043         if (rc != 0) {
6044                 pr_err("error %d\n", rc);
6045                 goto rw_error;
6046         }
6047         rc = adc_synchronization(demod);
6048         if (rc != 0) {
6049                 pr_err("error %d\n", rc);
6050                 goto rw_error;
6051         }
6052 
6053         rc = init_agc(demod);
6054         if (rc != 0) {
6055                 pr_err("error %d\n", rc);
6056                 goto rw_error;
6057         }
6058         rc = set_agc_if(demod, &(ext_attr->vsb_if_agc_cfg), false);
6059         if (rc != 0) {
6060                 pr_err("error %d\n", rc);
6061                 goto rw_error;
6062         }
6063         rc = set_agc_rf(demod, &(ext_attr->vsb_rf_agc_cfg), false);
6064         if (rc != 0) {
6065                 pr_err("error %d\n", rc);
6066                 goto rw_error;
6067         }
6068         {
6069                 /* TODO fix this, store a struct drxj_cfg_afe_gain structure in struct drxj_data instead
6070                    of only the gain */
6071                 struct drxj_cfg_afe_gain vsb_pga_cfg = { DRX_STANDARD_8VSB, 0 };
6072 
6073                 vsb_pga_cfg.gain = ext_attr->vsb_pga_cfg;
6074                 rc = ctrl_set_cfg_afe_gain(demod, &vsb_pga_cfg);
6075                 if (rc != 0) {
6076                         pr_err("error %d\n", rc);
6077                         goto rw_error;
6078                 }
6079         }
6080         rc = ctrl_set_cfg_pre_saw(demod, &(ext_attr->vsb_pre_saw_cfg));
6081         if (rc != 0) {
6082                 pr_err("error %d\n", rc);
6083                 goto rw_error;
6084         }
6085 
6086         /* Mpeg output has to be in front of FEC active */
6087         rc = set_mpegtei_handling(demod);
6088         if (rc != 0) {
6089                 pr_err("error %d\n", rc);
6090                 goto rw_error;
6091         }
6092         rc = bit_reverse_mpeg_output(demod);
6093         if (rc != 0) {
6094                 pr_err("error %d\n", rc);
6095                 goto rw_error;
6096         }
6097         rc = set_mpeg_start_width(demod);
6098         if (rc != 0) {
6099                 pr_err("error %d\n", rc);
6100                 goto rw_error;
6101         }
6102         {
6103                 /* TODO: move to set_standard after hardware reset value problem is solved */
6104                 /* Configure initial MPEG output */
6105                 struct drx_cfg_mpeg_output cfg_mpeg_output;
6106 
6107                 memcpy(&cfg_mpeg_output, &common_attr->mpeg_cfg, sizeof(cfg_mpeg_output));
6108                 cfg_mpeg_output.enable_mpeg_output = true;
6109 
6110                 rc = ctrl_set_cfg_mpeg_output(demod, &cfg_mpeg_output);
6111                 if (rc != 0) {
6112                         pr_err("error %d\n", rc);
6113                         goto rw_error;
6114                 }
6115         }
6116 
6117         /* TBD: what parameters should be set */
6118         cmd_param = 0x00;       /* Default mode AGC on, etc */
6119         cmd_scu.command = SCU_RAM_COMMAND_STANDARD_VSB
6120             | SCU_RAM_COMMAND_CMD_DEMOD_SET_PARAM;
6121         cmd_scu.parameter_len = 1;
6122         cmd_scu.result_len = 1;
6123         cmd_scu.parameter = &cmd_param;
6124         cmd_scu.result = &cmd_result;
6125         rc = scu_command(dev_addr, &cmd_scu);
6126         if (rc != 0) {
6127                 pr_err("error %d\n", rc);
6128                 goto rw_error;
6129         }
6130 
6131         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_BEAGC_GAINSHIFT__A, 0x0004, 0);
6132         if (rc != 0) {
6133                 pr_err("error %d\n", rc);
6134                 goto rw_error;
6135         }
6136         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_SNRTH_PT__A, 0x00D2, 0);
6137         if (rc != 0) {
6138                 pr_err("error %d\n", rc);
6139                 goto rw_error;
6140         }
6141         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_SYSSMTRNCTRL__A, VSB_TOP_SYSSMTRNCTRL__PRE | VSB_TOP_SYSSMTRNCTRL_NCOTIMEOUTCNTEN__M, 0);
6142         if (rc != 0) {
6143                 pr_err("error %d\n", rc);
6144                 goto rw_error;
6145         }
6146         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_BEDETCTRL__A, 0x142, 0);
6147         if (rc != 0) {
6148                 pr_err("error %d\n", rc);
6149                 goto rw_error;
6150         }
6151         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_LBAGCREFLVL__A, 640, 0);
6152         if (rc != 0) {
6153                 pr_err("error %d\n", rc);
6154                 goto rw_error;
6155         }
6156         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_CYGN1ACQ__A, 4, 0);
6157         if (rc != 0) {
6158                 pr_err("error %d\n", rc);
6159                 goto rw_error;
6160         }
6161         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_CYGN1TRK__A, 2, 0);
6162         if (rc != 0) {
6163                 pr_err("error %d\n", rc);
6164                 goto rw_error;
6165         }
6166         rc = drxj_dap_write_reg16(dev_addr, VSB_TOP_CYGN2TRK__A, 3, 0);
6167         if (rc != 0) {
6168                 pr_err("error %d\n", rc);
6169                 goto rw_error;
6170         }
6171 
6172         /* start demodulator */
6173         cmd_scu.command = SCU_RAM_COMMAND_STANDARD_VSB
6174             | SCU_RAM_COMMAND_CMD_DEMOD_START;
6175         cmd_scu.parameter_len = 0;
6176         cmd_scu.result_len = 1;
6177         cmd_scu.parameter = NULL;
6178         cmd_scu.result = &cmd_result;
6179         rc = scu_command(dev_addr, &cmd_scu);
6180         if (rc != 0) {
6181                 pr_err("error %d\n", rc);
6182                 goto rw_error;
6183         }
6184 
6185         rc = drxj_dap_write_reg16(dev_addr, IQM_COMM_EXEC__A, IQM_COMM_EXEC_ACTIVE, 0);
6186         if (rc != 0) {
6187                 pr_err("error %d\n", rc);
6188                 goto rw_error;
6189         }
6190         rc = drxj_dap_write_reg16(dev_addr, VSB_COMM_EXEC__A, VSB_COMM_EXEC_ACTIVE, 0);
6191         if (rc != 0) {
6192                 pr_err("error %d\n", rc);
6193                 goto rw_error;
6194         }
6195         rc = drxj_dap_write_reg16(dev_addr, FEC_COMM_EXEC__A, FEC_COMM_EXEC_ACTIVE, 0);
6196         if (rc != 0) {
6197                 pr_err("error %d\n", rc);
6198                 goto rw_error;
6199         }
6200 
6201         return 0;
6202 rw_error:
6203         return rc;
6204 }
6205 
6206 /*
6207 * \fn static short get_vsb_post_rs_pck_err(struct i2c_device_addr *dev_addr, u16 *PckErrs)
6208 * \brief Get the values of packet error in 8VSB mode
6209 * \return Error code
6210 */
6211 static int get_vsb_post_rs_pck_err(struct i2c_device_addr *dev_addr,
6212                                    u32 *pck_errs, u32 *pck_count)
6213 {
6214         int rc;
6215         u16 data = 0;
6216         u16 period = 0;
6217         u16 prescale = 0;
6218         u16 packet_errors_mant = 0;
6219         u16 packet_errors_exp = 0;
6220 
6221         rc = drxj_dap_read_reg16(dev_addr, FEC_RS_NR_FAILURES__A, &data, 0);
6222         if (rc != 0) {
6223                 pr_err("error %d\n", rc);
6224                 goto rw_error;
6225         }
6226         packet_errors_mant = data & FEC_RS_NR_FAILURES_FIXED_MANT__M;
6227         packet_errors_exp = (data & FEC_RS_NR_FAILURES_EXP__M)
6228             >> FEC_RS_NR_FAILURES_EXP__B;
6229         period = FEC_RS_MEASUREMENT_PERIOD;
6230         prescale = FEC_RS_MEASUREMENT_PRESCALE;
6231         /* packet error rate = (error packet number) per second */
6232         /* 77.3 us is time for per packet */
6233         if (period * prescale == 0) {
6234                 pr_err("error: period and/or prescale is zero!\n");
6235                 return -EIO;
6236         }
6237         *pck_errs = packet_errors_mant * (1 << packet_errors_exp);
6238         *pck_count = period * prescale * 77;
6239 
6240         return 0;
6241 rw_error:
6242         return rc;
6243 }
6244 
6245 /*
6246 * \fn static short GetVSBBer(struct i2c_device_addr *dev_addr, u32 *ber)
6247 * \brief Get the values of ber in VSB mode
6248 * \return Error code
6249 */
6250 static int get_vs_bpost_viterbi_ber(struct i2c_device_addr *dev_addr,
6251                                     u32 *ber, u32 *cnt)
6252 {
6253         int rc;
6254         u16 data = 0;
6255         u16 period = 0;
6256         u16 prescale = 0;
6257         u16 bit_errors_mant = 0;
6258         u16 bit_errors_exp = 0;
6259 
6260         rc = drxj_dap_read_reg16(dev_addr, FEC_RS_NR_BIT_ERRORS__A, &data, 0);
6261         if (rc != 0) {
6262                 pr_err("error %d\n", rc);
6263                 goto rw_error;
6264         }
6265         period = FEC_RS_MEASUREMENT_PERIOD;
6266         prescale = FEC_RS_MEASUREMENT_PRESCALE;
6267 
6268         bit_errors_mant = data & FEC_RS_NR_BIT_ERRORS_FIXED_MANT__M;
6269         bit_errors_exp = (data & FEC_RS_NR_BIT_ERRORS_EXP__M)
6270             >> FEC_RS_NR_BIT_ERRORS_EXP__B;
6271 
6272         *cnt = period * prescale * 207 * ((bit_errors_exp > 2) ? 1 : 8);
6273 
6274         if (((bit_errors_mant << bit_errors_exp) >> 3) > 68700)
6275                 *ber = (*cnt) * 26570;
6276         else {
6277                 if (period * prescale == 0) {
6278                         pr_err("error: period and/or prescale is zero!\n");
6279                         return -EIO;
6280                 }
6281                 *ber = bit_errors_mant << ((bit_errors_exp > 2) ?
6282                         (bit_errors_exp - 3) : bit_errors_exp);
6283         }
6284 
6285         return 0;
6286 rw_error:
6287         return rc;
6288 }
6289 
6290 /*
6291 * \fn static short get_vs_bpre_viterbi_ber(struct i2c_device_addr *dev_addr, u32 *ber)
6292 * \brief Get the values of ber in VSB mode
6293 * \return Error code
6294 */
6295 static int get_vs_bpre_viterbi_ber(struct i2c_device_addr *dev_addr,
6296                                    u32 *ber, u32 *cnt)
6297 {
6298         u16 data = 0;
6299         int rc;
6300 
6301         rc = drxj_dap_read_reg16(dev_addr, VSB_TOP_NR_SYM_ERRS__A, &data, 0);
6302         if (rc != 0) {
6303                 pr_err("error %d\n", rc);
6304                 return -EIO;
6305         }
6306         *ber = data;
6307         *cnt = VSB_TOP_MEASUREMENT_PERIOD * SYMBOLS_PER_SEGMENT;
6308 
6309         return 0;
6310 }
6311 
6312 /*
6313 * \fn static int get_vsbmer(struct i2c_device_addr *dev_addr, u16 *mer)
6314 * \brief Get the values of MER
6315 * \return Error code
6316 */
6317 static int get_vsbmer(struct i2c_device_addr *dev_addr, u16 *mer)
6318 {
6319         int rc;
6320         u16 data_hi = 0;
6321 
6322         rc = drxj_dap_read_reg16(dev_addr, VSB_TOP_ERR_ENERGY_H__A, &data_hi, 0);
6323         if (rc != 0) {
6324                 pr_err("error %d\n", rc);
6325                 goto rw_error;
6326         }
6327         *mer =
6328             (u16) (log1_times100(21504) - log1_times100((data_hi << 6) / 52));
6329 
6330         return 0;
6331 rw_error:
6332         return rc;
6333 }
6334 
6335 
6336 /*============================================================================*/
6337 /*==                     END 8VSB DATAPATH FUNCTIONS                        ==*/
6338 /*============================================================================*/
6339 
6340 /*============================================================================*/
6341 /*============================================================================*/
6342 /*==                       QAM DATAPATH FUNCTIONS                           ==*/
6343 /*============================================================================*/
6344 /*============================================================================*/
6345 
6346 /*
6347 * \fn int power_down_qam ()
6348 * \brief Powr down QAM related blocks.
6349 * \param demod instance of demodulator.
6350 * \param channel pointer to channel data.
6351 * \return int.
6352 */
6353 static int power_down_qam(struct drx_demod_instance *demod, bool primary)
6354 {
6355         struct drxjscu_cmd cmd_scu = { /* command      */ 0,
6356                 /* parameter_len */ 0,
6357                 /* result_len    */ 0,
6358                 /* *parameter   */ NULL,
6359                 /* *result      */ NULL
6360         };
6361         int rc;
6362         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
6363         struct drx_cfg_mpeg_output cfg_mpeg_output;
6364         struct drx_common_attr *common_attr = demod->my_common_attr;
6365         u16 cmd_result = 0;
6366 
6367         /*
6368            STOP demodulator
6369            resets IQM, QAM and FEC HW blocks
6370          */
6371         /* stop all comm_exec */
6372         rc = drxj_dap_write_reg16(dev_addr, FEC_COMM_EXEC__A, FEC_COMM_EXEC_STOP, 0);
6373         if (rc != 0) {
6374                 pr_err("error %d\n", rc);
6375                 goto rw_error;
6376         }
6377         rc = drxj_dap_write_reg16(dev_addr, QAM_COMM_EXEC__A, QAM_COMM_EXEC_STOP, 0);
6378         if (rc != 0) {
6379                 pr_err("error %d\n", rc);
6380                 goto rw_error;
6381         }
6382 
6383         cmd_scu.command = SCU_RAM_COMMAND_STANDARD_QAM |
6384             SCU_RAM_COMMAND_CMD_DEMOD_STOP;
6385         cmd_scu.parameter_len = 0;
6386         cmd_scu.result_len = 1;
6387         cmd_scu.parameter = NULL;
6388         cmd_scu.result = &cmd_result;
6389         rc = scu_command(dev_addr, &cmd_scu);
6390         if (rc != 0) {
6391                 pr_err("error %d\n", rc);
6392                 goto rw_error;
6393         }
6394 
6395         if (primary) {
6396                 rc = drxj_dap_write_reg16(dev_addr, IQM_COMM_EXEC__A, IQM_COMM_EXEC_STOP, 0);
6397                 if (rc != 0) {
6398                         pr_err("error %d\n", rc);
6399                         goto rw_error;
6400                 }
6401                 rc = set_iqm_af(demod, false);
6402                 if (rc != 0) {
6403                         pr_err("error %d\n", rc);
6404                         goto rw_error;
6405                 }
6406         } else {
6407                 rc = drxj_dap_write_reg16(dev_addr, IQM_FS_COMM_EXEC__A, IQM_FS_COMM_EXEC_STOP, 0);
6408                 if (rc != 0) {
6409                         pr_err("error %d\n", rc);
6410                         goto rw_error;
6411                 }
6412                 rc = drxj_dap_write_reg16(dev_addr, IQM_FD_COMM_EXEC__A, IQM_FD_COMM_EXEC_STOP, 0);
6413                 if (rc != 0) {
6414                         pr_err("error %d\n", rc);
6415                         goto rw_error;
6416                 }
6417                 rc = drxj_dap_write_reg16(dev_addr, IQM_RC_COMM_EXEC__A, IQM_RC_COMM_EXEC_STOP, 0);
6418                 if (rc != 0) {
6419                         pr_err("error %d\n", rc);
6420                         goto rw_error;
6421                 }
6422                 rc = drxj_dap_write_reg16(dev_addr, IQM_RT_COMM_EXEC__A, IQM_RT_COMM_EXEC_STOP, 0);
6423                 if (rc != 0) {
6424                         pr_err("error %d\n", rc);
6425                         goto rw_error;
6426                 }
6427                 rc = drxj_dap_write_reg16(dev_addr, IQM_CF_COMM_EXEC__A, IQM_CF_COMM_EXEC_STOP, 0);
6428                 if (rc != 0) {
6429                         pr_err("error %d\n", rc);
6430                         goto rw_error;
6431                 }
6432         }
6433 
6434         memcpy(&cfg_mpeg_output, &common_attr->mpeg_cfg, sizeof(cfg_mpeg_output));
6435         cfg_mpeg_output.enable_mpeg_output = false;
6436 
6437         rc = ctrl_set_cfg_mpeg_output(demod, &cfg_mpeg_output);
6438         if (rc != 0) {
6439                 pr_err("error %d\n", rc);
6440                 goto rw_error;
6441         }
6442 
6443         return 0;
6444 rw_error:
6445         return rc;
6446 }
6447 
6448 /*============================================================================*/
6449 
6450 /*
6451 * \fn int set_qam_measurement ()
6452 * \brief Setup of the QAM Measuremnt intervals for signal quality
6453 * \param demod instance of demod.
6454 * \param constellation current constellation.
6455 * \return int.
6456 *
6457 *  NOTE:
6458 *  Take into account that for certain settings the errorcounters can overflow.
6459 *  The implementation does not check this.
6460 *
6461 *  TODO: overriding the ext_attr->fec_bits_desired by constellation dependent
6462 *  constants to get a measurement period of approx. 1 sec. Remove fec_bits_desired
6463 *  field ?
6464 *
6465 */
6466 #ifndef DRXJ_VSB_ONLY
6467 static int
6468 set_qam_measurement(struct drx_demod_instance *demod,
6469                     enum drx_modulation constellation, u32 symbol_rate)
6470 {
6471         struct i2c_device_addr *dev_addr = NULL;        /* device address for I2C writes */
6472         struct drxj_data *ext_attr = NULL;      /* Global data container for DRXJ specific data */
6473         int rc;
6474         u32 fec_bits_desired = 0;       /* BER accounting period */
6475         u16 fec_rs_plen = 0;    /* defines RS BER measurement period */
6476         u16 fec_rs_prescale = 0;        /* ReedSolomon Measurement Prescale */
6477         u32 fec_rs_period = 0;  /* Value for corresponding I2C register */
6478         u32 fec_rs_bit_cnt = 0; /* Actual precise amount of bits */
6479         u32 fec_oc_snc_fail_period = 0; /* Value for corresponding I2C register */
6480         u32 qam_vd_period = 0;  /* Value for corresponding I2C register */
6481         u32 qam_vd_bit_cnt = 0; /* Actual precise amount of bits */
6482         u16 fec_vd_plen = 0;    /* no of trellis symbols: VD SER measur period */
6483         u16 qam_vd_prescale = 0;        /* Viterbi Measurement Prescale */
6484 
6485         dev_addr = demod->my_i2c_dev_addr;
6486         ext_attr = (struct drxj_data *) demod->my_ext_attr;
6487 
6488         fec_bits_desired = ext_attr->fec_bits_desired;
6489         fec_rs_prescale = ext_attr->fec_rs_prescale;
6490 
6491         switch (constellation) {
6492         case DRX_CONSTELLATION_QAM16:
6493                 fec_bits_desired = 4 * symbol_rate;
6494                 break;
6495         case DRX_CONSTELLATION_QAM32:
6496                 fec_bits_desired = 5 * symbol_rate;
6497                 break;
6498         case DRX_CONSTELLATION_QAM64:
6499                 fec_bits_desired = 6 * symbol_rate;
6500                 break;
6501         case DRX_CONSTELLATION_QAM128:
6502                 fec_bits_desired = 7 * symbol_rate;
6503                 break;
6504         case DRX_CONSTELLATION_QAM256:
6505                 fec_bits_desired = 8 * symbol_rate;
6506                 break;
6507         default:
6508                 return -EINVAL;
6509         }
6510 
6511         /* Parameters for Reed-Solomon Decoder */
6512         /* fecrs_period = (int)ceil(FEC_BITS_DESIRED/(fecrs_prescale*plen)) */
6513         /* rs_bit_cnt   = fecrs_period*fecrs_prescale*plen                  */
6514         /*     result is within 32 bit arithmetic ->                        */
6515         /*     no need for mult or frac functions                           */
6516 
6517         /* TODO: use constant instead of calculation and remove the fec_rs_plen in ext_attr */
6518         switch (ext_attr->standard) {
6519         case DRX_STANDARD_ITU_A:
6520         case DRX_STANDARD_ITU_C:
6521                 fec_rs_plen = 204 * 8;
6522                 break;
6523         case DRX_STANDARD_ITU_B:
6524                 fec_rs_plen = 128 * 7;
6525                 break;
6526         default:
6527                 return -EINVAL;
6528         }
6529 
6530         ext_attr->fec_rs_plen = fec_rs_plen;    /* for getSigQual */
6531         fec_rs_bit_cnt = fec_rs_prescale * fec_rs_plen; /* temp storage   */
6532         if (fec_rs_bit_cnt == 0) {
6533                 pr_err("error: fec_rs_bit_cnt is zero!\n");
6534                 return -EIO;
6535         }
6536         fec_rs_period = fec_bits_desired / fec_rs_bit_cnt + 1;  /* ceil */
6537         if (ext_attr->standard != DRX_STANDARD_ITU_B)
6538                 fec_oc_snc_fail_period = fec_rs_period;
6539 
6540         /* limit to max 16 bit value (I2C register width) if needed */
6541         if (fec_rs_period > 0xFFFF)
6542                 fec_rs_period = 0xFFFF;
6543 
6544         /* write corresponding registers */
6545         switch (ext_attr->standard) {
6546         case DRX_STANDARD_ITU_A:
6547         case DRX_STANDARD_ITU_C:
6548                 break;
6549         case DRX_STANDARD_ITU_B:
6550                 switch (constellation) {
6551                 case DRX_CONSTELLATION_QAM64:
6552                         fec_rs_period = 31581;
6553                         fec_oc_snc_fail_period = 17932;
6554                         break;
6555                 case DRX_CONSTELLATION_QAM256:
6556                         fec_rs_period = 45446;
6557                         fec_oc_snc_fail_period = 25805;
6558                         break;
6559                 default:
6560                         return -EINVAL;
6561                 }
6562                 break;
6563         default:
6564                 return -EINVAL;
6565         }
6566 
6567         rc = drxj_dap_write_reg16(dev_addr, FEC_OC_SNC_FAIL_PERIOD__A, (u16)fec_oc_snc_fail_period, 0);
6568         if (rc != 0) {
6569                 pr_err("error %d\n", rc);
6570                 goto rw_error;
6571         }
6572         rc = drxj_dap_write_reg16(dev_addr, FEC_RS_MEASUREMENT_PERIOD__A, (u16)fec_rs_period, 0);
6573         if (rc != 0) {
6574                 pr_err("error %d\n", rc);
6575                 goto rw_error;
6576         }
6577         rc = drxj_dap_write_reg16(dev_addr, FEC_RS_MEASUREMENT_PRESCALE__A, fec_rs_prescale, 0);
6578         if (rc != 0) {
6579                 pr_err("error %d\n", rc);
6580                 goto rw_error;
6581         }
6582         ext_attr->fec_rs_period = (u16) fec_rs_period;
6583         ext_attr->fec_rs_prescale = fec_rs_prescale;
6584         rc = drxdap_fasi_write_reg32(dev_addr, SCU_RAM_FEC_ACCUM_CW_CORRECTED_LO__A, 0, 0);
6585         if (rc != 0) {
6586                 pr_err("error %d\n", rc);
6587                 goto rw_error;
6588         }
6589         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_FEC_MEAS_COUNT__A, 0, 0);
6590         if (rc != 0) {
6591                 pr_err("error %d\n", rc);
6592                 goto rw_error;
6593         }
6594         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_FEC_ACCUM_PKT_FAILURES__A, 0, 0);
6595         if (rc != 0) {
6596                 pr_err("error %d\n", rc);
6597                 goto rw_error;
6598         }
6599 
6600         if (ext_attr->standard == DRX_STANDARD_ITU_B) {
6601                 /* Parameters for Viterbi Decoder */
6602                 /* qamvd_period = (int)ceil(FEC_BITS_DESIRED/                      */
6603                 /*                    (qamvd_prescale*plen*(qam_constellation+1))) */
6604                 /* vd_bit_cnt   = qamvd_period*qamvd_prescale*plen                 */
6605                 /*     result is within 32 bit arithmetic ->                       */
6606                 /*     no need for mult or frac functions                          */
6607 
6608                 /* a(8 bit) * b(8 bit) = 16 bit result => mult32 not needed */
6609                 fec_vd_plen = ext_attr->fec_vd_plen;
6610                 qam_vd_prescale = ext_attr->qam_vd_prescale;
6611                 qam_vd_bit_cnt = qam_vd_prescale * fec_vd_plen; /* temp storage */
6612 
6613                 switch (constellation) {
6614                 case DRX_CONSTELLATION_QAM64:
6615                         /* a(16 bit) * b(4 bit) = 20 bit result => mult32 not needed */
6616                         qam_vd_period =
6617                             qam_vd_bit_cnt * (QAM_TOP_CONSTELLATION_QAM64 + 1)
6618                             * (QAM_TOP_CONSTELLATION_QAM64 + 1);
6619                         break;
6620                 case DRX_CONSTELLATION_QAM256:
6621                         /* a(16 bit) * b(5 bit) = 21 bit result => mult32 not needed */
6622                         qam_vd_period =
6623                             qam_vd_bit_cnt * (QAM_TOP_CONSTELLATION_QAM256 + 1)
6624                             * (QAM_TOP_CONSTELLATION_QAM256 + 1);
6625                         break;
6626                 default:
6627                         return -EINVAL;
6628                 }
6629                 if (qam_vd_period == 0) {
6630                         pr_err("error: qam_vd_period is zero!\n");
6631                         return -EIO;
6632                 }
6633                 qam_vd_period = fec_bits_desired / qam_vd_period;
6634                 /* limit to max 16 bit value (I2C register width) if needed */
6635                 if (qam_vd_period > 0xFFFF)
6636                         qam_vd_period = 0xFFFF;
6637 
6638                 /* a(16 bit) * b(16 bit) = 32 bit result => mult32 not needed */
6639                 qam_vd_bit_cnt *= qam_vd_period;
6640 
6641                 rc = drxj_dap_write_reg16(dev_addr, QAM_VD_MEASUREMENT_PERIOD__A, (u16)qam_vd_period, 0);
6642                 if (rc != 0) {
6643                         pr_err("error %d\n", rc);
6644                         goto rw_error;
6645                 }
6646                 rc = drxj_dap_write_reg16(dev_addr, QAM_VD_MEASUREMENT_PRESCALE__A, qam_vd_prescale, 0);
6647                 if (rc != 0) {
6648                         pr_err("error %d\n", rc);
6649                         goto rw_error;
6650                 }
6651                 ext_attr->qam_vd_period = (u16) qam_vd_period;
6652                 ext_attr->qam_vd_prescale = qam_vd_prescale;
6653         }
6654 
6655         return 0;
6656 rw_error:
6657         return rc;
6658 }
6659 
6660 /*============================================================================*/
6661 
6662 /*
6663 * \fn int set_qam16 ()
6664 * \brief QAM16 specific setup
6665 * \param demod instance of demod.
6666 * \return int.
6667 */
6668 static int set_qam16(struct drx_demod_instance *demod)
6669 {
6670         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
6671         int rc;
6672         static const u8 qam_dq_qual_fun[] = {
6673                 DRXJ_16TO8(2),  /* fun0  */
6674                 DRXJ_16TO8(2),  /* fun1  */
6675                 DRXJ_16TO8(2),  /* fun2  */
6676                 DRXJ_16TO8(2),  /* fun3  */
6677                 DRXJ_16TO8(3),  /* fun4  */
6678                 DRXJ_16TO8(3),  /* fun5  */
6679         };
6680         static const u8 qam_eq_cma_rad[] = {
6681                 DRXJ_16TO8(13517),      /* RAD0  */
6682                 DRXJ_16TO8(13517),      /* RAD1  */
6683                 DRXJ_16TO8(13517),      /* RAD2  */
6684                 DRXJ_16TO8(13517),      /* RAD3  */
6685                 DRXJ_16TO8(13517),      /* RAD4  */
6686                 DRXJ_16TO8(13517),      /* RAD5  */
6687         };
6688 
6689         rc = drxdap_fasi_write_block(dev_addr, QAM_DQ_QUAL_FUN0__A, sizeof(qam_dq_qual_fun), ((u8 *)qam_dq_qual_fun), 0);
6690         if (rc != 0) {
6691                 pr_err("error %d\n", rc);
6692                 goto rw_error;
6693         }
6694         rc = drxdap_fasi_write_block(dev_addr, SCU_RAM_QAM_EQ_CMA_RAD0__A, sizeof(qam_eq_cma_rad), ((u8 *)qam_eq_cma_rad), 0);
6695         if (rc != 0) {
6696                 pr_err("error %d\n", rc);
6697                 goto rw_error;
6698         }
6699 
6700         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RTH__A, 140, 0);
6701         if (rc != 0) {
6702                 pr_err("error %d\n", rc);
6703                 goto rw_error;
6704         }
6705         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_FTH__A, 50, 0);
6706         if (rc != 0) {
6707                 pr_err("error %d\n", rc);
6708                 goto rw_error;
6709         }
6710         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_PTH__A, 120, 0);
6711         if (rc != 0) {
6712                 pr_err("error %d\n", rc);
6713                 goto rw_error;
6714         }
6715         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_QTH__A, 230, 0);
6716         if (rc != 0) {
6717                 pr_err("error %d\n", rc);
6718                 goto rw_error;
6719         }
6720         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_CTH__A, 95, 0);
6721         if (rc != 0) {
6722                 pr_err("error %d\n", rc);
6723                 goto rw_error;
6724         }
6725         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_MTH__A, 105, 0);
6726         if (rc != 0) {
6727                 pr_err("error %d\n", rc);
6728                 goto rw_error;
6729         }
6730 
6731         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RATE_LIM__A, 40, 0);
6732         if (rc != 0) {
6733                 pr_err("error %d\n", rc);
6734                 goto rw_error;
6735         }
6736         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_FREQ_LIM__A, 56, 0);
6737         if (rc != 0) {
6738                 pr_err("error %d\n", rc);
6739                 goto rw_error;
6740         }
6741         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_COUNT_LIM__A, 3, 0);
6742         if (rc != 0) {
6743                 pr_err("error %d\n", rc);
6744                 goto rw_error;
6745         }
6746 
6747         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, 16, 0);
6748         if (rc != 0) {
6749                 pr_err("error %d\n", rc);
6750                 goto rw_error;
6751         }
6752         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, 220, 0);
6753         if (rc != 0) {
6754                 pr_err("error %d\n", rc);
6755                 goto rw_error;
6756         }
6757         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, 25, 0);
6758         if (rc != 0) {
6759                 pr_err("error %d\n", rc);
6760                 goto rw_error;
6761         }
6762         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, 6, 0);
6763         if (rc != 0) {
6764                 pr_err("error %d\n", rc);
6765                 goto rw_error;
6766         }
6767         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16)(-24), 0);
6768         if (rc != 0) {
6769                 pr_err("error %d\n", rc);
6770                 goto rw_error;
6771         }
6772         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, (u16)(-65), 0);
6773         if (rc != 0) {
6774                 pr_err("error %d\n", rc);
6775                 goto rw_error;
6776         }
6777         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16)(-127), 0);
6778         if (rc != 0) {
6779                 pr_err("error %d\n", rc);
6780                 goto rw_error;
6781         }
6782 
6783         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CA_FINE__A, 15, 0);
6784         if (rc != 0) {
6785                 pr_err("error %d\n", rc);
6786                 goto rw_error;
6787         }
6788         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CA_COARSE__A, 40, 0);
6789         if (rc != 0) {
6790                 pr_err("error %d\n", rc);
6791                 goto rw_error;
6792         }
6793         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_FINE__A, 2, 0);
6794         if (rc != 0) {
6795                 pr_err("error %d\n", rc);
6796                 goto rw_error;
6797         }
6798         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_MEDIUM__A, 20, 0);
6799         if (rc != 0) {
6800                 pr_err("error %d\n", rc);
6801                 goto rw_error;
6802         }
6803         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_COARSE__A, 255, 0);
6804         if (rc != 0) {
6805                 pr_err("error %d\n", rc);
6806                 goto rw_error;
6807         }
6808         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_FINE__A, 2, 0);
6809         if (rc != 0) {
6810                 pr_err("error %d\n", rc);
6811                 goto rw_error;
6812         }
6813         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_MEDIUM__A, 10, 0);
6814         if (rc != 0) {
6815                 pr_err("error %d\n", rc);
6816                 goto rw_error;
6817         }
6818         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_COARSE__A, 50, 0);
6819         if (rc != 0) {
6820                 pr_err("error %d\n", rc);
6821                 goto rw_error;
6822         }
6823         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_FINE__A, 12, 0);
6824         if (rc != 0) {
6825                 pr_err("error %d\n", rc);
6826                 goto rw_error;
6827         }
6828         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24, 0);
6829         if (rc != 0) {
6830                 pr_err("error %d\n", rc);
6831                 goto rw_error;
6832         }
6833         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_COARSE__A, 24, 0);
6834         if (rc != 0) {
6835                 pr_err("error %d\n", rc);
6836                 goto rw_error;
6837         }
6838         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_FINE__A, 12, 0);
6839         if (rc != 0) {
6840                 pr_err("error %d\n", rc);
6841                 goto rw_error;
6842         }
6843         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16, 0);
6844         if (rc != 0) {
6845                 pr_err("error %d\n", rc);
6846                 goto rw_error;
6847         }
6848         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_COARSE__A, 16, 0);
6849         if (rc != 0) {
6850                 pr_err("error %d\n", rc);
6851                 goto rw_error;
6852         }
6853         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_FINE__A, 16, 0);
6854         if (rc != 0) {
6855                 pr_err("error %d\n", rc);
6856                 goto rw_error;
6857         }
6858         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_MEDIUM__A, 32, 0);
6859         if (rc != 0) {
6860                 pr_err("error %d\n", rc);
6861                 goto rw_error;
6862         }
6863         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_COARSE__A, 240, 0);
6864         if (rc != 0) {
6865                 pr_err("error %d\n", rc);
6866                 goto rw_error;
6867         }
6868         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_FINE__A, 5, 0);
6869         if (rc != 0) {
6870                 pr_err("error %d\n", rc);
6871                 goto rw_error;
6872         }
6873         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 15, 0);
6874         if (rc != 0) {
6875                 pr_err("error %d\n", rc);
6876                 goto rw_error;
6877         }
6878         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_COARSE__A, 32, 0);
6879         if (rc != 0) {
6880                 pr_err("error %d\n", rc);
6881                 goto rw_error;
6882         }
6883 
6884         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_SL_SIG_POWER__A, 40960, 0);
6885         if (rc != 0) {
6886                 pr_err("error %d\n", rc);
6887                 goto rw_error;
6888         }
6889 
6890         return 0;
6891 rw_error:
6892         return rc;
6893 }
6894 
6895 /*============================================================================*/
6896 
6897 /*
6898 * \fn int set_qam32 ()
6899 * \brief QAM32 specific setup
6900 * \param demod instance of demod.
6901 * \return int.
6902 */
6903 static int set_qam32(struct drx_demod_instance *demod)
6904 {
6905         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
6906         int rc;
6907         static const u8 qam_dq_qual_fun[] = {
6908                 DRXJ_16TO8(3),  /* fun0  */
6909                 DRXJ_16TO8(3),  /* fun1  */
6910                 DRXJ_16TO8(3),  /* fun2  */
6911                 DRXJ_16TO8(3),  /* fun3  */
6912                 DRXJ_16TO8(4),  /* fun4  */
6913                 DRXJ_16TO8(4),  /* fun5  */
6914         };
6915         static const u8 qam_eq_cma_rad[] = {
6916                 DRXJ_16TO8(6707),       /* RAD0  */
6917                 DRXJ_16TO8(6707),       /* RAD1  */
6918                 DRXJ_16TO8(6707),       /* RAD2  */
6919                 DRXJ_16TO8(6707),       /* RAD3  */
6920                 DRXJ_16TO8(6707),       /* RAD4  */
6921                 DRXJ_16TO8(6707),       /* RAD5  */
6922         };
6923 
6924         rc = drxdap_fasi_write_block(dev_addr, QAM_DQ_QUAL_FUN0__A, sizeof(qam_dq_qual_fun), ((u8 *)qam_dq_qual_fun), 0);
6925         if (rc != 0) {
6926                 pr_err("error %d\n", rc);
6927                 goto rw_error;
6928         }
6929         rc = drxdap_fasi_write_block(dev_addr, SCU_RAM_QAM_EQ_CMA_RAD0__A, sizeof(qam_eq_cma_rad), ((u8 *)qam_eq_cma_rad), 0);
6930         if (rc != 0) {
6931                 pr_err("error %d\n", rc);
6932                 goto rw_error;
6933         }
6934 
6935         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RTH__A, 90, 0);
6936         if (rc != 0) {
6937                 pr_err("error %d\n", rc);
6938                 goto rw_error;
6939         }
6940         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_FTH__A, 50, 0);
6941         if (rc != 0) {
6942                 pr_err("error %d\n", rc);
6943                 goto rw_error;
6944         }
6945         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_PTH__A, 100, 0);
6946         if (rc != 0) {
6947                 pr_err("error %d\n", rc);
6948                 goto rw_error;
6949         }
6950         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_QTH__A, 170, 0);
6951         if (rc != 0) {
6952                 pr_err("error %d\n", rc);
6953                 goto rw_error;
6954         }
6955         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_CTH__A, 80, 0);
6956         if (rc != 0) {
6957                 pr_err("error %d\n", rc);
6958                 goto rw_error;
6959         }
6960         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_MTH__A, 100, 0);
6961         if (rc != 0) {
6962                 pr_err("error %d\n", rc);
6963                 goto rw_error;
6964         }
6965 
6966         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RATE_LIM__A, 40, 0);
6967         if (rc != 0) {
6968                 pr_err("error %d\n", rc);
6969                 goto rw_error;
6970         }
6971         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_FREQ_LIM__A, 56, 0);
6972         if (rc != 0) {
6973                 pr_err("error %d\n", rc);
6974                 goto rw_error;
6975         }
6976         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_COUNT_LIM__A, 3, 0);
6977         if (rc != 0) {
6978                 pr_err("error %d\n", rc);
6979                 goto rw_error;
6980         }
6981 
6982         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, 12, 0);
6983         if (rc != 0) {
6984                 pr_err("error %d\n", rc);
6985                 goto rw_error;
6986         }
6987         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, 140, 0);
6988         if (rc != 0) {
6989                 pr_err("error %d\n", rc);
6990                 goto rw_error;
6991         }
6992         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, (u16)(-8), 0);
6993         if (rc != 0) {
6994                 pr_err("error %d\n", rc);
6995                 goto rw_error;
6996         }
6997         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, (u16)(-16), 0);
6998         if (rc != 0) {
6999                 pr_err("error %d\n", rc);
7000                 goto rw_error;
7001         }
7002         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16)(-26), 0);
7003         if (rc != 0) {
7004                 pr_err("error %d\n", rc);
7005                 goto rw_error;
7006         }
7007         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, (u16)(-56), 0);
7008         if (rc != 0) {
7009                 pr_err("error %d\n", rc);
7010                 goto rw_error;
7011         }
7012         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16)(-86), 0);
7013         if (rc != 0) {
7014                 pr_err("error %d\n", rc);
7015                 goto rw_error;
7016         }
7017 
7018         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CA_FINE__A, 15, 0);
7019         if (rc != 0) {
7020                 pr_err("error %d\n", rc);
7021                 goto rw_error;
7022         }
7023         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CA_COARSE__A, 40, 0);
7024         if (rc != 0) {
7025                 pr_err("error %d\n", rc);
7026                 goto rw_error;
7027         }
7028         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_FINE__A, 2, 0);
7029         if (rc != 0) {
7030                 pr_err("error %d\n", rc);
7031                 goto rw_error;
7032         }
7033         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_MEDIUM__A, 20, 0);
7034         if (rc != 0) {
7035                 pr_err("error %d\n", rc);
7036                 goto rw_error;
7037         }
7038         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_COARSE__A, 255, 0);
7039         if (rc != 0) {
7040                 pr_err("error %d\n", rc);
7041                 goto rw_error;
7042         }
7043         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_FINE__A, 2, 0);
7044         if (rc != 0) {
7045                 pr_err("error %d\n", rc);
7046                 goto rw_error;
7047         }
7048         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_MEDIUM__A, 10, 0);
7049         if (rc != 0) {
7050                 pr_err("error %d\n", rc);
7051                 goto rw_error;
7052         }
7053         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_COARSE__A, 50, 0);
7054         if (rc != 0) {
7055                 pr_err("error %d\n", rc);
7056                 goto rw_error;
7057         }
7058         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_FINE__A, 12, 0);
7059         if (rc != 0) {
7060                 pr_err("error %d\n", rc);
7061                 goto rw_error;
7062         }
7063         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24, 0);
7064         if (rc != 0) {
7065                 pr_err("error %d\n", rc);
7066                 goto rw_error;
7067         }
7068         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_COARSE__A, 24, 0);
7069         if (rc != 0) {
7070                 pr_err("error %d\n", rc);
7071                 goto rw_error;
7072         }
7073         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_FINE__A, 12, 0);
7074         if (rc != 0) {
7075                 pr_err("error %d\n", rc);
7076                 goto rw_error;
7077         }
7078         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16, 0);
7079         if (rc != 0) {
7080                 pr_err("error %d\n", rc);
7081                 goto rw_error;
7082         }
7083         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_COARSE__A, 16, 0);
7084         if (rc != 0) {
7085                 pr_err("error %d\n", rc);
7086                 goto rw_error;
7087         }
7088         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_FINE__A, 16, 0);
7089         if (rc != 0) {
7090                 pr_err("error %d\n", rc);
7091                 goto rw_error;
7092         }
7093         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_MEDIUM__A, 32, 0);
7094         if (rc != 0) {
7095                 pr_err("error %d\n", rc);
7096                 goto rw_error;
7097         }
7098         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_COARSE__A, 176, 0);
7099         if (rc != 0) {
7100                 pr_err("error %d\n", rc);
7101                 goto rw_error;
7102         }
7103         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_FINE__A, 5, 0);
7104         if (rc != 0) {
7105                 pr_err("error %d\n", rc);
7106                 goto rw_error;
7107         }
7108         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 15, 0);
7109         if (rc != 0) {
7110                 pr_err("error %d\n", rc);
7111                 goto rw_error;
7112         }
7113         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_COARSE__A, 8, 0);
7114         if (rc != 0) {
7115                 pr_err("error %d\n", rc);
7116                 goto rw_error;
7117         }
7118 
7119         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_SL_SIG_POWER__A, 20480, 0);
7120         if (rc != 0) {
7121                 pr_err("error %d\n", rc);
7122                 goto rw_error;
7123         }
7124 
7125         return 0;
7126 rw_error:
7127         return rc;
7128 }
7129 
7130 /*============================================================================*/
7131 
7132 /*
7133 * \fn int set_qam64 ()
7134 * \brief QAM64 specific setup
7135 * \param demod instance of demod.
7136 * \return int.
7137 */
7138 static int set_qam64(struct drx_demod_instance *demod)
7139 {
7140         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
7141         int rc;
7142         static const u8 qam_dq_qual_fun[] = {
7143                 /* this is hw reset value. no necessary to re-write */
7144                 DRXJ_16TO8(4),  /* fun0  */
7145                 DRXJ_16TO8(4),  /* fun1  */
7146                 DRXJ_16TO8(4),  /* fun2  */
7147                 DRXJ_16TO8(4),  /* fun3  */
7148                 DRXJ_16TO8(6),  /* fun4  */
7149                 DRXJ_16TO8(6),  /* fun5  */
7150         };
7151         static const u8 qam_eq_cma_rad[] = {
7152                 DRXJ_16TO8(13336),      /* RAD0  */
7153                 DRXJ_16TO8(12618),      /* RAD1  */
7154                 DRXJ_16TO8(11988),      /* RAD2  */
7155                 DRXJ_16TO8(13809),      /* RAD3  */
7156                 DRXJ_16TO8(13809),      /* RAD4  */
7157                 DRXJ_16TO8(15609),      /* RAD5  */
7158         };
7159 
7160         rc = drxdap_fasi_write_block(dev_addr, QAM_DQ_QUAL_FUN0__A, sizeof(qam_dq_qual_fun), ((u8 *)qam_dq_qual_fun), 0);
7161         if (rc != 0) {
7162                 pr_err("error %d\n", rc);
7163                 goto rw_error;
7164         }
7165         rc = drxdap_fasi_write_block(dev_addr, SCU_RAM_QAM_EQ_CMA_RAD0__A, sizeof(qam_eq_cma_rad), ((u8 *)qam_eq_cma_rad), 0);
7166         if (rc != 0) {
7167                 pr_err("error %d\n", rc);
7168                 goto rw_error;
7169         }
7170 
7171         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RTH__A, 105, 0);
7172         if (rc != 0) {
7173                 pr_err("error %d\n", rc);
7174                 goto rw_error;
7175         }
7176         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_FTH__A, 60, 0);
7177         if (rc != 0) {
7178                 pr_err("error %d\n", rc);
7179                 goto rw_error;
7180         }
7181         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_PTH__A, 100, 0);
7182         if (rc != 0) {
7183                 pr_err("error %d\n", rc);
7184                 goto rw_error;
7185         }
7186         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_QTH__A, 195, 0);
7187         if (rc != 0) {
7188                 pr_err("error %d\n", rc);
7189                 goto rw_error;
7190         }
7191         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_CTH__A, 80, 0);
7192         if (rc != 0) {
7193                 pr_err("error %d\n", rc);
7194                 goto rw_error;
7195         }
7196         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_MTH__A, 84, 0);
7197         if (rc != 0) {
7198                 pr_err("error %d\n", rc);
7199                 goto rw_error;
7200         }
7201 
7202         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RATE_LIM__A, 40, 0);
7203         if (rc != 0) {
7204                 pr_err("error %d\n", rc);
7205                 goto rw_error;
7206         }
7207         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_FREQ_LIM__A, 32, 0);
7208         if (rc != 0) {
7209                 pr_err("error %d\n", rc);
7210                 goto rw_error;
7211         }
7212         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_COUNT_LIM__A, 3, 0);
7213         if (rc != 0) {
7214                 pr_err("error %d\n", rc);
7215                 goto rw_error;
7216         }
7217 
7218         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, 12, 0);
7219         if (rc != 0) {
7220                 pr_err("error %d\n", rc);
7221                 goto rw_error;
7222         }
7223         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, 141, 0);
7224         if (rc != 0) {
7225                 pr_err("error %d\n", rc);
7226                 goto rw_error;
7227         }
7228         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, 7, 0);
7229         if (rc != 0) {
7230                 pr_err("error %d\n", rc);
7231                 goto rw_error;
7232         }
7233         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, 0, 0);
7234         if (rc != 0) {
7235                 pr_err("error %d\n", rc);
7236                 goto rw_error;
7237         }
7238         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16)(-15), 0);
7239         if (rc != 0) {
7240                 pr_err("error %d\n", rc);
7241                 goto rw_error;
7242         }
7243         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, (u16)(-45), 0);
7244         if (rc != 0) {
7245                 pr_err("error %d\n", rc);
7246                 goto rw_error;
7247         }
7248         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16)(-80), 0);
7249         if (rc != 0) {
7250                 pr_err("error %d\n", rc);
7251                 goto rw_error;
7252         }
7253 
7254         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CA_FINE__A, 15, 0);
7255         if (rc != 0) {
7256                 pr_err("error %d\n", rc);
7257                 goto rw_error;
7258         }
7259         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CA_COARSE__A, 40, 0);
7260         if (rc != 0) {
7261                 pr_err("error %d\n", rc);
7262                 goto rw_error;
7263         }
7264         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_FINE__A, 2, 0);
7265         if (rc != 0) {
7266                 pr_err("error %d\n", rc);
7267                 goto rw_error;
7268         }
7269         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_MEDIUM__A, 30, 0);
7270         if (rc != 0) {
7271                 pr_err("error %d\n", rc);
7272                 goto rw_error;
7273         }
7274         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_COARSE__A, 255, 0);
7275         if (rc != 0) {
7276                 pr_err("error %d\n", rc);
7277                 goto rw_error;
7278         }
7279         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_FINE__A, 2, 0);
7280         if (rc != 0) {
7281                 pr_err("error %d\n", rc);
7282                 goto rw_error;
7283         }
7284         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_MEDIUM__A, 15, 0);
7285         if (rc != 0) {
7286                 pr_err("error %d\n", rc);
7287                 goto rw_error;
7288         }
7289         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_COARSE__A, 80, 0);
7290         if (rc != 0) {
7291                 pr_err("error %d\n", rc);
7292                 goto rw_error;
7293         }
7294         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_FINE__A, 12, 0);
7295         if (rc != 0) {
7296                 pr_err("error %d\n", rc);
7297                 goto rw_error;
7298         }
7299         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24, 0);
7300         if (rc != 0) {
7301                 pr_err("error %d\n", rc);
7302                 goto rw_error;
7303         }
7304         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_COARSE__A, 24, 0);
7305         if (rc != 0) {
7306                 pr_err("error %d\n", rc);
7307                 goto rw_error;
7308         }
7309         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_FINE__A, 12, 0);
7310         if (rc != 0) {
7311                 pr_err("error %d\n", rc);
7312                 goto rw_error;
7313         }
7314         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16, 0);
7315         if (rc != 0) {
7316                 pr_err("error %d\n", rc);
7317                 goto rw_error;
7318         }
7319         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_COARSE__A, 16, 0);
7320         if (rc != 0) {
7321                 pr_err("error %d\n", rc);
7322                 goto rw_error;
7323         }
7324         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_FINE__A, 16, 0);
7325         if (rc != 0) {
7326                 pr_err("error %d\n", rc);
7327                 goto rw_error;
7328         }
7329         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_MEDIUM__A, 48, 0);
7330         if (rc != 0) {
7331                 pr_err("error %d\n", rc);
7332                 goto rw_error;
7333         }
7334         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_COARSE__A, 160, 0);
7335         if (rc != 0) {
7336                 pr_err("error %d\n", rc);
7337                 goto rw_error;
7338         }
7339         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_FINE__A, 5, 0);
7340         if (rc != 0) {
7341                 pr_err("error %d\n", rc);
7342                 goto rw_error;
7343         }
7344         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 15, 0);
7345         if (rc != 0) {
7346                 pr_err("error %d\n", rc);
7347                 goto rw_error;
7348         }
7349         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_COARSE__A, 32, 0);
7350         if (rc != 0) {
7351                 pr_err("error %d\n", rc);
7352                 goto rw_error;
7353         }
7354 
7355         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_SL_SIG_POWER__A, 43008, 0);
7356         if (rc != 0) {
7357                 pr_err("error %d\n", rc);
7358                 goto rw_error;
7359         }
7360 
7361         return 0;
7362 rw_error:
7363         return rc;
7364 }
7365 
7366 /*============================================================================*/
7367 
7368 /*
7369 * \fn int set_qam128 ()
7370 * \brief QAM128 specific setup
7371 * \param demod: instance of demod.
7372 * \return int.
7373 */
7374 static int set_qam128(struct drx_demod_instance *demod)
7375 {
7376         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
7377         int rc;
7378         static const u8 qam_dq_qual_fun[] = {
7379                 DRXJ_16TO8(6),  /* fun0  */
7380                 DRXJ_16TO8(6),  /* fun1  */
7381                 DRXJ_16TO8(6),  /* fun2  */
7382                 DRXJ_16TO8(6),  /* fun3  */
7383                 DRXJ_16TO8(9),  /* fun4  */
7384                 DRXJ_16TO8(9),  /* fun5  */
7385         };
7386         static const u8 qam_eq_cma_rad[] = {
7387                 DRXJ_16TO8(6164),       /* RAD0  */
7388                 DRXJ_16TO8(6598),       /* RAD1  */
7389                 DRXJ_16TO8(6394),       /* RAD2  */
7390                 DRXJ_16TO8(6409),       /* RAD3  */
7391                 DRXJ_16TO8(6656),       /* RAD4  */
7392                 DRXJ_16TO8(7238),       /* RAD5  */
7393         };
7394 
7395         rc = drxdap_fasi_write_block(dev_addr, QAM_DQ_QUAL_FUN0__A, sizeof(qam_dq_qual_fun), ((u8 *)qam_dq_qual_fun), 0);
7396         if (rc != 0) {
7397                 pr_err("error %d\n", rc);
7398                 goto rw_error;
7399         }
7400         rc = drxdap_fasi_write_block(dev_addr, SCU_RAM_QAM_EQ_CMA_RAD0__A, sizeof(qam_eq_cma_rad), ((u8 *)qam_eq_cma_rad), 0);
7401         if (rc != 0) {
7402                 pr_err("error %d\n", rc);
7403                 goto rw_error;
7404         }
7405 
7406         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RTH__A, 50, 0);
7407         if (rc != 0) {
7408                 pr_err("error %d\n", rc);
7409                 goto rw_error;
7410         }
7411         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_FTH__A, 60, 0);
7412         if (rc != 0) {
7413                 pr_err("error %d\n", rc);
7414                 goto rw_error;
7415         }
7416         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_PTH__A, 100, 0);
7417         if (rc != 0) {
7418                 pr_err("error %d\n", rc);
7419                 goto rw_error;
7420         }
7421         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_QTH__A, 140, 0);
7422         if (rc != 0) {
7423                 pr_err("error %d\n", rc);
7424                 goto rw_error;
7425         }
7426         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_CTH__A, 80, 0);
7427         if (rc != 0) {
7428                 pr_err("error %d\n", rc);
7429                 goto rw_error;
7430         }
7431         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_MTH__A, 100, 0);
7432         if (rc != 0) {
7433                 pr_err("error %d\n", rc);
7434                 goto rw_error;
7435         }
7436 
7437         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RATE_LIM__A, 40, 0);
7438         if (rc != 0) {
7439                 pr_err("error %d\n", rc);
7440                 goto rw_error;
7441         }
7442         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_FREQ_LIM__A, 32, 0);
7443         if (rc != 0) {
7444                 pr_err("error %d\n", rc);
7445                 goto rw_error;
7446         }
7447         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_COUNT_LIM__A, 3, 0);
7448         if (rc != 0) {
7449                 pr_err("error %d\n", rc);
7450                 goto rw_error;
7451         }
7452 
7453         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, 8, 0);
7454         if (rc != 0) {
7455                 pr_err("error %d\n", rc);
7456                 goto rw_error;
7457         }
7458         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, 65, 0);
7459         if (rc != 0) {
7460                 pr_err("error %d\n", rc);
7461                 goto rw_error;
7462         }
7463         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, 5, 0);
7464         if (rc != 0) {
7465                 pr_err("error %d\n", rc);
7466                 goto rw_error;
7467         }
7468         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, 3, 0);
7469         if (rc != 0) {
7470                 pr_err("error %d\n", rc);
7471                 goto rw_error;
7472         }
7473         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16)(-1), 0);
7474         if (rc != 0) {
7475                 pr_err("error %d\n", rc);
7476                 goto rw_error;
7477         }
7478         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, 12, 0);
7479         if (rc != 0) {
7480                 pr_err("error %d\n", rc);
7481                 goto rw_error;
7482         }
7483         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16)(-23), 0);
7484         if (rc != 0) {
7485                 pr_err("error %d\n", rc);
7486                 goto rw_error;
7487         }
7488 
7489         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CA_FINE__A, 15, 0);
7490         if (rc != 0) {
7491                 pr_err("error %d\n", rc);
7492                 goto rw_error;
7493         }
7494         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CA_COARSE__A, 40, 0);
7495         if (rc != 0) {
7496                 pr_err("error %d\n", rc);
7497                 goto rw_error;
7498         }
7499         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_FINE__A, 2, 0);
7500         if (rc != 0) {
7501                 pr_err("error %d\n", rc);
7502                 goto rw_error;
7503         }
7504         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_MEDIUM__A, 40, 0);
7505         if (rc != 0) {
7506                 pr_err("error %d\n", rc);
7507                 goto rw_error;
7508         }
7509         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_COARSE__A, 255, 0);
7510         if (rc != 0) {
7511                 pr_err("error %d\n", rc);
7512                 goto rw_error;
7513         }
7514         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_FINE__A, 2, 0);
7515         if (rc != 0) {
7516                 pr_err("error %d\n", rc);
7517                 goto rw_error;
7518         }
7519         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_MEDIUM__A, 20, 0);
7520         if (rc != 0) {
7521                 pr_err("error %d\n", rc);
7522                 goto rw_error;
7523         }
7524         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_COARSE__A, 80, 0);
7525         if (rc != 0) {
7526                 pr_err("error %d\n", rc);
7527                 goto rw_error;
7528         }
7529         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_FINE__A, 12, 0);
7530         if (rc != 0) {
7531                 pr_err("error %d\n", rc);
7532                 goto rw_error;
7533         }
7534         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24, 0);
7535         if (rc != 0) {
7536                 pr_err("error %d\n", rc);
7537                 goto rw_error;
7538         }
7539         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_COARSE__A, 24, 0);
7540         if (rc != 0) {
7541                 pr_err("error %d\n", rc);
7542                 goto rw_error;
7543         }
7544         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_FINE__A, 12, 0);
7545         if (rc != 0) {
7546                 pr_err("error %d\n", rc);
7547                 goto rw_error;
7548         }
7549         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16, 0);
7550         if (rc != 0) {
7551                 pr_err("error %d\n", rc);
7552                 goto rw_error;
7553         }
7554         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_COARSE__A, 16, 0);
7555         if (rc != 0) {
7556                 pr_err("error %d\n", rc);
7557                 goto rw_error;
7558         }
7559         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_FINE__A, 16, 0);
7560         if (rc != 0) {
7561                 pr_err("error %d\n", rc);
7562                 goto rw_error;
7563         }
7564         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_MEDIUM__A, 32, 0);
7565         if (rc != 0) {
7566                 pr_err("error %d\n", rc);
7567                 goto rw_error;
7568         }
7569         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_COARSE__A, 144, 0);
7570         if (rc != 0) {
7571                 pr_err("error %d\n", rc);
7572                 goto rw_error;
7573         }
7574         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_FINE__A, 5, 0);
7575         if (rc != 0) {
7576                 pr_err("error %d\n", rc);
7577                 goto rw_error;
7578         }
7579         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 15, 0);
7580         if (rc != 0) {
7581                 pr_err("error %d\n", rc);
7582                 goto rw_error;
7583         }
7584         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_COARSE__A, 16, 0);
7585         if (rc != 0) {
7586                 pr_err("error %d\n", rc);
7587                 goto rw_error;
7588         }
7589 
7590         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_SL_SIG_POWER__A, 20992, 0);
7591         if (rc != 0) {
7592                 pr_err("error %d\n", rc);
7593                 goto rw_error;
7594         }
7595 
7596         return 0;
7597 rw_error:
7598         return rc;
7599 }
7600 
7601 /*============================================================================*/
7602 
7603 /*
7604 * \fn int set_qam256 ()
7605 * \brief QAM256 specific setup
7606 * \param demod: instance of demod.
7607 * \return int.
7608 */
7609 static int set_qam256(struct drx_demod_instance *demod)
7610 {
7611         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
7612         int rc;
7613         static const u8 qam_dq_qual_fun[] = {
7614                 DRXJ_16TO8(8),  /* fun0  */
7615                 DRXJ_16TO8(8),  /* fun1  */
7616                 DRXJ_16TO8(8),  /* fun2  */
7617                 DRXJ_16TO8(8),  /* fun3  */
7618                 DRXJ_16TO8(12), /* fun4  */
7619                 DRXJ_16TO8(12), /* fun5  */
7620         };
7621         static const u8 qam_eq_cma_rad[] = {
7622                 DRXJ_16TO8(12345),      /* RAD0  */
7623                 DRXJ_16TO8(12345),      /* RAD1  */
7624                 DRXJ_16TO8(13626),      /* RAD2  */
7625                 DRXJ_16TO8(12931),      /* RAD3  */
7626                 DRXJ_16TO8(14719),      /* RAD4  */
7627                 DRXJ_16TO8(15356),      /* RAD5  */
7628         };
7629 
7630         rc = drxdap_fasi_write_block(dev_addr, QAM_DQ_QUAL_FUN0__A, sizeof(qam_dq_qual_fun), ((u8 *)qam_dq_qual_fun), 0);
7631         if (rc != 0) {
7632                 pr_err("error %d\n", rc);
7633                 goto rw_error;
7634         }
7635         rc = drxdap_fasi_write_block(dev_addr, SCU_RAM_QAM_EQ_CMA_RAD0__A, sizeof(qam_eq_cma_rad), ((u8 *)qam_eq_cma_rad), 0);
7636         if (rc != 0) {
7637                 pr_err("error %d\n", rc);
7638                 goto rw_error;
7639         }
7640 
7641         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RTH__A, 50, 0);
7642         if (rc != 0) {
7643                 pr_err("error %d\n", rc);
7644                 goto rw_error;
7645         }
7646         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_FTH__A, 60, 0);
7647         if (rc != 0) {
7648                 pr_err("error %d\n", rc);
7649                 goto rw_error;
7650         }
7651         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_PTH__A, 100, 0);
7652         if (rc != 0) {
7653                 pr_err("error %d\n", rc);
7654                 goto rw_error;
7655         }
7656         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_QTH__A, 150, 0);
7657         if (rc != 0) {
7658                 pr_err("error %d\n", rc);
7659                 goto rw_error;
7660         }
7661         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_CTH__A, 80, 0);
7662         if (rc != 0) {
7663                 pr_err("error %d\n", rc);
7664                 goto rw_error;
7665         }
7666         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_MTH__A, 110, 0);
7667         if (rc != 0) {
7668                 pr_err("error %d\n", rc);
7669                 goto rw_error;
7670         }
7671 
7672         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RATE_LIM__A, 40, 0);
7673         if (rc != 0) {
7674                 pr_err("error %d\n", rc);
7675                 goto rw_error;
7676         }
7677         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_FREQ_LIM__A, 16, 0);
7678         if (rc != 0) {
7679                 pr_err("error %d\n", rc);
7680                 goto rw_error;
7681         }
7682         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_COUNT_LIM__A, 3, 0);
7683         if (rc != 0) {
7684                 pr_err("error %d\n", rc);
7685                 goto rw_error;
7686         }
7687 
7688         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, 8, 0);
7689         if (rc != 0) {
7690                 pr_err("error %d\n", rc);
7691                 goto rw_error;
7692         }
7693         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, 74, 0);
7694         if (rc != 0) {
7695                 pr_err("error %d\n", rc);
7696                 goto rw_error;
7697         }
7698         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, 18, 0);
7699         if (rc != 0) {
7700                 pr_err("error %d\n", rc);
7701                 goto rw_error;
7702         }
7703         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, 13, 0);
7704         if (rc != 0) {
7705                 pr_err("error %d\n", rc);
7706                 goto rw_error;
7707         }
7708         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, 7, 0);
7709         if (rc != 0) {
7710                 pr_err("error %d\n", rc);
7711                 goto rw_error;
7712         }
7713         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, 0, 0);
7714         if (rc != 0) {
7715                 pr_err("error %d\n", rc);
7716                 goto rw_error;
7717         }
7718         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16)(-8), 0);
7719         if (rc != 0) {
7720                 pr_err("error %d\n", rc);
7721                 goto rw_error;
7722         }
7723 
7724         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CA_FINE__A, 15, 0);
7725         if (rc != 0) {
7726                 pr_err("error %d\n", rc);
7727                 goto rw_error;
7728         }
7729         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CA_COARSE__A, 40, 0);
7730         if (rc != 0) {
7731                 pr_err("error %d\n", rc);
7732                 goto rw_error;
7733         }
7734         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_FINE__A, 2, 0);
7735         if (rc != 0) {
7736                 pr_err("error %d\n", rc);
7737                 goto rw_error;
7738         }
7739         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_MEDIUM__A, 50, 0);
7740         if (rc != 0) {
7741                 pr_err("error %d\n", rc);
7742                 goto rw_error;
7743         }
7744         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CP_COARSE__A, 255, 0);
7745         if (rc != 0) {
7746                 pr_err("error %d\n", rc);
7747                 goto rw_error;
7748         }
7749         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_FINE__A, 2, 0);
7750         if (rc != 0) {
7751                 pr_err("error %d\n", rc);
7752                 goto rw_error;
7753         }
7754         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_MEDIUM__A, 25, 0);
7755         if (rc != 0) {
7756                 pr_err("error %d\n", rc);
7757                 goto rw_error;
7758         }
7759         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CI_COARSE__A, 80, 0);
7760         if (rc != 0) {
7761                 pr_err("error %d\n", rc);
7762                 goto rw_error;
7763         }
7764         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_FINE__A, 12, 0);
7765         if (rc != 0) {
7766                 pr_err("error %d\n", rc);
7767                 goto rw_error;
7768         }
7769         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24, 0);
7770         if (rc != 0) {
7771                 pr_err("error %d\n", rc);
7772                 goto rw_error;
7773         }
7774         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EP_COARSE__A, 24, 0);
7775         if (rc != 0) {
7776                 pr_err("error %d\n", rc);
7777                 goto rw_error;
7778         }
7779         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_FINE__A, 12, 0);
7780         if (rc != 0) {
7781                 pr_err("error %d\n", rc);
7782                 goto rw_error;
7783         }
7784         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16, 0);
7785         if (rc != 0) {
7786                 pr_err("error %d\n", rc);
7787                 goto rw_error;
7788         }
7789         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_EI_COARSE__A, 16, 0);
7790         if (rc != 0) {
7791                 pr_err("error %d\n", rc);
7792                 goto rw_error;
7793         }
7794         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_FINE__A, 16, 0);
7795         if (rc != 0) {
7796                 pr_err("error %d\n", rc);
7797                 goto rw_error;
7798         }
7799         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_MEDIUM__A, 48, 0);
7800         if (rc != 0) {
7801                 pr_err("error %d\n", rc);
7802                 goto rw_error;
7803         }
7804         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF_COARSE__A, 80, 0);
7805         if (rc != 0) {
7806                 pr_err("error %d\n", rc);
7807                 goto rw_error;
7808         }
7809         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_FINE__A, 5, 0);
7810         if (rc != 0) {
7811                 pr_err("error %d\n", rc);
7812                 goto rw_error;
7813         }
7814         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 15, 0);
7815         if (rc != 0) {
7816                 pr_err("error %d\n", rc);
7817                 goto rw_error;
7818         }
7819         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_LC_CF1_COARSE__A, 16, 0);
7820         if (rc != 0) {
7821                 pr_err("error %d\n", rc);
7822                 goto rw_error;
7823         }
7824 
7825         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_SL_SIG_POWER__A, 43520, 0);
7826         if (rc != 0) {
7827                 pr_err("error %d\n", rc);
7828                 goto rw_error;
7829         }
7830 
7831         return 0;
7832 rw_error:
7833         return rc;
7834 }
7835 
7836 /*============================================================================*/
7837 #define QAM_SET_OP_ALL 0x1
7838 #define QAM_SET_OP_CONSTELLATION 0x2
7839 #define QAM_SET_OP_SPECTRUM 0X4
7840 
7841 /*
7842 * \fn int set_qam ()
7843 * \brief Set QAM demod.
7844 * \param demod:   instance of demod.
7845 * \param channel: pointer to channel data.
7846 * \return int.
7847 */
7848 static int
7849 set_qam(struct drx_demod_instance *demod,
7850         struct drx_channel *channel, s32 tuner_freq_offset, u32 op)
7851 {
7852         struct i2c_device_addr *dev_addr = NULL;
7853         struct drxj_data *ext_attr = NULL;
7854         struct drx_common_attr *common_attr = NULL;
7855         int rc;
7856         u32 adc_frequency = 0;
7857         u32 iqm_rc_rate = 0;
7858         u16 cmd_result = 0;
7859         u16 lc_symbol_freq = 0;
7860         u16 iqm_rc_stretch = 0;
7861         u16 set_env_parameters = 0;
7862         u16 set_param_parameters[2] = { 0 };
7863         struct drxjscu_cmd cmd_scu = { /* command      */ 0,
7864                 /* parameter_len */ 0,
7865                 /* result_len    */ 0,
7866                 /* parameter    */ NULL,
7867                 /* result       */ NULL
7868         };
7869         static const u8 qam_a_taps[] = {
7870                 DRXJ_16TO8(-1), /* re0  */
7871                 DRXJ_16TO8(1),  /* re1  */
7872                 DRXJ_16TO8(1),  /* re2  */
7873                 DRXJ_16TO8(-1), /* re3  */
7874                 DRXJ_16TO8(-1), /* re4  */
7875                 DRXJ_16TO8(2),  /* re5  */
7876                 DRXJ_16TO8(1),  /* re6  */
7877                 DRXJ_16TO8(-2), /* re7  */
7878                 DRXJ_16TO8(0),  /* re8  */
7879                 DRXJ_16TO8(3),  /* re9  */
7880                 DRXJ_16TO8(-1), /* re10 */
7881                 DRXJ_16TO8(-3), /* re11 */
7882                 DRXJ_16TO8(4),  /* re12 */
7883                 DRXJ_16TO8(1),  /* re13 */
7884                 DRXJ_16TO8(-8), /* re14 */
7885                 DRXJ_16TO8(4),  /* re15 */
7886                 DRXJ_16TO8(13), /* re16 */
7887                 DRXJ_16TO8(-13),        /* re17 */
7888                 DRXJ_16TO8(-19),        /* re18 */
7889                 DRXJ_16TO8(28), /* re19 */
7890                 DRXJ_16TO8(25), /* re20 */
7891                 DRXJ_16TO8(-53),        /* re21 */
7892                 DRXJ_16TO8(-31),        /* re22 */
7893                 DRXJ_16TO8(96), /* re23 */
7894                 DRXJ_16TO8(37), /* re24 */
7895                 DRXJ_16TO8(-190),       /* re25 */
7896                 DRXJ_16TO8(-40),        /* re26 */
7897                 DRXJ_16TO8(619) /* re27 */
7898         };
7899         static const u8 qam_b64_taps[] = {
7900                 DRXJ_16TO8(0),  /* re0  */
7901                 DRXJ_16TO8(-2), /* re1  */
7902                 DRXJ_16TO8(1),  /* re2  */
7903                 DRXJ_16TO8(2),  /* re3  */
7904                 DRXJ_16TO8(-2), /* re4  */
7905                 DRXJ_16TO8(0),  /* re5  */
7906                 DRXJ_16TO8(4),  /* re6  */
7907                 DRXJ_16TO8(-2), /* re7  */
7908                 DRXJ_16TO8(-4), /* re8  */
7909                 DRXJ_16TO8(4),  /* re9  */
7910                 DRXJ_16TO8(3),  /* re10 */
7911                 DRXJ_16TO8(-6), /* re11 */
7912                 DRXJ_16TO8(0),  /* re12 */
7913                 DRXJ_16TO8(6),  /* re13 */
7914                 DRXJ_16TO8(-5), /* re14 */
7915                 DRXJ_16TO8(-3), /* re15 */
7916                 DRXJ_16TO8(11), /* re16 */
7917                 DRXJ_16TO8(-4), /* re17 */
7918                 DRXJ_16TO8(-19),        /* re18 */
7919                 DRXJ_16TO8(19), /* re19 */
7920                 DRXJ_16TO8(28), /* re20 */
7921                 DRXJ_16TO8(-45),        /* re21 */
7922                 DRXJ_16TO8(-36),        /* re22 */
7923                 DRXJ_16TO8(90), /* re23 */
7924                 DRXJ_16TO8(42), /* re24 */
7925                 DRXJ_16TO8(-185),       /* re25 */
7926                 DRXJ_16TO8(-46),        /* re26 */
7927                 DRXJ_16TO8(614) /* re27 */
7928         };
7929         static const u8 qam_b256_taps[] = {
7930                 DRXJ_16TO8(-2), /* re0  */
7931                 DRXJ_16TO8(4),  /* re1  */
7932                 DRXJ_16TO8(1),  /* re2  */
7933                 DRXJ_16TO8(-4), /* re3  */
7934                 DRXJ_16TO8(0),  /* re4  */
7935                 DRXJ_16TO8(4),  /* re5  */
7936                 DRXJ_16TO8(-2), /* re6  */
7937                 DRXJ_16TO8(-4), /* re7  */
7938                 DRXJ_16TO8(5),  /* re8  */
7939                 DRXJ_16TO8(2),  /* re9  */
7940                 DRXJ_16TO8(-8), /* re10 */
7941                 DRXJ_16TO8(2),  /* re11 */
7942                 DRXJ_16TO8(11), /* re12 */
7943                 DRXJ_16TO8(-8), /* re13 */
7944                 DRXJ_16TO8(-15),        /* re14 */
7945                 DRXJ_16TO8(16), /* re15 */
7946                 DRXJ_16TO8(19), /* re16 */
7947                 DRXJ_16TO8(-27),        /* re17 */
7948                 DRXJ_16TO8(-22),        /* re18 */
7949                 DRXJ_16TO8(44), /* re19 */
7950                 DRXJ_16TO8(26), /* re20 */
7951                 DRXJ_16TO8(-69),        /* re21 */
7952                 DRXJ_16TO8(-28),        /* re22 */
7953                 DRXJ_16TO8(110),        /* re23 */
7954                 DRXJ_16TO8(31), /* re24 */
7955                 DRXJ_16TO8(-201),       /* re25 */
7956                 DRXJ_16TO8(-32),        /* re26 */
7957                 DRXJ_16TO8(628) /* re27 */
7958         };
7959         static const u8 qam_c_taps[] = {
7960                 DRXJ_16TO8(-3), /* re0  */
7961                 DRXJ_16TO8(3),  /* re1  */
7962                 DRXJ_16TO8(2),  /* re2  */
7963                 DRXJ_16TO8(-4), /* re3  */
7964                 DRXJ_16TO8(0),  /* re4  */
7965                 DRXJ_16TO8(4),  /* re5  */
7966                 DRXJ_16TO8(-1), /* re6  */
7967                 DRXJ_16TO8(-4), /* re7  */
7968                 DRXJ_16TO8(3),  /* re8  */
7969                 DRXJ_16TO8(3),  /* re9  */
7970                 DRXJ_16TO8(-5), /* re10 */
7971                 DRXJ_16TO8(0),  /* re11 */
7972                 DRXJ_16TO8(9),  /* re12 */
7973                 DRXJ_16TO8(-4), /* re13 */
7974                 DRXJ_16TO8(-12),        /* re14 */
7975                 DRXJ_16TO8(10), /* re15 */
7976                 DRXJ_16TO8(16), /* re16 */
7977                 DRXJ_16TO8(-21),        /* re17 */
7978                 DRXJ_16TO8(-20),        /* re18 */
7979                 DRXJ_16TO8(37), /* re19 */
7980                 DRXJ_16TO8(25), /* re20 */
7981                 DRXJ_16TO8(-62),        /* re21 */
7982                 DRXJ_16TO8(-28),        /* re22 */
7983                 DRXJ_16TO8(105),        /* re23 */
7984                 DRXJ_16TO8(31), /* re24 */
7985                 DRXJ_16TO8(-197),       /* re25 */
7986                 DRXJ_16TO8(-33),        /* re26 */
7987                 DRXJ_16TO8(626) /* re27 */
7988         };
7989 
7990         dev_addr = demod->my_i2c_dev_addr;
7991         ext_attr = (struct drxj_data *) demod->my_ext_attr;
7992         common_attr = (struct drx_common_attr *) demod->my_common_attr;
7993 
7994         if ((op & QAM_SET_OP_ALL) || (op & QAM_SET_OP_CONSTELLATION)) {
7995                 if (ext_attr->standard == DRX_STANDARD_ITU_B) {
7996                         switch (channel->constellation) {
7997                         case DRX_CONSTELLATION_QAM256:
7998                                 iqm_rc_rate = 0x00AE3562;
7999                                 lc_symbol_freq =
8000                                     QAM_LC_SYMBOL_FREQ_FREQ_QAM_B_256;
8001                                 channel->symbolrate = 5360537;
8002                                 iqm_rc_stretch = IQM_RC_STRETCH_QAM_B_256;
8003                                 break;
8004                         case DRX_CONSTELLATION_QAM64:
8005                                 iqm_rc_rate = 0x00C05A0E;
8006                                 lc_symbol_freq = 409;
8007                                 channel->symbolrate = 5056941;
8008                                 iqm_rc_stretch = IQM_RC_STRETCH_QAM_B_64;
8009                                 break;
8010                         default:
8011                                 return -EINVAL;
8012                         }
8013                 } else {
8014                         adc_frequency = (common_attr->sys_clock_freq * 1000) / 3;
8015                         if (channel->symbolrate == 0) {
8016                                 pr_err("error: channel symbolrate is zero!\n");
8017                                 return -EIO;
8018                         }
8019                         iqm_rc_rate =
8020                             (adc_frequency / channel->symbolrate) * (1 << 21) +
8021                             (frac28
8022                              ((adc_frequency % channel->symbolrate),
8023                               channel->symbolrate) >> 7) - (1 << 23);
8024                         lc_symbol_freq =
8025                             (u16) (frac28
8026                                      (channel->symbolrate +
8027                                       (adc_frequency >> 13),
8028                                       adc_frequency) >> 16);
8029                         if (lc_symbol_freq > 511)
8030                                 lc_symbol_freq = 511;
8031 
8032                         iqm_rc_stretch = 21;
8033                 }
8034 
8035                 if (ext_attr->standard == DRX_STANDARD_ITU_A) {
8036                         set_env_parameters = QAM_TOP_ANNEX_A;   /* annex             */
8037                         set_param_parameters[0] = channel->constellation;       /* constellation     */
8038                         set_param_parameters[1] = DRX_INTERLEAVEMODE_I12_J17;   /* interleave mode   */
8039                 } else if (ext_attr->standard == DRX_STANDARD_ITU_B) {
8040                         set_env_parameters = QAM_TOP_ANNEX_B;   /* annex             */
8041                         set_param_parameters[0] = channel->constellation;       /* constellation     */
8042                         set_param_parameters[1] = channel->interleavemode;      /* interleave mode   */
8043                 } else if (ext_attr->standard == DRX_STANDARD_ITU_C) {
8044                         set_env_parameters = QAM_TOP_ANNEX_C;   /* annex             */
8045                         set_param_parameters[0] = channel->constellation;       /* constellation     */
8046                         set_param_parameters[1] = DRX_INTERLEAVEMODE_I12_J17;   /* interleave mode   */
8047                 } else {
8048                         return -EINVAL;
8049                 }
8050         }
8051 
8052         if (op & QAM_SET_OP_ALL) {
8053                 /*
8054                    STEP 1: reset demodulator
8055                    resets IQM, QAM and FEC HW blocks
8056                    resets SCU variables
8057                  */
8058                 /* stop all comm_exec */
8059                 rc = drxj_dap_write_reg16(dev_addr, FEC_COMM_EXEC__A, FEC_COMM_EXEC_STOP, 0);
8060                 if (rc != 0) {
8061                         pr_err("error %d\n", rc);
8062                         goto rw_error;
8063                 }
8064                 rc = drxj_dap_write_reg16(dev_addr, QAM_COMM_EXEC__A, QAM_COMM_EXEC_STOP, 0);
8065                 if (rc != 0) {
8066                         pr_err("error %d\n", rc);
8067                         goto rw_error;
8068                 }
8069                 rc = drxj_dap_write_reg16(dev_addr, IQM_FS_COMM_EXEC__A, IQM_FS_COMM_EXEC_STOP, 0);
8070                 if (rc != 0) {
8071                         pr_err("error %d\n", rc);
8072                         goto rw_error;
8073                 }
8074                 rc = drxj_dap_write_reg16(dev_addr, IQM_FD_COMM_EXEC__A, IQM_FD_COMM_EXEC_STOP, 0);
8075                 if (rc != 0) {
8076                         pr_err("error %d\n", rc);
8077                         goto rw_error;
8078                 }
8079                 rc = drxj_dap_write_reg16(dev_addr, IQM_RC_COMM_EXEC__A, IQM_RC_COMM_EXEC_STOP, 0);
8080                 if (rc != 0) {
8081                         pr_err("error %d\n", rc);
8082                         goto rw_error;
8083                 }
8084                 rc = drxj_dap_write_reg16(dev_addr, IQM_RT_COMM_EXEC__A, IQM_RT_COMM_EXEC_STOP, 0);
8085                 if (rc != 0) {
8086                         pr_err("error %d\n", rc);
8087                         goto rw_error;
8088                 }
8089                 rc = drxj_dap_write_reg16(dev_addr, IQM_CF_COMM_EXEC__A, IQM_CF_COMM_EXEC_STOP, 0);
8090                 if (rc != 0) {
8091                         pr_err("error %d\n", rc);
8092                         goto rw_error;
8093                 }
8094 
8095                 cmd_scu.command = SCU_RAM_COMMAND_STANDARD_QAM |
8096                     SCU_RAM_COMMAND_CMD_DEMOD_RESET;
8097                 cmd_scu.parameter_len = 0;
8098                 cmd_scu.result_len = 1;
8099                 cmd_scu.parameter = NULL;
8100                 cmd_scu.result = &cmd_result;
8101                 rc = scu_command(dev_addr, &cmd_scu);
8102                 if (rc != 0) {
8103                         pr_err("error %d\n", rc);
8104                         goto rw_error;
8105                 }
8106         }
8107 
8108         if ((op & QAM_SET_OP_ALL) || (op & QAM_SET_OP_CONSTELLATION)) {
8109                 /*
8110                    STEP 2: configure demodulator
8111                    -set env
8112                    -set params (resets IQM,QAM,FEC HW; initializes some SCU variables )
8113                  */
8114                 cmd_scu.command = SCU_RAM_COMMAND_STANDARD_QAM |
8115                     SCU_RAM_COMMAND_CMD_DEMOD_SET_ENV;
8116                 cmd_scu.parameter_len = 1;
8117                 cmd_scu.result_len = 1;
8118                 cmd_scu.parameter = &set_env_parameters;
8119                 cmd_scu.result = &cmd_result;
8120                 rc = scu_command(dev_addr, &cmd_scu);
8121                 if (rc != 0) {
8122                         pr_err("error %d\n", rc);
8123                         goto rw_error;
8124                 }
8125 
8126                 cmd_scu.command = SCU_RAM_COMMAND_STANDARD_QAM |
8127                     SCU_RAM_COMMAND_CMD_DEMOD_SET_PARAM;
8128                 cmd_scu.parameter_len = 2;
8129                 cmd_scu.result_len = 1;
8130                 cmd_scu.parameter = set_param_parameters;
8131                 cmd_scu.result = &cmd_result;
8132                 rc = scu_command(dev_addr, &cmd_scu);
8133                 if (rc != 0) {
8134                         pr_err("error %d\n", rc);
8135                         goto rw_error;
8136                 }
8137                 /* set symbol rate */
8138                 rc = drxdap_fasi_write_reg32(dev_addr, IQM_RC_RATE_OFS_LO__A, iqm_rc_rate, 0);
8139                 if (rc != 0) {
8140                         pr_err("error %d\n", rc);
8141                         goto rw_error;
8142                 }
8143                 ext_attr->iqm_rc_rate_ofs = iqm_rc_rate;
8144                 rc = set_qam_measurement(demod, channel->constellation, channel->symbolrate);
8145                 if (rc != 0) {
8146                         pr_err("error %d\n", rc);
8147                         goto rw_error;
8148                 }
8149         }
8150         /* STEP 3: enable the system in a mode where the ADC provides valid signal
8151            setup constellation independent registers */
8152         /* from qam_cmd.py script (qam_driver_b) */
8153         /* TODO: remove re-writes of HW reset values */
8154         if ((op & QAM_SET_OP_ALL) || (op & QAM_SET_OP_SPECTRUM)) {
8155                 rc = set_frequency(demod, channel, tuner_freq_offset);
8156                 if (rc != 0) {
8157                         pr_err("error %d\n", rc);
8158                         goto rw_error;
8159                 }
8160         }
8161 
8162         if ((op & QAM_SET_OP_ALL) || (op & QAM_SET_OP_CONSTELLATION)) {
8163 
8164                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_SYMBOL_FREQ__A, lc_symbol_freq, 0);
8165                 if (rc != 0) {
8166                         pr_err("error %d\n", rc);
8167                         goto rw_error;
8168                 }
8169                 rc = drxj_dap_write_reg16(dev_addr, IQM_RC_STRETCH__A, iqm_rc_stretch, 0);
8170                 if (rc != 0) {
8171                         pr_err("error %d\n", rc);
8172                         goto rw_error;
8173                 }
8174         }
8175 
8176         if (op & QAM_SET_OP_ALL) {
8177                 if (!ext_attr->has_lna) {
8178                         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_AMUX__A, 0x02, 0);
8179                         if (rc != 0) {
8180                                 pr_err("error %d\n", rc);
8181                                 goto rw_error;
8182                         }
8183                 }
8184                 rc = drxj_dap_write_reg16(dev_addr, IQM_CF_SYMMETRIC__A, 0, 0);
8185                 if (rc != 0) {
8186                         pr_err("error %d\n", rc);
8187                         goto rw_error;
8188                 }
8189                 rc = drxj_dap_write_reg16(dev_addr, IQM_CF_MIDTAP__A, 3, 0);
8190                 if (rc != 0) {
8191                         pr_err("error %d\n", rc);
8192                         goto rw_error;
8193                 }
8194                 rc = drxj_dap_write_reg16(dev_addr, IQM_CF_OUT_ENA__A, IQM_CF_OUT_ENA_QAM__M, 0);
8195                 if (rc != 0) {
8196                         pr_err("error %d\n", rc);
8197                         goto rw_error;
8198                 }
8199 
8200                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_WR_RSV_0__A, 0x5f, 0);
8201                 if (rc != 0) {
8202                         pr_err("error %d\n", rc);
8203                         goto rw_error;
8204                 }       /* scu temporary shut down agc */
8205 
8206                 rc = drxj_dap_write_reg16(dev_addr, IQM_AF_SYNC_SEL__A, 3, 0);
8207                 if (rc != 0) {
8208                         pr_err("error %d\n", rc);
8209                         goto rw_error;
8210                 }
8211                 rc = drxj_dap_write_reg16(dev_addr, IQM_AF_CLP_LEN__A, 0, 0);
8212                 if (rc != 0) {
8213                         pr_err("error %d\n", rc);
8214                         goto rw_error;
8215                 }
8216                 rc = drxj_dap_write_reg16(dev_addr, IQM_AF_CLP_TH__A, 448, 0);
8217                 if (rc != 0) {
8218                         pr_err("error %d\n", rc);
8219                         goto rw_error;
8220                 }
8221                 rc = drxj_dap_write_reg16(dev_addr, IQM_AF_SNS_LEN__A, 0, 0);
8222                 if (rc != 0) {
8223                         pr_err("error %d\n", rc);
8224                         goto rw_error;
8225                 }
8226                 rc = drxj_dap_write_reg16(dev_addr, IQM_AF_PDREF__A, 4, 0);
8227                 if (rc != 0) {
8228                         pr_err("error %d\n", rc);
8229                         goto rw_error;
8230                 }
8231                 rc = drxj_dap_write_reg16(dev_addr, IQM_AF_STDBY__A, 0x10, 0);
8232                 if (rc != 0) {
8233                         pr_err("error %d\n", rc);
8234                         goto rw_error;
8235                 }
8236                 rc = drxj_dap_write_reg16(dev_addr, IQM_AF_PGA_GAIN__A, 11, 0);
8237                 if (rc != 0) {
8238                         pr_err("error %d\n", rc);
8239                         goto rw_error;
8240                 }
8241 
8242                 rc = drxj_dap_write_reg16(dev_addr, IQM_CF_POW_MEAS_LEN__A, 1, 0);
8243                 if (rc != 0) {
8244                         pr_err("error %d\n", rc);
8245                         goto rw_error;
8246                 }
8247                 rc = drxj_dap_write_reg16(dev_addr, IQM_CF_SCALE_SH__A, IQM_CF_SCALE_SH__PRE, 0);
8248                 if (rc != 0) {
8249                         pr_err("error %d\n", rc);
8250                         goto rw_error;
8251                 }       /*! reset default val ! */
8252 
8253                 rc = drxj_dap_write_reg16(dev_addr, QAM_SY_TIMEOUT__A, QAM_SY_TIMEOUT__PRE, 0);
8254                 if (rc != 0) {
8255                         pr_err("error %d\n", rc);
8256                         goto rw_error;
8257                 }       /*! reset default val ! */
8258                 if (ext_attr->standard == DRX_STANDARD_ITU_B) {
8259                         rc = drxj_dap_write_reg16(dev_addr, QAM_SY_SYNC_LWM__A, QAM_SY_SYNC_LWM__PRE, 0);
8260                         if (rc != 0) {
8261                                 pr_err("error %d\n", rc);
8262                                 goto rw_error;
8263                         }       /*! reset default val ! */
8264                         rc = drxj_dap_write_reg16(dev_addr, QAM_SY_SYNC_AWM__A, QAM_SY_SYNC_AWM__PRE, 0);
8265                         if (rc != 0) {
8266                                 pr_err("error %d\n", rc);
8267                                 goto rw_error;
8268                         }       /*! reset default val ! */
8269                         rc = drxj_dap_write_reg16(dev_addr, QAM_SY_SYNC_HWM__A, QAM_SY_SYNC_HWM__PRE, 0);
8270                         if (rc != 0) {
8271                                 pr_err("error %d\n", rc);
8272                                 goto rw_error;
8273                         }       /*! reset default val ! */
8274                 } else {
8275                         switch (channel->constellation) {
8276                         case DRX_CONSTELLATION_QAM16:
8277                         case DRX_CONSTELLATION_QAM64:
8278                         case DRX_CONSTELLATION_QAM256:
8279                                 rc = drxj_dap_write_reg16(dev_addr, QAM_SY_SYNC_LWM__A, 0x03, 0);
8280                                 if (rc != 0) {
8281                                         pr_err("error %d\n", rc);
8282                                         goto rw_error;
8283                                 }
8284                                 rc = drxj_dap_write_reg16(dev_addr, QAM_SY_SYNC_AWM__A, 0x04, 0);
8285                                 if (rc != 0) {
8286                                         pr_err("error %d\n", rc);
8287                                         goto rw_error;
8288                                 }
8289                                 rc = drxj_dap_write_reg16(dev_addr, QAM_SY_SYNC_HWM__A, QAM_SY_SYNC_HWM__PRE, 0);
8290                                 if (rc != 0) {
8291                                         pr_err("error %d\n", rc);
8292                                         goto rw_error;
8293                                 }       /*! reset default val ! */
8294                                 break;
8295                         case DRX_CONSTELLATION_QAM32:
8296                         case DRX_CONSTELLATION_QAM128:
8297                                 rc = drxj_dap_write_reg16(dev_addr, QAM_SY_SYNC_LWM__A, 0x03, 0);
8298                                 if (rc != 0) {
8299                                         pr_err("error %d\n", rc);
8300                                         goto rw_error;
8301                                 }
8302                                 rc = drxj_dap_write_reg16(dev_addr, QAM_SY_SYNC_AWM__A, 0x05, 0);
8303                                 if (rc != 0) {
8304                                         pr_err("error %d\n", rc);
8305                                         goto rw_error;
8306                                 }
8307                                 rc = drxj_dap_write_reg16(dev_addr, QAM_SY_SYNC_HWM__A, 0x06, 0);
8308                                 if (rc != 0) {
8309                                         pr_err("error %d\n", rc);
8310                                         goto rw_error;
8311                                 }
8312                                 break;
8313                         default:
8314                                 return -EIO;
8315                         }       /* switch */
8316                 }
8317 
8318                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_MODE__A, QAM_LC_MODE__PRE, 0);
8319                 if (rc != 0) {
8320                         pr_err("error %d\n", rc);
8321                         goto rw_error;
8322                 }       /*! reset default val ! */
8323                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_RATE_LIMIT__A, 3, 0);
8324                 if (rc != 0) {
8325                         pr_err("error %d\n", rc);
8326                         goto rw_error;
8327                 }
8328                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_LPF_FACTORP__A, 4, 0);
8329                 if (rc != 0) {
8330                         pr_err("error %d\n", rc);
8331                         goto rw_error;
8332                 }
8333                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_LPF_FACTORI__A, 4, 0);
8334                 if (rc != 0) {
8335                         pr_err("error %d\n", rc);
8336                         goto rw_error;
8337                 }
8338                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_MODE__A, 7, 0);
8339                 if (rc != 0) {
8340                         pr_err("error %d\n", rc);
8341                         goto rw_error;
8342                 }
8343                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB0__A, 1, 0);
8344                 if (rc != 0) {
8345                         pr_err("error %d\n", rc);
8346                         goto rw_error;
8347                 }
8348                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB1__A, 1, 0);
8349                 if (rc != 0) {
8350                         pr_err("error %d\n", rc);
8351                         goto rw_error;
8352                 }
8353                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB2__A, 1, 0);
8354                 if (rc != 0) {
8355                         pr_err("error %d\n", rc);
8356                         goto rw_error;
8357                 }
8358                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB3__A, 1, 0);
8359                 if (rc != 0) {
8360                         pr_err("error %d\n", rc);
8361                         goto rw_error;
8362                 }
8363                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB4__A, 2, 0);
8364                 if (rc != 0) {
8365                         pr_err("error %d\n", rc);
8366                         goto rw_error;
8367                 }
8368                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB5__A, 2, 0);
8369                 if (rc != 0) {
8370                         pr_err("error %d\n", rc);
8371                         goto rw_error;
8372                 }
8373                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB6__A, 2, 0);
8374                 if (rc != 0) {
8375                         pr_err("error %d\n", rc);
8376                         goto rw_error;
8377                 }
8378                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB8__A, 2, 0);
8379                 if (rc != 0) {
8380                         pr_err("error %d\n", rc);
8381                         goto rw_error;
8382                 }
8383                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB9__A, 2, 0);
8384                 if (rc != 0) {
8385                         pr_err("error %d\n", rc);
8386                         goto rw_error;
8387                 }
8388                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB10__A, 2, 0);
8389                 if (rc != 0) {
8390                         pr_err("error %d\n", rc);
8391                         goto rw_error;
8392                 }
8393                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB12__A, 2, 0);
8394                 if (rc != 0) {
8395                         pr_err("error %d\n", rc);
8396                         goto rw_error;
8397                 }
8398                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB15__A, 3, 0);
8399                 if (rc != 0) {
8400                         pr_err("error %d\n", rc);
8401                         goto rw_error;
8402                 }
8403                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB16__A, 3, 0);
8404                 if (rc != 0) {
8405                         pr_err("error %d\n", rc);
8406                         goto rw_error;
8407                 }
8408                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB20__A, 4, 0);
8409                 if (rc != 0) {
8410                         pr_err("error %d\n", rc);
8411                         goto rw_error;
8412                 }
8413                 rc = drxj_dap_write_reg16(dev_addr, QAM_LC_QUAL_TAB25__A, 4, 0);
8414                 if (rc != 0) {
8415                         pr_err("error %d\n", rc);
8416                         goto rw_error;
8417                 }
8418 
8419                 rc = drxj_dap_write_reg16(dev_addr, IQM_FS_ADJ_SEL__A, 1, 0);
8420                 if (rc != 0) {
8421                         pr_err("error %d\n", rc);
8422                         goto rw_error;
8423                 }
8424                 rc = drxj_dap_write_reg16(dev_addr, IQM_RC_ADJ_SEL__A, 1, 0);
8425                 if (rc != 0) {
8426                         pr_err("error %d\n", rc);
8427                         goto rw_error;
8428                 }
8429                 rc = drxj_dap_write_reg16(dev_addr, IQM_CF_ADJ_SEL__A, 1, 0);
8430                 if (rc != 0) {
8431                         pr_err("error %d\n", rc);
8432                         goto rw_error;
8433                 }
8434                 rc = drxj_dap_write_reg16(dev_addr, IQM_CF_POW_MEAS_LEN__A, 0, 0);
8435                 if (rc != 0) {
8436                         pr_err("error %d\n", rc);
8437                         goto rw_error;
8438                 }
8439                 rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_GPIO__A, 0, 0);
8440                 if (rc != 0) {
8441                         pr_err("error %d\n", rc);
8442                         goto rw_error;
8443                 }
8444 
8445                 /* No more resets of the IQM, current standard correctly set =>
8446                    now AGCs can be configured. */
8447                 /* turn on IQMAF. It has to be in front of setAgc**() */
8448                 rc = set_iqm_af(demod, true);
8449                 if (rc != 0) {
8450                         pr_err("error %d\n", rc);
8451                         goto rw_error;
8452                 }
8453                 rc = adc_synchronization(demod);
8454                 if (rc != 0) {
8455                         pr_err("error %d\n", rc);
8456                         goto rw_error;
8457                 }
8458 
8459                 rc = init_agc(demod);
8460                 if (rc != 0) {
8461                         pr_err("error %d\n", rc);
8462                         goto rw_error;
8463                 }
8464                 rc = set_agc_if(demod, &(ext_attr->qam_if_agc_cfg), false);
8465                 if (rc != 0) {
8466                         pr_err("error %d\n", rc);
8467                         goto rw_error;
8468                 }
8469                 rc = set_agc_rf(demod, &(ext_attr->qam_rf_agc_cfg), false);
8470                 if (rc != 0) {
8471                         pr_err("error %d\n", rc);
8472                         goto rw_error;
8473                 }
8474                 {
8475                         /* TODO fix this, store a struct drxj_cfg_afe_gain structure in struct drxj_data instead
8476                            of only the gain */
8477                         struct drxj_cfg_afe_gain qam_pga_cfg = { DRX_STANDARD_ITU_B, 0 };
8478 
8479                         qam_pga_cfg.gain = ext_attr->qam_pga_cfg;
8480                         rc = ctrl_set_cfg_afe_gain(demod, &qam_pga_cfg);
8481                         if (rc != 0) {
8482                                 pr_err("error %d\n", rc);
8483                                 goto rw_error;
8484                         }
8485                 }
8486                 rc = ctrl_set_cfg_pre_saw(demod, &(ext_attr->qam_pre_saw_cfg));
8487                 if (rc != 0) {
8488                         pr_err("error %d\n", rc);
8489                         goto rw_error;
8490                 }
8491         }
8492 
8493         if ((op & QAM_SET_OP_ALL) || (op & QAM_SET_OP_CONSTELLATION)) {
8494                 if (ext_attr->standard == DRX_STANDARD_ITU_A) {
8495                         rc = drxdap_fasi_write_block(dev_addr, IQM_CF_TAP_RE0__A, sizeof(qam_a_taps), ((u8 *)qam_a_taps), 0);
8496                         if (rc != 0) {
8497                                 pr_err("error %d\n", rc);
8498                                 goto rw_error;
8499                         }
8500                         rc = drxdap_fasi_write_block(dev_addr, IQM_CF_TAP_IM0__A, sizeof(qam_a_taps), ((u8 *)qam_a_taps), 0);
8501                         if (rc != 0) {
8502                                 pr_err("error %d\n", rc);
8503                                 goto rw_error;
8504                         }
8505                 } else if (ext_attr->standard == DRX_STANDARD_ITU_B) {
8506                         switch (channel->constellation) {
8507                         case DRX_CONSTELLATION_QAM64:
8508                                 rc = drxdap_fasi_write_block(dev_addr, IQM_CF_TAP_RE0__A, sizeof(qam_b64_taps), ((u8 *)qam_b64_taps), 0);
8509                                 if (rc != 0) {
8510                                         pr_err("error %d\n", rc);
8511                                         goto rw_error;
8512                                 }
8513                                 rc = drxdap_fasi_write_block(dev_addr, IQM_CF_TAP_IM0__A, sizeof(qam_b64_taps), ((u8 *)qam_b64_taps), 0);
8514                                 if (rc != 0) {
8515                                         pr_err("error %d\n", rc);
8516                                         goto rw_error;
8517                                 }
8518                                 break;
8519                         case DRX_CONSTELLATION_QAM256:
8520                                 rc = drxdap_fasi_write_block(dev_addr, IQM_CF_TAP_RE0__A, sizeof(qam_b256_taps), ((u8 *)qam_b256_taps), 0);
8521                                 if (rc != 0) {
8522                                         pr_err("error %d\n", rc);
8523                                         goto rw_error;
8524                                 }
8525                                 rc = drxdap_fasi_write_block(dev_addr, IQM_CF_TAP_IM0__A, sizeof(qam_b256_taps), ((u8 *)qam_b256_taps), 0);
8526                                 if (rc != 0) {
8527                                         pr_err("error %d\n", rc);
8528                                         goto rw_error;
8529                                 }
8530                                 break;
8531                         default:
8532                                 return -EIO;
8533                         }
8534                 } else if (ext_attr->standard == DRX_STANDARD_ITU_C) {
8535                         rc = drxdap_fasi_write_block(dev_addr, IQM_CF_TAP_RE0__A, sizeof(qam_c_taps), ((u8 *)qam_c_taps), 0);
8536                         if (rc != 0) {
8537                                 pr_err("error %d\n", rc);
8538                                 goto rw_error;
8539                         }
8540                         rc = drxdap_fasi_write_block(dev_addr, IQM_CF_TAP_IM0__A, sizeof(qam_c_taps), ((u8 *)qam_c_taps), 0);
8541                         if (rc != 0) {
8542                                 pr_err("error %d\n", rc);
8543                                 goto rw_error;
8544                         }
8545                 }
8546 
8547                 /* SETP 4: constellation specific setup */
8548                 switch (channel->constellation) {
8549                 case DRX_CONSTELLATION_QAM16:
8550                         rc = set_qam16(demod);
8551                         if (rc != 0) {
8552                                 pr_err("error %d\n", rc);
8553                                 goto rw_error;
8554                         }
8555                         break;
8556                 case DRX_CONSTELLATION_QAM32:
8557                         rc = set_qam32(demod);
8558                         if (rc != 0) {
8559                                 pr_err("error %d\n", rc);
8560                                 goto rw_error;
8561                         }
8562                         break;
8563                 case DRX_CONSTELLATION_QAM64:
8564                         rc = set_qam64(demod);
8565                         if (rc != 0) {
8566                                 pr_err("error %d\n", rc);
8567                                 goto rw_error;
8568                         }
8569                         break;
8570                 case DRX_CONSTELLATION_QAM128:
8571                         rc = set_qam128(demod);
8572                         if (rc != 0) {
8573                                 pr_err("error %d\n", rc);
8574                                 goto rw_error;
8575                         }
8576                         break;
8577                 case DRX_CONSTELLATION_QAM256:
8578                         rc = set_qam256(demod);
8579                         if (rc != 0) {
8580                                 pr_err("error %d\n", rc);
8581                                 goto rw_error;
8582                         }
8583                         break;
8584                 default:
8585                         return -EIO;
8586                 }               /* switch */
8587         }
8588 
8589         if ((op & QAM_SET_OP_ALL)) {
8590                 rc = drxj_dap_write_reg16(dev_addr, IQM_CF_SCALE_SH__A, 0, 0);
8591                 if (rc != 0) {
8592                         pr_err("error %d\n", rc);
8593                         goto rw_error;
8594                 }
8595 
8596                 /* Mpeg output has to be in front of FEC active */
8597                 rc = set_mpegtei_handling(demod);
8598                 if (rc != 0) {
8599                         pr_err("error %d\n", rc);
8600                         goto rw_error;
8601                 }
8602                 rc = bit_reverse_mpeg_output(demod);
8603                 if (rc != 0) {
8604                         pr_err("error %d\n", rc);
8605                         goto rw_error;
8606                 }
8607                 rc = set_mpeg_start_width(demod);
8608                 if (rc != 0) {
8609                         pr_err("error %d\n", rc);
8610                         goto rw_error;
8611                 }
8612                 {
8613                         /* TODO: move to set_standard after hardware reset value problem is solved */
8614                         /* Configure initial MPEG output */
8615                         struct drx_cfg_mpeg_output cfg_mpeg_output;
8616 
8617                         memcpy(&cfg_mpeg_output, &common_attr->mpeg_cfg, sizeof(cfg_mpeg_output));
8618                         cfg_mpeg_output.enable_mpeg_output = true;
8619 
8620                         rc = ctrl_set_cfg_mpeg_output(demod, &cfg_mpeg_output);
8621                         if (rc != 0) {
8622                                 pr_err("error %d\n", rc);
8623                                 goto rw_error;
8624                         }
8625                 }
8626         }
8627 
8628         if ((op & QAM_SET_OP_ALL) || (op & QAM_SET_OP_CONSTELLATION)) {
8629 
8630                 /* STEP 5: start QAM demodulator (starts FEC, QAM and IQM HW) */
8631                 cmd_scu.command = SCU_RAM_COMMAND_STANDARD_QAM |
8632                     SCU_RAM_COMMAND_CMD_DEMOD_START;
8633                 cmd_scu.parameter_len = 0;
8634                 cmd_scu.result_len = 1;
8635                 cmd_scu.parameter = NULL;
8636                 cmd_scu.result = &cmd_result;
8637                 rc = scu_command(dev_addr, &cmd_scu);
8638                 if (rc != 0) {
8639                         pr_err("error %d\n", rc);
8640                         goto rw_error;
8641                 }
8642         }
8643 
8644         rc = drxj_dap_write_reg16(dev_addr, IQM_COMM_EXEC__A, IQM_COMM_EXEC_ACTIVE, 0);
8645         if (rc != 0) {
8646                 pr_err("error %d\n", rc);
8647                 goto rw_error;
8648         }
8649         rc = drxj_dap_write_reg16(dev_addr, QAM_COMM_EXEC__A, QAM_COMM_EXEC_ACTIVE, 0);
8650         if (rc != 0) {
8651                 pr_err("error %d\n", rc);
8652                 goto rw_error;
8653         }
8654         rc = drxj_dap_write_reg16(dev_addr, FEC_COMM_EXEC__A, FEC_COMM_EXEC_ACTIVE, 0);
8655         if (rc != 0) {
8656                 pr_err("error %d\n", rc);
8657                 goto rw_error;
8658         }
8659 
8660         return 0;
8661 rw_error:
8662         return rc;
8663 }
8664 
8665 /*============================================================================*/
8666 static int ctrl_get_qam_sig_quality(struct drx_demod_instance *demod);
8667 
8668 static int qam_flip_spec(struct drx_demod_instance *demod, struct drx_channel *channel)
8669 {
8670         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
8671         struct drxj_data *ext_attr = demod->my_ext_attr;
8672         int rc;
8673         u32 iqm_fs_rate_ofs = 0;
8674         u32 iqm_fs_rate_lo = 0;
8675         u16 qam_ctl_ena = 0;
8676         u16 data = 0;
8677         u16 equ_mode = 0;
8678         u16 fsm_state = 0;
8679         int i = 0;
8680         int ofsofs = 0;
8681 
8682         /* Silence the controlling of lc, equ, and the acquisition state machine */
8683         rc = drxj_dap_read_reg16(dev_addr, SCU_RAM_QAM_CTL_ENA__A, &qam_ctl_ena, 0);
8684         if (rc != 0) {
8685                 pr_err("error %d\n", rc);
8686                 goto rw_error;
8687         }
8688         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_CTL_ENA__A, qam_ctl_ena & ~(SCU_RAM_QAM_CTL_ENA_ACQ__M | SCU_RAM_QAM_CTL_ENA_EQU__M | SCU_RAM_QAM_CTL_ENA_LC__M), 0);
8689         if (rc != 0) {
8690                 pr_err("error %d\n", rc);
8691                 goto rw_error;
8692         }
8693 
8694         /* freeze the frequency control loop */
8695         rc = drxj_dap_write_reg16(dev_addr, QAM_LC_CF__A, 0, 0);
8696         if (rc != 0) {
8697                 pr_err("error %d\n", rc);
8698                 goto rw_error;
8699         }
8700         rc = drxj_dap_write_reg16(dev_addr, QAM_LC_CF1__A, 0, 0);
8701         if (rc != 0) {
8702                 pr_err("error %d\n", rc);
8703                 goto rw_error;
8704         }
8705 
8706         rc = drxj_dap_atomic_read_reg32(dev_addr, IQM_FS_RATE_OFS_LO__A, &iqm_fs_rate_ofs, 0);
8707         if (rc != 0) {
8708                 pr_err("error %d\n", rc);
8709                 goto rw_error;
8710         }
8711         rc = drxj_dap_atomic_read_reg32(dev_addr, IQM_FS_RATE_LO__A, &iqm_fs_rate_lo, 0);
8712         if (rc != 0) {
8713                 pr_err("error %d\n", rc);
8714                 goto rw_error;
8715         }
8716         ofsofs = iqm_fs_rate_lo - iqm_fs_rate_ofs;
8717         iqm_fs_rate_ofs = ~iqm_fs_rate_ofs + 1;
8718         iqm_fs_rate_ofs -= 2 * ofsofs;
8719 
8720         /* freeze dq/fq updating */
8721         rc = drxj_dap_read_reg16(dev_addr, QAM_DQ_MODE__A, &data, 0);
8722         if (rc != 0) {
8723                 pr_err("error %d\n", rc);
8724                 goto rw_error;
8725         }
8726         data = (data & 0xfff9);
8727         rc = drxj_dap_write_reg16(dev_addr, QAM_DQ_MODE__A, data, 0);
8728         if (rc != 0) {
8729                 pr_err("error %d\n", rc);
8730                 goto rw_error;
8731         }
8732         rc = drxj_dap_write_reg16(dev_addr, QAM_FQ_MODE__A, data, 0);
8733         if (rc != 0) {
8734                 pr_err("error %d\n", rc);
8735                 goto rw_error;
8736         }
8737 
8738         /* lc_cp / _ci / _ca */
8739         rc = drxj_dap_write_reg16(dev_addr, QAM_LC_CI__A, 0, 0);
8740         if (rc != 0) {
8741                 pr_err("error %d\n", rc);
8742                 goto rw_error;
8743         }
8744         rc = drxj_dap_write_reg16(dev_addr, QAM_LC_EP__A, 0, 0);
8745         if (rc != 0) {
8746                 pr_err("error %d\n", rc);
8747                 goto rw_error;
8748         }
8749         rc = drxj_dap_write_reg16(dev_addr, QAM_FQ_LA_FACTOR__A, 0, 0);
8750         if (rc != 0) {
8751                 pr_err("error %d\n", rc);
8752                 goto rw_error;
8753         }
8754 
8755         /* flip the spec */
8756         rc = drxdap_fasi_write_reg32(dev_addr, IQM_FS_RATE_OFS_LO__A, iqm_fs_rate_ofs, 0);
8757         if (rc != 0) {
8758                 pr_err("error %d\n", rc);
8759                 goto rw_error;
8760         }
8761         ext_attr->iqm_fs_rate_ofs = iqm_fs_rate_ofs;
8762         ext_attr->pos_image = (ext_attr->pos_image) ? false : true;
8763 
8764         /* freeze dq/fq updating */
8765         rc = drxj_dap_read_reg16(dev_addr, QAM_DQ_MODE__A, &data, 0);
8766         if (rc != 0) {
8767                 pr_err("error %d\n", rc);
8768                 goto rw_error;
8769         }
8770         equ_mode = data;
8771         data = (data & 0xfff9);
8772         rc = drxj_dap_write_reg16(dev_addr, QAM_DQ_MODE__A, data, 0);
8773         if (rc != 0) {
8774                 pr_err("error %d\n", rc);
8775                 goto rw_error;
8776         }
8777         rc = drxj_dap_write_reg16(dev_addr, QAM_FQ_MODE__A, data, 0);
8778         if (rc != 0) {
8779                 pr_err("error %d\n", rc);
8780                 goto rw_error;
8781         }
8782 
8783         for (i = 0; i < 28; i++) {
8784                 rc = drxj_dap_read_reg16(dev_addr, QAM_DQ_TAP_IM_EL0__A + (2 * i), &data, 0);
8785                 if (rc != 0) {
8786                         pr_err("error %d\n", rc);
8787                         goto rw_error;
8788                 }
8789                 rc = drxj_dap_write_reg16(dev_addr, QAM_DQ_TAP_IM_EL0__A + (2 * i), -data, 0);
8790                 if (rc != 0) {
8791                         pr_err("error %d\n", rc);
8792                         goto rw_error;
8793                 }
8794         }
8795 
8796         for (i = 0; i < 24; i++) {
8797                 rc = drxj_dap_read_reg16(dev_addr, QAM_FQ_TAP_IM_EL0__A + (2 * i), &data, 0);
8798                 if (rc != 0) {
8799                         pr_err("error %d\n", rc);
8800                         goto rw_error;
8801                 }
8802                 rc = drxj_dap_write_reg16(dev_addr, QAM_FQ_TAP_IM_EL0__A + (2 * i), -data, 0);
8803                 if (rc != 0) {
8804                         pr_err("error %d\n", rc);
8805                         goto rw_error;
8806                 }
8807         }
8808 
8809         data = equ_mode;
8810         rc = drxj_dap_write_reg16(dev_addr, QAM_DQ_MODE__A, data, 0);
8811         if (rc != 0) {
8812                 pr_err("error %d\n", rc);
8813                 goto rw_error;
8814         }
8815         rc = drxj_dap_write_reg16(dev_addr, QAM_FQ_MODE__A, data, 0);
8816         if (rc != 0) {
8817                 pr_err("error %d\n", rc);
8818                 goto rw_error;
8819         }
8820 
8821         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_FSM_STATE_TGT__A, 4, 0);
8822         if (rc != 0) {
8823                 pr_err("error %d\n", rc);
8824                 goto rw_error;
8825         }
8826 
8827         i = 0;
8828         while ((fsm_state != 4) && (i++ < 100)) {
8829                 rc = drxj_dap_read_reg16(dev_addr, SCU_RAM_QAM_FSM_STATE__A, &fsm_state, 0);
8830                 if (rc != 0) {
8831                         pr_err("error %d\n", rc);
8832                         goto rw_error;
8833                 }
8834         }
8835         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_QAM_CTL_ENA__A, (qam_ctl_ena | 0x0016), 0);
8836         if (rc != 0) {
8837                 pr_err("error %d\n", rc);
8838                 goto rw_error;
8839         }
8840 
8841         return 0;
8842 rw_error:
8843         return rc;
8844 
8845 }
8846 
8847 #define  NO_LOCK        0x0
8848 #define  DEMOD_LOCKED   0x1
8849 #define  SYNC_FLIPPED   0x2
8850 #define  SPEC_MIRRORED  0x4
8851 /*
8852 * \fn int qam64auto ()
8853 * \brief auto do sync pattern switching and mirroring.
8854 * \param demod:   instance of demod.
8855 * \param channel: pointer to channel data.
8856 * \param tuner_freq_offset: tuner frequency offset.
8857 * \param lock_status: pointer to lock status.
8858 * \return int.
8859 */
8860 static int
8861 qam64auto(struct drx_demod_instance *demod,
8862           struct drx_channel *channel,
8863           s32 tuner_freq_offset, enum drx_lock_status *lock_status)
8864 {
8865         struct drxj_data *ext_attr = demod->my_ext_attr;
8866         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
8867         struct drx39xxj_state *state = dev_addr->user_data;
8868         struct dtv_frontend_properties *p = &state->frontend.dtv_property_cache;
8869         int rc;
8870         u32 lck_state = NO_LOCK;
8871         u32 start_time = 0;
8872         u32 d_locked_time = 0;
8873         u32 timeout_ofs = 0;
8874         u16 data = 0;
8875 
8876         /* external attributes for storing acquired channel constellation */
8877         *lock_status = DRX_NOT_LOCKED;
8878         start_time = jiffies_to_msecs(jiffies);
8879         lck_state = NO_LOCK;
8880         do {
8881                 rc = ctrl_lock_status(demod, lock_status);
8882                 if (rc != 0) {
8883                         pr_err("error %d\n", rc);
8884                         goto rw_error;
8885                 }
8886 
8887                 switch (lck_state) {
8888                 case NO_LOCK:
8889                         if (*lock_status == DRXJ_DEMOD_LOCK) {
8890                                 rc = ctrl_get_qam_sig_quality(demod);
8891                                 if (rc != 0) {
8892                                         pr_err("error %d\n", rc);
8893                                         goto rw_error;
8894                                 }
8895                                 if (p->cnr.stat[0].svalue > 20800) {
8896                                         lck_state = DEMOD_LOCKED;
8897                                         /* some delay to see if fec_lock possible TODO find the right value */
8898                                         timeout_ofs += DRXJ_QAM_DEMOD_LOCK_EXT_WAITTIME;        /* see something, waiting longer */
8899                                         d_locked_time = jiffies_to_msecs(jiffies);
8900                                 }
8901                         }
8902                         break;
8903                 case DEMOD_LOCKED:
8904                         if ((*lock_status == DRXJ_DEMOD_LOCK) &&        /* still demod_lock in 150ms */
8905                             ((jiffies_to_msecs(jiffies) - d_locked_time) >
8906                              DRXJ_QAM_FEC_LOCK_WAITTIME)) {
8907                                 rc = drxj_dap_read_reg16(demod->my_i2c_dev_addr, QAM_SY_TIMEOUT__A, &data, 0);
8908                                 if (rc != 0) {
8909                                         pr_err("error %d\n", rc);
8910                                         goto rw_error;
8911                                 }
8912                                 rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, QAM_SY_TIMEOUT__A, data | 0x1, 0);
8913                                 if (rc != 0) {
8914                                         pr_err("error %d\n", rc);
8915                                         goto rw_error;
8916                                 }
8917                                 lck_state = SYNC_FLIPPED;
8918                                 msleep(10);
8919                         }
8920                         break;
8921                 case SYNC_FLIPPED:
8922                         if (*lock_status == DRXJ_DEMOD_LOCK) {
8923                                 if (channel->mirror == DRX_MIRROR_AUTO) {
8924                                         /* flip sync pattern back */
8925                                         rc = drxj_dap_read_reg16(demod->my_i2c_dev_addr, QAM_SY_TIMEOUT__A, &data, 0);
8926                                         if (rc != 0) {
8927                                                 pr_err("error %d\n", rc);
8928                                                 goto rw_error;
8929                                         }
8930                                         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, QAM_SY_TIMEOUT__A, data & 0xFFFE, 0);
8931                                         if (rc != 0) {
8932                                                 pr_err("error %d\n", rc);
8933                                                 goto rw_error;
8934                                         }
8935                                         /* flip spectrum */
8936                                         ext_attr->mirror = DRX_MIRROR_YES;
8937                                         rc = qam_flip_spec(demod, channel);
8938                                         if (rc != 0) {
8939                                                 pr_err("error %d\n", rc);
8940                                                 goto rw_error;
8941                                         }
8942                                         lck_state = SPEC_MIRRORED;
8943                                         /* reset timer TODO: still need 500ms? */
8944                                         start_time = d_locked_time =
8945                                             jiffies_to_msecs(jiffies);
8946                                         timeout_ofs = 0;
8947                                 } else {        /* no need to wait lock */
8948 
8949                                         start_time =
8950                                             jiffies_to_msecs(jiffies) -
8951                                             DRXJ_QAM_MAX_WAITTIME - timeout_ofs;
8952                                 }
8953                         }
8954                         break;
8955                 case SPEC_MIRRORED:
8956                         if ((*lock_status == DRXJ_DEMOD_LOCK) &&        /* still demod_lock in 150ms */
8957                             ((jiffies_to_msecs(jiffies) - d_locked_time) >
8958                              DRXJ_QAM_FEC_LOCK_WAITTIME)) {
8959                                 rc = ctrl_get_qam_sig_quality(demod);
8960                                 if (rc != 0) {
8961                                         pr_err("error %d\n", rc);
8962                                         goto rw_error;
8963                                 }
8964                                 if (p->cnr.stat[0].svalue > 20800) {
8965                                         rc = drxj_dap_read_reg16(demod->my_i2c_dev_addr, QAM_SY_TIMEOUT__A, &data, 0);
8966                                         if (rc != 0) {
8967                                                 pr_err("error %d\n", rc);
8968                                                 goto rw_error;
8969                                         }
8970                                         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr, QAM_SY_TIMEOUT__A, data | 0x1, 0);
8971                                         if (rc != 0) {
8972                                                 pr_err("error %d\n", rc);
8973                                                 goto rw_error;
8974                                         }
8975                                         /* no need to wait lock */
8976                                         start_time =
8977                                             jiffies_to_msecs(jiffies) -
8978                                             DRXJ_QAM_MAX_WAITTIME - timeout_ofs;
8979                                 }
8980                         }
8981                         break;
8982                 default:
8983                         break;
8984                 }
8985                 msleep(10);
8986         } while
8987             ((*lock_status != DRX_LOCKED) &&
8988              (*lock_status != DRX_NEVER_LOCK) &&
8989              ((jiffies_to_msecs(jiffies) - start_time) <
8990               (DRXJ_QAM_MAX_WAITTIME + timeout_ofs))
8991             );
8992         /* Returning control to application ... */
8993 
8994         return 0;
8995 rw_error:
8996         return rc;
8997 }
8998 
8999 /*
9000 * \fn int qam256auto ()
9001 * \brief auto do sync pattern switching and mirroring.
9002 * \param demod:   instance of demod.
9003 * \param channel: pointer to channel data.
9004 * \param tuner_freq_offset: tuner frequency offset.
9005 * \param lock_status: pointer to lock status.
9006 * \return int.
9007 */
9008 static int
9009 qam256auto(struct drx_demod_instance *demod,
9010            struct drx_channel *channel,
9011            s32 tuner_freq_offset, enum drx_lock_status *lock_status)
9012 {
9013         struct drxj_data *ext_attr = demod->my_ext_attr;
9014         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
9015         struct drx39xxj_state *state = dev_addr->user_data;
9016         struct dtv_frontend_properties *p = &state->frontend.dtv_property_cache;
9017         int rc;
9018         u32 lck_state = NO_LOCK;
9019         u32 start_time = 0;
9020         u32 d_locked_time = 0;
9021         u32 timeout_ofs = DRXJ_QAM_DEMOD_LOCK_EXT_WAITTIME;
9022 
9023         /* external attributes for storing acquired channel constellation */
9024         *lock_status = DRX_NOT_LOCKED;
9025         start_time = jiffies_to_msecs(jiffies);
9026         lck_state = NO_LOCK;
9027         do {
9028                 rc = ctrl_lock_status(demod, lock_status);
9029                 if (rc != 0) {
9030                         pr_err("error %d\n", rc);
9031                         goto rw_error;
9032                 }
9033                 switch (lck_state) {
9034                 case NO_LOCK:
9035                         if (*lock_status == DRXJ_DEMOD_LOCK) {
9036                                 rc = ctrl_get_qam_sig_quality(demod);
9037                                 if (rc != 0) {
9038                                         pr_err("error %d\n", rc);
9039                                         goto rw_error;
9040                                 }
9041                                 if (p->cnr.stat[0].svalue > 26800) {
9042                                         lck_state = DEMOD_LOCKED;
9043                                         timeout_ofs += DRXJ_QAM_DEMOD_LOCK_EXT_WAITTIME;        /* see something, wait longer */
9044                                         d_locked_time = jiffies_to_msecs(jiffies);
9045                                 }
9046                         }
9047                         break;
9048                 case DEMOD_LOCKED:
9049                         if (*lock_status == DRXJ_DEMOD_LOCK) {
9050                                 if ((channel->mirror == DRX_MIRROR_AUTO) &&
9051                                     ((jiffies_to_msecs(jiffies) - d_locked_time) >
9052                                      DRXJ_QAM_FEC_LOCK_WAITTIME)) {
9053                                         ext_attr->mirror = DRX_MIRROR_YES;
9054                                         rc = qam_flip_spec(demod, channel);
9055                                         if (rc != 0) {
9056                                                 pr_err("error %d\n", rc);
9057                                                 goto rw_error;
9058                                         }
9059                                         lck_state = SPEC_MIRRORED;
9060                                         /* reset timer TODO: still need 300ms? */
9061                                         start_time = jiffies_to_msecs(jiffies);
9062                                         timeout_ofs = -DRXJ_QAM_MAX_WAITTIME / 2;
9063                                 }
9064                         }
9065                         break;
9066                 case SPEC_MIRRORED:
9067                         break;
9068                 default:
9069                         break;
9070                 }
9071                 msleep(10);
9072         } while
9073             ((*lock_status < DRX_LOCKED) &&
9074              (*lock_status != DRX_NEVER_LOCK) &&
9075              ((jiffies_to_msecs(jiffies) - start_time) <
9076               (DRXJ_QAM_MAX_WAITTIME + timeout_ofs)));
9077 
9078         return 0;
9079 rw_error:
9080         return rc;
9081 }
9082 
9083 /*
9084 * \fn int set_qam_channel ()
9085 * \brief Set QAM channel according to the requested constellation.
9086 * \param demod:   instance of demod.
9087 * \param channel: pointer to channel data.
9088 * \return int.
9089 */
9090 static int
9091 set_qam_channel(struct drx_demod_instance *demod,
9092                struct drx_channel *channel, s32 tuner_freq_offset)
9093 {
9094         struct drxj_data *ext_attr = NULL;
9095         int rc;
9096         enum drx_lock_status lock_status = DRX_NOT_LOCKED;
9097         bool auto_flag = false;
9098 
9099         /* external attributes for storing acquired channel constellation */
9100         ext_attr = (struct drxj_data *) demod->my_ext_attr;
9101 
9102         /* set QAM channel constellation */
9103         switch (channel->constellation) {
9104         case DRX_CONSTELLATION_QAM16:
9105         case DRX_CONSTELLATION_QAM32:
9106         case DRX_CONSTELLATION_QAM128:
9107                 return -EINVAL;
9108         case DRX_CONSTELLATION_QAM64:
9109         case DRX_CONSTELLATION_QAM256:
9110                 if (ext_attr->standard != DRX_STANDARD_ITU_B)
9111                         return -EINVAL;
9112 
9113                 ext_attr->constellation = channel->constellation;
9114                 if (channel->mirror == DRX_MIRROR_AUTO)
9115                         ext_attr->mirror = DRX_MIRROR_NO;
9116                 else
9117                         ext_attr->mirror = channel->mirror;
9118 
9119                 rc = set_qam(demod, channel, tuner_freq_offset, QAM_SET_OP_ALL);
9120                 if (rc != 0) {
9121                         pr_err("error %d\n", rc);
9122                         goto rw_error;
9123                 }
9124 
9125                 if (channel->constellation == DRX_CONSTELLATION_QAM64)
9126                         rc = qam64auto(demod, channel, tuner_freq_offset,
9127                                        &lock_status);
9128                 else
9129                         rc = qam256auto(demod, channel, tuner_freq_offset,
9130                                         &lock_status);
9131                 if (rc != 0) {
9132                         pr_err("error %d\n", rc);
9133                         goto rw_error;
9134                 }
9135                 break;
9136         case DRX_CONSTELLATION_AUTO:    /* for channel scan */
9137                 if (ext_attr->standard == DRX_STANDARD_ITU_B) {
9138                         u16 qam_ctl_ena = 0;
9139 
9140                         auto_flag = true;
9141 
9142                         /* try to lock default QAM constellation: QAM256 */
9143                         channel->constellation = DRX_CONSTELLATION_QAM256;
9144                         ext_attr->constellation = DRX_CONSTELLATION_QAM256;
9145                         if (channel->mirror == DRX_MIRROR_AUTO)
9146                                 ext_attr->mirror = DRX_MIRROR_NO;
9147                         else
9148                                 ext_attr->mirror = channel->mirror;
9149                         rc = set_qam(demod, channel, tuner_freq_offset,
9150                                      QAM_SET_OP_ALL);
9151                         if (rc != 0) {
9152                                 pr_err("error %d\n", rc);
9153                                 goto rw_error;
9154                         }
9155                         rc = qam256auto(demod, channel, tuner_freq_offset,
9156                                         &lock_status);
9157                         if (rc != 0) {
9158                                 pr_err("error %d\n", rc);
9159                                 goto rw_error;
9160                         }
9161 
9162                         if (lock_status >= DRX_LOCKED) {
9163                                 channel->constellation = DRX_CONSTELLATION_AUTO;
9164                                 break;
9165                         }
9166 
9167                         /* QAM254 not locked. Try QAM64 constellation */
9168                         channel->constellation = DRX_CONSTELLATION_QAM64;
9169                         ext_attr->constellation = DRX_CONSTELLATION_QAM64;
9170                         if (channel->mirror == DRX_MIRROR_AUTO)
9171                                 ext_attr->mirror = DRX_MIRROR_NO;
9172                         else
9173                                 ext_attr->mirror = channel->mirror;
9174 
9175                         rc = drxj_dap_read_reg16(demod->my_i2c_dev_addr,
9176                                                      SCU_RAM_QAM_CTL_ENA__A,
9177                                                      &qam_ctl_ena, 0);
9178                         if (rc != 0) {
9179                                 pr_err("error %d\n", rc);
9180                                 goto rw_error;
9181                         }
9182                         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr,
9183                                                       SCU_RAM_QAM_CTL_ENA__A,
9184                                                       qam_ctl_ena & ~SCU_RAM_QAM_CTL_ENA_ACQ__M, 0);
9185                         if (rc != 0) {
9186                                 pr_err("error %d\n", rc);
9187                                 goto rw_error;
9188                         }
9189                         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr,
9190                                                       SCU_RAM_QAM_FSM_STATE_TGT__A,
9191                                                       0x2, 0);
9192                         if (rc != 0) {
9193                                 pr_err("error %d\n", rc);
9194                                 goto rw_error;
9195                         }       /* force to rate hunting */
9196 
9197                         rc = set_qam(demod, channel, tuner_freq_offset,
9198                                      QAM_SET_OP_CONSTELLATION);
9199                         if (rc != 0) {
9200                                 pr_err("error %d\n", rc);
9201                                 goto rw_error;
9202                         }
9203                         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr,
9204                                                       SCU_RAM_QAM_CTL_ENA__A,
9205                                                       qam_ctl_ena, 0);
9206                         if (rc != 0) {
9207                                 pr_err("error %d\n", rc);
9208                                 goto rw_error;
9209                         }
9210 
9211                         rc = qam64auto(demod, channel, tuner_freq_offset,
9212                                        &lock_status);
9213                         if (rc != 0) {
9214                                 pr_err("error %d\n", rc);
9215                                 goto rw_error;
9216                         }
9217 
9218                         channel->constellation = DRX_CONSTELLATION_AUTO;
9219                 } else if (ext_attr->standard == DRX_STANDARD_ITU_C) {
9220                         u16 qam_ctl_ena = 0;
9221 
9222                         channel->constellation = DRX_CONSTELLATION_QAM64;
9223                         ext_attr->constellation = DRX_CONSTELLATION_QAM64;
9224                         auto_flag = true;
9225 
9226                         if (channel->mirror == DRX_MIRROR_AUTO)
9227                                 ext_attr->mirror = DRX_MIRROR_NO;
9228                         else
9229                                 ext_attr->mirror = channel->mirror;
9230                         rc = drxj_dap_read_reg16(demod->my_i2c_dev_addr,
9231                                                      SCU_RAM_QAM_CTL_ENA__A,
9232                                                      &qam_ctl_ena, 0);
9233                         if (rc != 0) {
9234                                 pr_err("error %d\n", rc);
9235                                 goto rw_error;
9236                         }
9237                         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr,
9238                                                       SCU_RAM_QAM_CTL_ENA__A,
9239                                                       qam_ctl_ena & ~SCU_RAM_QAM_CTL_ENA_ACQ__M, 0);
9240                         if (rc != 0) {
9241                                 pr_err("error %d\n", rc);
9242                                 goto rw_error;
9243                         }
9244                         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr,
9245                                                       SCU_RAM_QAM_FSM_STATE_TGT__A,
9246                                                       0x2, 0);
9247                         if (rc != 0) {
9248                                 pr_err("error %d\n", rc);
9249                                 goto rw_error;
9250                         }       /* force to rate hunting */
9251 
9252                         rc = set_qam(demod, channel, tuner_freq_offset,
9253                                      QAM_SET_OP_CONSTELLATION);
9254                         if (rc != 0) {
9255                                 pr_err("error %d\n", rc);
9256                                 goto rw_error;
9257                         }
9258                         rc = drxj_dap_write_reg16(demod->my_i2c_dev_addr,
9259                                                       SCU_RAM_QAM_CTL_ENA__A,
9260                                                       qam_ctl_ena, 0);
9261                         if (rc != 0) {
9262                                 pr_err("error %d\n", rc);
9263                                 goto rw_error;
9264                         }
9265                         rc = qam64auto(demod, channel, tuner_freq_offset,
9266                                        &lock_status);
9267                         if (rc != 0) {
9268                                 pr_err("error %d\n", rc);
9269                                 goto rw_error;
9270                         }
9271                         channel->constellation = DRX_CONSTELLATION_AUTO;
9272                 } else {
9273                         return -EINVAL;
9274                 }
9275                 break;
9276         default:
9277                 return -EINVAL;
9278         }
9279 
9280         return 0;
9281 rw_error:
9282         /* restore starting value */
9283         if (auto_flag)
9284                 channel->constellation = DRX_CONSTELLATION_AUTO;
9285         return rc;
9286 }
9287 
9288 /*============================================================================*/
9289 
9290 /*
9291 * \fn static short get_qamrs_err_count(struct i2c_device_addr *dev_addr)
9292 * \brief Get RS error count in QAM mode (used for post RS BER calculation)
9293 * \return Error code
9294 *
9295 * precondition: measurement period & measurement prescale must be set
9296 *
9297 */
9298 static int
9299 get_qamrs_err_count(struct i2c_device_addr *dev_addr,
9300                     struct drxjrs_errors *rs_errors)
9301 {
9302         int rc;
9303         u16 nr_bit_errors = 0,
9304             nr_symbol_errors = 0,
9305             nr_packet_errors = 0, nr_failures = 0, nr_snc_par_fail_count = 0;
9306 
9307         /* check arguments */
9308         if (dev_addr == NULL)
9309                 return -EINVAL;
9310 
9311         /* all reported errors are received in the  */
9312         /* most recently finished measurement period */
9313         /*   no of pre RS bit errors */
9314         rc = drxj_dap_read_reg16(dev_addr, FEC_RS_NR_BIT_ERRORS__A, &nr_bit_errors, 0);
9315         if (rc != 0) {
9316                 pr_err("error %d\n", rc);
9317                 goto rw_error;
9318         }
9319         /*   no of symbol errors      */
9320         rc = drxj_dap_read_reg16(dev_addr, FEC_RS_NR_SYMBOL_ERRORS__A, &nr_symbol_errors, 0);
9321         if (rc != 0) {
9322                 pr_err("error %d\n", rc);
9323                 goto rw_error;
9324         }
9325         /*   no of packet errors      */
9326         rc = drxj_dap_read_reg16(dev_addr, FEC_RS_NR_PACKET_ERRORS__A, &nr_packet_errors, 0);
9327         if (rc != 0) {
9328                 pr_err("error %d\n", rc);
9329                 goto rw_error;
9330         }
9331         /*   no of failures to decode */
9332         rc = drxj_dap_read_reg16(dev_addr, FEC_RS_NR_FAILURES__A, &nr_failures, 0);
9333         if (rc != 0) {
9334                 pr_err("error %d\n", rc);
9335                 goto rw_error;
9336         }
9337         /*   no of post RS bit erros  */
9338         rc = drxj_dap_read_reg16(dev_addr, FEC_OC_SNC_FAIL_COUNT__A, &nr_snc_par_fail_count, 0);
9339         if (rc != 0) {
9340                 pr_err("error %d\n", rc);
9341                 goto rw_error;
9342         }
9343         /* TODO: NOTE */
9344         /* These register values are fetched in non-atomic fashion           */
9345         /* It is possible that the read values contain unrelated information */
9346 
9347         rs_errors->nr_bit_errors = nr_bit_errors & FEC_RS_NR_BIT_ERRORS__M;
9348         rs_errors->nr_symbol_errors = nr_symbol_errors & FEC_RS_NR_SYMBOL_ERRORS__M;
9349         rs_errors->nr_packet_errors = nr_packet_errors & FEC_RS_NR_PACKET_ERRORS__M;
9350         rs_errors->nr_failures = nr_failures & FEC_RS_NR_FAILURES__M;
9351         rs_errors->nr_snc_par_fail_count =
9352             nr_snc_par_fail_count & FEC_OC_SNC_FAIL_COUNT__M;
9353 
9354         return 0;
9355 rw_error:
9356         return rc;
9357 }
9358 
9359 /*============================================================================*/
9360 
9361 /*
9362  * \fn int get_sig_strength()
9363  * \brief Retrieve signal strength for VSB and QAM.
9364  * \param demod Pointer to demod instance
9365  * \param u16-t Pointer to signal strength data; range 0, .. , 100.
9366  * \return int.
9367  * \retval 0 sig_strength contains valid data.
9368  * \retval -EINVAL sig_strength is NULL.
9369  * \retval -EIO Erroneous data, sig_strength contains invalid data.
9370  */
9371 #define DRXJ_AGC_TOP    0x2800
9372 #define DRXJ_AGC_SNS    0x1600
9373 #define DRXJ_RFAGC_MAX  0x3fff
9374 #define DRXJ_RFAGC_MIN  0x800
9375 
9376 static int get_sig_strength(struct drx_demod_instance *demod, u16 *sig_strength)
9377 {
9378         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
9379         int rc;
9380         u16 rf_gain = 0;
9381         u16 if_gain = 0;
9382         u16 if_agc_sns = 0;
9383         u16 if_agc_top = 0;
9384         u16 rf_agc_max = 0;
9385         u16 rf_agc_min = 0;
9386 
9387         rc = drxj_dap_read_reg16(dev_addr, IQM_AF_AGC_IF__A, &if_gain, 0);
9388         if (rc != 0) {
9389                 pr_err("error %d\n", rc);
9390                 goto rw_error;
9391         }
9392         if_gain &= IQM_AF_AGC_IF__M;
9393         rc = drxj_dap_read_reg16(dev_addr, IQM_AF_AGC_RF__A, &rf_gain, 0);
9394         if (rc != 0) {
9395                 pr_err("error %d\n", rc);
9396                 goto rw_error;
9397         }
9398         rf_gain &= IQM_AF_AGC_RF__M;
9399 
9400         if_agc_sns = DRXJ_AGC_SNS;
9401         if_agc_top = DRXJ_AGC_TOP;
9402         rf_agc_max = DRXJ_RFAGC_MAX;
9403         rf_agc_min = DRXJ_RFAGC_MIN;
9404 
9405         if (if_gain > if_agc_top) {
9406                 if (rf_gain > rf_agc_max)
9407                         *sig_strength = 100;
9408                 else if (rf_gain > rf_agc_min) {
9409                         if (rf_agc_max == rf_agc_min) {
9410                                 pr_err("error: rf_agc_max == rf_agc_min\n");
9411                                 return -EIO;
9412                         }
9413                         *sig_strength =
9414                         75 + 25 * (rf_gain - rf_agc_min) / (rf_agc_max -
9415                                                                 rf_agc_min);
9416                 } else
9417                         *sig_strength = 75;
9418         } else if (if_gain > if_agc_sns) {
9419                 if (if_agc_top == if_agc_sns) {
9420                         pr_err("error: if_agc_top == if_agc_sns\n");
9421                         return -EIO;
9422                 }
9423                 *sig_strength =
9424                 20 + 55 * (if_gain - if_agc_sns) / (if_agc_top - if_agc_sns);
9425         } else {
9426                 if (!if_agc_sns) {
9427                         pr_err("error: if_agc_sns is zero!\n");
9428                         return -EIO;
9429                 }
9430                 *sig_strength = (20 * if_gain / if_agc_sns);
9431         }
9432 
9433         if (*sig_strength <= 7)
9434                 *sig_strength = 0;
9435 
9436         return 0;
9437 rw_error:
9438         return rc;
9439 }
9440 
9441 /*
9442 * \fn int ctrl_get_qam_sig_quality()
9443 * \brief Retrieve QAM signal quality from device.
9444 * \param devmod Pointer to demodulator instance.
9445 * \param sig_quality Pointer to signal quality data.
9446 * \return int.
9447 * \retval 0 sig_quality contains valid data.
9448 * \retval -EINVAL sig_quality is NULL.
9449 * \retval -EIO Erroneous data, sig_quality contains invalid data.
9450 
9451 *  Pre-condition: Device must be started and in lock.
9452 */
9453 static int
9454 ctrl_get_qam_sig_quality(struct drx_demod_instance *demod)
9455 {
9456         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
9457         struct drxj_data *ext_attr = demod->my_ext_attr;
9458         struct drx39xxj_state *state = dev_addr->user_data;
9459         struct dtv_frontend_properties *p = &state->frontend.dtv_property_cache;
9460         struct drxjrs_errors measuredrs_errors = { 0, 0, 0, 0, 0 };
9461         enum drx_modulation constellation = ext_attr->constellation;
9462         int rc;
9463 
9464         u32 pre_bit_err_rs = 0; /* pre RedSolomon Bit Error Rate */
9465         u32 post_bit_err_rs = 0;        /* post RedSolomon Bit Error Rate */
9466         u32 pkt_errs = 0;       /* no of packet errors in RS */
9467         u16 qam_sl_err_power = 0;       /* accumulated error between raw and sliced symbols */
9468         u16 qsym_err_vd = 0;    /* quadrature symbol errors in QAM_VD */
9469         u16 fec_oc_period = 0;  /* SNC sync failure measurement period */
9470         u16 fec_rs_prescale = 0;        /* ReedSolomon Measurement Prescale */
9471         u16 fec_rs_period = 0;  /* Value for corresponding I2C register */
9472         /* calculation constants */
9473         u32 rs_bit_cnt = 0;     /* RedSolomon Bit Count */
9474         u32 qam_sl_sig_power = 0;       /* used for MER, depends of QAM constellation */
9475         /* intermediate results */
9476         u32 e = 0;              /* exponent value used for QAM BER/SER */
9477         u32 m = 0;              /* mantisa value used for QAM BER/SER */
9478         u32 ber_cnt = 0;        /* BER count */
9479         /* signal quality info */
9480         u32 qam_sl_mer = 0;     /* QAM MER */
9481         u32 qam_pre_rs_ber = 0; /* Pre RedSolomon BER */
9482         u32 qam_post_rs_ber = 0;        /* Post RedSolomon BER */
9483         u32 qam_vd_ser = 0;     /* ViterbiDecoder SER */
9484         u16 qam_vd_prescale = 0;        /* Viterbi Measurement Prescale */
9485         u16 qam_vd_period = 0;  /* Viterbi Measurement period */
9486         u32 vd_bit_cnt = 0;     /* ViterbiDecoder Bit Count */
9487 
9488         p->block_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
9489 
9490         /* read the physical registers */
9491         /*   Get the RS error data */
9492         rc = get_qamrs_err_count(dev_addr, &measuredrs_errors);
9493         if (rc != 0) {
9494                 pr_err("error %d\n", rc);
9495                 goto rw_error;
9496         }
9497         /* get the register value needed for MER */
9498         rc = drxj_dap_read_reg16(dev_addr, QAM_SL_ERR_POWER__A, &qam_sl_err_power, 0);
9499         if (rc != 0) {
9500                 pr_err("error %d\n", rc);
9501                 goto rw_error;
9502         }
9503         /* get the register value needed for post RS BER */
9504         rc = drxj_dap_read_reg16(dev_addr, FEC_OC_SNC_FAIL_PERIOD__A, &fec_oc_period, 0);
9505         if (rc != 0) {
9506                 pr_err("error %d\n", rc);
9507                 goto rw_error;
9508         }
9509 
9510         /* get constants needed for signal quality calculation */
9511         fec_rs_period = ext_attr->fec_rs_period;
9512         fec_rs_prescale = ext_attr->fec_rs_prescale;
9513         rs_bit_cnt = fec_rs_period * fec_rs_prescale * ext_attr->fec_rs_plen;
9514         qam_vd_period = ext_attr->qam_vd_period;
9515         qam_vd_prescale = ext_attr->qam_vd_prescale;
9516         vd_bit_cnt = qam_vd_period * qam_vd_prescale * ext_attr->fec_vd_plen;
9517 
9518         /* DRXJ_QAM_SL_SIG_POWER_QAMxxx  * 4     */
9519         switch (constellation) {
9520         case DRX_CONSTELLATION_QAM16:
9521                 qam_sl_sig_power = DRXJ_QAM_SL_SIG_POWER_QAM16 << 2;
9522                 break;
9523         case DRX_CONSTELLATION_QAM32:
9524                 qam_sl_sig_power = DRXJ_QAM_SL_SIG_POWER_QAM32 << 2;
9525                 break;
9526         case DRX_CONSTELLATION_QAM64:
9527                 qam_sl_sig_power = DRXJ_QAM_SL_SIG_POWER_QAM64 << 2;
9528                 break;
9529         case DRX_CONSTELLATION_QAM128:
9530                 qam_sl_sig_power = DRXJ_QAM_SL_SIG_POWER_QAM128 << 2;
9531                 break;
9532         case DRX_CONSTELLATION_QAM256:
9533                 qam_sl_sig_power = DRXJ_QAM_SL_SIG_POWER_QAM256 << 2;
9534                 break;
9535         default:
9536                 return -EIO;
9537         }
9538 
9539         /* ------------------------------ */
9540         /* MER Calculation                */
9541         /* ------------------------------ */
9542         /* MER is good if it is above 27.5 for QAM256 or 21.5 for QAM64 */
9543 
9544         /* 10.0*log10(qam_sl_sig_power * 4.0 / qam_sl_err_power); */
9545         if (qam_sl_err_power == 0)
9546                 qam_sl_mer = 0;
9547         else
9548                 qam_sl_mer = log1_times100(qam_sl_sig_power) - log1_times100((u32)qam_sl_err_power);
9549 
9550         /* ----------------------------------------- */
9551         /* Pre Viterbi Symbol Error Rate Calculation */
9552         /* ----------------------------------------- */
9553         /* pre viterbi SER is good if it is below 0.025 */
9554 
9555         /* get the register value */
9556         /*   no of quadrature symbol errors */
9557         rc = drxj_dap_read_reg16(dev_addr, QAM_VD_NR_QSYM_ERRORS__A, &qsym_err_vd, 0);
9558         if (rc != 0) {
9559                 pr_err("error %d\n", rc);
9560                 goto rw_error;
9561         }
9562         /* Extract the Exponent and the Mantisa  */
9563         /* of number of quadrature symbol errors */
9564         e = (qsym_err_vd & QAM_VD_NR_QSYM_ERRORS_EXP__M) >>
9565             QAM_VD_NR_QSYM_ERRORS_EXP__B;
9566         m = (qsym_err_vd & QAM_VD_NR_SYMBOL_ERRORS_FIXED_MANT__M) >>
9567             QAM_VD_NR_SYMBOL_ERRORS_FIXED_MANT__B;
9568 
9569         if ((m << e) >> 3 > 549752)
9570                 qam_vd_ser = 500000 * vd_bit_cnt * ((e > 2) ? 1 : 8) / 8;
9571         else
9572                 qam_vd_ser = m << ((e > 2) ? (e - 3) : e);
9573 
9574         /* --------------------------------------- */
9575         /* pre and post RedSolomon BER Calculation */
9576         /* --------------------------------------- */
9577         /* pre RS BER is good if it is below 3.5e-4 */
9578 
9579         /* get the register values */
9580         pre_bit_err_rs = (u32) measuredrs_errors.nr_bit_errors;
9581         pkt_errs = post_bit_err_rs = (u32) measuredrs_errors.nr_snc_par_fail_count;
9582 
9583         /* Extract the Exponent and the Mantisa of the */
9584         /* pre Reed-Solomon bit error count            */
9585         e = (pre_bit_err_rs & FEC_RS_NR_BIT_ERRORS_EXP__M) >>
9586             FEC_RS_NR_BIT_ERRORS_EXP__B;
9587         m = (pre_bit_err_rs & FEC_RS_NR_BIT_ERRORS_FIXED_MANT__M) >>
9588             FEC_RS_NR_BIT_ERRORS_FIXED_MANT__B;
9589 
9590         ber_cnt = m << e;
9591 
9592         /*qam_pre_rs_ber = frac_times1e6( ber_cnt, rs_bit_cnt ); */
9593         if (m > (rs_bit_cnt >> (e + 1)) || (rs_bit_cnt >> e) == 0)
9594                 qam_pre_rs_ber = 500000 * rs_bit_cnt >> e;
9595         else
9596                 qam_pre_rs_ber = ber_cnt;
9597 
9598         /* post RS BER = 1000000* (11.17 * FEC_OC_SNC_FAIL_COUNT__A) /  */
9599         /*               (1504.0 * FEC_OC_SNC_FAIL_PERIOD__A)  */
9600         /*
9601            => c = (1000000*100*11.17)/1504 =
9602            post RS BER = (( c* FEC_OC_SNC_FAIL_COUNT__A) /
9603            (100 * FEC_OC_SNC_FAIL_PERIOD__A)
9604            *100 and /100 is for more precision.
9605            => (20 bits * 12 bits) /(16 bits * 7 bits)  => safe in 32 bits computation
9606 
9607            Precision errors still possible.
9608          */
9609         if (!fec_oc_period) {
9610                 qam_post_rs_ber = 0xFFFFFFFF;
9611         } else {
9612                 e = post_bit_err_rs * 742686;
9613                 m = fec_oc_period * 100;
9614                 qam_post_rs_ber = e / m;
9615         }
9616 
9617         /* fill signal quality data structure */
9618         p->pre_bit_count.stat[0].scale = FE_SCALE_COUNTER;
9619         p->post_bit_count.stat[0].scale = FE_SCALE_COUNTER;
9620         p->pre_bit_error.stat[0].scale = FE_SCALE_COUNTER;
9621         p->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
9622         p->block_error.stat[0].scale = FE_SCALE_COUNTER;
9623         p->cnr.stat[0].scale = FE_SCALE_DECIBEL;
9624 
9625         p->cnr.stat[0].svalue = ((u16) qam_sl_mer) * 100;
9626         if (ext_attr->standard == DRX_STANDARD_ITU_B) {
9627                 p->pre_bit_error.stat[0].uvalue += qam_vd_ser;
9628                 p->pre_bit_count.stat[0].uvalue += vd_bit_cnt * ((e > 2) ? 1 : 8) / 8;
9629         } else {
9630                 p->pre_bit_error.stat[0].uvalue += qam_pre_rs_ber;
9631                 p->pre_bit_count.stat[0].uvalue += rs_bit_cnt >> e;
9632         }
9633 
9634         p->post_bit_error.stat[0].uvalue += qam_post_rs_ber;
9635         p->post_bit_count.stat[0].uvalue += rs_bit_cnt >> e;
9636 
9637         p->block_error.stat[0].uvalue += pkt_errs;
9638 
9639 #ifdef DRXJ_SIGNAL_ACCUM_ERR
9640         rc = get_acc_pkt_err(demod, &sig_quality->packet_error);
9641         if (rc != 0) {
9642                 pr_err("error %d\n", rc);
9643                 goto rw_error;
9644         }
9645 #endif
9646 
9647         return 0;
9648 rw_error:
9649         p->pre_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
9650         p->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
9651         p->pre_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
9652         p->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
9653         p->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
9654         p->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
9655 
9656         return rc;
9657 }
9658 
9659 #endif /* #ifndef DRXJ_VSB_ONLY */
9660 
9661 /*============================================================================*/
9662 /*==                     END QAM DATAPATH FUNCTIONS                         ==*/
9663 /*============================================================================*/
9664 
9665 /*============================================================================*/
9666 /*============================================================================*/
9667 /*==                       ATV DATAPATH FUNCTIONS                           ==*/
9668 /*============================================================================*/
9669 /*============================================================================*/
9670 
9671 /*
9672    Implementation notes.
9673 
9674    NTSC/FM AGCs
9675 
9676       Four AGCs are used for NTSC:
9677       (1) RF (used to attenuate the input signal in case of to much power)
9678       (2) IF (used to attenuate the input signal in case of to much power)
9679       (3) Video AGC (used to amplify the output signal in case input to low)
9680       (4) SIF AGC (used to amplify the output signal in case input to low)
9681 
9682       Video AGC is coupled to RF and IF. SIF AGC is not coupled. It is assumed
9683       that the coupling between Video AGC and the RF and IF AGCs also works in
9684       favor of the SIF AGC.
9685 
9686       Three AGCs are used for FM:
9687       (1) RF (used to attenuate the input signal in case of to much power)
9688       (2) IF (used to attenuate the input signal in case of to much power)
9689       (3) SIF AGC (used to amplify the output signal in case input to low)
9690 
9691       The SIF AGC is now coupled to the RF/IF AGCs.
9692       The SIF AGC is needed for both SIF output and the internal SIF signal to
9693       the AUD block.
9694 
9695       RF and IF AGCs DACs are part of AFE, Video and SIF AGC DACs are part of
9696       the ATV block. The AGC control algorithms are all implemented in
9697       microcode.
9698 
9699    ATV SETTINGS
9700 
9701       (Shadow settings will not be used for now, they will be implemented
9702        later on because of the schedule)
9703 
9704       Several HW/SCU "settings" can be used for ATV. The standard selection
9705       will reset most of these settings. To avoid that the end user application
9706       has to perform these settings each time the ATV or FM standards is
9707       selected the driver will shadow these settings. This enables the end user
9708       to perform the settings only once after a drx_open(). The driver must
9709       write the shadow settings to HW/SCU in case:
9710          ( setstandard FM/ATV) ||
9711          ( settings have changed && FM/ATV standard is active)
9712       The shadow settings will be stored in the device specific data container.
9713       A set of flags will be defined to flag changes in shadow settings.
9714       A routine will be implemented to write all changed shadow settings to
9715       HW/SCU.
9716 
9717       The "settings" will consist of: AGC settings, filter settings etc.
9718 
9719       Disadvantage of use of shadow settings:
9720       Direct changes in HW/SCU registers will not be reflected in the
9721       shadow settings and these changes will be overwritten during a next
9722       update. This can happen during evaluation. This will not be a problem
9723       for normal customer usage.
9724 */
9725 /* -------------------------------------------------------------------------- */
9726 
9727 /*
9728 * \fn int power_down_atv ()
9729 * \brief Power down ATV.
9730 * \param demod instance of demodulator
9731 * \param standard either NTSC or FM (sub strandard for ATV )
9732 * \return int.
9733 *
9734 *  Stops and thus resets ATV and IQM block
9735 *  SIF and CVBS ADC are powered down
9736 *  Calls audio power down
9737 */
9738 static int
9739 power_down_atv(struct drx_demod_instance *demod, enum drx_standard standard, bool primary)
9740 {
9741         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
9742         struct drxjscu_cmd cmd_scu = { /* command      */ 0,
9743                 /* parameter_len */ 0,
9744                 /* result_len    */ 0,
9745                 /* *parameter   */ NULL,
9746                 /* *result      */ NULL
9747         };
9748         int rc;
9749         u16 cmd_result = 0;
9750 
9751         /* ATV NTSC */
9752 
9753         /* Stop ATV SCU (will reset ATV and IQM hardware */
9754         cmd_scu.command = SCU_RAM_COMMAND_STANDARD_ATV |
9755             SCU_RAM_COMMAND_CMD_DEMOD_STOP;
9756         cmd_scu.parameter_len = 0;
9757         cmd_scu.result_len = 1;
9758         cmd_scu.parameter = NULL;
9759         cmd_scu.result = &cmd_result;
9760         rc = scu_command(dev_addr, &cmd_scu);
9761         if (rc != 0) {
9762                 pr_err("error %d\n", rc);
9763                 goto rw_error;
9764         }
9765         /* Disable ATV outputs (ATV reset enables CVBS, undo this) */
9766         rc = drxj_dap_write_reg16(dev_addr, ATV_TOP_STDBY__A, (ATV_TOP_STDBY_SIF_STDBY_STANDBY & (~ATV_TOP_STDBY_CVBS_STDBY_A2_ACTIVE)), 0);
9767         if (rc != 0) {
9768                 pr_err("error %d\n", rc);
9769                 goto rw_error;
9770         }
9771 
9772         rc = drxj_dap_write_reg16(dev_addr, ATV_COMM_EXEC__A, ATV_COMM_EXEC_STOP, 0);
9773         if (rc != 0) {
9774                 pr_err("error %d\n", rc);
9775                 goto rw_error;
9776         }
9777         if (primary) {
9778                 rc = drxj_dap_write_reg16(dev_addr, IQM_COMM_EXEC__A, IQM_COMM_EXEC_STOP, 0);
9779                 if (rc != 0) {
9780                         pr_err("error %d\n", rc);
9781                         goto rw_error;
9782                 }
9783                 rc = set_iqm_af(demod, false);
9784                 if (rc != 0) {
9785                         pr_err("error %d\n", rc);
9786                         goto rw_error;
9787                 }
9788         } else {
9789                 rc = drxj_dap_write_reg16(dev_addr, IQM_FS_COMM_EXEC__A, IQM_FS_COMM_EXEC_STOP, 0);
9790                 if (rc != 0) {
9791                         pr_err("error %d\n", rc);
9792                         goto rw_error;
9793                 }
9794                 rc = drxj_dap_write_reg16(dev_addr, IQM_FD_COMM_EXEC__A, IQM_FD_COMM_EXEC_STOP, 0);
9795                 if (rc != 0) {
9796                         pr_err("error %d\n", rc);
9797                         goto rw_error;
9798                 }
9799                 rc = drxj_dap_write_reg16(dev_addr, IQM_RC_COMM_EXEC__A, IQM_RC_COMM_EXEC_STOP, 0);
9800                 if (rc != 0) {
9801                         pr_err("error %d\n", rc);
9802                         goto rw_error;
9803                 }
9804                 rc = drxj_dap_write_reg16(dev_addr, IQM_RT_COMM_EXEC__A, IQM_RT_COMM_EXEC_STOP, 0);
9805                 if (rc != 0) {
9806                         pr_err("error %d\n", rc);
9807                         goto rw_error;
9808                 }
9809                 rc = drxj_dap_write_reg16(dev_addr, IQM_CF_COMM_EXEC__A, IQM_CF_COMM_EXEC_STOP, 0);
9810                 if (rc != 0) {
9811                         pr_err("error %d\n", rc);
9812                         goto rw_error;
9813                 }
9814         }
9815         rc = power_down_aud(demod);
9816         if (rc != 0) {
9817                 pr_err("error %d\n", rc);
9818                 goto rw_error;
9819         }
9820 
9821         return 0;
9822 rw_error:
9823         return rc;
9824 }
9825 
9826 /*============================================================================*/
9827 
9828 /*
9829 * \brief Power up AUD.
9830 * \param demod instance of demodulator
9831 * \return int.
9832 *
9833 */
9834 static int power_down_aud(struct drx_demod_instance *demod)
9835 {
9836         struct i2c_device_addr *dev_addr = NULL;
9837         struct drxj_data *ext_attr = NULL;
9838         int rc;
9839 
9840         dev_addr = (struct i2c_device_addr *)demod->my_i2c_dev_addr;
9841         ext_attr = (struct drxj_data *) demod->my_ext_attr;
9842 
9843         rc = drxj_dap_write_reg16(dev_addr, AUD_COMM_EXEC__A, AUD_COMM_EXEC_STOP, 0);
9844         if (rc != 0) {
9845                 pr_err("error %d\n", rc);
9846                 goto rw_error;
9847         }
9848 
9849         ext_attr->aud_data.audio_is_active = false;
9850 
9851         return 0;
9852 rw_error:
9853         return rc;
9854 }
9855 
9856 /*
9857 * \fn int set_orx_nsu_aox()
9858 * \brief Configure OrxNsuAox for OOB
9859 * \param demod instance of demodulator.
9860 * \param active
9861 * \return int.
9862 */
9863 static int set_orx_nsu_aox(struct drx_demod_instance *demod, bool active)
9864 {
9865         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
9866         int rc;
9867         u16 data = 0;
9868 
9869         /* Configure NSU_AOX */
9870         rc = drxj_dap_read_reg16(dev_addr, ORX_NSU_AOX_STDBY_W__A, &data, 0);
9871         if (rc != 0) {
9872                 pr_err("error %d\n", rc);
9873                 goto rw_error;
9874         }
9875         if (!active)
9876                 data &= ((~ORX_NSU_AOX_STDBY_W_STDBYADC_A2_ON) & (~ORX_NSU_AOX_STDBY_W_STDBYAMP_A2_ON) & (~ORX_NSU_AOX_STDBY_W_STDBYBIAS_A2_ON) & (~ORX_NSU_AOX_STDBY_W_STDBYPLL_A2_ON) & (~ORX_NSU_AOX_STDBY_W_STDBYPD_A2_ON) & (~ORX_NSU_AOX_STDBY_W_STDBYTAGC_IF_A2_ON) & (~ORX_NSU_AOX_STDBY_W_STDBYTAGC_RF_A2_ON) & (~ORX_NSU_AOX_STDBY_W_STDBYFLT_A2_ON));
9877         else
9878                 data |= (ORX_NSU_AOX_STDBY_W_STDBYADC_A2_ON | ORX_NSU_AOX_STDBY_W_STDBYAMP_A2_ON | ORX_NSU_AOX_STDBY_W_STDBYBIAS_A2_ON | ORX_NSU_AOX_STDBY_W_STDBYPLL_A2_ON | ORX_NSU_AOX_STDBY_W_STDBYPD_A2_ON | ORX_NSU_AOX_STDBY_W_STDBYTAGC_IF_A2_ON | ORX_NSU_AOX_STDBY_W_STDBYTAGC_RF_A2_ON | ORX_NSU_AOX_STDBY_W_STDBYFLT_A2_ON);
9879         rc = drxj_dap_write_reg16(dev_addr, ORX_NSU_AOX_STDBY_W__A, data, 0);
9880         if (rc != 0) {
9881                 pr_err("error %d\n", rc);
9882                 goto rw_error;
9883         }
9884 
9885         return 0;
9886 rw_error:
9887         return rc;
9888 }
9889 
9890 /*
9891 * \fn int ctrl_set_oob()
9892 * \brief Set OOB channel to be used.
9893 * \param demod instance of demodulator
9894 * \param oob_param OOB parameters for channel setting.
9895 * \frequency should be in KHz
9896 * \return int.
9897 *
9898 * Accepts  only. Returns error otherwise.
9899 * Demapper value is written after scu_command START
9900 * because START command causes COMM_EXEC transition
9901 * from 0 to 1 which causes all registers to be
9902 * overwritten with initial value
9903 *
9904 */
9905 
9906 /* Nyquist filter impulse response */
9907 #define IMPULSE_COSINE_ALPHA_0_3    {-3, -4, -1, 6, 10, 7, -5, -20, -25, -10, 29, 79, 123, 140} /*sqrt raised-cosine filter with alpha=0.3 */
9908 #define IMPULSE_COSINE_ALPHA_0_5    { 2, 0, -2, -2, 2, 5, 2, -10, -20, -14, 20, 74, 125, 145}   /*sqrt raised-cosine filter with alpha=0.5 */
9909 #define IMPULSE_COSINE_ALPHA_RO_0_5 { 0, 0, 1, 2, 3, 0, -7, -15, -16,  0, 34, 77, 114, 128}     /*full raised-cosine filter with alpha=0.5 (receiver only) */
9910 
9911 /* Coefficients for the nyquist filter (total: 27 taps) */
9912 #define NYQFILTERLEN 27
9913 
9914 static int ctrl_set_oob(struct drx_demod_instance *demod, struct drxoob *oob_param)
9915 {
9916         int rc;
9917         s32 freq = 0;   /* KHz */
9918         struct i2c_device_addr *dev_addr = NULL;
9919         struct drxj_data *ext_attr = NULL;
9920         u16 i = 0;
9921         bool mirror_freq_spect_oob = false;
9922         u16 trk_filter_value = 0;
9923         struct drxjscu_cmd scu_cmd;
9924         u16 set_param_parameters[3];
9925         u16 cmd_result[2] = { 0, 0 };
9926         s16 nyquist_coeffs[4][(NYQFILTERLEN + 1) / 2] = {
9927                 IMPULSE_COSINE_ALPHA_0_3,       /* Target Mode 0 */
9928                 IMPULSE_COSINE_ALPHA_0_3,       /* Target Mode 1 */
9929                 IMPULSE_COSINE_ALPHA_0_5,       /* Target Mode 2 */
9930                 IMPULSE_COSINE_ALPHA_RO_0_5     /* Target Mode 3 */
9931         };
9932         u8 mode_val[4] = { 2, 2, 0, 1 };
9933         u8 pfi_coeffs[4][6] = {
9934                 {DRXJ_16TO8(-92), DRXJ_16TO8(-108), DRXJ_16TO8(100)},   /* TARGET_MODE = 0:     PFI_A = -23/32; PFI_B = -54/32;  PFI_C = 25/32; fg = 0.5 MHz (Att=26dB) */
9935                 {DRXJ_16TO8(-64), DRXJ_16TO8(-80), DRXJ_16TO8(80)},     /* TARGET_MODE = 1:     PFI_A = -16/32; PFI_B = -40/32;  PFI_C = 20/32; fg = 1.0 MHz (Att=28dB) */
9936                 {DRXJ_16TO8(-80), DRXJ_16TO8(-98), DRXJ_16TO8(92)},     /* TARGET_MODE = 2, 3:  PFI_A = -20/32; PFI_B = -49/32;  PFI_C = 23/32; fg = 0.8 MHz (Att=25dB) */
9937                 {DRXJ_16TO8(-80), DRXJ_16TO8(-98), DRXJ_16TO8(92)}      /* TARGET_MODE = 2, 3:  PFI_A = -20/32; PFI_B = -49/32;  PFI_C = 23/32; fg = 0.8 MHz (Att=25dB) */
9938         };
9939         u16 mode_index;
9940 
9941         dev_addr = demod->my_i2c_dev_addr;
9942         ext_attr = (struct drxj_data *) demod->my_ext_attr;
9943         mirror_freq_spect_oob = ext_attr->mirror_freq_spect_oob;
9944 
9945         /* Check parameters */
9946         if (oob_param == NULL) {
9947                 /* power off oob module  */
9948                 scu_cmd.command = SCU_RAM_COMMAND_STANDARD_OOB
9949                     | SCU_RAM_COMMAND_CMD_DEMOD_STOP;
9950                 scu_cmd.parameter_len = 0;
9951                 scu_cmd.result_len = 1;
9952                 scu_cmd.result = cmd_result;
9953                 rc = scu_command(dev_addr, &scu_cmd);
9954                 if (rc != 0) {
9955                         pr_err("error %d\n", rc);
9956                         goto rw_error;
9957                 }
9958                 rc = set_orx_nsu_aox(demod, false);
9959                 if (rc != 0) {
9960                         pr_err("error %d\n", rc);
9961                         goto rw_error;
9962                 }
9963                 rc = drxj_dap_write_reg16(dev_addr, ORX_COMM_EXEC__A, ORX_COMM_EXEC_STOP, 0);
9964                 if (rc != 0) {
9965                         pr_err("error %d\n", rc);
9966                         goto rw_error;
9967                 }
9968 
9969                 ext_attr->oob_power_on = false;
9970                 return 0;
9971         }
9972 
9973         freq = oob_param->frequency;
9974         if ((freq < 70000) || (freq > 130000))
9975                 return -EIO;
9976         freq = (freq - 50000) / 50;
9977 
9978         {
9979                 u16 index = 0;
9980                 u16 remainder = 0;
9981                 u16 *trk_filtercfg = ext_attr->oob_trk_filter_cfg;
9982 
9983                 index = (u16) ((freq - 400) / 200);
9984                 remainder = (u16) ((freq - 400) % 200);
9985                 trk_filter_value =
9986                     trk_filtercfg[index] - (trk_filtercfg[index] -
9987                                            trk_filtercfg[index +
9988                                                         1]) / 10 * remainder /
9989                     20;
9990         }
9991 
9992    /********/
9993         /* Stop  */
9994    /********/
9995         rc = drxj_dap_write_reg16(dev_addr, ORX_COMM_EXEC__A, ORX_COMM_EXEC_STOP, 0);
9996         if (rc != 0) {
9997                 pr_err("error %d\n", rc);
9998                 goto rw_error;
9999         }
10000         scu_cmd.command = SCU_RAM_COMMAND_STANDARD_OOB
10001             | SCU_RAM_COMMAND_CMD_DEMOD_STOP;
10002         scu_cmd.parameter_len = 0;
10003         scu_cmd.result_len = 1;
10004         scu_cmd.result = cmd_result;
10005         rc = scu_command(dev_addr, &scu_cmd);
10006         if (rc != 0) {
10007                 pr_err("error %d\n", rc);
10008                 goto rw_error;
10009         }
10010    /********/
10011         /* Reset */
10012    /********/
10013         scu_cmd.command = SCU_RAM_COMMAND_STANDARD_OOB
10014             | SCU_RAM_COMMAND_CMD_DEMOD_RESET;
10015         scu_cmd.parameter_len = 0;
10016         scu_cmd.result_len = 1;
10017         scu_cmd.result = cmd_result;
10018         rc = scu_command(dev_addr, &scu_cmd);
10019         if (rc != 0) {
10020                 pr_err("error %d\n", rc);
10021                 goto rw_error;
10022         }
10023    /**********/
10024         /* SET_ENV */
10025    /**********/
10026         /* set frequency, spectrum inversion and data rate */
10027         scu_cmd.command = SCU_RAM_COMMAND_STANDARD_OOB
10028             | SCU_RAM_COMMAND_CMD_DEMOD_SET_ENV;
10029         scu_cmd.parameter_len = 3;
10030         /* 1-data rate;2-frequency */
10031         switch (oob_param->standard) {
10032         case DRX_OOB_MODE_A:
10033                 if (
10034                            /* signal is transmitted inverted */
10035                            ((oob_param->spectrum_inverted == true) &&
10036                             /* and tuner is not mirroring the signal */
10037                             (!mirror_freq_spect_oob)) |
10038                            /* or */
10039                            /* signal is transmitted noninverted */
10040                            ((oob_param->spectrum_inverted == false) &&
10041                             /* and tuner is mirroring the signal */
10042                             (mirror_freq_spect_oob))
10043                     )
10044                         set_param_parameters[0] =
10045                             SCU_RAM_ORX_RF_RX_DATA_RATE_2048KBPS_INVSPEC;
10046                 else
10047                         set_param_parameters[0] =
10048                             SCU_RAM_ORX_RF_RX_DATA_RATE_2048KBPS_REGSPEC;
10049                 break;
10050         case DRX_OOB_MODE_B_GRADE_A:
10051                 if (
10052                            /* signal is transmitted inverted */
10053                            ((oob_param->spectrum_inverted == true) &&
10054                             /* and tuner is not mirroring the signal */
10055                             (!mirror_freq_spect_oob)) |
10056                            /* or */
10057                            /* signal is transmitted noninverted */
10058                            ((oob_param->spectrum_inverted == false) &&
10059                             /* and tuner is mirroring the signal */
10060                             (mirror_freq_spect_oob))
10061                     )
10062                         set_param_parameters[0] =
10063                             SCU_RAM_ORX_RF_RX_DATA_RATE_1544KBPS_INVSPEC;
10064                 else
10065                         set_param_parameters[0] =
10066                             SCU_RAM_ORX_RF_RX_DATA_RATE_1544KBPS_REGSPEC;
10067                 break;
10068         case DRX_OOB_MODE_B_GRADE_B:
10069         default:
10070                 if (
10071                            /* signal is transmitted inverted */
10072                            ((oob_param->spectrum_inverted == true) &&
10073                             /* and tuner is not mirroring the signal */
10074                             (!mirror_freq_spect_oob)) |
10075                            /* or */
10076                            /* signal is transmitted noninverted */
10077                            ((oob_param->spectrum_inverted == false) &&
10078                             /* and tuner is mirroring the signal */
10079                             (mirror_freq_spect_oob))
10080                     )
10081                         set_param_parameters[0] =
10082                             SCU_RAM_ORX_RF_RX_DATA_RATE_3088KBPS_INVSPEC;
10083                 else
10084                         set_param_parameters[0] =
10085                             SCU_RAM_ORX_RF_RX_DATA_RATE_3088KBPS_REGSPEC;
10086                 break;
10087         }
10088         set_param_parameters[1] = (u16) (freq & 0xFFFF);
10089         set_param_parameters[2] = trk_filter_value;
10090         scu_cmd.parameter = set_param_parameters;
10091         scu_cmd.result_len = 1;
10092         scu_cmd.result = cmd_result;
10093         mode_index = mode_val[(set_param_parameters[0] & 0xC0) >> 6];
10094         rc = scu_command(dev_addr, &scu_cmd);
10095         if (rc != 0) {
10096                 pr_err("error %d\n", rc);
10097                 goto rw_error;
10098         }
10099 
10100         rc = drxj_dap_write_reg16(dev_addr, SIO_TOP_COMM_KEY__A, 0xFABA, 0);
10101         if (rc != 0) {
10102                 pr_err("error %d\n", rc);
10103                 goto rw_error;
10104         }       /*  Write magic word to enable pdr reg write  */
10105         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_OOB_CRX_CFG__A, OOB_CRX_DRIVE_STRENGTH << SIO_PDR_OOB_CRX_CFG_DRIVE__B | 0x03 << SIO_PDR_OOB_CRX_CFG_MODE__B, 0);
10106         if (rc != 0) {
10107                 pr_err("error %d\n", rc);
10108                 goto rw_error;
10109         }
10110         rc = drxj_dap_write_reg16(dev_addr, SIO_PDR_OOB_DRX_CFG__A, OOB_DRX_DRIVE_STRENGTH << SIO_PDR_OOB_DRX_CFG_DRIVE__B | 0x03 << SIO_PDR_OOB_DRX_CFG_MODE__B, 0);
10111         if (rc != 0) {
10112                 pr_err("error %d\n", rc);
10113                 goto rw_error;
10114         }
10115         rc = drxj_dap_write_reg16(dev_addr, SIO_TOP_COMM_KEY__A, 0x0000, 0);
10116         if (rc != 0) {
10117                 pr_err("error %d\n", rc);
10118                 goto rw_error;
10119         }       /*  Write magic word to disable pdr reg write */
10120 
10121         rc = drxj_dap_write_reg16(dev_addr, ORX_TOP_COMM_KEY__A, 0, 0);
10122         if (rc != 0) {
10123                 pr_err("error %d\n", rc);
10124                 goto rw_error;
10125         }
10126         rc = drxj_dap_write_reg16(dev_addr, ORX_FWP_AAG_LEN_W__A, 16000, 0);
10127         if (rc != 0) {
10128                 pr_err("error %d\n", rc);
10129                 goto rw_error;
10130         }
10131         rc = drxj_dap_write_reg16(dev_addr, ORX_FWP_AAG_THR_W__A, 40, 0);
10132         if (rc != 0) {
10133                 pr_err("error %d\n", rc);
10134                 goto rw_error;
10135         }
10136 
10137         /* ddc */
10138         rc = drxj_dap_write_reg16(dev_addr, ORX_DDC_OFO_SET_W__A, ORX_DDC_OFO_SET_W__PRE, 0);
10139         if (rc != 0) {
10140                 pr_err("error %d\n", rc);
10141                 goto rw_error;
10142         }
10143 
10144         /* nsu */
10145         rc = drxj_dap_write_reg16(dev_addr, ORX_NSU_AOX_LOPOW_W__A, ext_attr->oob_lo_pow, 0);
10146         if (rc != 0) {
10147                 pr_err("error %d\n", rc);
10148                 goto rw_error;
10149         }
10150 
10151         /* initialization for target mode */
10152         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_TARGET_MODE__A, SCU_RAM_ORX_TARGET_MODE_2048KBPS_SQRT, 0);
10153         if (rc != 0) {
10154                 pr_err("error %d\n", rc);
10155                 goto rw_error;
10156         }
10157         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_FREQ_GAIN_CORR__A, SCU_RAM_ORX_FREQ_GAIN_CORR_2048KBPS, 0);
10158         if (rc != 0) {
10159                 pr_err("error %d\n", rc);
10160                 goto rw_error;
10161         }
10162 
10163         /* Reset bits for timing and freq. recovery */
10164         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_RST_CPH__A, 0x0001, 0);
10165         if (rc != 0) {
10166                 pr_err("error %d\n", rc);
10167                 goto rw_error;
10168         }
10169         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_RST_CTI__A, 0x0002, 0);
10170         if (rc != 0) {
10171                 pr_err("error %d\n", rc);
10172                 goto rw_error;
10173         }
10174         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_RST_KRN__A, 0x0004, 0);
10175         if (rc != 0) {
10176                 pr_err("error %d\n", rc);
10177                 goto rw_error;
10178         }
10179         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_RST_KRP__A, 0x0008, 0);
10180         if (rc != 0) {
10181                 pr_err("error %d\n", rc);
10182                 goto rw_error;
10183         }
10184 
10185         /* AGN_LOCK = {2048>>3, -2048, 8, -8, 0, 1}; */
10186         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_AGN_LOCK_TH__A, 2048 >> 3, 0);
10187         if (rc != 0) {
10188                 pr_err("error %d\n", rc);
10189                 goto rw_error;
10190         }
10191         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_AGN_LOCK_TOTH__A, (u16)(-2048), 0);
10192         if (rc != 0) {
10193                 pr_err("error %d\n", rc);
10194                 goto rw_error;
10195         }
10196         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_AGN_ONLOCK_TTH__A, 8, 0);
10197         if (rc != 0) {
10198                 pr_err("error %d\n", rc);
10199                 goto rw_error;
10200         }
10201         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_AGN_UNLOCK_TTH__A, (u16)(-8), 0);
10202         if (rc != 0) {
10203                 pr_err("error %d\n", rc);
10204                 goto rw_error;
10205         }
10206         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_AGN_LOCK_MASK__A, 1, 0);
10207         if (rc != 0) {
10208                 pr_err("error %d\n", rc);
10209                 goto rw_error;
10210         }
10211 
10212         /* DGN_LOCK = {10, -2048, 8, -8, 0, 1<<1}; */
10213         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_DGN_LOCK_TH__A, 10, 0);
10214         if (rc != 0) {
10215                 pr_err("error %d\n", rc);
10216                 goto rw_error;
10217         }
10218         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_DGN_LOCK_TOTH__A, (u16)(-2048), 0);
10219         if (rc != 0) {
10220                 pr_err("error %d\n", rc);
10221                 goto rw_error;
10222         }
10223         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_DGN_ONLOCK_TTH__A, 8, 0);
10224         if (rc != 0) {
10225                 pr_err("error %d\n", rc);
10226                 goto rw_error;
10227         }
10228         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_DGN_UNLOCK_TTH__A, (u16)(-8), 0);
10229         if (rc != 0) {
10230                 pr_err("error %d\n", rc);
10231                 goto rw_error;
10232         }
10233         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_DGN_LOCK_MASK__A, 1 << 1, 0);
10234         if (rc != 0) {
10235                 pr_err("error %d\n", rc);
10236                 goto rw_error;
10237         }
10238 
10239         /* FRQ_LOCK = {15,-2048, 8, -8, 0, 1<<2}; */
10240         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_FRQ_LOCK_TH__A, 17, 0);
10241         if (rc != 0) {
10242                 pr_err("error %d\n", rc);
10243                 goto rw_error;
10244         }
10245         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_FRQ_LOCK_TOTH__A, (u16)(-2048), 0);
10246         if (rc != 0) {
10247                 pr_err("error %d\n", rc);
10248                 goto rw_error;
10249         }
10250         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_FRQ_ONLOCK_TTH__A, 8, 0);
10251         if (rc != 0) {
10252                 pr_err("error %d\n", rc);
10253                 goto rw_error;
10254         }
10255         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_FRQ_UNLOCK_TTH__A, (u16)(-8), 0);
10256         if (rc != 0) {
10257                 pr_err("error %d\n", rc);
10258                 goto rw_error;
10259         }
10260         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_FRQ_LOCK_MASK__A, 1 << 2, 0);
10261         if (rc != 0) {
10262                 pr_err("error %d\n", rc);
10263                 goto rw_error;
10264         }
10265 
10266         /* PHA_LOCK = {5000, -2048, 8, -8, 0, 1<<3}; */
10267         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_PHA_LOCK_TH__A, 3000, 0);
10268         if (rc != 0) {
10269                 pr_err("error %d\n", rc);
10270                 goto rw_error;
10271         }
10272         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_PHA_LOCK_TOTH__A, (u16)(-2048), 0);
10273         if (rc != 0) {
10274                 pr_err("error %d\n", rc);
10275                 goto rw_error;
10276         }
10277         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_PHA_ONLOCK_TTH__A, 8, 0);
10278         if (rc != 0) {
10279                 pr_err("error %d\n", rc);
10280                 goto rw_error;
10281         }
10282         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_PHA_UNLOCK_TTH__A, (u16)(-8), 0);
10283         if (rc != 0) {
10284                 pr_err("error %d\n", rc);
10285                 goto rw_error;
10286         }
10287         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_PHA_LOCK_MASK__A, 1 << 3, 0);
10288         if (rc != 0) {
10289                 pr_err("error %d\n", rc);
10290                 goto rw_error;
10291         }
10292 
10293         /* TIM_LOCK = {300,      -2048, 8, -8, 0, 1<<4}; */
10294         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_TIM_LOCK_TH__A, 400, 0);
10295         if (rc != 0) {
10296                 pr_err("error %d\n", rc);
10297                 goto rw_error;
10298         }
10299         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_TIM_LOCK_TOTH__A, (u16)(-2048), 0);
10300         if (rc != 0) {
10301                 pr_err("error %d\n", rc);
10302                 goto rw_error;
10303         }
10304         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_TIM_ONLOCK_TTH__A, 8, 0);
10305         if (rc != 0) {
10306                 pr_err("error %d\n", rc);
10307                 goto rw_error;
10308         }
10309         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_TIM_UNLOCK_TTH__A, (u16)(-8), 0);
10310         if (rc != 0) {
10311                 pr_err("error %d\n", rc);
10312                 goto rw_error;
10313         }
10314         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_TIM_LOCK_MASK__A, 1 << 4, 0);
10315         if (rc != 0) {
10316                 pr_err("error %d\n", rc);
10317                 goto rw_error;
10318         }
10319 
10320         /* EQU_LOCK = {20,      -2048, 8, -8, 0, 1<<5}; */
10321         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_EQU_LOCK_TH__A, 20, 0);
10322         if (rc != 0) {
10323                 pr_err("error %d\n", rc);
10324                 goto rw_error;
10325         }
10326         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_EQU_LOCK_TOTH__A, (u16)(-2048), 0);
10327         if (rc != 0) {
10328                 pr_err("error %d\n", rc);
10329                 goto rw_error;
10330         }
10331         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_EQU_ONLOCK_TTH__A, 4, 0);
10332         if (rc != 0) {
10333                 pr_err("error %d\n", rc);
10334                 goto rw_error;
10335         }
10336         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_EQU_UNLOCK_TTH__A, (u16)(-4), 0);
10337         if (rc != 0) {
10338                 pr_err("error %d\n", rc);
10339                 goto rw_error;
10340         }
10341         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_ORX_EQU_LOCK_MASK__A, 1 << 5, 0);
10342         if (rc != 0) {
10343                 pr_err("error %d\n", rc);
10344                 goto rw_error;
10345         }
10346 
10347         /* PRE-Filter coefficients (PFI) */
10348         rc = drxdap_fasi_write_block(dev_addr, ORX_FWP_PFI_A_W__A, sizeof(pfi_coeffs[mode_index]), ((u8 *)pfi_coeffs[mode_index]), 0);
10349         if (rc != 0) {
10350                 pr_err("error %d\n", rc);
10351                 goto rw_error;
10352         }
10353         rc = drxj_dap_write_reg16(dev_addr, ORX_TOP_MDE_W__A, mode_index, 0);
10354         if (rc != 0) {
10355                 pr_err("error %d\n", rc);
10356                 goto rw_error;
10357         }
10358 
10359         /* NYQUIST-Filter coefficients (NYQ) */
10360         for (i = 0; i < (NYQFILTERLEN + 1) / 2; i++) {
10361                 rc = drxj_dap_write_reg16(dev_addr, ORX_FWP_NYQ_ADR_W__A, i, 0);
10362                 if (rc != 0) {
10363                         pr_err("error %d\n", rc);
10364                         goto rw_error;
10365                 }
10366                 rc = drxj_dap_write_reg16(dev_addr, ORX_FWP_NYQ_COF_RW__A, nyquist_coeffs[mode_index][i], 0);
10367                 if (rc != 0) {
10368                         pr_err("error %d\n", rc);
10369                         goto rw_error;
10370                 }
10371         }
10372         rc = drxj_dap_write_reg16(dev_addr, ORX_FWP_NYQ_ADR_W__A, 31, 0);
10373         if (rc != 0) {
10374                 pr_err("error %d\n", rc);
10375                 goto rw_error;
10376         }
10377         rc = drxj_dap_write_reg16(dev_addr, ORX_COMM_EXEC__A, ORX_COMM_EXEC_ACTIVE, 0);
10378         if (rc != 0) {
10379                 pr_err("error %d\n", rc);
10380                 goto rw_error;
10381         }
10382         /********/
10383         /* Start */
10384         /********/
10385         scu_cmd.command = SCU_RAM_COMMAND_STANDARD_OOB
10386             | SCU_RAM_COMMAND_CMD_DEMOD_START;
10387         scu_cmd.parameter_len = 0;
10388         scu_cmd.result_len = 1;
10389         scu_cmd.result = cmd_result;
10390         rc = scu_command(dev_addr, &scu_cmd);
10391         if (rc != 0) {
10392                 pr_err("error %d\n", rc);
10393                 goto rw_error;
10394         }
10395 
10396         rc = set_orx_nsu_aox(demod, true);
10397         if (rc != 0) {
10398                 pr_err("error %d\n", rc);
10399                 goto rw_error;
10400         }
10401         rc = drxj_dap_write_reg16(dev_addr, ORX_NSU_AOX_STHR_W__A, ext_attr->oob_pre_saw, 0);
10402         if (rc != 0) {
10403                 pr_err("error %d\n", rc);
10404                 goto rw_error;
10405         }
10406 
10407         ext_attr->oob_power_on = true;
10408 
10409         return 0;
10410 rw_error:
10411         return rc;
10412 }
10413 
10414 /*============================================================================*/
10415 /*==                     END OOB DATAPATH FUNCTIONS                         ==*/
10416 /*============================================================================*/
10417 
10418 /*=============================================================================
10419   ===== MC command related functions ==========================================
10420   ===========================================================================*/
10421 
10422 /*=============================================================================
10423   ===== ctrl_set_channel() ==========================================================
10424   ===========================================================================*/
10425 /*
10426 * \fn int ctrl_set_channel()
10427 * \brief Select a new transmission channel.
10428 * \param demod instance of demod.
10429 * \param channel Pointer to channel data.
10430 * \return int.
10431 *
10432 * In case the tuner module is not used and in case of NTSC/FM the pogrammer
10433 * must tune the tuner to the centre frequency of the NTSC/FM channel.
10434 *
10435 */
10436 static int
10437 ctrl_set_channel(struct drx_demod_instance *demod, struct drx_channel *channel)
10438 {
10439         int rc;
10440         s32 tuner_freq_offset = 0;
10441         struct drxj_data *ext_attr = NULL;
10442         struct i2c_device_addr *dev_addr = NULL;
10443         enum drx_standard standard = DRX_STANDARD_UNKNOWN;
10444 #ifndef DRXJ_VSB_ONLY
10445         u32 min_symbol_rate = 0;
10446         u32 max_symbol_rate = 0;
10447         int bandwidth_temp = 0;
10448         int bandwidth = 0;
10449 #endif
10450    /*== check arguments ======================================================*/
10451         if ((demod == NULL) || (channel == NULL))
10452                 return -EINVAL;
10453 
10454         dev_addr = demod->my_i2c_dev_addr;
10455         ext_attr = (struct drxj_data *) demod->my_ext_attr;
10456         standard = ext_attr->standard;
10457 
10458         /* check valid standards */
10459         switch (standard) {
10460         case DRX_STANDARD_8VSB:
10461 #ifndef DRXJ_VSB_ONLY
10462         case DRX_STANDARD_ITU_A:
10463         case DRX_STANDARD_ITU_B:
10464         case DRX_STANDARD_ITU_C:
10465 #endif /* DRXJ_VSB_ONLY */
10466                 break;
10467         case DRX_STANDARD_UNKNOWN:
10468         default:
10469                 return -EINVAL;
10470         }
10471 
10472         /* check bandwidth QAM annex B, NTSC and 8VSB */
10473         if ((standard == DRX_STANDARD_ITU_B) ||
10474             (standard == DRX_STANDARD_8VSB) ||
10475             (standard == DRX_STANDARD_NTSC)) {
10476                 switch (channel->bandwidth) {
10477                 case DRX_BANDWIDTH_6MHZ:
10478                 case DRX_BANDWIDTH_UNKNOWN:     /* fall through */
10479                         channel->bandwidth = DRX_BANDWIDTH_6MHZ;
10480                         break;
10481                 case DRX_BANDWIDTH_8MHZ:        /* fall through */
10482                 case DRX_BANDWIDTH_7MHZ:        /* fall through */
10483                 default:
10484                         return -EINVAL;
10485                 }
10486         }
10487 
10488         /* For QAM annex A and annex C:
10489            -check symbolrate and constellation
10490            -derive bandwidth from symbolrate (input bandwidth is ignored)
10491          */
10492 #ifndef DRXJ_VSB_ONLY
10493         if ((standard == DRX_STANDARD_ITU_A) ||
10494             (standard == DRX_STANDARD_ITU_C)) {
10495                 struct drxuio_cfg uio_cfg = { DRX_UIO1, DRX_UIO_MODE_FIRMWARE_SAW };
10496                 int bw_rolloff_factor = 0;
10497 
10498                 bw_rolloff_factor = (standard == DRX_STANDARD_ITU_A) ? 115 : 113;
10499                 min_symbol_rate = DRXJ_QAM_SYMBOLRATE_MIN;
10500                 max_symbol_rate = DRXJ_QAM_SYMBOLRATE_MAX;
10501                 /* config SMA_TX pin to SAW switch mode */
10502                 rc = ctrl_set_uio_cfg(demod, &uio_cfg);
10503                 if (rc != 0) {
10504                         pr_err("error %d\n", rc);
10505                         goto rw_error;
10506                 }
10507 
10508                 if (channel->symbolrate < min_symbol_rate ||
10509                     channel->symbolrate > max_symbol_rate) {
10510                         return -EINVAL;
10511                 }
10512 
10513                 switch (channel->constellation) {
10514                 case DRX_CONSTELLATION_QAM16:   /* fall through */
10515                 case DRX_CONSTELLATION_QAM32:   /* fall through */
10516                 case DRX_CONSTELLATION_QAM64:   /* fall through */
10517                 case DRX_CONSTELLATION_QAM128:  /* fall through */
10518                 case DRX_CONSTELLATION_QAM256:
10519                         bandwidth_temp = channel->symbolrate * bw_rolloff_factor;
10520                         bandwidth = bandwidth_temp / 100;
10521 
10522                         if ((bandwidth_temp % 100) >= 50)
10523                                 bandwidth++;
10524 
10525                         if (bandwidth <= 6100000) {
10526                                 channel->bandwidth = DRX_BANDWIDTH_6MHZ;
10527                         } else if ((bandwidth > 6100000)
10528                                    && (bandwidth <= 7100000)) {
10529                                 channel->bandwidth = DRX_BANDWIDTH_7MHZ;
10530                         } else if (bandwidth > 7100000) {
10531                                 channel->bandwidth = DRX_BANDWIDTH_8MHZ;
10532                         }
10533                         break;
10534                 default:
10535                         return -EINVAL;
10536                 }
10537         }
10538 
10539         /* For QAM annex B:
10540            -check constellation
10541          */
10542         if (standard == DRX_STANDARD_ITU_B) {
10543                 switch (channel->constellation) {
10544                 case DRX_CONSTELLATION_AUTO:
10545                 case DRX_CONSTELLATION_QAM256:
10546                 case DRX_CONSTELLATION_QAM64:
10547                         break;
10548                 default:
10549                         return -EINVAL;
10550                 }
10551 
10552                 switch (channel->interleavemode) {
10553                 case DRX_INTERLEAVEMODE_I128_J1:
10554                 case DRX_INTERLEAVEMODE_I128_J1_V2:
10555                 case DRX_INTERLEAVEMODE_I128_J2:
10556                 case DRX_INTERLEAVEMODE_I64_J2:
10557                 case DRX_INTERLEAVEMODE_I128_J3:
10558                 case DRX_INTERLEAVEMODE_I32_J4:
10559                 case DRX_INTERLEAVEMODE_I128_J4:
10560                 case DRX_INTERLEAVEMODE_I16_J8:
10561                 case DRX_INTERLEAVEMODE_I128_J5:
10562                 case DRX_INTERLEAVEMODE_I8_J16:
10563                 case DRX_INTERLEAVEMODE_I128_J6:
10564                 case DRX_INTERLEAVEMODE_I128_J7:
10565                 case DRX_INTERLEAVEMODE_I128_J8:
10566                 case DRX_INTERLEAVEMODE_I12_J17:
10567                 case DRX_INTERLEAVEMODE_I5_J4:
10568                 case DRX_INTERLEAVEMODE_B52_M240:
10569                 case DRX_INTERLEAVEMODE_B52_M720:
10570                 case DRX_INTERLEAVEMODE_UNKNOWN:
10571                 case DRX_INTERLEAVEMODE_AUTO:
10572                         break;
10573                 default:
10574                         return -EINVAL;
10575                 }
10576         }
10577 
10578         if ((ext_attr->uio_sma_tx_mode) == DRX_UIO_MODE_FIRMWARE_SAW) {
10579                 /* SAW SW, user UIO is used for switchable SAW */
10580                 struct drxuio_data uio1 = { DRX_UIO1, false };
10581 
10582                 switch (channel->bandwidth) {
10583                 case DRX_BANDWIDTH_8MHZ:
10584                         uio1.value = true;
10585                         break;
10586                 case DRX_BANDWIDTH_7MHZ:
10587                         uio1.value = false;
10588                         break;
10589                 case DRX_BANDWIDTH_6MHZ:
10590                         uio1.value = false;
10591                         break;
10592                 case DRX_BANDWIDTH_UNKNOWN:
10593                 default:
10594                         return -EINVAL;
10595                 }
10596 
10597                 rc = ctrl_uio_write(demod, &uio1);
10598                 if (rc != 0) {
10599                         pr_err("error %d\n", rc);
10600                         goto rw_error;
10601                 }
10602         }
10603 #endif /* DRXJ_VSB_ONLY */
10604         rc = drxj_dap_write_reg16(dev_addr, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE, 0);
10605         if (rc != 0) {
10606                 pr_err("error %d\n", rc);
10607                 goto rw_error;
10608         }
10609 
10610         tuner_freq_offset = 0;
10611 
10612    /*== Setup demod for specific standard ====================================*/
10613         switch (standard) {
10614         case DRX_STANDARD_8VSB:
10615                 if (channel->mirror == DRX_MIRROR_AUTO)
10616                         ext_attr->mirror = DRX_MIRROR_NO;
10617                 else
10618                         ext_attr->mirror = channel->mirror;
10619                 rc = set_vsb(demod);
10620                 if (rc != 0) {
10621                         pr_err("error %d\n", rc);
10622                         goto rw_error;
10623                 }
10624                 rc = set_frequency(demod, channel, tuner_freq_offset);
10625                 if (rc != 0) {
10626                         pr_err("error %d\n", rc);
10627                         goto rw_error;
10628                 }
10629                 break;
10630 #ifndef DRXJ_VSB_ONLY
10631         case DRX_STANDARD_ITU_A:        /* fallthrough */
10632         case DRX_STANDARD_ITU_B:        /* fallthrough */
10633         case DRX_STANDARD_ITU_C:
10634                 rc = set_qam_channel(demod, channel, tuner_freq_offset);
10635                 if (rc != 0) {
10636                         pr_err("error %d\n", rc);
10637                         goto rw_error;
10638                 }
10639                 break;
10640 #endif
10641         case DRX_STANDARD_UNKNOWN:
10642         default:
10643                 return -EIO;
10644         }
10645 
10646         /* flag the packet error counter reset */
10647         ext_attr->reset_pkt_err_acc = true;
10648 
10649         return 0;
10650 rw_error:
10651         return rc;
10652 }
10653 
10654 /*=============================================================================
10655   ===== SigQuality() ==========================================================
10656   ===========================================================================*/
10657 
10658 /*
10659 * \fn int ctrl_sig_quality()
10660 * \brief Retrieve signal quality form device.
10661 * \param devmod Pointer to demodulator instance.
10662 * \param sig_quality Pointer to signal quality data.
10663 * \return int.
10664 * \retval 0 sig_quality contains valid data.
10665 * \retval -EINVAL sig_quality is NULL.
10666 * \retval -EIO Erroneous data, sig_quality contains invalid data.
10667 
10668 */
10669 static int
10670 ctrl_sig_quality(struct drx_demod_instance *demod,
10671                  enum drx_lock_status lock_status)
10672 {
10673         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
10674         struct drxj_data *ext_attr = demod->my_ext_attr;
10675         struct drx39xxj_state *state = dev_addr->user_data;
10676         struct dtv_frontend_properties *p = &state->frontend.dtv_property_cache;
10677         enum drx_standard standard = ext_attr->standard;
10678         int rc;
10679         u32 ber, cnt, err, pkt;
10680         u16 mer, strength = 0;
10681 
10682         rc = get_sig_strength(demod, &strength);
10683         if (rc < 0) {
10684                 pr_err("error getting signal strength %d\n", rc);
10685                 p->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
10686         } else {
10687                 p->strength.stat[0].scale = FE_SCALE_RELATIVE;
10688                 p->strength.stat[0].uvalue = 65535UL *  strength/ 100;
10689         }
10690 
10691         switch (standard) {
10692         case DRX_STANDARD_8VSB:
10693 #ifdef DRXJ_SIGNAL_ACCUM_ERR
10694                 rc = get_acc_pkt_err(demod, &pkt);
10695                 if (rc != 0) {
10696                         pr_err("error %d\n", rc);
10697                         goto rw_error;
10698                 }
10699 #endif
10700                 if (lock_status != DRXJ_DEMOD_LOCK && lock_status != DRX_LOCKED) {
10701                         p->pre_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
10702                         p->pre_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
10703                         p->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
10704                         p->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
10705                         p->block_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
10706                         p->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
10707                         p->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
10708                 } else {
10709                         rc = get_vsb_post_rs_pck_err(dev_addr, &err, &pkt);
10710                         if (rc != 0) {
10711                                 pr_err("error %d getting UCB\n", rc);
10712                                 p->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
10713                         } else {
10714                                 p->block_error.stat[0].scale = FE_SCALE_COUNTER;
10715                                 p->block_error.stat[0].uvalue += err;
10716                                 p->block_count.stat[0].scale = FE_SCALE_COUNTER;
10717                                 p->block_count.stat[0].uvalue += pkt;
10718                         }
10719 
10720                         /* PostViterbi is compute in steps of 10^(-6) */
10721                         rc = get_vs_bpre_viterbi_ber(dev_addr, &ber, &cnt);
10722                         if (rc != 0) {
10723                                 pr_err("error %d getting pre-ber\n", rc);
10724                                 p->pre_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
10725                         } else {
10726                                 p->pre_bit_error.stat[0].scale = FE_SCALE_COUNTER;
10727                                 p->pre_bit_error.stat[0].uvalue += ber;
10728                                 p->pre_bit_count.stat[0].scale = FE_SCALE_COUNTER;
10729                                 p->pre_bit_count.stat[0].uvalue += cnt;
10730                         }
10731 
10732                         rc = get_vs_bpost_viterbi_ber(dev_addr, &ber, &cnt);
10733                         if (rc != 0) {
10734                                 pr_err("error %d getting post-ber\n", rc);
10735                                 p->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
10736                         } else {
10737                                 p->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
10738                                 p->post_bit_error.stat[0].uvalue += ber;
10739                                 p->post_bit_count.stat[0].scale = FE_SCALE_COUNTER;
10740                                 p->post_bit_count.stat[0].uvalue += cnt;
10741                         }
10742                         rc = get_vsbmer(dev_addr, &mer);
10743                         if (rc != 0) {
10744                                 pr_err("error %d getting MER\n", rc);
10745                                 p->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
10746                         } else {
10747                                 p->cnr.stat[0].svalue = mer * 100;
10748                                 p->cnr.stat[0].scale = FE_SCALE_DECIBEL;
10749                         }
10750                 }
10751                 break;
10752 #ifndef DRXJ_VSB_ONLY
10753         case DRX_STANDARD_ITU_A:
10754         case DRX_STANDARD_ITU_B:
10755         case DRX_STANDARD_ITU_C:
10756                 rc = ctrl_get_qam_sig_quality(demod);
10757                 if (rc != 0) {
10758                         pr_err("error %d\n", rc);
10759                         goto rw_error;
10760                 }
10761                 break;
10762 #endif
10763         default:
10764                 return -EIO;
10765         }
10766 
10767         return 0;
10768 rw_error:
10769         return rc;
10770 }
10771 
10772 /*============================================================================*/
10773 
10774 /*
10775 * \fn int ctrl_lock_status()
10776 * \brief Retrieve lock status .
10777 * \param dev_addr Pointer to demodulator device address.
10778 * \param lock_stat Pointer to lock status structure.
10779 * \return int.
10780 *
10781 */
10782 static int
10783 ctrl_lock_status(struct drx_demod_instance *demod, enum drx_lock_status *lock_stat)
10784 {
10785         enum drx_standard standard = DRX_STANDARD_UNKNOWN;
10786         struct drxj_data *ext_attr = NULL;
10787         struct i2c_device_addr *dev_addr = NULL;
10788         struct drxjscu_cmd cmd_scu = { /* command      */ 0,
10789                 /* parameter_len */ 0,
10790                 /* result_len    */ 0,
10791                 /* *parameter   */ NULL,
10792                 /* *result      */ NULL
10793         };
10794         int rc;
10795         u16 cmd_result[2] = { 0, 0 };
10796         u16 demod_lock = SCU_RAM_PARAM_1_RES_DEMOD_GET_LOCK_DEMOD_LOCKED;
10797 
10798         /* check arguments */
10799         if ((demod == NULL) || (lock_stat == NULL))
10800                 return -EINVAL;
10801 
10802         dev_addr = demod->my_i2c_dev_addr;
10803         ext_attr = (struct drxj_data *) demod->my_ext_attr;
10804         standard = ext_attr->standard;
10805 
10806         *lock_stat = DRX_NOT_LOCKED;
10807 
10808         /* define the SCU command code */
10809         switch (standard) {
10810         case DRX_STANDARD_8VSB:
10811                 cmd_scu.command = SCU_RAM_COMMAND_STANDARD_VSB |
10812                     SCU_RAM_COMMAND_CMD_DEMOD_GET_LOCK;
10813                 demod_lock |= 0x6;
10814                 break;
10815 #ifndef DRXJ_VSB_ONLY
10816         case DRX_STANDARD_ITU_A:
10817         case DRX_STANDARD_ITU_B:
10818         case DRX_STANDARD_ITU_C:
10819                 cmd_scu.command = SCU_RAM_COMMAND_STANDARD_QAM |
10820                     SCU_RAM_COMMAND_CMD_DEMOD_GET_LOCK;
10821                 break;
10822 #endif
10823         case DRX_STANDARD_UNKNOWN:      /* fallthrough */
10824         default:
10825                 return -EIO;
10826         }
10827 
10828         /* define the SCU command parameters and execute the command */
10829         cmd_scu.parameter_len = 0;
10830         cmd_scu.result_len = 2;
10831         cmd_scu.parameter = NULL;
10832         cmd_scu.result = cmd_result;
10833         rc = scu_command(dev_addr, &cmd_scu);
10834         if (rc != 0) {
10835                 pr_err("error %d\n", rc);
10836                 goto rw_error;
10837         }
10838 
10839         /* set the lock status */
10840         if (cmd_scu.result[1] < demod_lock) {
10841                 /* 0x0000 NOT LOCKED */
10842                 *lock_stat = DRX_NOT_LOCKED;
10843         } else if (cmd_scu.result[1] < SCU_RAM_PARAM_1_RES_DEMOD_GET_LOCK_LOCKED) {
10844                 *lock_stat = DRXJ_DEMOD_LOCK;
10845         } else if (cmd_scu.result[1] <
10846                    SCU_RAM_PARAM_1_RES_DEMOD_GET_LOCK_NEVER_LOCK) {
10847                 /* 0x8000 DEMOD + FEC LOCKED (system lock) */
10848                 *lock_stat = DRX_LOCKED;
10849         } else {
10850                 /* 0xC000 NEVER LOCKED */
10851                 /* (system will never be able to lock to the signal) */
10852                 *lock_stat = DRX_NEVER_LOCK;
10853         }
10854 
10855         return 0;
10856 rw_error:
10857         return rc;
10858 }
10859 
10860 /*============================================================================*/
10861 
10862 /*
10863 * \fn int ctrl_set_standard()
10864 * \brief Set modulation standard to be used.
10865 * \param standard Modulation standard.
10866 * \return int.
10867 *
10868 * Setup stuff for the desired demodulation standard.
10869 * Disable and power down the previous selected demodulation standard
10870 *
10871 */
10872 static int
10873 ctrl_set_standard(struct drx_demod_instance *demod, enum drx_standard *standard)
10874 {
10875         struct drxj_data *ext_attr = NULL;
10876         int rc;
10877         enum drx_standard prev_standard;
10878 
10879         /* check arguments */
10880         if ((standard == NULL) || (demod == NULL))
10881                 return -EINVAL;
10882 
10883         ext_attr = (struct drxj_data *) demod->my_ext_attr;
10884         prev_standard = ext_attr->standard;
10885 
10886         /*
10887            Stop and power down previous standard
10888          */
10889         switch (prev_standard) {
10890 #ifndef DRXJ_VSB_ONLY
10891         case DRX_STANDARD_ITU_A:        /* fallthrough */
10892         case DRX_STANDARD_ITU_B:        /* fallthrough */
10893         case DRX_STANDARD_ITU_C:
10894                 rc = power_down_qam(demod, false);
10895                 if (rc != 0) {
10896                         pr_err("error %d\n", rc);
10897                         goto rw_error;
10898                 }
10899                 break;
10900 #endif
10901         case DRX_STANDARD_8VSB:
10902                 rc = power_down_vsb(demod, false);
10903                 if (rc != 0) {
10904                         pr_err("error %d\n", rc);
10905                         goto rw_error;
10906                 }
10907                 break;
10908         case DRX_STANDARD_UNKNOWN:
10909                 /* Do nothing */
10910                 break;
10911         case DRX_STANDARD_AUTO: /* fallthrough */
10912         default:
10913                 return -EINVAL;
10914         }
10915 
10916         /*
10917            Initialize channel independent registers
10918            Power up new standard
10919          */
10920         ext_attr->standard = *standard;
10921 
10922         switch (*standard) {
10923 #ifndef DRXJ_VSB_ONLY
10924         case DRX_STANDARD_ITU_A:        /* fallthrough */
10925         case DRX_STANDARD_ITU_B:        /* fallthrough */
10926         case DRX_STANDARD_ITU_C:
10927                 do {
10928                         u16 dummy;
10929                         rc = drxj_dap_read_reg16(demod->my_i2c_dev_addr, SCU_RAM_VERSION_HI__A, &dummy, 0);
10930                         if (rc != 0) {
10931                                 pr_err("error %d\n", rc);
10932                                 goto rw_error;
10933                         }
10934                 } while (0);
10935                 break;
10936 #endif
10937         case DRX_STANDARD_8VSB:
10938                 rc = set_vsb_leak_n_gain(demod);
10939                 if (rc != 0) {
10940                         pr_err("error %d\n", rc);
10941                         goto rw_error;
10942                 }
10943                 break;
10944         default:
10945                 ext_attr->standard = DRX_STANDARD_UNKNOWN;
10946                 return -EINVAL;
10947                 break;
10948         }
10949 
10950         return 0;
10951 rw_error:
10952         /* Don't know what the standard is now ... try again */
10953         ext_attr->standard = DRX_STANDARD_UNKNOWN;
10954         return rc;
10955 }
10956 
10957 /*============================================================================*/
10958 
10959 static void drxj_reset_mode(struct drxj_data *ext_attr)
10960 {
10961         /* Initialize default AFE configuration for QAM */
10962         if (ext_attr->has_lna) {
10963                 /* IF AGC off, PGA active */
10964 #ifndef DRXJ_VSB_ONLY
10965                 ext_attr->qam_if_agc_cfg.standard = DRX_STANDARD_ITU_B;
10966                 ext_attr->qam_if_agc_cfg.ctrl_mode = DRX_AGC_CTRL_OFF;
10967                 ext_attr->qam_pga_cfg = 140 + (11 * 13);
10968 #endif
10969                 ext_attr->vsb_if_agc_cfg.standard = DRX_STANDARD_8VSB;
10970                 ext_attr->vsb_if_agc_cfg.ctrl_mode = DRX_AGC_CTRL_OFF;
10971                 ext_attr->vsb_pga_cfg = 140 + (11 * 13);
10972         } else {
10973                 /* IF AGC on, PGA not active */
10974 #ifndef DRXJ_VSB_ONLY
10975                 ext_attr->qam_if_agc_cfg.standard = DRX_STANDARD_ITU_B;
10976                 ext_attr->qam_if_agc_cfg.ctrl_mode = DRX_AGC_CTRL_AUTO;
10977                 ext_attr->qam_if_agc_cfg.min_output_level = 0;
10978                 ext_attr->qam_if_agc_cfg.max_output_level = 0x7FFF;
10979                 ext_attr->qam_if_agc_cfg.speed = 3;
10980                 ext_attr->qam_if_agc_cfg.top = 1297;
10981                 ext_attr->qam_pga_cfg = 140;
10982 #endif
10983                 ext_attr->vsb_if_agc_cfg.standard = DRX_STANDARD_8VSB;
10984                 ext_attr->vsb_if_agc_cfg.ctrl_mode = DRX_AGC_CTRL_AUTO;
10985                 ext_attr->vsb_if_agc_cfg.min_output_level = 0;
10986                 ext_attr->vsb_if_agc_cfg.max_output_level = 0x7FFF;
10987                 ext_attr->vsb_if_agc_cfg.speed = 3;
10988                 ext_attr->vsb_if_agc_cfg.top = 1024;
10989                 ext_attr->vsb_pga_cfg = 140;
10990         }
10991         /* TODO: remove min_output_level and max_output_level for both QAM and VSB after */
10992         /* mc has not used them */
10993 #ifndef DRXJ_VSB_ONLY
10994         ext_attr->qam_rf_agc_cfg.standard = DRX_STANDARD_ITU_B;
10995         ext_attr->qam_rf_agc_cfg.ctrl_mode = DRX_AGC_CTRL_AUTO;
10996         ext_attr->qam_rf_agc_cfg.min_output_level = 0;
10997         ext_attr->qam_rf_agc_cfg.max_output_level = 0x7FFF;
10998         ext_attr->qam_rf_agc_cfg.speed = 3;
10999         ext_attr->qam_rf_agc_cfg.top = 9500;
11000         ext_attr->qam_rf_agc_cfg.cut_off_current = 4000;
11001         ext_attr->qam_pre_saw_cfg.standard = DRX_STANDARD_ITU_B;
11002         ext_attr->qam_pre_saw_cfg.reference = 0x07;
11003         ext_attr->qam_pre_saw_cfg.use_pre_saw = true;
11004 #endif
11005         /* Initialize default AFE configuration for VSB */
11006         ext_attr->vsb_rf_agc_cfg.standard = DRX_STANDARD_8VSB;
11007         ext_attr->vsb_rf_agc_cfg.ctrl_mode = DRX_AGC_CTRL_AUTO;
11008         ext_attr->vsb_rf_agc_cfg.min_output_level = 0;
11009         ext_attr->vsb_rf_agc_cfg.max_output_level = 0x7FFF;
11010         ext_attr->vsb_rf_agc_cfg.speed = 3;
11011         ext_attr->vsb_rf_agc_cfg.top = 9500;
11012         ext_attr->vsb_rf_agc_cfg.cut_off_current = 4000;
11013         ext_attr->vsb_pre_saw_cfg.standard = DRX_STANDARD_8VSB;
11014         ext_attr->vsb_pre_saw_cfg.reference = 0x07;
11015         ext_attr->vsb_pre_saw_cfg.use_pre_saw = true;
11016 }
11017 
11018 /*
11019 * \fn int ctrl_power_mode()
11020 * \brief Set the power mode of the device to the specified power mode
11021 * \param demod Pointer to demodulator instance.
11022 * \param mode  Pointer to new power mode.
11023 * \return int.
11024 * \retval 0          Success
11025 * \retval -EIO       I2C error or other failure
11026 * \retval -EINVAL Invalid mode argument.
11027 *
11028 *
11029 */
11030 static int
11031 ctrl_power_mode(struct drx_demod_instance *demod, enum drx_power_mode *mode)
11032 {
11033         struct drx_common_attr *common_attr = (struct drx_common_attr *) NULL;
11034         struct drxj_data *ext_attr = (struct drxj_data *) NULL;
11035         struct i2c_device_addr *dev_addr = (struct i2c_device_addr *)NULL;
11036         int rc;
11037         u16 sio_cc_pwd_mode = 0;
11038 
11039         common_attr = (struct drx_common_attr *) demod->my_common_attr;
11040         ext_attr = (struct drxj_data *) demod->my_ext_attr;
11041         dev_addr = demod->my_i2c_dev_addr;
11042 
11043         /* Check arguments */
11044         if (mode == NULL)
11045                 return -EINVAL;
11046 
11047         /* If already in requested power mode, do nothing */
11048         if (common_attr->current_power_mode == *mode)
11049                 return 0;
11050 
11051         switch (*mode) {
11052         case DRX_POWER_UP:
11053         case DRXJ_POWER_DOWN_MAIN_PATH:
11054                 sio_cc_pwd_mode = SIO_CC_PWD_MODE_LEVEL_NONE;
11055                 break;
11056         case DRXJ_POWER_DOWN_CORE:
11057                 sio_cc_pwd_mode = SIO_CC_PWD_MODE_LEVEL_CLOCK;
11058                 break;
11059         case DRXJ_POWER_DOWN_PLL:
11060                 sio_cc_pwd_mode = SIO_CC_PWD_MODE_LEVEL_PLL;
11061                 break;
11062         case DRX_POWER_DOWN:
11063                 sio_cc_pwd_mode = SIO_CC_PWD_MODE_LEVEL_OSC;
11064                 break;
11065         default:
11066                 /* Unknow sleep mode */
11067                 return -EINVAL;
11068                 break;
11069         }
11070 
11071         /* Check if device needs to be powered up */
11072         if ((common_attr->current_power_mode != DRX_POWER_UP)) {
11073                 rc = power_up_device(demod);
11074                 if (rc != 0) {
11075                         pr_err("error %d\n", rc);
11076                         goto rw_error;
11077                 }
11078         }
11079 
11080         if (*mode == DRX_POWER_UP) {
11081                 /* Restore analog & pin configuration */
11082 
11083                 /* Initialize default AFE configuration for VSB */
11084                 drxj_reset_mode(ext_attr);
11085         } else {
11086                 /* Power down to requested mode */
11087                 /* Backup some register settings */
11088                 /* Set pins with possible pull-ups connected to them in input mode */
11089                 /* Analog power down */
11090                 /* ADC power down */
11091                 /* Power down device */
11092                 /* stop all comm_exec */
11093                 /*
11094                    Stop and power down previous standard
11095                  */
11096 
11097                 switch (ext_attr->standard) {
11098                 case DRX_STANDARD_ITU_A:
11099                 case DRX_STANDARD_ITU_B:
11100                 case DRX_STANDARD_ITU_C:
11101                         rc = power_down_qam(demod, true);
11102                         if (rc != 0) {
11103                                 pr_err("error %d\n", rc);
11104                                 goto rw_error;
11105                         }
11106                         break;
11107                 case DRX_STANDARD_8VSB:
11108                         rc = power_down_vsb(demod, true);
11109                         if (rc != 0) {
11110                                 pr_err("error %d\n", rc);
11111                                 goto rw_error;
11112                         }
11113                         break;
11114                 case DRX_STANDARD_PAL_SECAM_BG: /* fallthrough */
11115                 case DRX_STANDARD_PAL_SECAM_DK: /* fallthrough */
11116                 case DRX_STANDARD_PAL_SECAM_I:  /* fallthrough */
11117                 case DRX_STANDARD_PAL_SECAM_L:  /* fallthrough */
11118                 case DRX_STANDARD_PAL_SECAM_LP: /* fallthrough */
11119                 case DRX_STANDARD_NTSC: /* fallthrough */
11120                 case DRX_STANDARD_FM:
11121                         rc = power_down_atv(demod, ext_attr->standard, true);
11122                         if (rc != 0) {
11123                                 pr_err("error %d\n", rc);
11124                                 goto rw_error;
11125                         }
11126                         break;
11127                 case DRX_STANDARD_UNKNOWN:
11128                         /* Do nothing */
11129                         break;
11130                 case DRX_STANDARD_AUTO: /* fallthrough */
11131                 default:
11132                         return -EIO;
11133                 }
11134                 ext_attr->standard = DRX_STANDARD_UNKNOWN;
11135         }
11136 
11137         if (*mode != DRXJ_POWER_DOWN_MAIN_PATH) {
11138                 rc = drxj_dap_write_reg16(dev_addr, SIO_CC_PWD_MODE__A, sio_cc_pwd_mode, 0);
11139                 if (rc != 0) {
11140                         pr_err("error %d\n", rc);
11141                         goto rw_error;
11142                 }
11143                 rc = drxj_dap_write_reg16(dev_addr, SIO_CC_UPDATE__A, SIO_CC_UPDATE_KEY, 0);
11144                 if (rc != 0) {
11145                         pr_err("error %d\n", rc);
11146                         goto rw_error;
11147                 }
11148 
11149                 if ((*mode != DRX_POWER_UP)) {
11150                         /* Initialize HI, wakeup key especially before put IC to sleep */
11151                         rc = init_hi(demod);
11152                         if (rc != 0) {
11153                                 pr_err("error %d\n", rc);
11154                                 goto rw_error;
11155                         }
11156 
11157                         ext_attr->hi_cfg_ctrl |= SIO_HI_RA_RAM_PAR_5_CFG_SLEEP_ZZZ;
11158                         rc = hi_cfg_command(demod);
11159                         if (rc != 0) {
11160                                 pr_err("error %d\n", rc);
11161                                 goto rw_error;
11162                         }
11163                 }
11164         }
11165 
11166         common_attr->current_power_mode = *mode;
11167 
11168         return 0;
11169 rw_error:
11170         return rc;
11171 }
11172 
11173 /*============================================================================*/
11174 /*== CTRL Set/Get Config related functions ===================================*/
11175 /*============================================================================*/
11176 
11177 /*
11178 * \fn int ctrl_set_cfg_pre_saw()
11179 * \brief Set Pre-saw reference.
11180 * \param demod demod instance
11181 * \param u16 *
11182 * \return int.
11183 *
11184 * Check arguments
11185 * Dispatch handling to standard specific function.
11186 *
11187 */
11188 static int
11189 ctrl_set_cfg_pre_saw(struct drx_demod_instance *demod, struct drxj_cfg_pre_saw *pre_saw)
11190 {
11191         struct i2c_device_addr *dev_addr = NULL;
11192         struct drxj_data *ext_attr = NULL;
11193         int rc;
11194 
11195         dev_addr = demod->my_i2c_dev_addr;
11196         ext_attr = (struct drxj_data *) demod->my_ext_attr;
11197 
11198         /* check arguments */
11199         if ((pre_saw == NULL) || (pre_saw->reference > IQM_AF_PDREF__M)
11200             ) {
11201                 return -EINVAL;
11202         }
11203 
11204         /* Only if standard is currently active */
11205         if ((ext_attr->standard == pre_saw->standard) ||
11206             (DRXJ_ISQAMSTD(ext_attr->standard) &&
11207              DRXJ_ISQAMSTD(pre_saw->standard)) ||
11208             (DRXJ_ISATVSTD(ext_attr->standard) &&
11209              DRXJ_ISATVSTD(pre_saw->standard))) {
11210                 rc = drxj_dap_write_reg16(dev_addr, IQM_AF_PDREF__A, pre_saw->reference, 0);
11211                 if (rc != 0) {
11212                         pr_err("error %d\n", rc);
11213                         goto rw_error;
11214                 }
11215         }
11216 
11217         /* Store pre-saw settings */
11218         switch (pre_saw->standard) {
11219         case DRX_STANDARD_8VSB:
11220                 ext_attr->vsb_pre_saw_cfg = *pre_saw;
11221                 break;
11222 #ifndef DRXJ_VSB_ONLY
11223         case DRX_STANDARD_ITU_A:        /* fallthrough */
11224         case DRX_STANDARD_ITU_B:        /* fallthrough */
11225         case DRX_STANDARD_ITU_C:
11226                 ext_attr->qam_pre_saw_cfg = *pre_saw;
11227                 break;
11228 #endif
11229         default:
11230                 return -EINVAL;
11231         }
11232 
11233         return 0;
11234 rw_error:
11235         return rc;
11236 }
11237 
11238 /*============================================================================*/
11239 
11240 /*
11241 * \fn int ctrl_set_cfg_afe_gain()
11242 * \brief Set AFE Gain.
11243 * \param demod demod instance
11244 * \param u16 *
11245 * \return int.
11246 *
11247 * Check arguments
11248 * Dispatch handling to standard specific function.
11249 *
11250 */
11251 static int
11252 ctrl_set_cfg_afe_gain(struct drx_demod_instance *demod, struct drxj_cfg_afe_gain *afe_gain)
11253 {
11254         struct i2c_device_addr *dev_addr = NULL;
11255         struct drxj_data *ext_attr = NULL;
11256         int rc;
11257         u8 gain = 0;
11258 
11259         /* check arguments */
11260         if (afe_gain == NULL)
11261                 return -EINVAL;
11262 
11263         dev_addr = demod->my_i2c_dev_addr;
11264         ext_attr = (struct drxj_data *) demod->my_ext_attr;
11265 
11266         switch (afe_gain->standard) {
11267         case DRX_STANDARD_8VSB: /* fallthrough */
11268 #ifndef DRXJ_VSB_ONLY
11269         case DRX_STANDARD_ITU_A:        /* fallthrough */
11270         case DRX_STANDARD_ITU_B:        /* fallthrough */
11271         case DRX_STANDARD_ITU_C:
11272 #endif
11273                 /* Do nothing */
11274                 break;
11275         default:
11276                 return -EINVAL;
11277         }
11278 
11279         /* TODO PGA gain is also written by microcode (at least by QAM and VSB)
11280            So I (PJ) think interface requires choice between auto, user mode */
11281 
11282         if (afe_gain->gain >= 329)
11283                 gain = 15;
11284         else if (afe_gain->gain <= 147)
11285                 gain = 0;
11286         else
11287                 gain = (afe_gain->gain - 140 + 6) / 13;
11288 
11289         /* Only if standard is currently active */
11290         if (ext_attr->standard == afe_gain->standard) {
11291                         rc = drxj_dap_write_reg16(dev_addr, IQM_AF_PGA_GAIN__A, gain, 0);
11292                         if (rc != 0) {
11293                                 pr_err("error %d\n", rc);
11294                                 goto rw_error;
11295                         }
11296                 }
11297 
11298         /* Store AFE Gain settings */
11299         switch (afe_gain->standard) {
11300         case DRX_STANDARD_8VSB:
11301                 ext_attr->vsb_pga_cfg = gain * 13 + 140;
11302                 break;
11303 #ifndef DRXJ_VSB_ONLY
11304         case DRX_STANDARD_ITU_A:        /* fallthrough */
11305         case DRX_STANDARD_ITU_B:        /* fallthrough */
11306         case DRX_STANDARD_ITU_C:
11307                 ext_attr->qam_pga_cfg = gain * 13 + 140;
11308                 break;
11309 #endif
11310         default:
11311                 return -EIO;
11312         }
11313 
11314         return 0;
11315 rw_error:
11316         return rc;
11317 }
11318 
11319 /*============================================================================*/
11320 
11321 
11322 /*=============================================================================
11323 ===== EXPORTED FUNCTIONS ====================================================*/
11324 
11325 static int drx_ctrl_u_code(struct drx_demod_instance *demod,
11326                        struct drxu_code_info *mc_info,
11327                        enum drxu_code_action action);
11328 static int drxj_set_lna_state(struct drx_demod_instance *demod, bool state);
11329 
11330 /*
11331 * \fn drxj_open()
11332 * \brief Open the demod instance, configure device, configure drxdriver
11333 * \return Status_t Return status.
11334 *
11335 * drxj_open() can be called with a NULL ucode image => no ucode upload.
11336 * This means that drxj_open() must NOT contain SCU commands or, in general,
11337 * rely on SCU or AUD ucode to be present.
11338 *
11339 */
11340 
11341 static int drxj_open(struct drx_demod_instance *demod)
11342 {
11343         struct i2c_device_addr *dev_addr = NULL;
11344         struct drxj_data *ext_attr = NULL;
11345         struct drx_common_attr *common_attr = NULL;
11346         u32 driver_version = 0;
11347         struct drxu_code_info ucode_info;
11348         struct drx_cfg_mpeg_output cfg_mpeg_output;
11349         int rc;
11350         enum drx_power_mode power_mode = DRX_POWER_UP;
11351 
11352         if ((demod == NULL) ||
11353             (demod->my_common_attr == NULL) ||
11354             (demod->my_ext_attr == NULL) ||
11355             (demod->my_i2c_dev_addr == NULL) ||
11356             (demod->my_common_attr->is_opened)) {
11357                 return -EINVAL;
11358         }
11359 
11360         /* Check arguments */
11361         if (demod->my_ext_attr == NULL)
11362                 return -EINVAL;
11363 
11364         dev_addr = demod->my_i2c_dev_addr;
11365         ext_attr = (struct drxj_data *) demod->my_ext_attr;
11366         common_attr = (struct drx_common_attr *) demod->my_common_attr;
11367 
11368         rc = ctrl_power_mode(demod, &power_mode);
11369         if (rc != 0) {
11370                 pr_err("error %d\n", rc);
11371                 goto rw_error;
11372         }
11373         if (power_mode != DRX_POWER_UP) {
11374                 rc = -EINVAL;
11375                 pr_err("failed to powerup device\n");
11376                 goto rw_error;
11377         }
11378 
11379         /* has to be in front of setIqmAf and setOrxNsuAox */
11380         rc = get_device_capabilities(demod);
11381         if (rc != 0) {
11382                 pr_err("error %d\n", rc);
11383                 goto rw_error;
11384         }
11385 
11386         /*
11387          * Soft reset of sys- and osc-clockdomain
11388          *
11389          * HACK: On windows, it writes a 0x07 here, instead of just 0x03.
11390          * As we didn't load the firmware here yet, we should do the same.
11391          * Btw, this is coherent with DRX-K, where we send reset codes
11392          * for modulation (OFTM, in DRX-k), SYS and OSC clock domains.
11393          */
11394         rc = drxj_dap_write_reg16(dev_addr, SIO_CC_SOFT_RST__A, (0x04 | SIO_CC_SOFT_RST_SYS__M | SIO_CC_SOFT_RST_OSC__M), 0);
11395         if (rc != 0) {
11396                 pr_err("error %d\n", rc);
11397                 goto rw_error;
11398         }
11399         rc = drxj_dap_write_reg16(dev_addr, SIO_CC_UPDATE__A, SIO_CC_UPDATE_KEY, 0);
11400         if (rc != 0) {
11401                 pr_err("error %d\n", rc);
11402                 goto rw_error;
11403         }
11404         msleep(1);
11405 
11406         /* TODO first make sure that everything keeps working before enabling this */
11407         /* PowerDownAnalogBlocks() */
11408         rc = drxj_dap_write_reg16(dev_addr, ATV_TOP_STDBY__A, (~ATV_TOP_STDBY_CVBS_STDBY_A2_ACTIVE) | ATV_TOP_STDBY_SIF_STDBY_STANDBY, 0);
11409         if (rc != 0) {
11410                 pr_err("error %d\n", rc);
11411                 goto rw_error;
11412         }
11413 
11414         rc = set_iqm_af(demod, false);
11415         if (rc != 0) {
11416                 pr_err("error %d\n", rc);
11417                 goto rw_error;
11418         }
11419         rc = set_orx_nsu_aox(demod, false);
11420         if (rc != 0) {
11421                 pr_err("error %d\n", rc);
11422                 goto rw_error;
11423         }
11424 
11425         rc = init_hi(demod);
11426         if (rc != 0) {
11427                 pr_err("error %d\n", rc);
11428                 goto rw_error;
11429         }
11430 
11431         /* disable mpegoutput pins */
11432         memcpy(&cfg_mpeg_output, &common_attr->mpeg_cfg, sizeof(cfg_mpeg_output));
11433         cfg_mpeg_output.enable_mpeg_output = false;
11434 
11435         rc = ctrl_set_cfg_mpeg_output(demod, &cfg_mpeg_output);
11436         if (rc != 0) {
11437                 pr_err("error %d\n", rc);
11438                 goto rw_error;
11439         }
11440         /* Stop AUD Inform SetAudio it will need to do all setting */
11441         rc = power_down_aud(demod);
11442         if (rc != 0) {
11443                 pr_err("error %d\n", rc);
11444                 goto rw_error;
11445         }
11446         /* Stop SCU */
11447         rc = drxj_dap_write_reg16(dev_addr, SCU_COMM_EXEC__A, SCU_COMM_EXEC_STOP, 0);
11448         if (rc != 0) {
11449                 pr_err("error %d\n", rc);
11450                 goto rw_error;
11451         }
11452 
11453         /* Upload microcode */
11454         if (common_attr->microcode_file != NULL) {
11455                 /* Dirty trick to use common ucode upload & verify,
11456                    pretend device is already open */
11457                 common_attr->is_opened = true;
11458                 ucode_info.mc_file = common_attr->microcode_file;
11459 
11460                 if (DRX_ISPOWERDOWNMODE(demod->my_common_attr->current_power_mode)) {
11461                         pr_err("Should powerup before loading the firmware.");
11462                         return -EINVAL;
11463                 }
11464 
11465                 rc = drx_ctrl_u_code(demod, &ucode_info, UCODE_UPLOAD);
11466                 if (rc != 0) {
11467                         pr_err("error %d while uploading the firmware\n", rc);
11468                         goto rw_error;
11469                 }
11470                 if (common_attr->verify_microcode == true) {
11471                         rc = drx_ctrl_u_code(demod, &ucode_info, UCODE_VERIFY);
11472                         if (rc != 0) {
11473                                 pr_err("error %d while verifying the firmware\n",
11474                                        rc);
11475                                 goto rw_error;
11476                         }
11477                 }
11478                 common_attr->is_opened = false;
11479         }
11480 
11481         /* Run SCU for a little while to initialize microcode version numbers */
11482         rc = drxj_dap_write_reg16(dev_addr, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE, 0);
11483         if (rc != 0) {
11484                 pr_err("error %d\n", rc);
11485                 goto rw_error;
11486         }
11487 
11488         /* Initialize scan timeout */
11489         common_attr->scan_demod_lock_timeout = DRXJ_SCAN_TIMEOUT;
11490         common_attr->scan_desired_lock = DRX_LOCKED;
11491 
11492         drxj_reset_mode(ext_attr);
11493         ext_attr->standard = DRX_STANDARD_UNKNOWN;
11494 
11495         rc = smart_ant_init(demod);
11496         if (rc != 0) {
11497                 pr_err("error %d\n", rc);
11498                 goto rw_error;
11499         }
11500 
11501         /* Stamp driver version number in SCU data RAM in BCD code
11502            Done to enable field application engineers to retrieve drxdriver version
11503            via I2C from SCU RAM
11504          */
11505         driver_version = (VERSION_MAJOR / 100) % 10;
11506         driver_version <<= 4;
11507         driver_version += (VERSION_MAJOR / 10) % 10;
11508         driver_version <<= 4;
11509         driver_version += (VERSION_MAJOR % 10);
11510         driver_version <<= 4;
11511         driver_version += (VERSION_MINOR % 10);
11512         driver_version <<= 4;
11513         driver_version += (VERSION_PATCH / 1000) % 10;
11514         driver_version <<= 4;
11515         driver_version += (VERSION_PATCH / 100) % 10;
11516         driver_version <<= 4;
11517         driver_version += (VERSION_PATCH / 10) % 10;
11518         driver_version <<= 4;
11519         driver_version += (VERSION_PATCH % 10);
11520         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_DRIVER_VER_HI__A, (u16)(driver_version >> 16), 0);
11521         if (rc != 0) {
11522                 pr_err("error %d\n", rc);
11523                 goto rw_error;
11524         }
11525         rc = drxj_dap_write_reg16(dev_addr, SCU_RAM_DRIVER_VER_LO__A, (u16)(driver_version & 0xFFFF), 0);
11526         if (rc != 0) {
11527                 pr_err("error %d\n", rc);
11528                 goto rw_error;
11529         }
11530 
11531         rc = ctrl_set_oob(demod, NULL);
11532         if (rc != 0) {
11533                 pr_err("error %d\n", rc);
11534                 goto rw_error;
11535         }
11536 
11537         /* refresh the audio data structure with default */
11538         ext_attr->aud_data = drxj_default_aud_data_g;
11539 
11540         demod->my_common_attr->is_opened = true;
11541         drxj_set_lna_state(demod, false);
11542         return 0;
11543 rw_error:
11544         common_attr->is_opened = false;
11545         return rc;
11546 }
11547 
11548 /*============================================================================*/
11549 /*
11550 * \fn drxj_close()
11551 * \brief Close the demod instance, power down the device
11552 * \return Status_t Return status.
11553 *
11554 */
11555 static int drxj_close(struct drx_demod_instance *demod)
11556 {
11557         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
11558         int rc;
11559         enum drx_power_mode power_mode = DRX_POWER_UP;
11560 
11561         if ((demod->my_common_attr == NULL) ||
11562             (demod->my_ext_attr == NULL) ||
11563             (demod->my_i2c_dev_addr == NULL) ||
11564             (!demod->my_common_attr->is_opened)) {
11565                 return -EINVAL;
11566         }
11567 
11568         /* power up */
11569         rc = ctrl_power_mode(demod, &power_mode);
11570         if (rc != 0) {
11571                 pr_err("error %d\n", rc);
11572                 goto rw_error;
11573         }
11574 
11575         rc = drxj_dap_write_reg16(dev_addr, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE, 0);
11576         if (rc != 0) {
11577                 pr_err("error %d\n", rc);
11578                 goto rw_error;
11579         }
11580         power_mode = DRX_POWER_DOWN;
11581         rc = ctrl_power_mode(demod, &power_mode);
11582         if (rc != 0) {
11583                 pr_err("error %d\n", rc);
11584                 goto rw_error;
11585         }
11586 
11587         DRX_ATTR_ISOPENED(demod) = false;
11588 
11589         return 0;
11590 rw_error:
11591         DRX_ATTR_ISOPENED(demod) = false;
11592 
11593         return rc;
11594 }
11595 
11596 /*
11597  * Microcode related functions
11598  */
11599 
11600 /*
11601  * drx_u_code_compute_crc       - Compute CRC of block of microcode data.
11602  * @block_data: Pointer to microcode data.
11603  * @nr_words:   Size of microcode block (number of 16 bits words).
11604  *
11605  * returns The computed CRC residue.
11606  */
11607 static u16 drx_u_code_compute_crc(u8 *block_data, u16 nr_words)
11608 {
11609         u16 i = 0;
11610         u16 j = 0;
11611         u32 crc_word = 0;
11612         u32 carry = 0;
11613 
11614         while (i < nr_words) {
11615                 crc_word |= (u32)be16_to_cpu(*(__be16 *)(block_data));
11616                 for (j = 0; j < 16; j++) {
11617                         crc_word <<= 1;
11618                         if (carry != 0)
11619                                 crc_word ^= 0x80050000UL;
11620                         carry = crc_word & 0x80000000UL;
11621                 }
11622                 i++;
11623                 block_data += (sizeof(u16));
11624         }
11625         return (u16)(crc_word >> 16);
11626 }
11627 
11628 /*
11629  * drx_check_firmware - checks if the loaded firmware is valid
11630  *
11631  * @demod:      demod structure
11632  * @mc_data:    pointer to the start of the firmware
11633  * @size:       firmware size
11634  */
11635 static int drx_check_firmware(struct drx_demod_instance *demod, u8 *mc_data,
11636                           unsigned size)
11637 {
11638         struct drxu_code_block_hdr block_hdr;
11639         int i;
11640         unsigned count = 2 * sizeof(u16);
11641         u32 mc_dev_type, mc_version, mc_base_version;
11642         u16 mc_nr_of_blks = be16_to_cpu(*(__be16 *)(mc_data + sizeof(u16)));
11643 
11644         /*
11645          * Scan microcode blocks first for version info
11646          * and firmware check
11647          */
11648 
11649         /* Clear version block */
11650         DRX_ATTR_MCRECORD(demod).aux_type = 0;
11651         DRX_ATTR_MCRECORD(demod).mc_dev_type = 0;
11652         DRX_ATTR_MCRECORD(demod).mc_version = 0;
11653         DRX_ATTR_MCRECORD(demod).mc_base_version = 0;
11654 
11655         for (i = 0; i < mc_nr_of_blks; i++) {
11656                 if (count + 3 * sizeof(u16) + sizeof(u32) > size)
11657                         goto eof;
11658 
11659                 /* Process block header */
11660                 block_hdr.addr = be32_to_cpu(*(__be32 *)(mc_data + count));
11661                 count += sizeof(u32);
11662                 block_hdr.size = be16_to_cpu(*(__be16 *)(mc_data + count));
11663                 count += sizeof(u16);
11664                 block_hdr.flags = be16_to_cpu(*(__be16 *)(mc_data + count));
11665                 count += sizeof(u16);
11666                 block_hdr.CRC = be16_to_cpu(*(__be16 *)(mc_data + count));
11667                 count += sizeof(u16);
11668 
11669                 pr_debug("%u: addr %u, size %u, flags 0x%04x, CRC 0x%04x\n",
11670                         count, block_hdr.addr, block_hdr.size, block_hdr.flags,
11671                         block_hdr.CRC);
11672 
11673                 if (block_hdr.flags & 0x8) {
11674                         u8 *auxblk = ((void *)mc_data) + block_hdr.addr;
11675                         u16 auxtype;
11676 
11677                         if (block_hdr.addr + sizeof(u16) > size)
11678                                 goto eof;
11679 
11680                         auxtype = be16_to_cpu(*(__be16 *)(auxblk));
11681 
11682                         /* Aux block. Check type */
11683                         if (DRX_ISMCVERTYPE(auxtype)) {
11684                                 if (block_hdr.addr + 2 * sizeof(u16) + 2 * sizeof (u32) > size)
11685                                         goto eof;
11686 
11687                                 auxblk += sizeof(u16);
11688                                 mc_dev_type = be32_to_cpu(*(__be32 *)(auxblk));
11689                                 auxblk += sizeof(u32);
11690                                 mc_version = be32_to_cpu(*(__be32 *)(auxblk));
11691                                 auxblk += sizeof(u32);
11692                                 mc_base_version = be32_to_cpu(*(__be32 *)(auxblk));
11693 
11694                                 DRX_ATTR_MCRECORD(demod).aux_type = auxtype;
11695                                 DRX_ATTR_MCRECORD(demod).mc_dev_type = mc_dev_type;
11696                                 DRX_ATTR_MCRECORD(demod).mc_version = mc_version;
11697                                 DRX_ATTR_MCRECORD(demod).mc_base_version = mc_base_version;
11698 
11699                                 pr_info("Firmware dev %x, ver %x, base ver %x\n",
11700                                         mc_dev_type, mc_version, mc_base_version);
11701 
11702                         }
11703                 } else if (count + block_hdr.size * sizeof(u16) > size)
11704                         goto eof;
11705 
11706                 count += block_hdr.size * sizeof(u16);
11707         }
11708         return 0;
11709 eof:
11710         pr_err("Firmware is truncated at pos %u/%u\n", count, size);
11711         return -EINVAL;
11712 }
11713 
11714 /*
11715  * drx_ctrl_u_code - Handle microcode upload or verify.
11716  * @dev_addr: Address of device.
11717  * @mc_info:  Pointer to information about microcode data.
11718  * @action:  Either UCODE_UPLOAD or UCODE_VERIFY
11719  *
11720  * This function returns:
11721  *      0:
11722  *              - In case of UCODE_UPLOAD: code is successfully uploaded.
11723  *               - In case of UCODE_VERIFY: image on device is equal to
11724  *                image provided to this control function.
11725  *      -EIO:
11726  *              - In case of UCODE_UPLOAD: I2C error.
11727  *              - In case of UCODE_VERIFY: I2C error or image on device
11728  *                is not equal to image provided to this control function.
11729  *      -EINVAL:
11730  *              - Invalid arguments.
11731  *              - Provided image is corrupt
11732  */
11733 static int drx_ctrl_u_code(struct drx_demod_instance *demod,
11734                        struct drxu_code_info *mc_info,
11735                        enum drxu_code_action action)
11736 {
11737         struct i2c_device_addr *dev_addr = demod->my_i2c_dev_addr;
11738         int rc;
11739         u16 i = 0;
11740         u16 mc_nr_of_blks = 0;
11741         u16 mc_magic_word = 0;
11742         const u8 *mc_data_init = NULL;
11743         u8 *mc_data = NULL;
11744         unsigned size;
11745         char *mc_file;
11746 
11747         /* Check arguments */
11748         if (!mc_info || !mc_info->mc_file)
11749                 return -EINVAL;
11750 
11751         mc_file = mc_info->mc_file;
11752 
11753         if (!demod->firmware) {
11754                 const struct firmware *fw = NULL;
11755 
11756                 rc = request_firmware(&fw, mc_file, demod->i2c->dev.parent);
11757                 if (rc < 0) {
11758                         pr_err("Couldn't read firmware %s\n", mc_file);
11759                         return rc;
11760                 }
11761                 demod->firmware = fw;
11762 
11763                 if (demod->firmware->size < 2 * sizeof(u16)) {
11764                         rc = -EINVAL;
11765                         pr_err("Firmware is too short!\n");
11766                         goto release;
11767                 }
11768 
11769                 pr_info("Firmware %s, size %zu\n",
11770                         mc_file, demod->firmware->size);
11771         }
11772 
11773         mc_data_init = demod->firmware->data;
11774         size = demod->firmware->size;
11775 
11776         mc_data = (void *)mc_data_init;
11777         /* Check data */
11778         mc_magic_word = be16_to_cpu(*(__be16 *)(mc_data));
11779         mc_data += sizeof(u16);
11780         mc_nr_of_blks = be16_to_cpu(*(__be16 *)(mc_data));
11781         mc_data += sizeof(u16);
11782 
11783         if ((mc_magic_word != DRX_UCODE_MAGIC_WORD) || (mc_nr_of_blks == 0)) {
11784                 rc = -EINVAL;
11785                 pr_err("Firmware magic word doesn't match\n");
11786                 goto release;
11787         }
11788 
11789         if (action == UCODE_UPLOAD) {
11790                 rc = drx_check_firmware(demod, (u8 *)mc_data_init, size);
11791                 if (rc)
11792                         goto release;
11793                 pr_info("Uploading firmware %s\n", mc_file);
11794         } else {
11795                 pr_info("Verifying if firmware upload was ok.\n");
11796         }
11797 
11798         /* Process microcode blocks */
11799         for (i = 0; i < mc_nr_of_blks; i++) {
11800                 struct drxu_code_block_hdr block_hdr;
11801                 u16 mc_block_nr_bytes = 0;
11802 
11803                 /* Process block header */
11804                 block_hdr.addr = be32_to_cpu(*(__be32 *)(mc_data));
11805                 mc_data += sizeof(u32);
11806                 block_hdr.size = be16_to_cpu(*(__be16 *)(mc_data));
11807                 mc_data += sizeof(u16);
11808                 block_hdr.flags = be16_to_cpu(*(__be16 *)(mc_data));
11809                 mc_data += sizeof(u16);
11810                 block_hdr.CRC = be16_to_cpu(*(__be16 *)(mc_data));
11811                 mc_data += sizeof(u16);
11812 
11813                 pr_debug("%zd: addr %u, size %u, flags 0x%04x, CRC 0x%04x\n",
11814                         (mc_data - mc_data_init), block_hdr.addr,
11815                          block_hdr.size, block_hdr.flags, block_hdr.CRC);
11816 
11817                 /* Check block header on:
11818                    - data larger than 64Kb
11819                    - if CRC enabled check CRC
11820                  */
11821                 if ((block_hdr.size > 0x7FFF) ||
11822                     (((block_hdr.flags & DRX_UCODE_CRC_FLAG) != 0) &&
11823                      (block_hdr.CRC != drx_u_code_compute_crc(mc_data, block_hdr.size)))
11824                     ) {
11825                         /* Wrong data ! */
11826                         rc = -EINVAL;
11827                         pr_err("firmware CRC is wrong\n");
11828                         goto release;
11829                 }
11830 
11831                 if (!block_hdr.size)
11832                         continue;
11833 
11834                 mc_block_nr_bytes = block_hdr.size * ((u16) sizeof(u16));
11835 
11836                 /* Perform the desired action */
11837                 switch (action) {
11838                 case UCODE_UPLOAD:      /* Upload microcode */
11839                         if (drxdap_fasi_write_block(dev_addr,
11840                                                         block_hdr.addr,
11841                                                         mc_block_nr_bytes,
11842                                                         mc_data, 0x0000)) {
11843                                 rc = -EIO;
11844                                 pr_err("error writing firmware at pos %zd\n",
11845                                        mc_data - mc_data_init);
11846                                 goto release;
11847                         }
11848                         break;
11849                 case UCODE_VERIFY: {    /* Verify uploaded microcode */
11850                         int result = 0;
11851                         u8 mc_data_buffer[DRX_UCODE_MAX_BUF_SIZE];
11852                         u32 bytes_to_comp = 0;
11853                         u32 bytes_left = mc_block_nr_bytes;
11854                         u32 curr_addr = block_hdr.addr;
11855                         u8 *curr_ptr = mc_data;
11856 
11857                         while (bytes_left != 0) {
11858                                 if (bytes_left > DRX_UCODE_MAX_BUF_SIZE)
11859                                         bytes_to_comp = DRX_UCODE_MAX_BUF_SIZE;
11860                                 else
11861                                         bytes_to_comp = bytes_left;
11862 
11863                                 if (drxdap_fasi_read_block(dev_addr,
11864                                                     curr_addr,
11865                                                     (u16)bytes_to_comp,
11866                                                     (u8 *)mc_data_buffer,
11867                                                     0x0000)) {
11868                                         pr_err("error reading firmware at pos %zd\n",
11869                                                mc_data - mc_data_init);
11870                                         return -EIO;
11871                                 }
11872 
11873                                 result = memcmp(curr_ptr, mc_data_buffer,
11874                                                 bytes_to_comp);
11875 
11876                                 if (result) {
11877                                         pr_err("error verifying firmware at pos %zd\n",
11878                                                mc_data - mc_data_init);
11879                                         return -EIO;
11880                                 }
11881 
11882                                 curr_addr += ((dr_xaddr_t)(bytes_to_comp / 2));
11883                                 curr_ptr =&(curr_ptr[bytes_to_comp]);
11884                                 bytes_left -=((u32) bytes_to_comp);
11885                         }
11886                         break;
11887                 }
11888                 default:
11889                         return -EINVAL;
11890                         break;
11891 
11892                 }
11893                 mc_data += mc_block_nr_bytes;
11894         }
11895 
11896         return 0;
11897 
11898 release:
11899         release_firmware(demod->firmware);
11900         demod->firmware = NULL;
11901 
11902         return rc;
11903 }
11904 
11905 /* caller is expected to check if lna is supported before enabling */
11906 static int drxj_set_lna_state(struct drx_demod_instance *demod, bool state)
11907 {
11908         struct drxuio_cfg uio_cfg;
11909         struct drxuio_data uio_data;
11910         int result;
11911 
11912         uio_cfg.uio = DRX_UIO1;
11913         uio_cfg.mode = DRX_UIO_MODE_READWRITE;
11914         /* Configure user-I/O #3: enable read/write */
11915         result = ctrl_set_uio_cfg(demod, &uio_cfg);
11916         if (result) {
11917                 pr_err("Failed to setup LNA GPIO!\n");
11918                 return result;
11919         }
11920 
11921         uio_data.uio = DRX_UIO1;
11922         uio_data.value = state;
11923         result = ctrl_uio_write(demod, &uio_data);
11924         if (result != 0) {
11925                 pr_err("Failed to %sable LNA!\n",
11926                        state ? "en" : "dis");
11927                 return result;
11928         }
11929         return 0;
11930 }
11931 
11932 /*
11933  * The Linux DVB Driver for Micronas DRX39xx family (drx3933j)
11934  *
11935  * Written by Devin Heitmueller <devin.heitmueller@kernellabs.com>
11936  */
11937 
11938 static int drx39xxj_set_powerstate(struct dvb_frontend *fe, int enable)
11939 {
11940         struct drx39xxj_state *state = fe->demodulator_priv;
11941         struct drx_demod_instance *demod = state->demod;
11942         int result;
11943         enum drx_power_mode power_mode;
11944 
11945         if (enable)
11946                 power_mode = DRX_POWER_UP;
11947         else
11948                 power_mode = DRX_POWER_DOWN;
11949 
11950         result = ctrl_power_mode(demod, &power_mode);
11951         if (result != 0) {
11952                 pr_err("Power state change failed\n");
11953                 return 0;
11954         }
11955 
11956         return 0;
11957 }
11958 
11959 static int drx39xxj_read_status(struct dvb_frontend *fe, enum fe_status *status)
11960 {
11961         struct drx39xxj_state *state = fe->demodulator_priv;
11962         struct drx_demod_instance *demod = state->demod;
11963         int result;
11964         enum drx_lock_status lock_status;
11965 
11966         *status = 0;
11967 
11968         result = ctrl_lock_status(demod, &lock_status);
11969         if (result != 0) {
11970                 pr_err("drx39xxj: could not get lock status!\n");
11971                 *status = 0;
11972         }
11973 
11974         switch (lock_status) {
11975         case DRX_NEVER_LOCK:
11976                 *status = 0;
11977                 pr_err("drx says NEVER_LOCK\n");
11978                 break;
11979         case DRX_NOT_LOCKED:
11980                 *status = 0;
11981                 break;
11982         case DRX_LOCK_STATE_1:
11983         case DRX_LOCK_STATE_2:
11984         case DRX_LOCK_STATE_3:
11985         case DRX_LOCK_STATE_4:
11986         case DRX_LOCK_STATE_5:
11987         case DRX_LOCK_STATE_6:
11988         case DRX_LOCK_STATE_7:
11989         case DRX_LOCK_STATE_8:
11990         case DRX_LOCK_STATE_9:
11991                 *status = FE_HAS_SIGNAL
11992                     | FE_HAS_CARRIER | FE_HAS_VITERBI | FE_HAS_SYNC;
11993                 break;
11994         case DRX_LOCKED:
11995                 *status = FE_HAS_SIGNAL
11996                     | FE_HAS_CARRIER
11997                     | FE_HAS_VITERBI | FE_HAS_SYNC | FE_HAS_LOCK;
11998                 break;
11999         default:
12000                 pr_err("Lock state unknown %d\n", lock_status);
12001         }
12002         ctrl_sig_quality(demod, lock_status);
12003 
12004         return 0;
12005 }
12006 
12007 static int drx39xxj_read_ber(struct dvb_frontend *fe, u32 *ber)
12008 {
12009         struct dtv_frontend_properties *p = &fe->dtv_property_cache;
12010 
12011         if (p->pre_bit_error.stat[0].scale == FE_SCALE_NOT_AVAILABLE) {
12012                 *ber = 0;
12013                 return 0;
12014         }
12015 
12016         if (!p->pre_bit_count.stat[0].uvalue) {
12017                 if (!p->pre_bit_error.stat[0].uvalue)
12018                         *ber = 0;
12019                 else
12020                         *ber = 1000000;
12021         } else {
12022                 *ber = frac_times1e6(p->pre_bit_error.stat[0].uvalue,
12023                                      p->pre_bit_count.stat[0].uvalue);
12024         }
12025         return 0;
12026 }
12027 
12028 static int drx39xxj_read_signal_strength(struct dvb_frontend *fe,
12029                                          u16 *strength)
12030 {
12031         struct dtv_frontend_properties *p = &fe->dtv_property_cache;
12032 
12033         if (p->strength.stat[0].scale == FE_SCALE_NOT_AVAILABLE) {
12034                 *strength = 0;
12035                 return 0;
12036         }
12037 
12038         *strength = p->strength.stat[0].uvalue;
12039         return 0;
12040 }
12041 
12042 static int drx39xxj_read_snr(struct dvb_frontend *fe, u16 *snr)
12043 {
12044         struct dtv_frontend_properties *p = &fe->dtv_property_cache;
12045         u64 tmp64;
12046 
12047         if (p->cnr.stat[0].scale == FE_SCALE_NOT_AVAILABLE) {
12048                 *snr = 0;
12049                 return 0;
12050         }
12051 
12052         tmp64 = p->cnr.stat[0].svalue;
12053         do_div(tmp64, 10);
12054         *snr = tmp64;
12055         return 0;
12056 }
12057 
12058 static int drx39xxj_read_ucblocks(struct dvb_frontend *fe, u32 *ucb)
12059 {
12060         struct dtv_frontend_properties *p = &fe->dtv_property_cache;
12061 
12062         if (p->block_error.stat[0].scale == FE_SCALE_NOT_AVAILABLE) {
12063                 *ucb = 0;
12064                 return 0;
12065         }
12066 
12067         *ucb = p->block_error.stat[0].uvalue;
12068         return 0;
12069 }
12070 
12071 static int drx39xxj_set_frontend(struct dvb_frontend *fe)
12072 {
12073 #ifdef DJH_DEBUG
12074         int i;
12075 #endif
12076         struct dtv_frontend_properties *p = &fe->dtv_property_cache;
12077         struct drx39xxj_state *state = fe->demodulator_priv;
12078         struct drx_demod_instance *demod = state->demod;
12079         enum drx_standard standard = DRX_STANDARD_8VSB;
12080         struct drx_channel channel;
12081         int result;
12082         static const struct drx_channel def_channel = {
12083                 /* frequency      */ 0,
12084                 /* bandwidth      */ DRX_BANDWIDTH_6MHZ,
12085                 /* mirror         */ DRX_MIRROR_NO,
12086                 /* constellation  */ DRX_CONSTELLATION_AUTO,
12087                 /* hierarchy      */ DRX_HIERARCHY_UNKNOWN,
12088                 /* priority       */ DRX_PRIORITY_UNKNOWN,
12089                 /* coderate       */ DRX_CODERATE_UNKNOWN,
12090                 /* guard          */ DRX_GUARD_UNKNOWN,
12091                 /* fftmode        */ DRX_FFTMODE_UNKNOWN,
12092                 /* classification */ DRX_CLASSIFICATION_AUTO,
12093                 /* symbolrate     */ 5057000,
12094                 /* interleavemode */ DRX_INTERLEAVEMODE_UNKNOWN,
12095                 /* ldpc           */ DRX_LDPC_UNKNOWN,
12096                 /* carrier        */ DRX_CARRIER_UNKNOWN,
12097                 /* frame mode     */ DRX_FRAMEMODE_UNKNOWN
12098         };
12099         u32 constellation = DRX_CONSTELLATION_AUTO;
12100 
12101         /* Bring the demod out of sleep */
12102         drx39xxj_set_powerstate(fe, 1);
12103 
12104         if (fe->ops.tuner_ops.set_params) {
12105                 u32 int_freq;
12106 
12107                 if (fe->ops.i2c_gate_ctrl)
12108                         fe->ops.i2c_gate_ctrl(fe, 1);
12109 
12110                 /* Set tuner to desired frequency and standard */
12111                 fe->ops.tuner_ops.set_params(fe);
12112 
12113                 /* Use the tuner's IF */
12114                 if (fe->ops.tuner_ops.get_if_frequency) {
12115                         fe->ops.tuner_ops.get_if_frequency(fe, &int_freq);
12116                         demod->my_common_attr->intermediate_freq = int_freq / 1000;
12117                 }
12118 
12119                 if (fe->ops.i2c_gate_ctrl)
12120                         fe->ops.i2c_gate_ctrl(fe, 0);
12121         }
12122 
12123         switch (p->delivery_system) {
12124         case SYS_ATSC:
12125                 standard = DRX_STANDARD_8VSB;
12126                 break;
12127         case SYS_DVBC_ANNEX_B:
12128                 standard = DRX_STANDARD_ITU_B;
12129 
12130                 switch (p->modulation) {
12131                 case QAM_64:
12132                         constellation = DRX_CONSTELLATION_QAM64;
12133                         break;
12134                 case QAM_256:
12135                         constellation = DRX_CONSTELLATION_QAM256;
12136                         break;
12137                 default:
12138                         constellation = DRX_CONSTELLATION_AUTO;
12139                         break;
12140                 }
12141                 break;
12142         default:
12143                 return -EINVAL;
12144         }
12145         /* Set the standard (will be powered up if necessary */
12146         result = ctrl_set_standard(demod, &standard);
12147         if (result != 0) {
12148                 pr_err("Failed to set standard! result=%02x\n",
12149                         result);
12150                 return -EINVAL;
12151         }
12152 
12153         /* set channel parameters */
12154         channel = def_channel;
12155         channel.frequency = p->frequency / 1000;
12156         channel.bandwidth = DRX_BANDWIDTH_6MHZ;
12157         channel.constellation = constellation;
12158 
12159         /* program channel */
12160         result = ctrl_set_channel(demod, &channel);
12161         if (result != 0) {
12162                 pr_err("Failed to set channel!\n");
12163                 return -EINVAL;
12164         }
12165         /* Just for giggles, let's shut off the LNA again.... */
12166         drxj_set_lna_state(demod, false);
12167 
12168         /* After set_frontend, except for strength, stats aren't available */
12169         p->strength.stat[0].scale = FE_SCALE_RELATIVE;
12170 
12171         return 0;
12172 }
12173 
12174 static int drx39xxj_sleep(struct dvb_frontend *fe)
12175 {
12176         /* power-down the demodulator */
12177         return drx39xxj_set_powerstate(fe, 0);
12178 }
12179 
12180 static int drx39xxj_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
12181 {
12182         struct drx39xxj_state *state = fe->demodulator_priv;
12183         struct drx_demod_instance *demod = state->demod;
12184         bool i2c_gate_state;
12185         int result;
12186 
12187 #ifdef DJH_DEBUG
12188         pr_debug("i2c gate call: enable=%d state=%d\n", enable,
12189                state->i2c_gate_open);
12190 #endif
12191 
12192         if (enable)
12193                 i2c_gate_state = true;
12194         else
12195                 i2c_gate_state = false;
12196 
12197         if (state->i2c_gate_open == enable) {
12198                 /* We're already in the desired state */
12199                 return 0;
12200         }
12201 
12202         result = ctrl_i2c_bridge(demod, &i2c_gate_state);
12203         if (result != 0) {
12204                 pr_err("drx39xxj: could not open i2c gate [%d]\n",
12205                        result);
12206                 dump_stack();
12207         } else {
12208                 state->i2c_gate_open = enable;
12209         }
12210         return 0;
12211 }
12212 
12213 static int drx39xxj_init(struct dvb_frontend *fe)
12214 {
12215         struct drx39xxj_state *state = fe->demodulator_priv;
12216         struct drx_demod_instance *demod = state->demod;
12217         int rc = 0;
12218 
12219         if (fe->exit == DVB_FE_DEVICE_RESUME) {
12220                 /* so drxj_open() does what it needs to do */
12221                 demod->my_common_attr->is_opened = false;
12222                 rc = drxj_open(demod);
12223                 if (rc != 0)
12224                         pr_err("drx39xxj_init(): DRX open failed rc=%d!\n", rc);
12225         } else
12226                 drx39xxj_set_powerstate(fe, 1);
12227 
12228         return rc;
12229 }
12230 
12231 static int drx39xxj_set_lna(struct dvb_frontend *fe)
12232 {
12233         struct dtv_frontend_properties *c = &fe->dtv_property_cache;
12234         struct drx39xxj_state *state = fe->demodulator_priv;
12235         struct drx_demod_instance *demod = state->demod;
12236         struct drxj_data *ext_attr = demod->my_ext_attr;
12237 
12238         if (c->lna) {
12239                 if (!ext_attr->has_lna) {
12240                         pr_err("LNA is not supported on this device!\n");
12241                         return -EINVAL;
12242 
12243                 }
12244         }
12245 
12246         return drxj_set_lna_state(demod, c->lna);
12247 }
12248 
12249 static int drx39xxj_get_tune_settings(struct dvb_frontend *fe,
12250                                       struct dvb_frontend_tune_settings *tune)
12251 {
12252         tune->min_delay_ms = 1000;
12253         return 0;
12254 }
12255 
12256 static void drx39xxj_release(struct dvb_frontend *fe)
12257 {
12258         struct drx39xxj_state *state = fe->demodulator_priv;
12259         struct drx_demod_instance *demod = state->demod;
12260 
12261         /* if device is removed don't access it */
12262         if (fe->exit != DVB_FE_DEVICE_REMOVED)
12263                 drxj_close(demod);
12264 
12265         kfree(demod->my_ext_attr);
12266         kfree(demod->my_common_attr);
12267         kfree(demod->my_i2c_dev_addr);
12268         release_firmware(demod->firmware);
12269         kfree(demod);
12270         kfree(state);
12271 }
12272 
12273 static const struct dvb_frontend_ops drx39xxj_ops;
12274 
12275 struct dvb_frontend *drx39xxj_attach(struct i2c_adapter *i2c)
12276 {
12277         struct drx39xxj_state *state = NULL;
12278         struct i2c_device_addr *demod_addr = NULL;
12279         struct drx_common_attr *demod_comm_attr = NULL;
12280         struct drxj_data *demod_ext_attr = NULL;
12281         struct drx_demod_instance *demod = NULL;
12282         struct dtv_frontend_properties *p;
12283         int result;
12284 
12285         /* allocate memory for the internal state */
12286         state = kzalloc(sizeof(struct drx39xxj_state), GFP_KERNEL);
12287         if (state == NULL)
12288                 goto error;
12289 
12290         demod = kmemdup(&drxj_default_demod_g,
12291                         sizeof(struct drx_demod_instance), GFP_KERNEL);
12292         if (demod == NULL)
12293                 goto error;
12294 
12295         demod_addr = kmemdup(&drxj_default_addr_g,
12296                              sizeof(struct i2c_device_addr), GFP_KERNEL);
12297         if (demod_addr == NULL)
12298                 goto error;
12299 
12300         demod_comm_attr = kmemdup(&drxj_default_comm_attr_g,
12301                                   sizeof(struct drx_common_attr), GFP_KERNEL);
12302         if (demod_comm_attr == NULL)
12303                 goto error;
12304 
12305         demod_ext_attr = kmemdup(&drxj_data_g, sizeof(struct drxj_data),
12306                                  GFP_KERNEL);
12307         if (demod_ext_attr == NULL)
12308                 goto error;
12309 
12310         /* setup the state */
12311         state->i2c = i2c;
12312         state->demod = demod;
12313 
12314         /* setup the demod data */
12315         demod->my_i2c_dev_addr = demod_addr;
12316         demod->my_common_attr = demod_comm_attr;
12317         demod->my_i2c_dev_addr->user_data = state;
12318         demod->my_common_attr->microcode_file = DRX39XX_MAIN_FIRMWARE;
12319         demod->my_common_attr->verify_microcode = true;
12320         demod->my_common_attr->intermediate_freq = 5000;
12321         demod->my_common_attr->current_power_mode = DRX_POWER_DOWN;
12322         demod->my_ext_attr = demod_ext_attr;
12323         ((struct drxj_data *)demod_ext_attr)->uio_sma_tx_mode = DRX_UIO_MODE_READWRITE;
12324         demod->i2c = i2c;
12325 
12326         result = drxj_open(demod);
12327         if (result != 0) {
12328                 pr_err("DRX open failed!  Aborting\n");
12329                 goto error;
12330         }
12331 
12332         /* create dvb_frontend */
12333         memcpy(&state->frontend.ops, &drx39xxj_ops,
12334                sizeof(struct dvb_frontend_ops));
12335 
12336         state->frontend.demodulator_priv = state;
12337 
12338         /* Initialize stats - needed for DVBv5 stats to work */
12339         p = &state->frontend.dtv_property_cache;
12340         p->strength.len = 1;
12341         p->pre_bit_count.len = 1;
12342         p->pre_bit_error.len = 1;
12343         p->post_bit_count.len = 1;
12344         p->post_bit_error.len = 1;
12345         p->block_count.len = 1;
12346         p->block_error.len = 1;
12347         p->cnr.len = 1;
12348 
12349         p->strength.stat[0].scale = FE_SCALE_RELATIVE;
12350         p->pre_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
12351         p->pre_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
12352         p->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
12353         p->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
12354         p->block_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
12355         p->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
12356         p->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
12357 
12358         return &state->frontend;
12359 
12360 error:
12361         kfree(demod_ext_attr);
12362         kfree(demod_comm_attr);
12363         kfree(demod_addr);
12364         kfree(demod);
12365         kfree(state);
12366 
12367         return NULL;
12368 }
12369 EXPORT_SYMBOL(drx39xxj_attach);
12370 
12371 static const struct dvb_frontend_ops drx39xxj_ops = {
12372         .delsys = { SYS_ATSC, SYS_DVBC_ANNEX_B },
12373         .info = {
12374                  .name = "Micronas DRX39xxj family Frontend",
12375                  .frequency_min_hz =  51 * MHz,
12376                  .frequency_max_hz = 858 * MHz,
12377                  .frequency_stepsize_hz = 62500,
12378                  .caps = FE_CAN_QAM_64 | FE_CAN_QAM_256 | FE_CAN_8VSB
12379         },
12380 
12381         .init = drx39xxj_init,
12382         .i2c_gate_ctrl = drx39xxj_i2c_gate_ctrl,
12383         .sleep = drx39xxj_sleep,
12384         .set_frontend = drx39xxj_set_frontend,
12385         .get_tune_settings = drx39xxj_get_tune_settings,
12386         .read_status = drx39xxj_read_status,
12387         .read_ber = drx39xxj_read_ber,
12388         .read_signal_strength = drx39xxj_read_signal_strength,
12389         .read_snr = drx39xxj_read_snr,
12390         .read_ucblocks = drx39xxj_read_ucblocks,
12391         .release = drx39xxj_release,
12392         .set_lna = drx39xxj_set_lna,
12393 };
12394 
12395 MODULE_DESCRIPTION("Micronas DRX39xxj Frontend");
12396 MODULE_AUTHOR("Devin Heitmueller");
12397 MODULE_LICENSE("GPL");
12398 MODULE_FIRMWARE(DRX39XX_MAIN_FIRMWARE);

/* [<][>][^][v][top][bottom][index][help] */