235 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 TDA665x tuner driver4 Copyright (C) Manu Abraham (abraham.manu@gmail.com)5 6*/7 8#include <linux/init.h>9#include <linux/kernel.h>10#include <linux/module.h>11#include <linux/slab.h>12 13#include <media/dvb_frontend.h>14#include "tda665x.h"15 16struct tda665x_state {17 struct dvb_frontend *fe;18 struct i2c_adapter *i2c;19 const struct tda665x_config *config;20 21 u32 frequency;22 u32 bandwidth;23};24 25static int tda665x_read(struct tda665x_state *state, u8 *buf)26{27 const struct tda665x_config *config = state->config;28 int err = 0;29 struct i2c_msg msg = { .addr = config->addr, .flags = I2C_M_RD, .buf = buf, .len = 2 };30 31 err = i2c_transfer(state->i2c, &msg, 1);32 if (err != 1)33 goto exit;34 35 return err;36exit:37 printk(KERN_ERR "%s: I/O Error err=<%d>\n", __func__, err);38 return err;39}40 41static int tda665x_write(struct tda665x_state *state, u8 *buf, u8 length)42{43 const struct tda665x_config *config = state->config;44 int err = 0;45 struct i2c_msg msg = { .addr = config->addr, .flags = 0, .buf = buf, .len = length };46 47 err = i2c_transfer(state->i2c, &msg, 1);48 if (err != 1)49 goto exit;50 51 return err;52exit:53 printk(KERN_ERR "%s: I/O Error err=<%d>\n", __func__, err);54 return err;55}56 57static int tda665x_get_frequency(struct dvb_frontend *fe, u32 *frequency)58{59 struct tda665x_state *state = fe->tuner_priv;60 61 *frequency = state->frequency;62 63 return 0;64}65 66static int tda665x_get_status(struct dvb_frontend *fe, u32 *status)67{68 struct tda665x_state *state = fe->tuner_priv;69 u8 result = 0;70 int err = 0;71 72 *status = 0;73 74 err = tda665x_read(state, &result);75 if (err < 0)76 goto exit;77 78 if ((result >> 6) & 0x01) {79 printk(KERN_DEBUG "%s: Tuner Phase Locked\n", __func__);80 *status = 1;81 }82 83 return err;84exit:85 printk(KERN_ERR "%s: I/O Error\n", __func__);86 return err;87}88 89static int tda665x_set_frequency(struct dvb_frontend *fe,90 u32 new_frequency)91{92 struct tda665x_state *state = fe->tuner_priv;93 const struct tda665x_config *config = state->config;94 u32 frequency, status = 0;95 u8 buf[4];96 int err = 0;97 98 if ((new_frequency < config->frequency_max)99 || (new_frequency > config->frequency_min)) {100 printk(KERN_ERR "%s: Frequency beyond limits, frequency=%d\n",101 __func__, new_frequency);102 return -EINVAL;103 }104 105 frequency = new_frequency;106 107 frequency += config->frequency_offst;108 frequency *= config->ref_multiplier;109 frequency += config->ref_divider >> 1;110 frequency /= config->ref_divider;111 112 buf[0] = (u8) ((frequency & 0x7f00) >> 8);113 buf[1] = (u8) (frequency & 0x00ff) >> 0;114 buf[2] = 0x80 | 0x40 | 0x02;115 buf[3] = 0x00;116 117 /* restore frequency */118 frequency = new_frequency;119 120 if (frequency < 153000000) {121 /* VHF-L */122 buf[3] |= 0x01; /* fc, Low Band, 47 - 153 MHz */123 if (frequency < 68000000)124 buf[3] |= 0x40; /* 83uA */125 if (frequency < 1040000000)126 buf[3] |= 0x60; /* 122uA */127 if (frequency < 1250000000)128 buf[3] |= 0x80; /* 163uA */129 else130 buf[3] |= 0xa0; /* 254uA */131 } else if (frequency < 438000000) {132 /* VHF-H */133 buf[3] |= 0x02; /* fc, Mid Band, 153 - 438 MHz */134 if (frequency < 230000000)135 buf[3] |= 0x40;136 if (frequency < 300000000)137 buf[3] |= 0x60;138 else139 buf[3] |= 0x80;140 } else {141 /* UHF */142 buf[3] |= 0x04; /* fc, High Band, 438 - 862 MHz */143 if (frequency < 470000000)144 buf[3] |= 0x60;145 if (frequency < 526000000)146 buf[3] |= 0x80;147 else148 buf[3] |= 0xa0;149 }150 151 /* Set params */152 err = tda665x_write(state, buf, 5);153 if (err < 0)154 goto exit;155 156 /* sleep for some time */157 printk(KERN_DEBUG "%s: Waiting to Phase LOCK\n", __func__);158 msleep(20);159 /* check status */160 err = tda665x_get_status(fe, &status);161 if (err < 0)162 goto exit;163 164 if (status == 1) {165 printk(KERN_DEBUG "%s: Tuner Phase locked: status=%d\n",166 __func__, status);167 state->frequency = frequency; /* cache successful state */168 } else {169 printk(KERN_ERR "%s: No Phase lock: status=%d\n",170 __func__, status);171 }172 173 return 0;174exit:175 printk(KERN_ERR "%s: I/O Error\n", __func__);176 return err;177}178 179static int tda665x_set_params(struct dvb_frontend *fe)180{181 struct dtv_frontend_properties *c = &fe->dtv_property_cache;182 183 tda665x_set_frequency(fe, c->frequency);184 185 return 0;186}187 188static void tda665x_release(struct dvb_frontend *fe)189{190 struct tda665x_state *state = fe->tuner_priv;191 192 fe->tuner_priv = NULL;193 kfree(state);194}195 196static const struct dvb_tuner_ops tda665x_ops = {197 .get_status = tda665x_get_status,198 .set_params = tda665x_set_params,199 .get_frequency = tda665x_get_frequency,200 .release = tda665x_release201};202 203struct dvb_frontend *tda665x_attach(struct dvb_frontend *fe,204 const struct tda665x_config *config,205 struct i2c_adapter *i2c)206{207 struct tda665x_state *state = NULL;208 struct dvb_tuner_info *info;209 210 state = kzalloc(sizeof(struct tda665x_state), GFP_KERNEL);211 if (!state)212 return NULL;213 214 state->config = config;215 state->i2c = i2c;216 state->fe = fe;217 fe->tuner_priv = state;218 fe->ops.tuner_ops = tda665x_ops;219 info = &fe->ops.tuner_ops.info;220 221 memcpy(info->name, config->name, sizeof(config->name));222 info->frequency_min_hz = config->frequency_min;223 info->frequency_max_hz = config->frequency_max;224 info->frequency_step_hz = config->frequency_offst;225 226 printk(KERN_DEBUG "%s: Attaching TDA665x (%s) tuner\n", __func__, info->name);227 228 return fe;229}230EXPORT_SYMBOL_GPL(tda665x_attach);231 232MODULE_DESCRIPTION("TDA665x driver");233MODULE_AUTHOR("Manu Abraham");234MODULE_LICENSE("GPL");235