12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396 |
- #include <linux/videodev2.h>
- #include <linux/mutex.h>
- #include <linux/slab.h>
- #include <linux/bitrev.h>
- #include "tuner-i2c.h"
- #include "r820t.h"
- #define REG_SHADOW_START 5
- #define NUM_REGS 27
- #define NUM_IMR 5
- #define IMR_TRIAL 9
- #define VER_NUM 49
- static int debug;
- module_param(debug, int, 0644);
- MODULE_PARM_DESC(debug, "enable verbose debug messages");
- static int no_imr_cal;
- module_param(no_imr_cal, int, 0444);
- MODULE_PARM_DESC(no_imr_cal, "Disable IMR calibration at module init");
- enum xtal_cap_value {
- XTAL_LOW_CAP_30P = 0,
- XTAL_LOW_CAP_20P,
- XTAL_LOW_CAP_10P,
- XTAL_LOW_CAP_0P,
- XTAL_HIGH_CAP_0P
- };
- struct r820t_sect_type {
- u8 phase_y;
- u8 gain_x;
- u16 value;
- };
- struct r820t_priv {
- struct list_head hybrid_tuner_instance_list;
- const struct r820t_config *cfg;
- struct tuner_i2c_props i2c_props;
- struct mutex lock;
- u8 regs[NUM_REGS];
- u8 buf[NUM_REGS + 1];
- enum xtal_cap_value xtal_cap_sel;
- u16 pll;
- u32 int_freq;
- u8 fil_cal_code;
- bool imr_done;
- bool has_lock;
- bool init_done;
- struct r820t_sect_type imr_data[NUM_IMR];
-
- u32 delsys;
- enum v4l2_tuner_type type;
- v4l2_std_id std;
- u32 bw;
- };
- struct r820t_freq_range {
- u32 freq;
- u8 open_d;
- u8 rf_mux_ploy;
- u8 tf_c;
- u8 xtal_cap20p;
- u8 xtal_cap10p;
- u8 xtal_cap0p;
- u8 imr_mem;
- };
- #define VCO_POWER_REF 0x02
- #define DIP_FREQ 32000000
- static LIST_HEAD(hybrid_tuner_instance_list);
- static DEFINE_MUTEX(r820t_list_mutex);
- static const u8 r820t_init_array[NUM_REGS] = {
- 0x83, 0x32, 0x75,
- 0xc0, 0x40, 0xd6, 0x6c,
- 0xf5, 0x63, 0x75, 0x68,
- 0x6c, 0x83, 0x80, 0x00,
- 0x0f, 0x00, 0xc0, 0x30,
- 0x48, 0xcc, 0x60, 0x00,
- 0x54, 0xae, 0x4a, 0xc0
- };
- static const struct r820t_freq_range freq_ranges[] = {
- {
- .freq = 0,
- .open_d = 0x08,
- .rf_mux_ploy = 0x02,
- .tf_c = 0xdf,
- .xtal_cap20p = 0x02,
- .xtal_cap10p = 0x01,
- .xtal_cap0p = 0x00,
- .imr_mem = 0,
- }, {
- .freq = 50,
- .open_d = 0x08,
- .rf_mux_ploy = 0x02,
- .tf_c = 0xbe,
- .xtal_cap20p = 0x02,
- .xtal_cap10p = 0x01,
- .xtal_cap0p = 0x00,
- .imr_mem = 0,
- }, {
- .freq = 55,
- .open_d = 0x08,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x8b,
- .xtal_cap20p = 0x02,
- .xtal_cap10p = 0x01,
- .xtal_cap0p = 0x00,
- .imr_mem = 0,
- }, {
- .freq = 60,
- .open_d = 0x08,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x7b,
- .xtal_cap20p = 0x02,
- .xtal_cap10p = 0x01,
- .xtal_cap0p = 0x00,
- .imr_mem = 0,
- }, {
- .freq = 65,
- .open_d = 0x08,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x69,
- .xtal_cap20p = 0x02,
- .xtal_cap10p = 0x01,
- .xtal_cap0p = 0x00,
- .imr_mem = 0,
- }, {
- .freq = 70,
- .open_d = 0x08,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x58,
- .xtal_cap20p = 0x02,
- .xtal_cap10p = 0x01,
- .xtal_cap0p = 0x00,
- .imr_mem = 0,
- }, {
- .freq = 75,
- .open_d = 0x00,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x44,
- .xtal_cap20p = 0x02,
- .xtal_cap10p = 0x01,
- .xtal_cap0p = 0x00,
- .imr_mem = 0,
- }, {
- .freq = 80,
- .open_d = 0x00,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x44,
- .xtal_cap20p = 0x02,
- .xtal_cap10p = 0x01,
- .xtal_cap0p = 0x00,
- .imr_mem = 0,
- }, {
- .freq = 90,
- .open_d = 0x00,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x34,
- .xtal_cap20p = 0x01,
- .xtal_cap10p = 0x01,
- .xtal_cap0p = 0x00,
- .imr_mem = 0,
- }, {
- .freq = 100,
- .open_d = 0x00,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x34,
- .xtal_cap20p = 0x01,
- .xtal_cap10p = 0x01,
- .xtal_cap0p = 0x00,
- .imr_mem = 0,
- }, {
- .freq = 110,
- .open_d = 0x00,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x24,
- .xtal_cap20p = 0x01,
- .xtal_cap10p = 0x01,
- .xtal_cap0p = 0x00,
- .imr_mem = 1,
- }, {
- .freq = 120,
- .open_d = 0x00,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x24,
- .xtal_cap20p = 0x01,
- .xtal_cap10p = 0x01,
- .xtal_cap0p = 0x00,
- .imr_mem = 1,
- }, {
- .freq = 140,
- .open_d = 0x00,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x14,
- .xtal_cap20p = 0x01,
- .xtal_cap10p = 0x01,
- .xtal_cap0p = 0x00,
- .imr_mem = 1,
- }, {
- .freq = 180,
- .open_d = 0x00,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x13,
- .xtal_cap20p = 0x00,
- .xtal_cap10p = 0x00,
- .xtal_cap0p = 0x00,
- .imr_mem = 1,
- }, {
- .freq = 220,
- .open_d = 0x00,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x13,
- .xtal_cap20p = 0x00,
- .xtal_cap10p = 0x00,
- .xtal_cap0p = 0x00,
- .imr_mem = 2,
- }, {
- .freq = 250,
- .open_d = 0x00,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x11,
- .xtal_cap20p = 0x00,
- .xtal_cap10p = 0x00,
- .xtal_cap0p = 0x00,
- .imr_mem = 2,
- }, {
- .freq = 280,
- .open_d = 0x00,
- .rf_mux_ploy = 0x02,
- .tf_c = 0x00,
- .xtal_cap20p = 0x00,
- .xtal_cap10p = 0x00,
- .xtal_cap0p = 0x00,
- .imr_mem = 2,
- }, {
- .freq = 310,
- .open_d = 0x00,
- .rf_mux_ploy = 0x41,
- .tf_c = 0x00,
- .xtal_cap20p = 0x00,
- .xtal_cap10p = 0x00,
- .xtal_cap0p = 0x00,
- .imr_mem = 2,
- }, {
- .freq = 450,
- .open_d = 0x00,
- .rf_mux_ploy = 0x41,
- .tf_c = 0x00,
- .xtal_cap20p = 0x00,
- .xtal_cap10p = 0x00,
- .xtal_cap0p = 0x00,
- .imr_mem = 3,
- }, {
- .freq = 588,
- .open_d = 0x00,
- .rf_mux_ploy = 0x40,
- .tf_c = 0x00,
- .xtal_cap20p = 0x00,
- .xtal_cap10p = 0x00,
- .xtal_cap0p = 0x00,
- .imr_mem = 3,
- }, {
- .freq = 650,
- .open_d = 0x00,
- .rf_mux_ploy = 0x40,
- .tf_c = 0x00,
- .xtal_cap20p = 0x00,
- .xtal_cap10p = 0x00,
- .xtal_cap0p = 0x00,
- .imr_mem = 4,
- }
- };
- static int r820t_xtal_capacitor[][2] = {
- { 0x0b, XTAL_LOW_CAP_30P },
- { 0x02, XTAL_LOW_CAP_20P },
- { 0x01, XTAL_LOW_CAP_10P },
- { 0x00, XTAL_LOW_CAP_0P },
- { 0x10, XTAL_HIGH_CAP_0P },
- };
- static void shadow_store(struct r820t_priv *priv, u8 reg, const u8 *val,
- int len)
- {
- int r = reg - REG_SHADOW_START;
- if (r < 0) {
- len += r;
- r = 0;
- }
- if (len <= 0)
- return;
- if (len > NUM_REGS - r)
- len = NUM_REGS - r;
- tuner_dbg("%s: prev reg=%02x len=%d: %*ph\n",
- __func__, r + REG_SHADOW_START, len, len, val);
- memcpy(&priv->regs[r], val, len);
- }
- static int r820t_write(struct r820t_priv *priv, u8 reg, const u8 *val,
- int len)
- {
- int rc, size, pos = 0;
-
- shadow_store(priv, reg, val, len);
- do {
- if (len > priv->cfg->max_i2c_msg_len - 1)
- size = priv->cfg->max_i2c_msg_len - 1;
- else
- size = len;
-
- priv->buf[0] = reg;
- memcpy(&priv->buf[1], &val[pos], size);
- rc = tuner_i2c_xfer_send(&priv->i2c_props, priv->buf, size + 1);
- if (rc != size + 1) {
- tuner_info("%s: i2c wr failed=%d reg=%02x len=%d: %*ph\n",
- __func__, rc, reg, size, size, &priv->buf[1]);
- if (rc < 0)
- return rc;
- return -EREMOTEIO;
- }
- tuner_dbg("%s: i2c wr reg=%02x len=%d: %*ph\n",
- __func__, reg, size, size, &priv->buf[1]);
- reg += size;
- len -= size;
- pos += size;
- } while (len > 0);
- return 0;
- }
- static inline int r820t_write_reg(struct r820t_priv *priv, u8 reg, u8 val)
- {
- u8 tmp = val;
- return r820t_write(priv, reg, &tmp, 1);
- }
- static int r820t_read_cache_reg(struct r820t_priv *priv, int reg)
- {
- reg -= REG_SHADOW_START;
- if (reg >= 0 && reg < NUM_REGS)
- return priv->regs[reg];
- else
- return -EINVAL;
- }
- static inline int r820t_write_reg_mask(struct r820t_priv *priv, u8 reg, u8 val,
- u8 bit_mask)
- {
- u8 tmp = val;
- int rc = r820t_read_cache_reg(priv, reg);
- if (rc < 0)
- return rc;
- tmp = (rc & ~bit_mask) | (tmp & bit_mask);
- return r820t_write(priv, reg, &tmp, 1);
- }
- static int r820t_read(struct r820t_priv *priv, u8 reg, u8 *val, int len)
- {
- int rc, i;
- u8 *p = &priv->buf[1];
- priv->buf[0] = reg;
- rc = tuner_i2c_xfer_send_recv(&priv->i2c_props, priv->buf, 1, p, len);
- if (rc != len) {
- tuner_info("%s: i2c rd failed=%d reg=%02x len=%d: %*ph\n",
- __func__, rc, reg, len, len, p);
- if (rc < 0)
- return rc;
- return -EREMOTEIO;
- }
-
- for (i = 0; i < len; i++)
- val[i] = bitrev8(p[i]);
- tuner_dbg("%s: i2c rd reg=%02x len=%d: %*ph\n",
- __func__, reg, len, len, val);
- return 0;
- }
- static int r820t_set_mux(struct r820t_priv *priv, u32 freq)
- {
- const struct r820t_freq_range *range;
- int i, rc;
- u8 val, reg08, reg09;
-
- freq = freq / 1000000;
- for (i = 0; i < ARRAY_SIZE(freq_ranges) - 1; i++) {
- if (freq < freq_ranges[i + 1].freq)
- break;
- }
- range = &freq_ranges[i];
- tuner_dbg("set r820t range#%d for frequency %d MHz\n", i, freq);
-
- rc = r820t_write_reg_mask(priv, 0x17, range->open_d, 0x08);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1a, range->rf_mux_ploy, 0xc3);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg(priv, 0x1b, range->tf_c);
- if (rc < 0)
- return rc;
-
- switch (priv->xtal_cap_sel) {
- case XTAL_LOW_CAP_30P:
- case XTAL_LOW_CAP_20P:
- val = range->xtal_cap20p | 0x08;
- break;
- case XTAL_LOW_CAP_10P:
- val = range->xtal_cap10p | 0x08;
- break;
- case XTAL_HIGH_CAP_0P:
- val = range->xtal_cap0p | 0x00;
- break;
- default:
- case XTAL_LOW_CAP_0P:
- val = range->xtal_cap0p | 0x08;
- break;
- }
- rc = r820t_write_reg_mask(priv, 0x10, val, 0x0b);
- if (rc < 0)
- return rc;
- if (priv->imr_done) {
- reg08 = priv->imr_data[range->imr_mem].gain_x;
- reg09 = priv->imr_data[range->imr_mem].phase_y;
- } else {
- reg08 = 0;
- reg09 = 0;
- }
- rc = r820t_write_reg_mask(priv, 0x08, reg08, 0x3f);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg_mask(priv, 0x09, reg09, 0x3f);
- return rc;
- }
- static int r820t_set_pll(struct r820t_priv *priv, enum v4l2_tuner_type type,
- u32 freq)
- {
- u32 vco_freq;
- int rc, i;
- unsigned sleep_time = 10000;
- u32 vco_fra;
- u32 vco_min = 1770000;
- u32 vco_max = vco_min * 2;
- u32 pll_ref;
- u16 n_sdm = 2;
- u16 sdm = 0;
- u8 mix_div = 2;
- u8 div_buf = 0;
- u8 div_num = 0;
- u8 refdiv2 = 0;
- u8 ni, si, nint, vco_fine_tune, val;
- u8 data[5];
-
- freq = freq / 1000;
- pll_ref = priv->cfg->xtal / 1000;
- #if 0
-
- if ((priv->cfg->rafael_chip == CHIP_R620D) ||
- (priv->cfg->rafael_chip == CHIP_R828D) ||
- (priv->cfg->rafael_chip == CHIP_R828)) {
-
- if (type != V4L2_TUNER_DIGITAL_TV) {
- pll_ref /= 2;
- refdiv2 = 0x10;
- sleep_time = 20000;
- }
- } else {
- if (priv->cfg->xtal > 24000000) {
- pll_ref /= 2;
- refdiv2 = 0x10;
- }
- }
- #endif
- rc = r820t_write_reg_mask(priv, 0x10, refdiv2, 0x10);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1a, 0x00, 0x0c);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x12, 0x80, 0xe0);
- if (rc < 0)
- return rc;
-
- while (mix_div <= 64) {
- if (((freq * mix_div) >= vco_min) &&
- ((freq * mix_div) < vco_max)) {
- div_buf = mix_div;
- while (div_buf > 2) {
- div_buf = div_buf >> 1;
- div_num++;
- }
- break;
- }
- mix_div = mix_div << 1;
- }
- rc = r820t_read(priv, 0x00, data, sizeof(data));
- if (rc < 0)
- return rc;
- vco_fine_tune = (data[4] & 0x30) >> 4;
- tuner_dbg("mix_div=%d div_num=%d vco_fine_tune=%d\n",
- mix_div, div_num, vco_fine_tune);
-
- if (priv->cfg->rafael_chip != CHIP_R828D) {
- if (vco_fine_tune > VCO_POWER_REF)
- div_num = div_num - 1;
- else if (vco_fine_tune < VCO_POWER_REF)
- div_num = div_num + 1;
- }
- rc = r820t_write_reg_mask(priv, 0x10, div_num << 5, 0xe0);
- if (rc < 0)
- return rc;
- vco_freq = freq * mix_div;
- nint = vco_freq / (2 * pll_ref);
- vco_fra = vco_freq - 2 * pll_ref * nint;
-
- if (vco_fra < pll_ref / 64) {
- vco_fra = 0;
- } else if (vco_fra > pll_ref * 127 / 64) {
- vco_fra = 0;
- nint++;
- } else if ((vco_fra > pll_ref * 127 / 128) && (vco_fra < pll_ref)) {
- vco_fra = pll_ref * 127 / 128;
- } else if ((vco_fra > pll_ref) && (vco_fra < pll_ref * 129 / 128)) {
- vco_fra = pll_ref * 129 / 128;
- }
- ni = (nint - 13) / 4;
- si = nint - 4 * ni - 13;
- rc = r820t_write_reg(priv, 0x14, ni + (si << 6));
- if (rc < 0)
- return rc;
-
- if (!vco_fra)
- val = 0x08;
- else
- val = 0x00;
- rc = r820t_write_reg_mask(priv, 0x12, val, 0x08);
- if (rc < 0)
- return rc;
-
- while (vco_fra > 1) {
- if (vco_fra > (2 * pll_ref / n_sdm)) {
- sdm = sdm + 32768 / (n_sdm / 2);
- vco_fra = vco_fra - 2 * pll_ref / n_sdm;
- if (n_sdm >= 0x8000)
- break;
- }
- n_sdm = n_sdm << 1;
- }
- tuner_dbg("freq %d kHz, pll ref %d%s, sdm=0x%04x\n",
- freq, pll_ref, refdiv2 ? " / 2" : "", sdm);
- rc = r820t_write_reg(priv, 0x16, sdm >> 8);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x15, sdm & 0xff);
- if (rc < 0)
- return rc;
- for (i = 0; i < 2; i++) {
- usleep_range(sleep_time, sleep_time + 1000);
-
- rc = r820t_read(priv, 0x00, data, 3);
- if (rc < 0)
- return rc;
- if (data[2] & 0x40)
- break;
- if (!i) {
-
- rc = r820t_write_reg_mask(priv, 0x12, 0x60, 0xe0);
- if (rc < 0)
- return rc;
- }
- }
- if (!(data[2] & 0x40)) {
- priv->has_lock = false;
- return 0;
- }
- priv->has_lock = true;
- tuner_dbg("tuner has lock at frequency %d kHz\n", freq);
-
- rc = r820t_write_reg_mask(priv, 0x1a, 0x08, 0x08);
- return rc;
- }
- static int r820t_sysfreq_sel(struct r820t_priv *priv, u32 freq,
- enum v4l2_tuner_type type,
- v4l2_std_id std,
- u32 delsys)
- {
- int rc;
- u8 mixer_top, lna_top, cp_cur, div_buf_cur, lna_vth_l, mixer_vth_l;
- u8 air_cable1_in, cable2_in, pre_dect, lna_discharge, filter_cur;
- tuner_dbg("adjusting tuner parameters for the standard\n");
- switch (delsys) {
- case SYS_DVBT:
- if ((freq == 506000000) || (freq == 666000000) ||
- (freq == 818000000)) {
- mixer_top = 0x14;
- lna_top = 0xe5;
- cp_cur = 0x28;
- div_buf_cur = 0x20;
- } else {
- mixer_top = 0x24;
- lna_top = 0xe5;
- cp_cur = 0x38;
- div_buf_cur = 0x30;
- }
- lna_vth_l = 0x53;
- mixer_vth_l = 0x75;
- air_cable1_in = 0x00;
- cable2_in = 0x00;
- pre_dect = 0x40;
- lna_discharge = 14;
- filter_cur = 0x40;
- break;
- case SYS_DVBT2:
- mixer_top = 0x24;
- lna_top = 0xe5;
- lna_vth_l = 0x53;
- mixer_vth_l = 0x75;
- air_cable1_in = 0x00;
- cable2_in = 0x00;
- pre_dect = 0x40;
- lna_discharge = 14;
- cp_cur = 0x38;
- div_buf_cur = 0x30;
- filter_cur = 0x40;
- break;
- case SYS_ISDBT:
- mixer_top = 0x24;
- lna_top = 0xe5;
- lna_vth_l = 0x75;
- mixer_vth_l = 0x75;
- air_cable1_in = 0x00;
- cable2_in = 0x00;
- pre_dect = 0x40;
- lna_discharge = 14;
- cp_cur = 0x38;
- div_buf_cur = 0x30;
- filter_cur = 0x40;
- break;
- case SYS_DVBC_ANNEX_A:
- mixer_top = 0x24;
- lna_top = 0xe5;
- lna_vth_l = 0x62;
- mixer_vth_l = 0x75;
- air_cable1_in = 0x60;
- cable2_in = 0x00;
- pre_dect = 0x40;
- lna_discharge = 14;
- cp_cur = 0x38;
- div_buf_cur = 0x30;
- filter_cur = 0x40;
- break;
- default:
- mixer_top = 0x24;
- lna_top = 0xe5;
- lna_vth_l = 0x53;
- mixer_vth_l = 0x75;
- air_cable1_in = 0x00;
- cable2_in = 0x00;
- pre_dect = 0x40;
- lna_discharge = 14;
- cp_cur = 0x38;
- div_buf_cur = 0x30;
- filter_cur = 0x40;
- break;
- }
- if (priv->cfg->use_diplexer &&
- ((priv->cfg->rafael_chip == CHIP_R820T) ||
- (priv->cfg->rafael_chip == CHIP_R828S) ||
- (priv->cfg->rafael_chip == CHIP_R820C))) {
- if (freq > DIP_FREQ)
- air_cable1_in = 0x00;
- else
- air_cable1_in = 0x60;
- cable2_in = 0x00;
- }
- if (priv->cfg->use_predetect) {
- rc = r820t_write_reg_mask(priv, 0x06, pre_dect, 0x40);
- if (rc < 0)
- return rc;
- }
- rc = r820t_write_reg_mask(priv, 0x1d, lna_top, 0xc7);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg_mask(priv, 0x1c, mixer_top, 0xf8);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x0d, lna_vth_l);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x0e, mixer_vth_l);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x05, air_cable1_in, 0x60);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg_mask(priv, 0x06, cable2_in, 0x08);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg_mask(priv, 0x11, cp_cur, 0x38);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg_mask(priv, 0x17, div_buf_cur, 0x30);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg_mask(priv, 0x0a, filter_cur, 0x60);
- if (rc < 0)
- return rc;
-
-
- tuner_dbg("adjusting LNA parameters\n");
- if (type != V4L2_TUNER_ANALOG_TV) {
-
- rc = r820t_write_reg_mask(priv, 0x1d, 0, 0x38);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1c, 0, 0x04);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x06, 0, 0x40);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1a, 0x30, 0x30);
- if (rc < 0)
- return rc;
- msleep(250);
-
- rc = r820t_write_reg_mask(priv, 0x1d, 0x18, 0x38);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1c, mixer_top, 0x04);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1e, lna_discharge, 0x1f);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1a, 0x20, 0x30);
- if (rc < 0)
- return rc;
- } else {
-
- rc = r820t_write_reg_mask(priv, 0x06, 0, 0x40);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1d, lna_top, 0x38);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1c, mixer_top, 0x04);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1e, lna_discharge, 0x1f);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1a, 0x00, 0x30);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg_mask(priv, 0x10, 0x00, 0x04);
- if (rc < 0)
- return rc;
- }
- return 0;
- }
- static int r820t_set_tv_standard(struct r820t_priv *priv,
- unsigned bw,
- enum v4l2_tuner_type type,
- v4l2_std_id std, u32 delsys)
- {
- int rc, i;
- u32 if_khz, filt_cal_lo;
- u8 data[5], val;
- u8 filt_gain, img_r, filt_q, hp_cor, ext_enable, loop_through;
- u8 lt_att, flt_ext_widest, polyfil_cur;
- bool need_calibration;
- tuner_dbg("selecting the delivery system\n");
- if (delsys == SYS_ISDBT) {
- if_khz = 4063;
- filt_cal_lo = 59000;
- filt_gain = 0x10;
- img_r = 0x00;
- filt_q = 0x10;
- hp_cor = 0x6a;
- ext_enable = 0x40;
- loop_through = 0x00;
- lt_att = 0x00;
- flt_ext_widest = 0x80;
- polyfil_cur = 0x60;
- } else if (delsys == SYS_DVBC_ANNEX_A) {
- if_khz = 5070;
- filt_cal_lo = 73500;
- filt_gain = 0x10;
- img_r = 0x00;
- filt_q = 0x10;
- hp_cor = 0x0b;
- ext_enable = 0x40;
- loop_through = 0x00;
- lt_att = 0x00;
- flt_ext_widest = 0x00;
- polyfil_cur = 0x60;
- } else if (delsys == SYS_DVBC_ANNEX_C) {
- if_khz = 4063;
- filt_cal_lo = 55000;
- filt_gain = 0x10;
- img_r = 0x00;
- filt_q = 0x10;
- hp_cor = 0x6a;
- ext_enable = 0x40;
- loop_through = 0x00;
- lt_att = 0x00;
- flt_ext_widest = 0x80;
- polyfil_cur = 0x60;
- } else {
- if (bw <= 6) {
- if_khz = 3570;
- filt_cal_lo = 56000;
- filt_gain = 0x10;
- img_r = 0x00;
- filt_q = 0x10;
- hp_cor = 0x6b;
- ext_enable = 0x60;
- loop_through = 0x00;
- lt_att = 0x00;
- flt_ext_widest = 0x00;
- polyfil_cur = 0x60;
- } else if (bw == 7) {
- #if 0
-
- if_khz = 4070;
- filt_cal_lo = 60000;
- filt_gain = 0x10;
- img_r = 0x00;
- filt_q = 0x10;
- hp_cor = 0x2b;
- ext_enable = 0x60;
- loop_through = 0x00;
- lt_att = 0x00;
- flt_ext_widest = 0x00;
- polyfil_cur = 0x60;
- #endif
-
- if_khz = 4570;
- filt_cal_lo = 63000;
- filt_gain = 0x10;
- img_r = 0x00;
- filt_q = 0x10;
- hp_cor = 0x2a;
- ext_enable = 0x60;
- loop_through = 0x00;
- lt_att = 0x00;
- flt_ext_widest = 0x00;
- polyfil_cur = 0x60;
- } else {
- if_khz = 4570;
- filt_cal_lo = 68500;
- filt_gain = 0x10;
- img_r = 0x00;
- filt_q = 0x10;
- hp_cor = 0x0b;
- ext_enable = 0x60;
- loop_through = 0x00;
- lt_att = 0x00;
- flt_ext_widest = 0x00;
- polyfil_cur = 0x60;
- }
- }
-
- memcpy(priv->regs, r820t_init_array, sizeof(r820t_init_array));
-
- if (priv->imr_done)
- val = 1 | priv->xtal_cap_sel << 1;
- else
- val = 0;
- rc = r820t_write_reg_mask(priv, 0x0c, val, 0x0f);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x13, VER_NUM, 0x3f);
- if (rc < 0)
- return rc;
-
- if (type != V4L2_TUNER_ANALOG_TV) {
- rc = r820t_write_reg_mask(priv, 0x1d, 0x00, 0x38);
- if (rc < 0)
- return rc;
- usleep_range(1000, 2000);
- }
- priv->int_freq = if_khz * 1000;
-
- if (type != priv->type)
- need_calibration = true;
- else if ((type == V4L2_TUNER_ANALOG_TV) && (std != priv->std))
- need_calibration = true;
- else if ((type == V4L2_TUNER_DIGITAL_TV) &&
- ((delsys != priv->delsys) || bw != priv->bw))
- need_calibration = true;
- else
- need_calibration = false;
- if (need_calibration) {
- tuner_dbg("calibrating the tuner\n");
- for (i = 0; i < 2; i++) {
-
- rc = r820t_write_reg_mask(priv, 0x0b, hp_cor, 0x60);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x0f, 0x04, 0x04);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x10, 0x00, 0x03);
- if (rc < 0)
- return rc;
- rc = r820t_set_pll(priv, type, filt_cal_lo * 1000);
- if (rc < 0 || !priv->has_lock)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x0b, 0x10, 0x10);
- if (rc < 0)
- return rc;
- usleep_range(1000, 2000);
-
- rc = r820t_write_reg_mask(priv, 0x0b, 0x00, 0x10);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x0f, 0x00, 0x04);
- if (rc < 0)
- return rc;
-
- rc = r820t_read(priv, 0x00, data, sizeof(data));
- if (rc < 0)
- return rc;
- priv->fil_cal_code = data[4] & 0x0f;
- if (priv->fil_cal_code && priv->fil_cal_code != 0x0f)
- break;
- }
-
- if (priv->fil_cal_code == 0x0f)
- priv->fil_cal_code = 0;
- }
- rc = r820t_write_reg_mask(priv, 0x0a,
- filt_q | priv->fil_cal_code, 0x1f);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x0b, hp_cor, 0xef);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x07, img_r, 0x80);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x06, filt_gain, 0x30);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1e, ext_enable, 0x60);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x05, loop_through, 0x80);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1f, lt_att, 0x80);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x0f, flt_ext_widest, 0x80);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x19, polyfil_cur, 0x60);
- if (rc < 0)
- return rc;
-
- priv->delsys = delsys;
- priv->type = type;
- priv->std = std;
- priv->bw = bw;
- return 0;
- }
- static int r820t_read_gain(struct r820t_priv *priv)
- {
- u8 data[4];
- int rc;
- rc = r820t_read(priv, 0x00, data, sizeof(data));
- if (rc < 0)
- return rc;
- return ((data[3] & 0x08) << 1) + ((data[3] & 0xf0) >> 4);
- }
- #if 0
- static const int r820t_lna_gain_steps[] = {
- 0, 9, 13, 40, 38, 13, 31, 22, 26, 31, 26, 14, 19, 5, 35, 13
- };
- static const int r820t_mixer_gain_steps[] = {
- 0, 5, 10, 10, 19, 9, 10, 25, 17, 10, 8, 16, 13, 6, 3, -8
- };
- static int r820t_set_gain_mode(struct r820t_priv *priv,
- bool set_manual_gain,
- int gain)
- {
- int rc;
- if (set_manual_gain) {
- int i, total_gain = 0;
- uint8_t mix_index = 0, lna_index = 0;
- u8 data[4];
-
- rc = r820t_write_reg_mask(priv, 0x05, 0x10, 0x10);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x07, 0, 0x10);
- if (rc < 0)
- return rc;
- rc = r820t_read(priv, 0x00, data, sizeof(data));
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x0c, 0x08, 0x9f);
- if (rc < 0)
- return rc;
- for (i = 0; i < 15; i++) {
- if (total_gain >= gain)
- break;
- total_gain += r820t_lna_gain_steps[++lna_index];
- if (total_gain >= gain)
- break;
- total_gain += r820t_mixer_gain_steps[++mix_index];
- }
-
- rc = r820t_write_reg_mask(priv, 0x05, lna_index, 0x0f);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x07, mix_index, 0x0f);
- if (rc < 0)
- return rc;
- } else {
-
- rc = r820t_write_reg_mask(priv, 0x05, 0, 0x10);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x07, 0x10, 0x10);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x0c, 0x0b, 0x9f);
- if (rc < 0)
- return rc;
- }
- return 0;
- }
- #endif
- static int generic_set_freq(struct dvb_frontend *fe,
- u32 freq ,
- unsigned bw,
- enum v4l2_tuner_type type,
- v4l2_std_id std, u32 delsys)
- {
- struct r820t_priv *priv = fe->tuner_priv;
- int rc;
- u32 lo_freq;
- tuner_dbg("should set frequency to %d kHz, bw %d MHz\n",
- freq / 1000, bw);
- rc = r820t_set_tv_standard(priv, bw, type, std, delsys);
- if (rc < 0)
- goto err;
- if ((type == V4L2_TUNER_ANALOG_TV) && (std == V4L2_STD_SECAM_LC))
- lo_freq = freq - priv->int_freq;
- else
- lo_freq = freq + priv->int_freq;
- rc = r820t_set_mux(priv, lo_freq);
- if (rc < 0)
- goto err;
- rc = r820t_set_pll(priv, type, lo_freq);
- if (rc < 0 || !priv->has_lock)
- goto err;
- rc = r820t_sysfreq_sel(priv, freq, type, std, delsys);
- if (rc < 0)
- goto err;
- tuner_dbg("%s: PLL locked on frequency %d Hz, gain=%d\n",
- __func__, freq, r820t_read_gain(priv));
- err:
- if (rc < 0)
- tuner_dbg("%s: failed=%d\n", __func__, rc);
- return rc;
- }
- static int r820t_standby(struct r820t_priv *priv)
- {
- int rc;
-
- if (!priv->init_done)
- return 0;
- rc = r820t_write_reg(priv, 0x06, 0xb1);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x05, 0x03);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x07, 0x3a);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x08, 0x40);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x09, 0xc0);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x0a, 0x36);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x0c, 0x35);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x0f, 0x68);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x11, 0x03);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x17, 0xf4);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x19, 0x0c);
-
- priv->type = -1;
- return rc;
- }
- static int r820t_xtal_check(struct r820t_priv *priv)
- {
- int rc, i;
- u8 data[3], val;
-
- memcpy(priv->regs, r820t_init_array, sizeof(r820t_init_array));
-
- rc = r820t_write_reg_mask(priv, 0x10, 0x0b, 0x0b);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1a, 0x00, 0x0c);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x13, 0x7f, 0x7f);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x13, 0x00, 0x40);
- if (rc < 0)
- return rc;
-
- for (i = 0; i < ARRAY_SIZE(r820t_xtal_capacitor); i++) {
- rc = r820t_write_reg_mask(priv, 0x10,
- r820t_xtal_capacitor[i][0], 0x1b);
- if (rc < 0)
- return rc;
- usleep_range(5000, 6000);
- rc = r820t_read(priv, 0x00, data, sizeof(data));
- if (rc < 0)
- return rc;
- if (!(data[2] & 0x40))
- continue;
- val = data[2] & 0x3f;
- if (priv->cfg->xtal == 16000000 && (val > 29 || val < 23))
- break;
- if (val != 0x3f)
- break;
- }
- if (i == ARRAY_SIZE(r820t_xtal_capacitor))
- return -EINVAL;
- return r820t_xtal_capacitor[i][1];
- }
- static int r820t_imr_prepare(struct r820t_priv *priv)
- {
- int rc;
-
- memcpy(priv->regs, r820t_init_array, sizeof(r820t_init_array));
-
- rc = r820t_write_reg_mask(priv, 0x05, 0x20, 0x20);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x07, 0, 0x10);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x0a, 0x0f, 0x0f);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x0b, 0x60, 0x6f);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x0c, 0x0b, 0x9f);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x0f, 0, 0x08);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x18, 0x10, 0x10);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1c, 0x02, 0x02);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x1e, 0x80, 0x80);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg_mask(priv, 0x06, 0x20, 0x20);
- return rc;
- }
- static int r820t_multi_read(struct r820t_priv *priv)
- {
- int rc, i;
- u16 sum = 0;
- u8 data[2], min = 255, max = 0;
- usleep_range(5000, 6000);
- for (i = 0; i < 6; i++) {
- rc = r820t_read(priv, 0x00, data, sizeof(data));
- if (rc < 0)
- return rc;
- sum += data[1];
- if (data[1] < min)
- min = data[1];
- if (data[1] > max)
- max = data[1];
- }
- rc = sum - max - min;
- return rc;
- }
- static int r820t_imr_cross(struct r820t_priv *priv,
- struct r820t_sect_type iq_point[3],
- u8 *x_direct)
- {
- struct r820t_sect_type cross[5];
- struct r820t_sect_type tmp;
- int i, rc;
- u8 reg08, reg09;
- reg08 = r820t_read_cache_reg(priv, 8) & 0xc0;
- reg09 = r820t_read_cache_reg(priv, 9) & 0xc0;
- tmp.gain_x = 0;
- tmp.phase_y = 0;
- tmp.value = 255;
- for (i = 0; i < 5; i++) {
- switch (i) {
- case 0:
- cross[i].gain_x = reg08;
- cross[i].phase_y = reg09;
- break;
- case 1:
- cross[i].gain_x = reg08;
- cross[i].phase_y = reg09 + 1;
- break;
- case 2:
- cross[i].gain_x = reg08;
- cross[i].phase_y = (reg09 | 0x20) + 1;
- break;
- case 3:
- cross[i].gain_x = reg08 + 1;
- cross[i].phase_y = reg09;
- break;
- default:
- cross[i].gain_x = (reg08 | 0x20) + 1;
- cross[i].phase_y = reg09;
- }
- rc = r820t_write_reg(priv, 0x08, cross[i].gain_x);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x09, cross[i].phase_y);
- if (rc < 0)
- return rc;
- rc = r820t_multi_read(priv);
- if (rc < 0)
- return rc;
- cross[i].value = rc;
- if (cross[i].value < tmp.value)
- tmp = cross[i];
- }
- if ((tmp.phase_y & 0x1f) == 1) {
- *x_direct = 0;
- iq_point[0] = cross[0];
- iq_point[1] = cross[1];
- iq_point[2] = cross[2];
- } else {
- *x_direct = 1;
- iq_point[0] = cross[0];
- iq_point[1] = cross[3];
- iq_point[2] = cross[4];
- }
- return 0;
- }
- static void r820t_compre_cor(struct r820t_sect_type iq[3])
- {
- int i;
- for (i = 3; i > 0; i--) {
- if (iq[0].value > iq[i - 1].value)
- swap(iq[0], iq[i - 1]);
- }
- }
- static int r820t_compre_step(struct r820t_priv *priv,
- struct r820t_sect_type iq[3], u8 reg)
- {
- int rc;
- struct r820t_sect_type tmp;
-
-
- tmp.phase_y = iq[0].phase_y;
- tmp.gain_x = iq[0].gain_x;
- while (((tmp.gain_x & 0x1f) < IMR_TRIAL) &&
- ((tmp.phase_y & 0x1f) < IMR_TRIAL)) {
- if (reg == 0x08)
- tmp.gain_x++;
- else
- tmp.phase_y++;
- rc = r820t_write_reg(priv, 0x08, tmp.gain_x);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, 0x09, tmp.phase_y);
- if (rc < 0)
- return rc;
- rc = r820t_multi_read(priv);
- if (rc < 0)
- return rc;
- tmp.value = rc;
- if (tmp.value <= iq[0].value) {
- iq[0].gain_x = tmp.gain_x;
- iq[0].phase_y = tmp.phase_y;
- iq[0].value = tmp.value;
- } else {
- return 0;
- }
- }
- return 0;
- }
- static int r820t_iq_tree(struct r820t_priv *priv,
- struct r820t_sect_type iq[3],
- u8 fix_val, u8 var_val, u8 fix_reg)
- {
- int rc, i;
- u8 tmp, var_reg;
-
- if (fix_reg == 0x08)
- var_reg = 0x09;
- else
- var_reg = 0x08;
- for (i = 0; i < 3; i++) {
- rc = r820t_write_reg(priv, fix_reg, fix_val);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg(priv, var_reg, var_val);
- if (rc < 0)
- return rc;
- rc = r820t_multi_read(priv);
- if (rc < 0)
- return rc;
- iq[i].value = rc;
- if (fix_reg == 0x08) {
- iq[i].gain_x = fix_val;
- iq[i].phase_y = var_val;
- } else {
- iq[i].phase_y = fix_val;
- iq[i].gain_x = var_val;
- }
- if (i == 0) {
- var_val++;
- } else if (i == 1) {
-
- if ((var_val & 0x1f) < 0x02) {
- tmp = 2 - (var_val & 0x1f);
-
- if (var_val & 0x20) {
- var_val &= 0xc0;
- var_val |= tmp;
- } else {
- var_val |= 0x20 | tmp;
- }
- } else {
- var_val -= 2;
- }
- }
- }
- return 0;
- }
- static int r820t_section(struct r820t_priv *priv,
- struct r820t_sect_type *iq_point)
- {
- int rc;
- struct r820t_sect_type compare_iq[3], compare_bet[3];
-
- if (!(iq_point->gain_x & 0x1f))
- compare_iq[0].gain_x = ((iq_point->gain_x) & 0xdf) + 1;
- else
- compare_iq[0].gain_x = iq_point->gain_x - 1;
- compare_iq[0].phase_y = iq_point->phase_y;
-
- rc = r820t_iq_tree(priv, compare_iq, compare_iq[0].gain_x,
- compare_iq[0].phase_y, 0x08);
- if (rc < 0)
- return rc;
- r820t_compre_cor(compare_iq);
- compare_bet[0] = compare_iq[0];
-
- compare_iq[0].gain_x = iq_point->gain_x;
- compare_iq[0].phase_y = iq_point->phase_y;
- rc = r820t_iq_tree(priv, compare_iq, compare_iq[0].gain_x,
- compare_iq[0].phase_y, 0x08);
- if (rc < 0)
- return rc;
- r820t_compre_cor(compare_iq);
- compare_bet[1] = compare_iq[0];
-
- if ((iq_point->gain_x & 0x1f) == 0x00)
- compare_iq[0].gain_x = ((iq_point->gain_x) | 0x20) + 1;
- else
- compare_iq[0].gain_x = iq_point->gain_x + 1;
- compare_iq[0].phase_y = iq_point->phase_y;
- rc = r820t_iq_tree(priv, compare_iq, compare_iq[0].gain_x,
- compare_iq[0].phase_y, 0x08);
- if (rc < 0)
- return rc;
- r820t_compre_cor(compare_iq);
- compare_bet[2] = compare_iq[0];
- r820t_compre_cor(compare_bet);
- *iq_point = compare_bet[0];
- return 0;
- }
- static int r820t_vga_adjust(struct r820t_priv *priv)
- {
- int rc;
- u8 vga_count;
-
- for (vga_count = 12; vga_count < 16; vga_count++) {
- rc = r820t_write_reg_mask(priv, 0x0c, vga_count, 0x0f);
- if (rc < 0)
- return rc;
- usleep_range(10000, 11000);
- rc = r820t_multi_read(priv);
- if (rc < 0)
- return rc;
- if (rc > 40 * 4)
- break;
- }
- return 0;
- }
- static int r820t_iq(struct r820t_priv *priv, struct r820t_sect_type *iq_pont)
- {
- struct r820t_sect_type compare_iq[3];
- int rc;
- u8 x_direction = 0;
- u8 dir_reg, other_reg;
- r820t_vga_adjust(priv);
- rc = r820t_imr_cross(priv, compare_iq, &x_direction);
- if (rc < 0)
- return rc;
- if (x_direction == 1) {
- dir_reg = 0x08;
- other_reg = 0x09;
- } else {
- dir_reg = 0x09;
- other_reg = 0x08;
- }
-
- r820t_compre_cor(compare_iq);
-
- rc = r820t_compre_step(priv, compare_iq, dir_reg);
- if (rc < 0)
- return rc;
-
- rc = r820t_iq_tree(priv, compare_iq, compare_iq[0].gain_x,
- compare_iq[0].phase_y, dir_reg);
- if (rc < 0)
- return rc;
-
- r820t_compre_cor(compare_iq);
-
- rc = r820t_compre_step(priv, compare_iq, other_reg);
- if (rc < 0)
- return rc;
-
- rc = r820t_iq_tree(priv, compare_iq, compare_iq[0].gain_x,
- compare_iq[0].phase_y, other_reg);
- if (rc < 0)
- return rc;
- r820t_compre_cor(compare_iq);
-
- rc = r820t_section(priv, compare_iq);
- *iq_pont = compare_iq[0];
-
- rc = r820t_write_reg_mask(priv, 0x08, 0, 0x3f);
- if (rc < 0)
- return rc;
- rc = r820t_write_reg_mask(priv, 0x09, 0, 0x3f);
- return rc;
- }
- static int r820t_f_imr(struct r820t_priv *priv, struct r820t_sect_type *iq_pont)
- {
- int rc;
- r820t_vga_adjust(priv);
-
- rc = r820t_section(priv, iq_pont);
- if (rc < 0)
- return rc;
- return 0;
- }
- static int r820t_imr(struct r820t_priv *priv, unsigned imr_mem, bool im_flag)
- {
- struct r820t_sect_type imr_point;
- int rc;
- u32 ring_vco, ring_freq, ring_ref;
- u8 n_ring, n;
- int reg18, reg19, reg1f;
- if (priv->cfg->xtal > 24000000)
- ring_ref = priv->cfg->xtal / 2000;
- else
- ring_ref = priv->cfg->xtal / 1000;
- n_ring = 15;
- for (n = 0; n < 16; n++) {
- if ((16 + n) * 8 * ring_ref >= 3100000) {
- n_ring = n;
- break;
- }
- }
- reg18 = r820t_read_cache_reg(priv, 0x18);
- reg19 = r820t_read_cache_reg(priv, 0x19);
- reg1f = r820t_read_cache_reg(priv, 0x1f);
- reg18 &= 0xf0;
- reg18 |= n_ring;
- ring_vco = (16 + n_ring) * 8 * ring_ref;
- reg18 &= 0xdf;
- reg19 &= 0xfc;
- reg1f &= 0xfc;
- switch (imr_mem) {
- case 0:
- ring_freq = ring_vco / 48;
- reg18 |= 0x20;
- reg19 |= 0x03;
- reg1f |= 0x02;
- break;
- case 1:
- ring_freq = ring_vco / 16;
- reg18 |= 0x00;
- reg19 |= 0x02;
- reg1f |= 0x00;
- break;
- case 2:
- ring_freq = ring_vco / 8;
- reg18 |= 0x00;
- reg19 |= 0x01;
- reg1f |= 0x03;
- break;
- case 3:
- ring_freq = ring_vco / 6;
- reg18 |= 0x20;
- reg19 |= 0x00;
- reg1f |= 0x03;
- break;
- case 4:
- ring_freq = ring_vco / 4;
- reg18 |= 0x00;
- reg19 |= 0x00;
- reg1f |= 0x01;
- break;
- default:
- ring_freq = ring_vco / 4;
- reg18 |= 0x00;
- reg19 |= 0x00;
- reg1f |= 0x01;
- break;
- }
-
-
- rc = r820t_write_reg(priv, 0x18, reg18);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg(priv, 0x19, reg19);
- if (rc < 0)
- return rc;
-
- rc = r820t_write_reg(priv, 0x1f, reg1f);
- if (rc < 0)
- return rc;
-
- rc = r820t_set_mux(priv, (ring_freq - 5300) * 1000);
- if (rc < 0)
- return rc;
- rc = r820t_set_pll(priv, V4L2_TUNER_DIGITAL_TV,
- (ring_freq - 5300) * 1000);
- if (!priv->has_lock)
- rc = -EINVAL;
- if (rc < 0)
- return rc;
- if (im_flag) {
- rc = r820t_iq(priv, &imr_point);
- } else {
- imr_point.gain_x = priv->imr_data[3].gain_x;
- imr_point.phase_y = priv->imr_data[3].phase_y;
- imr_point.value = priv->imr_data[3].value;
- rc = r820t_f_imr(priv, &imr_point);
- }
- if (rc < 0)
- return rc;
-
- switch (imr_mem) {
- case 0:
- priv->imr_data[0].gain_x = imr_point.gain_x;
- priv->imr_data[0].phase_y = imr_point.phase_y;
- priv->imr_data[0].value = imr_point.value;
- break;
- case 1:
- priv->imr_data[1].gain_x = imr_point.gain_x;
- priv->imr_data[1].phase_y = imr_point.phase_y;
- priv->imr_data[1].value = imr_point.value;
- break;
- case 2:
- priv->imr_data[2].gain_x = imr_point.gain_x;
- priv->imr_data[2].phase_y = imr_point.phase_y;
- priv->imr_data[2].value = imr_point.value;
- break;
- case 3:
- priv->imr_data[3].gain_x = imr_point.gain_x;
- priv->imr_data[3].phase_y = imr_point.phase_y;
- priv->imr_data[3].value = imr_point.value;
- break;
- case 4:
- priv->imr_data[4].gain_x = imr_point.gain_x;
- priv->imr_data[4].phase_y = imr_point.phase_y;
- priv->imr_data[4].value = imr_point.value;
- break;
- default:
- priv->imr_data[4].gain_x = imr_point.gain_x;
- priv->imr_data[4].phase_y = imr_point.phase_y;
- priv->imr_data[4].value = imr_point.value;
- break;
- }
- return 0;
- }
- static int r820t_imr_callibrate(struct r820t_priv *priv)
- {
- int rc, i;
- int xtal_cap = 0;
- if (priv->init_done)
- return 0;
-
- if ((priv->cfg->rafael_chip == CHIP_R820T) ||
- (priv->cfg->rafael_chip == CHIP_R828S) ||
- (priv->cfg->rafael_chip == CHIP_R820C)) {
- priv->xtal_cap_sel = XTAL_HIGH_CAP_0P;
- } else {
-
- rc = r820t_write(priv, 0x05,
- r820t_init_array, sizeof(r820t_init_array));
- if (rc < 0)
- return rc;
- for (i = 0; i < 3; i++) {
- rc = r820t_xtal_check(priv);
- if (rc < 0)
- return rc;
- if (!i || rc > xtal_cap)
- xtal_cap = rc;
- }
- priv->xtal_cap_sel = xtal_cap;
- }
-
- if (no_imr_cal) {
- priv->init_done = true;
- return 0;
- }
-
- rc = r820t_write(priv, 0x05,
- r820t_init_array, sizeof(r820t_init_array));
- if (rc < 0)
- return rc;
- rc = r820t_imr_prepare(priv);
- if (rc < 0)
- return rc;
- rc = r820t_imr(priv, 3, true);
- if (rc < 0)
- return rc;
- rc = r820t_imr(priv, 1, false);
- if (rc < 0)
- return rc;
- rc = r820t_imr(priv, 0, false);
- if (rc < 0)
- return rc;
- rc = r820t_imr(priv, 2, false);
- if (rc < 0)
- return rc;
- rc = r820t_imr(priv, 4, false);
- if (rc < 0)
- return rc;
- priv->init_done = true;
- priv->imr_done = true;
- return 0;
- }
- #if 0
- static int r820t_gpio(struct r820t_priv *priv, bool enable)
- {
- return r820t_write_reg_mask(priv, 0x0f, enable ? 1 : 0, 0x01);
- }
- #endif
- static int r820t_init(struct dvb_frontend *fe)
- {
- struct r820t_priv *priv = fe->tuner_priv;
- int rc;
- tuner_dbg("%s:\n", __func__);
- mutex_lock(&priv->lock);
- if (fe->ops.i2c_gate_ctrl)
- fe->ops.i2c_gate_ctrl(fe, 1);
- rc = r820t_imr_callibrate(priv);
- if (rc < 0)
- goto err;
-
- rc = r820t_write(priv, 0x05,
- r820t_init_array, sizeof(r820t_init_array));
- err:
- if (fe->ops.i2c_gate_ctrl)
- fe->ops.i2c_gate_ctrl(fe, 0);
- mutex_unlock(&priv->lock);
- if (rc < 0)
- tuner_dbg("%s: failed=%d\n", __func__, rc);
- return rc;
- }
- static int r820t_sleep(struct dvb_frontend *fe)
- {
- struct r820t_priv *priv = fe->tuner_priv;
- int rc;
- tuner_dbg("%s:\n", __func__);
- mutex_lock(&priv->lock);
- if (fe->ops.i2c_gate_ctrl)
- fe->ops.i2c_gate_ctrl(fe, 1);
- rc = r820t_standby(priv);
- if (fe->ops.i2c_gate_ctrl)
- fe->ops.i2c_gate_ctrl(fe, 0);
- mutex_unlock(&priv->lock);
- tuner_dbg("%s: failed=%d\n", __func__, rc);
- return rc;
- }
- static int r820t_set_analog_freq(struct dvb_frontend *fe,
- struct analog_parameters *p)
- {
- struct r820t_priv *priv = fe->tuner_priv;
- unsigned bw;
- int rc;
- tuner_dbg("%s called\n", __func__);
-
- if (!p->std)
- p->std = V4L2_STD_MN;
- if ((p->std == V4L2_STD_PAL_M) || (p->std == V4L2_STD_NTSC))
- bw = 6;
- else
- bw = 8;
- mutex_lock(&priv->lock);
- if (fe->ops.i2c_gate_ctrl)
- fe->ops.i2c_gate_ctrl(fe, 1);
- rc = generic_set_freq(fe, 62500l * p->frequency, bw,
- V4L2_TUNER_ANALOG_TV, p->std, SYS_UNDEFINED);
- if (fe->ops.i2c_gate_ctrl)
- fe->ops.i2c_gate_ctrl(fe, 0);
- mutex_unlock(&priv->lock);
- return rc;
- }
- static int r820t_set_params(struct dvb_frontend *fe)
- {
- struct r820t_priv *priv = fe->tuner_priv;
- struct dtv_frontend_properties *c = &fe->dtv_property_cache;
- int rc;
- unsigned bw;
- tuner_dbg("%s: delivery_system=%d frequency=%d bandwidth_hz=%d\n",
- __func__, c->delivery_system, c->frequency, c->bandwidth_hz);
- mutex_lock(&priv->lock);
- if (fe->ops.i2c_gate_ctrl)
- fe->ops.i2c_gate_ctrl(fe, 1);
- bw = (c->bandwidth_hz + 500000) / 1000000;
- if (!bw)
- bw = 8;
- rc = generic_set_freq(fe, c->frequency, bw,
- V4L2_TUNER_DIGITAL_TV, 0, c->delivery_system);
- if (fe->ops.i2c_gate_ctrl)
- fe->ops.i2c_gate_ctrl(fe, 0);
- mutex_unlock(&priv->lock);
- if (rc)
- tuner_dbg("%s: failed=%d\n", __func__, rc);
- return rc;
- }
- static int r820t_signal(struct dvb_frontend *fe, u16 *strength)
- {
- struct r820t_priv *priv = fe->tuner_priv;
- int rc = 0;
- mutex_lock(&priv->lock);
- if (fe->ops.i2c_gate_ctrl)
- fe->ops.i2c_gate_ctrl(fe, 1);
- if (priv->has_lock) {
- rc = r820t_read_gain(priv);
- if (rc < 0)
- goto err;
-
- *strength = (45 - rc) << 4 | 0xff;
- if (*strength == 0xff)
- *strength = 0;
- } else {
- *strength = 0;
- }
- err:
- if (fe->ops.i2c_gate_ctrl)
- fe->ops.i2c_gate_ctrl(fe, 0);
- mutex_unlock(&priv->lock);
- tuner_dbg("%s: %s, gain=%d strength=%d\n",
- __func__,
- priv->has_lock ? "PLL locked" : "no signal",
- rc, *strength);
- return 0;
- }
- static int r820t_get_if_frequency(struct dvb_frontend *fe, u32 *frequency)
- {
- struct r820t_priv *priv = fe->tuner_priv;
- tuner_dbg("%s:\n", __func__);
- *frequency = priv->int_freq;
- return 0;
- }
- static int r820t_release(struct dvb_frontend *fe)
- {
- struct r820t_priv *priv = fe->tuner_priv;
- tuner_dbg("%s:\n", __func__);
- mutex_lock(&r820t_list_mutex);
- if (priv)
- hybrid_tuner_release_state(priv);
- mutex_unlock(&r820t_list_mutex);
- fe->tuner_priv = NULL;
- return 0;
- }
- static const struct dvb_tuner_ops r820t_tuner_ops = {
- .info = {
- .name = "Rafael Micro R820T",
- .frequency_min = 42000000,
- .frequency_max = 1002000000,
- },
- .init = r820t_init,
- .release = r820t_release,
- .sleep = r820t_sleep,
- .set_params = r820t_set_params,
- .set_analog_params = r820t_set_analog_freq,
- .get_if_frequency = r820t_get_if_frequency,
- .get_rf_strength = r820t_signal,
- };
- struct dvb_frontend *r820t_attach(struct dvb_frontend *fe,
- struct i2c_adapter *i2c,
- const struct r820t_config *cfg)
- {
- struct r820t_priv *priv;
- int rc = -ENODEV;
- u8 data[5];
- int instance;
- mutex_lock(&r820t_list_mutex);
- instance = hybrid_tuner_request_state(struct r820t_priv, priv,
- hybrid_tuner_instance_list,
- i2c, cfg->i2c_addr,
- "r820t");
- switch (instance) {
- case 0:
-
- goto err_no_gate;
- case 1:
-
- priv->cfg = cfg;
- mutex_init(&priv->lock);
- fe->tuner_priv = priv;
- break;
- case 2:
-
- fe->tuner_priv = priv;
- break;
- }
- if (fe->ops.i2c_gate_ctrl)
- fe->ops.i2c_gate_ctrl(fe, 1);
-
- rc = r820t_read(priv, 0x00, data, sizeof(data));
- if (rc < 0)
- goto err;
- rc = r820t_sleep(fe);
- if (rc < 0)
- goto err;
- tuner_info("Rafael Micro r820t successfully identified\n");
- if (fe->ops.i2c_gate_ctrl)
- fe->ops.i2c_gate_ctrl(fe, 0);
- mutex_unlock(&r820t_list_mutex);
- memcpy(&fe->ops.tuner_ops, &r820t_tuner_ops,
- sizeof(struct dvb_tuner_ops));
- return fe;
- err:
- if (fe->ops.i2c_gate_ctrl)
- fe->ops.i2c_gate_ctrl(fe, 0);
- err_no_gate:
- mutex_unlock(&r820t_list_mutex);
- tuner_info("%s: failed=%d\n", __func__, rc);
- r820t_release(fe);
- return NULL;
- }
- EXPORT_SYMBOL_GPL(r820t_attach);
- MODULE_DESCRIPTION("Rafael Micro r820t silicon tuner driver");
- MODULE_AUTHOR("Mauro Carvalho Chehab");
- MODULE_LICENSE("GPL");
|