18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci Driver for Zarlink VP310/MT312/ZL10313 Satellite Channel Decoder 48c2ecf20Sopenharmony_ci 58c2ecf20Sopenharmony_ci Copyright (C) 2003 Andreas Oberritter <obi@linuxtv.org> 68c2ecf20Sopenharmony_ci Copyright (C) 2008 Matthias Schwarzott <zzam@gentoo.org> 78c2ecf20Sopenharmony_ci 88c2ecf20Sopenharmony_ci 98c2ecf20Sopenharmony_ci References: 108c2ecf20Sopenharmony_ci http://products.zarlink.com/product_profiles/MT312.htm 118c2ecf20Sopenharmony_ci http://products.zarlink.com/product_profiles/SL1935.htm 128c2ecf20Sopenharmony_ci*/ 138c2ecf20Sopenharmony_ci 148c2ecf20Sopenharmony_ci#include <linux/delay.h> 158c2ecf20Sopenharmony_ci#include <linux/errno.h> 168c2ecf20Sopenharmony_ci#include <linux/init.h> 178c2ecf20Sopenharmony_ci#include <linux/kernel.h> 188c2ecf20Sopenharmony_ci#include <linux/module.h> 198c2ecf20Sopenharmony_ci#include <linux/string.h> 208c2ecf20Sopenharmony_ci#include <linux/slab.h> 218c2ecf20Sopenharmony_ci 228c2ecf20Sopenharmony_ci#include <media/dvb_frontend.h> 238c2ecf20Sopenharmony_ci#include "mt312_priv.h" 248c2ecf20Sopenharmony_ci#include "mt312.h" 258c2ecf20Sopenharmony_ci 268c2ecf20Sopenharmony_ci/* Max transfer size done by I2C transfer functions */ 278c2ecf20Sopenharmony_ci#define MAX_XFER_SIZE 64 288c2ecf20Sopenharmony_ci 298c2ecf20Sopenharmony_cistruct mt312_state { 308c2ecf20Sopenharmony_ci struct i2c_adapter *i2c; 318c2ecf20Sopenharmony_ci /* configuration settings */ 328c2ecf20Sopenharmony_ci const struct mt312_config *config; 338c2ecf20Sopenharmony_ci struct dvb_frontend frontend; 348c2ecf20Sopenharmony_ci 358c2ecf20Sopenharmony_ci u8 id; 368c2ecf20Sopenharmony_ci unsigned long xtal; 378c2ecf20Sopenharmony_ci u8 freq_mult; 388c2ecf20Sopenharmony_ci}; 398c2ecf20Sopenharmony_ci 408c2ecf20Sopenharmony_cistatic int debug; 418c2ecf20Sopenharmony_ci#define dprintk(args...) \ 428c2ecf20Sopenharmony_ci do { \ 438c2ecf20Sopenharmony_ci if (debug) \ 448c2ecf20Sopenharmony_ci printk(KERN_DEBUG "mt312: " args); \ 458c2ecf20Sopenharmony_ci } while (0) 468c2ecf20Sopenharmony_ci 478c2ecf20Sopenharmony_ci#define MT312_PLL_CLK 10000000UL /* 10 MHz */ 488c2ecf20Sopenharmony_ci#define MT312_PLL_CLK_10_111 10111000UL /* 10.111 MHz */ 498c2ecf20Sopenharmony_ci 508c2ecf20Sopenharmony_cistatic int mt312_read(struct mt312_state *state, const enum mt312_reg_addr reg, 518c2ecf20Sopenharmony_ci u8 *buf, const size_t count) 528c2ecf20Sopenharmony_ci{ 538c2ecf20Sopenharmony_ci int ret; 548c2ecf20Sopenharmony_ci struct i2c_msg msg[2]; 558c2ecf20Sopenharmony_ci u8 regbuf[1] = { reg }; 568c2ecf20Sopenharmony_ci 578c2ecf20Sopenharmony_ci msg[0].addr = state->config->demod_address; 588c2ecf20Sopenharmony_ci msg[0].flags = 0; 598c2ecf20Sopenharmony_ci msg[0].buf = regbuf; 608c2ecf20Sopenharmony_ci msg[0].len = 1; 618c2ecf20Sopenharmony_ci msg[1].addr = state->config->demod_address; 628c2ecf20Sopenharmony_ci msg[1].flags = I2C_M_RD; 638c2ecf20Sopenharmony_ci msg[1].buf = buf; 648c2ecf20Sopenharmony_ci msg[1].len = count; 658c2ecf20Sopenharmony_ci 668c2ecf20Sopenharmony_ci ret = i2c_transfer(state->i2c, msg, 2); 678c2ecf20Sopenharmony_ci 688c2ecf20Sopenharmony_ci if (ret != 2) { 698c2ecf20Sopenharmony_ci printk(KERN_DEBUG "%s: ret == %d\n", __func__, ret); 708c2ecf20Sopenharmony_ci return -EREMOTEIO; 718c2ecf20Sopenharmony_ci } 728c2ecf20Sopenharmony_ci 738c2ecf20Sopenharmony_ci if (debug) { 748c2ecf20Sopenharmony_ci int i; 758c2ecf20Sopenharmony_ci dprintk("R(%d):", reg & 0x7f); 768c2ecf20Sopenharmony_ci for (i = 0; i < count; i++) 778c2ecf20Sopenharmony_ci printk(KERN_CONT " %02x", buf[i]); 788c2ecf20Sopenharmony_ci printk("\n"); 798c2ecf20Sopenharmony_ci } 808c2ecf20Sopenharmony_ci 818c2ecf20Sopenharmony_ci return 0; 828c2ecf20Sopenharmony_ci} 838c2ecf20Sopenharmony_ci 848c2ecf20Sopenharmony_cistatic int mt312_write(struct mt312_state *state, const enum mt312_reg_addr reg, 858c2ecf20Sopenharmony_ci const u8 *src, const size_t count) 868c2ecf20Sopenharmony_ci{ 878c2ecf20Sopenharmony_ci int ret; 888c2ecf20Sopenharmony_ci u8 buf[MAX_XFER_SIZE]; 898c2ecf20Sopenharmony_ci struct i2c_msg msg; 908c2ecf20Sopenharmony_ci 918c2ecf20Sopenharmony_ci if (1 + count > sizeof(buf)) { 928c2ecf20Sopenharmony_ci printk(KERN_WARNING 938c2ecf20Sopenharmony_ci "mt312: write: len=%zu is too big!\n", count); 948c2ecf20Sopenharmony_ci return -EINVAL; 958c2ecf20Sopenharmony_ci } 968c2ecf20Sopenharmony_ci 978c2ecf20Sopenharmony_ci if (debug) { 988c2ecf20Sopenharmony_ci int i; 998c2ecf20Sopenharmony_ci dprintk("W(%d):", reg & 0x7f); 1008c2ecf20Sopenharmony_ci for (i = 0; i < count; i++) 1018c2ecf20Sopenharmony_ci printk(KERN_CONT " %02x", src[i]); 1028c2ecf20Sopenharmony_ci printk("\n"); 1038c2ecf20Sopenharmony_ci } 1048c2ecf20Sopenharmony_ci 1058c2ecf20Sopenharmony_ci buf[0] = reg; 1068c2ecf20Sopenharmony_ci memcpy(&buf[1], src, count); 1078c2ecf20Sopenharmony_ci 1088c2ecf20Sopenharmony_ci msg.addr = state->config->demod_address; 1098c2ecf20Sopenharmony_ci msg.flags = 0; 1108c2ecf20Sopenharmony_ci msg.buf = buf; 1118c2ecf20Sopenharmony_ci msg.len = count + 1; 1128c2ecf20Sopenharmony_ci 1138c2ecf20Sopenharmony_ci ret = i2c_transfer(state->i2c, &msg, 1); 1148c2ecf20Sopenharmony_ci 1158c2ecf20Sopenharmony_ci if (ret != 1) { 1168c2ecf20Sopenharmony_ci dprintk("%s: ret == %d\n", __func__, ret); 1178c2ecf20Sopenharmony_ci return -EREMOTEIO; 1188c2ecf20Sopenharmony_ci } 1198c2ecf20Sopenharmony_ci 1208c2ecf20Sopenharmony_ci return 0; 1218c2ecf20Sopenharmony_ci} 1228c2ecf20Sopenharmony_ci 1238c2ecf20Sopenharmony_cistatic inline int mt312_readreg(struct mt312_state *state, 1248c2ecf20Sopenharmony_ci const enum mt312_reg_addr reg, u8 *val) 1258c2ecf20Sopenharmony_ci{ 1268c2ecf20Sopenharmony_ci return mt312_read(state, reg, val, 1); 1278c2ecf20Sopenharmony_ci} 1288c2ecf20Sopenharmony_ci 1298c2ecf20Sopenharmony_cistatic inline int mt312_writereg(struct mt312_state *state, 1308c2ecf20Sopenharmony_ci const enum mt312_reg_addr reg, const u8 val) 1318c2ecf20Sopenharmony_ci{ 1328c2ecf20Sopenharmony_ci u8 tmp = val; /* see gcc.gnu.org/bugzilla/show_bug.cgi?id=81715 */ 1338c2ecf20Sopenharmony_ci 1348c2ecf20Sopenharmony_ci 1358c2ecf20Sopenharmony_ci return mt312_write(state, reg, &tmp, 1); 1368c2ecf20Sopenharmony_ci} 1378c2ecf20Sopenharmony_ci 1388c2ecf20Sopenharmony_cistatic int mt312_reset(struct mt312_state *state, const u8 full) 1398c2ecf20Sopenharmony_ci{ 1408c2ecf20Sopenharmony_ci return mt312_writereg(state, RESET, full ? 0x80 : 0x40); 1418c2ecf20Sopenharmony_ci} 1428c2ecf20Sopenharmony_ci 1438c2ecf20Sopenharmony_cistatic int mt312_get_inversion(struct mt312_state *state, 1448c2ecf20Sopenharmony_ci enum fe_spectral_inversion *i) 1458c2ecf20Sopenharmony_ci{ 1468c2ecf20Sopenharmony_ci int ret; 1478c2ecf20Sopenharmony_ci u8 vit_mode; 1488c2ecf20Sopenharmony_ci 1498c2ecf20Sopenharmony_ci ret = mt312_readreg(state, VIT_MODE, &vit_mode); 1508c2ecf20Sopenharmony_ci if (ret < 0) 1518c2ecf20Sopenharmony_ci return ret; 1528c2ecf20Sopenharmony_ci 1538c2ecf20Sopenharmony_ci if (vit_mode & 0x80) /* auto inversion was used */ 1548c2ecf20Sopenharmony_ci *i = (vit_mode & 0x40) ? INVERSION_ON : INVERSION_OFF; 1558c2ecf20Sopenharmony_ci 1568c2ecf20Sopenharmony_ci return 0; 1578c2ecf20Sopenharmony_ci} 1588c2ecf20Sopenharmony_ci 1598c2ecf20Sopenharmony_cistatic int mt312_get_symbol_rate(struct mt312_state *state, u32 *sr) 1608c2ecf20Sopenharmony_ci{ 1618c2ecf20Sopenharmony_ci int ret; 1628c2ecf20Sopenharmony_ci u8 sym_rate_h; 1638c2ecf20Sopenharmony_ci u8 dec_ratio; 1648c2ecf20Sopenharmony_ci u16 sym_rat_op; 1658c2ecf20Sopenharmony_ci u16 monitor; 1668c2ecf20Sopenharmony_ci u8 buf[2]; 1678c2ecf20Sopenharmony_ci 1688c2ecf20Sopenharmony_ci ret = mt312_readreg(state, SYM_RATE_H, &sym_rate_h); 1698c2ecf20Sopenharmony_ci if (ret < 0) 1708c2ecf20Sopenharmony_ci return ret; 1718c2ecf20Sopenharmony_ci 1728c2ecf20Sopenharmony_ci if (sym_rate_h & 0x80) { 1738c2ecf20Sopenharmony_ci /* symbol rate search was used */ 1748c2ecf20Sopenharmony_ci ret = mt312_writereg(state, MON_CTRL, 0x03); 1758c2ecf20Sopenharmony_ci if (ret < 0) 1768c2ecf20Sopenharmony_ci return ret; 1778c2ecf20Sopenharmony_ci 1788c2ecf20Sopenharmony_ci ret = mt312_read(state, MONITOR_H, buf, sizeof(buf)); 1798c2ecf20Sopenharmony_ci if (ret < 0) 1808c2ecf20Sopenharmony_ci return ret; 1818c2ecf20Sopenharmony_ci 1828c2ecf20Sopenharmony_ci monitor = (buf[0] << 8) | buf[1]; 1838c2ecf20Sopenharmony_ci 1848c2ecf20Sopenharmony_ci dprintk("sr(auto) = %u\n", 1858c2ecf20Sopenharmony_ci DIV_ROUND_CLOSEST(monitor * 15625, 4)); 1868c2ecf20Sopenharmony_ci } else { 1878c2ecf20Sopenharmony_ci ret = mt312_writereg(state, MON_CTRL, 0x05); 1888c2ecf20Sopenharmony_ci if (ret < 0) 1898c2ecf20Sopenharmony_ci return ret; 1908c2ecf20Sopenharmony_ci 1918c2ecf20Sopenharmony_ci ret = mt312_read(state, MONITOR_H, buf, sizeof(buf)); 1928c2ecf20Sopenharmony_ci if (ret < 0) 1938c2ecf20Sopenharmony_ci return ret; 1948c2ecf20Sopenharmony_ci 1958c2ecf20Sopenharmony_ci dec_ratio = ((buf[0] >> 5) & 0x07) * 32; 1968c2ecf20Sopenharmony_ci 1978c2ecf20Sopenharmony_ci ret = mt312_read(state, SYM_RAT_OP_H, buf, sizeof(buf)); 1988c2ecf20Sopenharmony_ci if (ret < 0) 1998c2ecf20Sopenharmony_ci return ret; 2008c2ecf20Sopenharmony_ci 2018c2ecf20Sopenharmony_ci sym_rat_op = (buf[0] << 8) | buf[1]; 2028c2ecf20Sopenharmony_ci 2038c2ecf20Sopenharmony_ci dprintk("sym_rat_op=%d dec_ratio=%d\n", 2048c2ecf20Sopenharmony_ci sym_rat_op, dec_ratio); 2058c2ecf20Sopenharmony_ci dprintk("*sr(manual) = %lu\n", 2068c2ecf20Sopenharmony_ci (((state->xtal * 8192) / (sym_rat_op + 8192)) * 2078c2ecf20Sopenharmony_ci 2) - dec_ratio); 2088c2ecf20Sopenharmony_ci } 2098c2ecf20Sopenharmony_ci 2108c2ecf20Sopenharmony_ci return 0; 2118c2ecf20Sopenharmony_ci} 2128c2ecf20Sopenharmony_ci 2138c2ecf20Sopenharmony_cistatic int mt312_get_code_rate(struct mt312_state *state, enum fe_code_rate *cr) 2148c2ecf20Sopenharmony_ci{ 2158c2ecf20Sopenharmony_ci const enum fe_code_rate fec_tab[8] = 2168c2ecf20Sopenharmony_ci { FEC_1_2, FEC_2_3, FEC_3_4, FEC_5_6, FEC_6_7, FEC_7_8, 2178c2ecf20Sopenharmony_ci FEC_AUTO, FEC_AUTO }; 2188c2ecf20Sopenharmony_ci 2198c2ecf20Sopenharmony_ci int ret; 2208c2ecf20Sopenharmony_ci u8 fec_status; 2218c2ecf20Sopenharmony_ci 2228c2ecf20Sopenharmony_ci ret = mt312_readreg(state, FEC_STATUS, &fec_status); 2238c2ecf20Sopenharmony_ci if (ret < 0) 2248c2ecf20Sopenharmony_ci return ret; 2258c2ecf20Sopenharmony_ci 2268c2ecf20Sopenharmony_ci *cr = fec_tab[(fec_status >> 4) & 0x07]; 2278c2ecf20Sopenharmony_ci 2288c2ecf20Sopenharmony_ci return 0; 2298c2ecf20Sopenharmony_ci} 2308c2ecf20Sopenharmony_ci 2318c2ecf20Sopenharmony_cistatic int mt312_initfe(struct dvb_frontend *fe) 2328c2ecf20Sopenharmony_ci{ 2338c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 2348c2ecf20Sopenharmony_ci int ret; 2358c2ecf20Sopenharmony_ci u8 buf[2]; 2368c2ecf20Sopenharmony_ci 2378c2ecf20Sopenharmony_ci /* wake up */ 2388c2ecf20Sopenharmony_ci ret = mt312_writereg(state, CONFIG, 2398c2ecf20Sopenharmony_ci (state->freq_mult == 6 ? 0x88 : 0x8c)); 2408c2ecf20Sopenharmony_ci if (ret < 0) 2418c2ecf20Sopenharmony_ci return ret; 2428c2ecf20Sopenharmony_ci 2438c2ecf20Sopenharmony_ci /* wait at least 150 usec */ 2448c2ecf20Sopenharmony_ci udelay(150); 2458c2ecf20Sopenharmony_ci 2468c2ecf20Sopenharmony_ci /* full reset */ 2478c2ecf20Sopenharmony_ci ret = mt312_reset(state, 1); 2488c2ecf20Sopenharmony_ci if (ret < 0) 2498c2ecf20Sopenharmony_ci return ret; 2508c2ecf20Sopenharmony_ci 2518c2ecf20Sopenharmony_ci/* Per datasheet, write correct values. 09/28/03 ACCJr. 2528c2ecf20Sopenharmony_ci * If we don't do this, we won't get FE_HAS_VITERBI in the VP310. */ 2538c2ecf20Sopenharmony_ci { 2548c2ecf20Sopenharmony_ci u8 buf_def[8] = { 0x14, 0x12, 0x03, 0x02, 2558c2ecf20Sopenharmony_ci 0x01, 0x00, 0x00, 0x00 }; 2568c2ecf20Sopenharmony_ci 2578c2ecf20Sopenharmony_ci ret = mt312_write(state, VIT_SETUP, buf_def, sizeof(buf_def)); 2588c2ecf20Sopenharmony_ci if (ret < 0) 2598c2ecf20Sopenharmony_ci return ret; 2608c2ecf20Sopenharmony_ci } 2618c2ecf20Sopenharmony_ci 2628c2ecf20Sopenharmony_ci switch (state->id) { 2638c2ecf20Sopenharmony_ci case ID_ZL10313: 2648c2ecf20Sopenharmony_ci /* enable ADC */ 2658c2ecf20Sopenharmony_ci ret = mt312_writereg(state, GPP_CTRL, 0x80); 2668c2ecf20Sopenharmony_ci if (ret < 0) 2678c2ecf20Sopenharmony_ci return ret; 2688c2ecf20Sopenharmony_ci 2698c2ecf20Sopenharmony_ci /* configure ZL10313 for optimal ADC performance */ 2708c2ecf20Sopenharmony_ci buf[0] = 0x80; 2718c2ecf20Sopenharmony_ci buf[1] = 0xB0; 2728c2ecf20Sopenharmony_ci ret = mt312_write(state, HW_CTRL, buf, 2); 2738c2ecf20Sopenharmony_ci if (ret < 0) 2748c2ecf20Sopenharmony_ci return ret; 2758c2ecf20Sopenharmony_ci 2768c2ecf20Sopenharmony_ci /* enable MPEG output and ADCs */ 2778c2ecf20Sopenharmony_ci ret = mt312_writereg(state, HW_CTRL, 0x00); 2788c2ecf20Sopenharmony_ci if (ret < 0) 2798c2ecf20Sopenharmony_ci return ret; 2808c2ecf20Sopenharmony_ci 2818c2ecf20Sopenharmony_ci ret = mt312_writereg(state, MPEG_CTRL, 0x00); 2828c2ecf20Sopenharmony_ci if (ret < 0) 2838c2ecf20Sopenharmony_ci return ret; 2848c2ecf20Sopenharmony_ci 2858c2ecf20Sopenharmony_ci break; 2868c2ecf20Sopenharmony_ci } 2878c2ecf20Sopenharmony_ci 2888c2ecf20Sopenharmony_ci /* SYS_CLK */ 2898c2ecf20Sopenharmony_ci buf[0] = DIV_ROUND_CLOSEST(state->xtal * state->freq_mult * 2, 1000000); 2908c2ecf20Sopenharmony_ci 2918c2ecf20Sopenharmony_ci /* DISEQC_RATIO */ 2928c2ecf20Sopenharmony_ci buf[1] = DIV_ROUND_CLOSEST(state->xtal, 22000 * 4); 2938c2ecf20Sopenharmony_ci 2948c2ecf20Sopenharmony_ci ret = mt312_write(state, SYS_CLK, buf, sizeof(buf)); 2958c2ecf20Sopenharmony_ci if (ret < 0) 2968c2ecf20Sopenharmony_ci return ret; 2978c2ecf20Sopenharmony_ci 2988c2ecf20Sopenharmony_ci ret = mt312_writereg(state, SNR_THS_HIGH, 0x32); 2998c2ecf20Sopenharmony_ci if (ret < 0) 3008c2ecf20Sopenharmony_ci return ret; 3018c2ecf20Sopenharmony_ci 3028c2ecf20Sopenharmony_ci /* different MOCLK polarity */ 3038c2ecf20Sopenharmony_ci switch (state->id) { 3048c2ecf20Sopenharmony_ci case ID_ZL10313: 3058c2ecf20Sopenharmony_ci buf[0] = 0x33; 3068c2ecf20Sopenharmony_ci break; 3078c2ecf20Sopenharmony_ci default: 3088c2ecf20Sopenharmony_ci buf[0] = 0x53; 3098c2ecf20Sopenharmony_ci break; 3108c2ecf20Sopenharmony_ci } 3118c2ecf20Sopenharmony_ci 3128c2ecf20Sopenharmony_ci ret = mt312_writereg(state, OP_CTRL, buf[0]); 3138c2ecf20Sopenharmony_ci if (ret < 0) 3148c2ecf20Sopenharmony_ci return ret; 3158c2ecf20Sopenharmony_ci 3168c2ecf20Sopenharmony_ci /* TS_SW_LIM */ 3178c2ecf20Sopenharmony_ci buf[0] = 0x8c; 3188c2ecf20Sopenharmony_ci buf[1] = 0x98; 3198c2ecf20Sopenharmony_ci 3208c2ecf20Sopenharmony_ci ret = mt312_write(state, TS_SW_LIM_L, buf, sizeof(buf)); 3218c2ecf20Sopenharmony_ci if (ret < 0) 3228c2ecf20Sopenharmony_ci return ret; 3238c2ecf20Sopenharmony_ci 3248c2ecf20Sopenharmony_ci ret = mt312_writereg(state, CS_SW_LIM, 0x69); 3258c2ecf20Sopenharmony_ci if (ret < 0) 3268c2ecf20Sopenharmony_ci return ret; 3278c2ecf20Sopenharmony_ci 3288c2ecf20Sopenharmony_ci return 0; 3298c2ecf20Sopenharmony_ci} 3308c2ecf20Sopenharmony_ci 3318c2ecf20Sopenharmony_cistatic int mt312_send_master_cmd(struct dvb_frontend *fe, 3328c2ecf20Sopenharmony_ci struct dvb_diseqc_master_cmd *c) 3338c2ecf20Sopenharmony_ci{ 3348c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 3358c2ecf20Sopenharmony_ci int ret; 3368c2ecf20Sopenharmony_ci u8 diseqc_mode; 3378c2ecf20Sopenharmony_ci 3388c2ecf20Sopenharmony_ci if ((c->msg_len == 0) || (c->msg_len > sizeof(c->msg))) 3398c2ecf20Sopenharmony_ci return -EINVAL; 3408c2ecf20Sopenharmony_ci 3418c2ecf20Sopenharmony_ci ret = mt312_readreg(state, DISEQC_MODE, &diseqc_mode); 3428c2ecf20Sopenharmony_ci if (ret < 0) 3438c2ecf20Sopenharmony_ci return ret; 3448c2ecf20Sopenharmony_ci 3458c2ecf20Sopenharmony_ci ret = mt312_write(state, (0x80 | DISEQC_INSTR), c->msg, c->msg_len); 3468c2ecf20Sopenharmony_ci if (ret < 0) 3478c2ecf20Sopenharmony_ci return ret; 3488c2ecf20Sopenharmony_ci 3498c2ecf20Sopenharmony_ci ret = mt312_writereg(state, DISEQC_MODE, 3508c2ecf20Sopenharmony_ci (diseqc_mode & 0x40) | ((c->msg_len - 1) << 3) 3518c2ecf20Sopenharmony_ci | 0x04); 3528c2ecf20Sopenharmony_ci if (ret < 0) 3538c2ecf20Sopenharmony_ci return ret; 3548c2ecf20Sopenharmony_ci 3558c2ecf20Sopenharmony_ci /* is there a better way to wait for message to be transmitted */ 3568c2ecf20Sopenharmony_ci msleep(100); 3578c2ecf20Sopenharmony_ci 3588c2ecf20Sopenharmony_ci /* set DISEQC_MODE[2:0] to zero if a return message is expected */ 3598c2ecf20Sopenharmony_ci if (c->msg[0] & 0x02) { 3608c2ecf20Sopenharmony_ci ret = mt312_writereg(state, DISEQC_MODE, (diseqc_mode & 0x40)); 3618c2ecf20Sopenharmony_ci if (ret < 0) 3628c2ecf20Sopenharmony_ci return ret; 3638c2ecf20Sopenharmony_ci } 3648c2ecf20Sopenharmony_ci 3658c2ecf20Sopenharmony_ci return 0; 3668c2ecf20Sopenharmony_ci} 3678c2ecf20Sopenharmony_ci 3688c2ecf20Sopenharmony_cistatic int mt312_send_burst(struct dvb_frontend *fe, 3698c2ecf20Sopenharmony_ci const enum fe_sec_mini_cmd c) 3708c2ecf20Sopenharmony_ci{ 3718c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 3728c2ecf20Sopenharmony_ci const u8 mini_tab[2] = { 0x02, 0x03 }; 3738c2ecf20Sopenharmony_ci 3748c2ecf20Sopenharmony_ci int ret; 3758c2ecf20Sopenharmony_ci u8 diseqc_mode; 3768c2ecf20Sopenharmony_ci 3778c2ecf20Sopenharmony_ci if (c > SEC_MINI_B) 3788c2ecf20Sopenharmony_ci return -EINVAL; 3798c2ecf20Sopenharmony_ci 3808c2ecf20Sopenharmony_ci ret = mt312_readreg(state, DISEQC_MODE, &diseqc_mode); 3818c2ecf20Sopenharmony_ci if (ret < 0) 3828c2ecf20Sopenharmony_ci return ret; 3838c2ecf20Sopenharmony_ci 3848c2ecf20Sopenharmony_ci ret = mt312_writereg(state, DISEQC_MODE, 3858c2ecf20Sopenharmony_ci (diseqc_mode & 0x40) | mini_tab[c]); 3868c2ecf20Sopenharmony_ci if (ret < 0) 3878c2ecf20Sopenharmony_ci return ret; 3888c2ecf20Sopenharmony_ci 3898c2ecf20Sopenharmony_ci return 0; 3908c2ecf20Sopenharmony_ci} 3918c2ecf20Sopenharmony_ci 3928c2ecf20Sopenharmony_cistatic int mt312_set_tone(struct dvb_frontend *fe, 3938c2ecf20Sopenharmony_ci const enum fe_sec_tone_mode t) 3948c2ecf20Sopenharmony_ci{ 3958c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 3968c2ecf20Sopenharmony_ci const u8 tone_tab[2] = { 0x01, 0x00 }; 3978c2ecf20Sopenharmony_ci 3988c2ecf20Sopenharmony_ci int ret; 3998c2ecf20Sopenharmony_ci u8 diseqc_mode; 4008c2ecf20Sopenharmony_ci 4018c2ecf20Sopenharmony_ci if (t > SEC_TONE_OFF) 4028c2ecf20Sopenharmony_ci return -EINVAL; 4038c2ecf20Sopenharmony_ci 4048c2ecf20Sopenharmony_ci ret = mt312_readreg(state, DISEQC_MODE, &diseqc_mode); 4058c2ecf20Sopenharmony_ci if (ret < 0) 4068c2ecf20Sopenharmony_ci return ret; 4078c2ecf20Sopenharmony_ci 4088c2ecf20Sopenharmony_ci ret = mt312_writereg(state, DISEQC_MODE, 4098c2ecf20Sopenharmony_ci (diseqc_mode & 0x40) | tone_tab[t]); 4108c2ecf20Sopenharmony_ci if (ret < 0) 4118c2ecf20Sopenharmony_ci return ret; 4128c2ecf20Sopenharmony_ci 4138c2ecf20Sopenharmony_ci return 0; 4148c2ecf20Sopenharmony_ci} 4158c2ecf20Sopenharmony_ci 4168c2ecf20Sopenharmony_cistatic int mt312_set_voltage(struct dvb_frontend *fe, 4178c2ecf20Sopenharmony_ci const enum fe_sec_voltage v) 4188c2ecf20Sopenharmony_ci{ 4198c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 4208c2ecf20Sopenharmony_ci const u8 volt_tab[3] = { 0x00, 0x40, 0x00 }; 4218c2ecf20Sopenharmony_ci u8 val; 4228c2ecf20Sopenharmony_ci 4238c2ecf20Sopenharmony_ci if (v > SEC_VOLTAGE_OFF) 4248c2ecf20Sopenharmony_ci return -EINVAL; 4258c2ecf20Sopenharmony_ci 4268c2ecf20Sopenharmony_ci val = volt_tab[v]; 4278c2ecf20Sopenharmony_ci if (state->config->voltage_inverted) 4288c2ecf20Sopenharmony_ci val ^= 0x40; 4298c2ecf20Sopenharmony_ci 4308c2ecf20Sopenharmony_ci return mt312_writereg(state, DISEQC_MODE, val); 4318c2ecf20Sopenharmony_ci} 4328c2ecf20Sopenharmony_ci 4338c2ecf20Sopenharmony_cistatic int mt312_read_status(struct dvb_frontend *fe, enum fe_status *s) 4348c2ecf20Sopenharmony_ci{ 4358c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 4368c2ecf20Sopenharmony_ci int ret; 4378c2ecf20Sopenharmony_ci u8 status[3]; 4388c2ecf20Sopenharmony_ci 4398c2ecf20Sopenharmony_ci *s = 0; 4408c2ecf20Sopenharmony_ci 4418c2ecf20Sopenharmony_ci ret = mt312_read(state, QPSK_STAT_H, status, sizeof(status)); 4428c2ecf20Sopenharmony_ci if (ret < 0) 4438c2ecf20Sopenharmony_ci return ret; 4448c2ecf20Sopenharmony_ci 4458c2ecf20Sopenharmony_ci dprintk("QPSK_STAT_H: 0x%02x, QPSK_STAT_L: 0x%02x, FEC_STATUS: 0x%02x\n", 4468c2ecf20Sopenharmony_ci status[0], status[1], status[2]); 4478c2ecf20Sopenharmony_ci 4488c2ecf20Sopenharmony_ci if (status[0] & 0xc0) 4498c2ecf20Sopenharmony_ci *s |= FE_HAS_SIGNAL; /* signal noise ratio */ 4508c2ecf20Sopenharmony_ci if (status[0] & 0x04) 4518c2ecf20Sopenharmony_ci *s |= FE_HAS_CARRIER; /* qpsk carrier lock */ 4528c2ecf20Sopenharmony_ci if (status[2] & 0x02) 4538c2ecf20Sopenharmony_ci *s |= FE_HAS_VITERBI; /* viterbi lock */ 4548c2ecf20Sopenharmony_ci if (status[2] & 0x04) 4558c2ecf20Sopenharmony_ci *s |= FE_HAS_SYNC; /* byte align lock */ 4568c2ecf20Sopenharmony_ci if (status[0] & 0x01) 4578c2ecf20Sopenharmony_ci *s |= FE_HAS_LOCK; /* qpsk lock */ 4588c2ecf20Sopenharmony_ci 4598c2ecf20Sopenharmony_ci return 0; 4608c2ecf20Sopenharmony_ci} 4618c2ecf20Sopenharmony_ci 4628c2ecf20Sopenharmony_cistatic int mt312_read_ber(struct dvb_frontend *fe, u32 *ber) 4638c2ecf20Sopenharmony_ci{ 4648c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 4658c2ecf20Sopenharmony_ci int ret; 4668c2ecf20Sopenharmony_ci u8 buf[3]; 4678c2ecf20Sopenharmony_ci 4688c2ecf20Sopenharmony_ci ret = mt312_read(state, RS_BERCNT_H, buf, 3); 4698c2ecf20Sopenharmony_ci if (ret < 0) 4708c2ecf20Sopenharmony_ci return ret; 4718c2ecf20Sopenharmony_ci 4728c2ecf20Sopenharmony_ci *ber = ((buf[0] << 16) | (buf[1] << 8) | buf[2]) * 64; 4738c2ecf20Sopenharmony_ci 4748c2ecf20Sopenharmony_ci return 0; 4758c2ecf20Sopenharmony_ci} 4768c2ecf20Sopenharmony_ci 4778c2ecf20Sopenharmony_cistatic int mt312_read_signal_strength(struct dvb_frontend *fe, 4788c2ecf20Sopenharmony_ci u16 *signal_strength) 4798c2ecf20Sopenharmony_ci{ 4808c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 4818c2ecf20Sopenharmony_ci int ret; 4828c2ecf20Sopenharmony_ci u8 buf[3]; 4838c2ecf20Sopenharmony_ci u16 agc; 4848c2ecf20Sopenharmony_ci s16 err_db; 4858c2ecf20Sopenharmony_ci 4868c2ecf20Sopenharmony_ci ret = mt312_read(state, AGC_H, buf, sizeof(buf)); 4878c2ecf20Sopenharmony_ci if (ret < 0) 4888c2ecf20Sopenharmony_ci return ret; 4898c2ecf20Sopenharmony_ci 4908c2ecf20Sopenharmony_ci agc = (buf[0] << 6) | (buf[1] >> 2); 4918c2ecf20Sopenharmony_ci err_db = (s16) (((buf[1] & 0x03) << 14) | buf[2] << 6) >> 6; 4928c2ecf20Sopenharmony_ci 4938c2ecf20Sopenharmony_ci *signal_strength = agc; 4948c2ecf20Sopenharmony_ci 4958c2ecf20Sopenharmony_ci dprintk("agc=%08x err_db=%hd\n", agc, err_db); 4968c2ecf20Sopenharmony_ci 4978c2ecf20Sopenharmony_ci return 0; 4988c2ecf20Sopenharmony_ci} 4998c2ecf20Sopenharmony_ci 5008c2ecf20Sopenharmony_cistatic int mt312_read_snr(struct dvb_frontend *fe, u16 *snr) 5018c2ecf20Sopenharmony_ci{ 5028c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 5038c2ecf20Sopenharmony_ci int ret; 5048c2ecf20Sopenharmony_ci u8 buf[2]; 5058c2ecf20Sopenharmony_ci 5068c2ecf20Sopenharmony_ci ret = mt312_read(state, M_SNR_H, buf, sizeof(buf)); 5078c2ecf20Sopenharmony_ci if (ret < 0) 5088c2ecf20Sopenharmony_ci return ret; 5098c2ecf20Sopenharmony_ci 5108c2ecf20Sopenharmony_ci *snr = 0xFFFF - ((((buf[0] & 0x7f) << 8) | buf[1]) << 1); 5118c2ecf20Sopenharmony_ci 5128c2ecf20Sopenharmony_ci return 0; 5138c2ecf20Sopenharmony_ci} 5148c2ecf20Sopenharmony_ci 5158c2ecf20Sopenharmony_cistatic int mt312_read_ucblocks(struct dvb_frontend *fe, u32 *ubc) 5168c2ecf20Sopenharmony_ci{ 5178c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 5188c2ecf20Sopenharmony_ci int ret; 5198c2ecf20Sopenharmony_ci u8 buf[2]; 5208c2ecf20Sopenharmony_ci 5218c2ecf20Sopenharmony_ci ret = mt312_read(state, RS_UBC_H, buf, sizeof(buf)); 5228c2ecf20Sopenharmony_ci if (ret < 0) 5238c2ecf20Sopenharmony_ci return ret; 5248c2ecf20Sopenharmony_ci 5258c2ecf20Sopenharmony_ci *ubc = (buf[0] << 8) | buf[1]; 5268c2ecf20Sopenharmony_ci 5278c2ecf20Sopenharmony_ci return 0; 5288c2ecf20Sopenharmony_ci} 5298c2ecf20Sopenharmony_ci 5308c2ecf20Sopenharmony_cistatic int mt312_set_frontend(struct dvb_frontend *fe) 5318c2ecf20Sopenharmony_ci{ 5328c2ecf20Sopenharmony_ci struct dtv_frontend_properties *p = &fe->dtv_property_cache; 5338c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 5348c2ecf20Sopenharmony_ci int ret; 5358c2ecf20Sopenharmony_ci u8 buf[5], config_val; 5368c2ecf20Sopenharmony_ci u16 sr; 5378c2ecf20Sopenharmony_ci 5388c2ecf20Sopenharmony_ci const u8 fec_tab[10] = 5398c2ecf20Sopenharmony_ci { 0x00, 0x01, 0x02, 0x04, 0x3f, 0x08, 0x10, 0x20, 0x3f, 0x3f }; 5408c2ecf20Sopenharmony_ci const u8 inv_tab[3] = { 0x00, 0x40, 0x80 }; 5418c2ecf20Sopenharmony_ci 5428c2ecf20Sopenharmony_ci dprintk("%s: Freq %d\n", __func__, p->frequency); 5438c2ecf20Sopenharmony_ci 5448c2ecf20Sopenharmony_ci if ((p->frequency < fe->ops.info.frequency_min_hz / kHz) 5458c2ecf20Sopenharmony_ci || (p->frequency > fe->ops.info.frequency_max_hz / kHz)) 5468c2ecf20Sopenharmony_ci return -EINVAL; 5478c2ecf20Sopenharmony_ci 5488c2ecf20Sopenharmony_ci if (((int)p->inversion < INVERSION_OFF) 5498c2ecf20Sopenharmony_ci || (p->inversion > INVERSION_ON)) 5508c2ecf20Sopenharmony_ci return -EINVAL; 5518c2ecf20Sopenharmony_ci 5528c2ecf20Sopenharmony_ci if ((p->symbol_rate < fe->ops.info.symbol_rate_min) 5538c2ecf20Sopenharmony_ci || (p->symbol_rate > fe->ops.info.symbol_rate_max)) 5548c2ecf20Sopenharmony_ci return -EINVAL; 5558c2ecf20Sopenharmony_ci 5568c2ecf20Sopenharmony_ci if (((int)p->fec_inner < FEC_NONE) 5578c2ecf20Sopenharmony_ci || (p->fec_inner > FEC_AUTO)) 5588c2ecf20Sopenharmony_ci return -EINVAL; 5598c2ecf20Sopenharmony_ci 5608c2ecf20Sopenharmony_ci if ((p->fec_inner == FEC_4_5) 5618c2ecf20Sopenharmony_ci || (p->fec_inner == FEC_8_9)) 5628c2ecf20Sopenharmony_ci return -EINVAL; 5638c2ecf20Sopenharmony_ci 5648c2ecf20Sopenharmony_ci switch (state->id) { 5658c2ecf20Sopenharmony_ci case ID_VP310: 5668c2ecf20Sopenharmony_ci /* For now we will do this only for the VP310. 5678c2ecf20Sopenharmony_ci * It should be better for the mt312 as well, 5688c2ecf20Sopenharmony_ci * but tuning will be slower. ACCJr 09/29/03 5698c2ecf20Sopenharmony_ci */ 5708c2ecf20Sopenharmony_ci ret = mt312_readreg(state, CONFIG, &config_val); 5718c2ecf20Sopenharmony_ci if (ret < 0) 5728c2ecf20Sopenharmony_ci return ret; 5738c2ecf20Sopenharmony_ci if (p->symbol_rate >= 30000000) { 5748c2ecf20Sopenharmony_ci /* Note that 30MS/s should use 90MHz */ 5758c2ecf20Sopenharmony_ci if (state->freq_mult == 6) { 5768c2ecf20Sopenharmony_ci /* We are running 60MHz */ 5778c2ecf20Sopenharmony_ci state->freq_mult = 9; 5788c2ecf20Sopenharmony_ci ret = mt312_initfe(fe); 5798c2ecf20Sopenharmony_ci if (ret < 0) 5808c2ecf20Sopenharmony_ci return ret; 5818c2ecf20Sopenharmony_ci } 5828c2ecf20Sopenharmony_ci } else { 5838c2ecf20Sopenharmony_ci if (state->freq_mult == 9) { 5848c2ecf20Sopenharmony_ci /* We are running 90MHz */ 5858c2ecf20Sopenharmony_ci state->freq_mult = 6; 5868c2ecf20Sopenharmony_ci ret = mt312_initfe(fe); 5878c2ecf20Sopenharmony_ci if (ret < 0) 5888c2ecf20Sopenharmony_ci return ret; 5898c2ecf20Sopenharmony_ci } 5908c2ecf20Sopenharmony_ci } 5918c2ecf20Sopenharmony_ci break; 5928c2ecf20Sopenharmony_ci 5938c2ecf20Sopenharmony_ci case ID_MT312: 5948c2ecf20Sopenharmony_ci case ID_ZL10313: 5958c2ecf20Sopenharmony_ci break; 5968c2ecf20Sopenharmony_ci 5978c2ecf20Sopenharmony_ci default: 5988c2ecf20Sopenharmony_ci return -EINVAL; 5998c2ecf20Sopenharmony_ci } 6008c2ecf20Sopenharmony_ci 6018c2ecf20Sopenharmony_ci if (fe->ops.tuner_ops.set_params) { 6028c2ecf20Sopenharmony_ci fe->ops.tuner_ops.set_params(fe); 6038c2ecf20Sopenharmony_ci if (fe->ops.i2c_gate_ctrl) 6048c2ecf20Sopenharmony_ci fe->ops.i2c_gate_ctrl(fe, 0); 6058c2ecf20Sopenharmony_ci } 6068c2ecf20Sopenharmony_ci 6078c2ecf20Sopenharmony_ci /* sr = (u16)(sr * 256.0 / 1000000.0) */ 6088c2ecf20Sopenharmony_ci sr = DIV_ROUND_CLOSEST(p->symbol_rate * 4, 15625); 6098c2ecf20Sopenharmony_ci 6108c2ecf20Sopenharmony_ci /* SYM_RATE */ 6118c2ecf20Sopenharmony_ci buf[0] = (sr >> 8) & 0x3f; 6128c2ecf20Sopenharmony_ci buf[1] = (sr >> 0) & 0xff; 6138c2ecf20Sopenharmony_ci 6148c2ecf20Sopenharmony_ci /* VIT_MODE */ 6158c2ecf20Sopenharmony_ci buf[2] = inv_tab[p->inversion] | fec_tab[p->fec_inner]; 6168c2ecf20Sopenharmony_ci 6178c2ecf20Sopenharmony_ci /* QPSK_CTRL */ 6188c2ecf20Sopenharmony_ci buf[3] = 0x40; /* swap I and Q before QPSK demodulation */ 6198c2ecf20Sopenharmony_ci 6208c2ecf20Sopenharmony_ci if (p->symbol_rate < 10000000) 6218c2ecf20Sopenharmony_ci buf[3] |= 0x04; /* use afc mode */ 6228c2ecf20Sopenharmony_ci 6238c2ecf20Sopenharmony_ci /* GO */ 6248c2ecf20Sopenharmony_ci buf[4] = 0x01; 6258c2ecf20Sopenharmony_ci 6268c2ecf20Sopenharmony_ci ret = mt312_write(state, SYM_RATE_H, buf, sizeof(buf)); 6278c2ecf20Sopenharmony_ci if (ret < 0) 6288c2ecf20Sopenharmony_ci return ret; 6298c2ecf20Sopenharmony_ci 6308c2ecf20Sopenharmony_ci ret = mt312_reset(state, 0); 6318c2ecf20Sopenharmony_ci if (ret < 0) 6328c2ecf20Sopenharmony_ci return ret; 6338c2ecf20Sopenharmony_ci 6348c2ecf20Sopenharmony_ci return 0; 6358c2ecf20Sopenharmony_ci} 6368c2ecf20Sopenharmony_ci 6378c2ecf20Sopenharmony_cistatic int mt312_get_frontend(struct dvb_frontend *fe, 6388c2ecf20Sopenharmony_ci struct dtv_frontend_properties *p) 6398c2ecf20Sopenharmony_ci{ 6408c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 6418c2ecf20Sopenharmony_ci int ret; 6428c2ecf20Sopenharmony_ci 6438c2ecf20Sopenharmony_ci ret = mt312_get_inversion(state, &p->inversion); 6448c2ecf20Sopenharmony_ci if (ret < 0) 6458c2ecf20Sopenharmony_ci return ret; 6468c2ecf20Sopenharmony_ci 6478c2ecf20Sopenharmony_ci ret = mt312_get_symbol_rate(state, &p->symbol_rate); 6488c2ecf20Sopenharmony_ci if (ret < 0) 6498c2ecf20Sopenharmony_ci return ret; 6508c2ecf20Sopenharmony_ci 6518c2ecf20Sopenharmony_ci ret = mt312_get_code_rate(state, &p->fec_inner); 6528c2ecf20Sopenharmony_ci if (ret < 0) 6538c2ecf20Sopenharmony_ci return ret; 6548c2ecf20Sopenharmony_ci 6558c2ecf20Sopenharmony_ci return 0; 6568c2ecf20Sopenharmony_ci} 6578c2ecf20Sopenharmony_ci 6588c2ecf20Sopenharmony_cistatic int mt312_i2c_gate_ctrl(struct dvb_frontend *fe, int enable) 6598c2ecf20Sopenharmony_ci{ 6608c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 6618c2ecf20Sopenharmony_ci 6628c2ecf20Sopenharmony_ci u8 val = 0x00; 6638c2ecf20Sopenharmony_ci int ret; 6648c2ecf20Sopenharmony_ci 6658c2ecf20Sopenharmony_ci switch (state->id) { 6668c2ecf20Sopenharmony_ci case ID_ZL10313: 6678c2ecf20Sopenharmony_ci ret = mt312_readreg(state, GPP_CTRL, &val); 6688c2ecf20Sopenharmony_ci if (ret < 0) 6698c2ecf20Sopenharmony_ci goto error; 6708c2ecf20Sopenharmony_ci 6718c2ecf20Sopenharmony_ci /* preserve this bit to not accidentally shutdown ADC */ 6728c2ecf20Sopenharmony_ci val &= 0x80; 6738c2ecf20Sopenharmony_ci break; 6748c2ecf20Sopenharmony_ci } 6758c2ecf20Sopenharmony_ci 6768c2ecf20Sopenharmony_ci if (enable) 6778c2ecf20Sopenharmony_ci val |= 0x40; 6788c2ecf20Sopenharmony_ci else 6798c2ecf20Sopenharmony_ci val &= ~0x40; 6808c2ecf20Sopenharmony_ci 6818c2ecf20Sopenharmony_ci ret = mt312_writereg(state, GPP_CTRL, val); 6828c2ecf20Sopenharmony_ci 6838c2ecf20Sopenharmony_cierror: 6848c2ecf20Sopenharmony_ci return ret; 6858c2ecf20Sopenharmony_ci} 6868c2ecf20Sopenharmony_ci 6878c2ecf20Sopenharmony_cistatic int mt312_sleep(struct dvb_frontend *fe) 6888c2ecf20Sopenharmony_ci{ 6898c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 6908c2ecf20Sopenharmony_ci int ret; 6918c2ecf20Sopenharmony_ci u8 config; 6928c2ecf20Sopenharmony_ci 6938c2ecf20Sopenharmony_ci /* reset all registers to defaults */ 6948c2ecf20Sopenharmony_ci ret = mt312_reset(state, 1); 6958c2ecf20Sopenharmony_ci if (ret < 0) 6968c2ecf20Sopenharmony_ci return ret; 6978c2ecf20Sopenharmony_ci 6988c2ecf20Sopenharmony_ci if (state->id == ID_ZL10313) { 6998c2ecf20Sopenharmony_ci /* reset ADC */ 7008c2ecf20Sopenharmony_ci ret = mt312_writereg(state, GPP_CTRL, 0x00); 7018c2ecf20Sopenharmony_ci if (ret < 0) 7028c2ecf20Sopenharmony_ci return ret; 7038c2ecf20Sopenharmony_ci 7048c2ecf20Sopenharmony_ci /* full shutdown of ADCs, mpeg bus tristated */ 7058c2ecf20Sopenharmony_ci ret = mt312_writereg(state, HW_CTRL, 0x0d); 7068c2ecf20Sopenharmony_ci if (ret < 0) 7078c2ecf20Sopenharmony_ci return ret; 7088c2ecf20Sopenharmony_ci } 7098c2ecf20Sopenharmony_ci 7108c2ecf20Sopenharmony_ci ret = mt312_readreg(state, CONFIG, &config); 7118c2ecf20Sopenharmony_ci if (ret < 0) 7128c2ecf20Sopenharmony_ci return ret; 7138c2ecf20Sopenharmony_ci 7148c2ecf20Sopenharmony_ci /* enter standby */ 7158c2ecf20Sopenharmony_ci ret = mt312_writereg(state, CONFIG, config & 0x7f); 7168c2ecf20Sopenharmony_ci if (ret < 0) 7178c2ecf20Sopenharmony_ci return ret; 7188c2ecf20Sopenharmony_ci 7198c2ecf20Sopenharmony_ci return 0; 7208c2ecf20Sopenharmony_ci} 7218c2ecf20Sopenharmony_ci 7228c2ecf20Sopenharmony_cistatic int mt312_get_tune_settings(struct dvb_frontend *fe, 7238c2ecf20Sopenharmony_ci struct dvb_frontend_tune_settings *fesettings) 7248c2ecf20Sopenharmony_ci{ 7258c2ecf20Sopenharmony_ci fesettings->min_delay_ms = 50; 7268c2ecf20Sopenharmony_ci fesettings->step_size = 0; 7278c2ecf20Sopenharmony_ci fesettings->max_drift = 0; 7288c2ecf20Sopenharmony_ci return 0; 7298c2ecf20Sopenharmony_ci} 7308c2ecf20Sopenharmony_ci 7318c2ecf20Sopenharmony_cistatic void mt312_release(struct dvb_frontend *fe) 7328c2ecf20Sopenharmony_ci{ 7338c2ecf20Sopenharmony_ci struct mt312_state *state = fe->demodulator_priv; 7348c2ecf20Sopenharmony_ci kfree(state); 7358c2ecf20Sopenharmony_ci} 7368c2ecf20Sopenharmony_ci 7378c2ecf20Sopenharmony_ci#define MT312_SYS_CLK 90000000UL /* 90 MHz */ 7388c2ecf20Sopenharmony_cistatic const struct dvb_frontend_ops mt312_ops = { 7398c2ecf20Sopenharmony_ci .delsys = { SYS_DVBS }, 7408c2ecf20Sopenharmony_ci .info = { 7418c2ecf20Sopenharmony_ci .name = "Zarlink ???? DVB-S", 7428c2ecf20Sopenharmony_ci .frequency_min_hz = 950 * MHz, 7438c2ecf20Sopenharmony_ci .frequency_max_hz = 2150 * MHz, 7448c2ecf20Sopenharmony_ci /* FIXME: adjust freq to real used xtal */ 7458c2ecf20Sopenharmony_ci .frequency_stepsize_hz = MT312_PLL_CLK / 128, 7468c2ecf20Sopenharmony_ci .symbol_rate_min = MT312_SYS_CLK / 128, /* FIXME as above */ 7478c2ecf20Sopenharmony_ci .symbol_rate_max = MT312_SYS_CLK / 2, 7488c2ecf20Sopenharmony_ci .caps = 7498c2ecf20Sopenharmony_ci FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | 7508c2ecf20Sopenharmony_ci FE_CAN_FEC_3_4 | FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | 7518c2ecf20Sopenharmony_ci FE_CAN_FEC_AUTO | FE_CAN_QPSK | FE_CAN_MUTE_TS | 7528c2ecf20Sopenharmony_ci FE_CAN_RECOVER 7538c2ecf20Sopenharmony_ci }, 7548c2ecf20Sopenharmony_ci 7558c2ecf20Sopenharmony_ci .release = mt312_release, 7568c2ecf20Sopenharmony_ci 7578c2ecf20Sopenharmony_ci .init = mt312_initfe, 7588c2ecf20Sopenharmony_ci .sleep = mt312_sleep, 7598c2ecf20Sopenharmony_ci .i2c_gate_ctrl = mt312_i2c_gate_ctrl, 7608c2ecf20Sopenharmony_ci 7618c2ecf20Sopenharmony_ci .set_frontend = mt312_set_frontend, 7628c2ecf20Sopenharmony_ci .get_frontend = mt312_get_frontend, 7638c2ecf20Sopenharmony_ci .get_tune_settings = mt312_get_tune_settings, 7648c2ecf20Sopenharmony_ci 7658c2ecf20Sopenharmony_ci .read_status = mt312_read_status, 7668c2ecf20Sopenharmony_ci .read_ber = mt312_read_ber, 7678c2ecf20Sopenharmony_ci .read_signal_strength = mt312_read_signal_strength, 7688c2ecf20Sopenharmony_ci .read_snr = mt312_read_snr, 7698c2ecf20Sopenharmony_ci .read_ucblocks = mt312_read_ucblocks, 7708c2ecf20Sopenharmony_ci 7718c2ecf20Sopenharmony_ci .diseqc_send_master_cmd = mt312_send_master_cmd, 7728c2ecf20Sopenharmony_ci .diseqc_send_burst = mt312_send_burst, 7738c2ecf20Sopenharmony_ci .set_tone = mt312_set_tone, 7748c2ecf20Sopenharmony_ci .set_voltage = mt312_set_voltage, 7758c2ecf20Sopenharmony_ci}; 7768c2ecf20Sopenharmony_ci 7778c2ecf20Sopenharmony_cistruct dvb_frontend *mt312_attach(const struct mt312_config *config, 7788c2ecf20Sopenharmony_ci struct i2c_adapter *i2c) 7798c2ecf20Sopenharmony_ci{ 7808c2ecf20Sopenharmony_ci struct mt312_state *state = NULL; 7818c2ecf20Sopenharmony_ci 7828c2ecf20Sopenharmony_ci /* allocate memory for the internal state */ 7838c2ecf20Sopenharmony_ci state = kzalloc(sizeof(struct mt312_state), GFP_KERNEL); 7848c2ecf20Sopenharmony_ci if (state == NULL) 7858c2ecf20Sopenharmony_ci goto error; 7868c2ecf20Sopenharmony_ci 7878c2ecf20Sopenharmony_ci /* setup the state */ 7888c2ecf20Sopenharmony_ci state->config = config; 7898c2ecf20Sopenharmony_ci state->i2c = i2c; 7908c2ecf20Sopenharmony_ci 7918c2ecf20Sopenharmony_ci /* check if the demod is there */ 7928c2ecf20Sopenharmony_ci if (mt312_readreg(state, ID, &state->id) < 0) 7938c2ecf20Sopenharmony_ci goto error; 7948c2ecf20Sopenharmony_ci 7958c2ecf20Sopenharmony_ci /* create dvb_frontend */ 7968c2ecf20Sopenharmony_ci memcpy(&state->frontend.ops, &mt312_ops, 7978c2ecf20Sopenharmony_ci sizeof(struct dvb_frontend_ops)); 7988c2ecf20Sopenharmony_ci state->frontend.demodulator_priv = state; 7998c2ecf20Sopenharmony_ci 8008c2ecf20Sopenharmony_ci switch (state->id) { 8018c2ecf20Sopenharmony_ci case ID_VP310: 8028c2ecf20Sopenharmony_ci strscpy(state->frontend.ops.info.name, "Zarlink VP310 DVB-S", 8038c2ecf20Sopenharmony_ci sizeof(state->frontend.ops.info.name)); 8048c2ecf20Sopenharmony_ci state->xtal = MT312_PLL_CLK; 8058c2ecf20Sopenharmony_ci state->freq_mult = 9; 8068c2ecf20Sopenharmony_ci break; 8078c2ecf20Sopenharmony_ci case ID_MT312: 8088c2ecf20Sopenharmony_ci strscpy(state->frontend.ops.info.name, "Zarlink MT312 DVB-S", 8098c2ecf20Sopenharmony_ci sizeof(state->frontend.ops.info.name)); 8108c2ecf20Sopenharmony_ci state->xtal = MT312_PLL_CLK; 8118c2ecf20Sopenharmony_ci state->freq_mult = 6; 8128c2ecf20Sopenharmony_ci break; 8138c2ecf20Sopenharmony_ci case ID_ZL10313: 8148c2ecf20Sopenharmony_ci strscpy(state->frontend.ops.info.name, "Zarlink ZL10313 DVB-S", 8158c2ecf20Sopenharmony_ci sizeof(state->frontend.ops.info.name)); 8168c2ecf20Sopenharmony_ci state->xtal = MT312_PLL_CLK_10_111; 8178c2ecf20Sopenharmony_ci state->freq_mult = 9; 8188c2ecf20Sopenharmony_ci break; 8198c2ecf20Sopenharmony_ci default: 8208c2ecf20Sopenharmony_ci printk(KERN_WARNING "Only Zarlink VP310/MT312/ZL10313 are supported chips.\n"); 8218c2ecf20Sopenharmony_ci goto error; 8228c2ecf20Sopenharmony_ci } 8238c2ecf20Sopenharmony_ci 8248c2ecf20Sopenharmony_ci return &state->frontend; 8258c2ecf20Sopenharmony_ci 8268c2ecf20Sopenharmony_cierror: 8278c2ecf20Sopenharmony_ci kfree(state); 8288c2ecf20Sopenharmony_ci return NULL; 8298c2ecf20Sopenharmony_ci} 8308c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(mt312_attach); 8318c2ecf20Sopenharmony_ci 8328c2ecf20Sopenharmony_cimodule_param(debug, int, 0644); 8338c2ecf20Sopenharmony_ciMODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off)."); 8348c2ecf20Sopenharmony_ci 8358c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Zarlink VP310/MT312/ZL10313 DVB-S Demodulator driver"); 8368c2ecf20Sopenharmony_ciMODULE_AUTHOR("Andreas Oberritter <obi@linuxtv.org>"); 8378c2ecf20Sopenharmony_ciMODULE_AUTHOR("Matthias Schwarzott <zzam@gentoo.org>"); 8388c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL"); 8398c2ecf20Sopenharmony_ci 840