av7110.c 77 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822
  1. /*
  2. * driver for the SAA7146 based AV110 cards (like the Fujitsu-Siemens DVB)
  3. * av7110.c: initialization and demux stuff
  4. *
  5. * Copyright (C) 1999-2002 Ralph Metzler
  6. * & Marcus Metzler for convergence integrated media GmbH
  7. *
  8. * originally based on code by:
  9. * Copyright (C) 1998,1999 Christian Theiss <mistert@rz.fh-augsburg.de>
  10. *
  11. * This program is free software; you can redistribute it and/or
  12. * modify it under the terms of the GNU General Public License
  13. * as published by the Free Software Foundation; either version 2
  14. * of the License, or (at your option) any later version.
  15. *
  16. *
  17. * This program is distributed in the hope that it will be useful,
  18. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  20. * GNU General Public License for more details.
  21. *
  22. *
  23. * You should have received a copy of the GNU General Public License
  24. * along with this program; if not, write to the Free Software
  25. * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  26. * Or, point your browser to http://www.gnu.org/copyleft/gpl.html
  27. *
  28. *
  29. * the project's page is at http://www.linuxtv.org/dvb/
  30. */
  31. #include <linux/config.h>
  32. #include <linux/module.h>
  33. #include <linux/kmod.h>
  34. #include <linux/delay.h>
  35. #include <linux/fs.h>
  36. #include <linux/timer.h>
  37. #include <linux/poll.h>
  38. #include <linux/byteorder/swabb.h>
  39. #include <linux/smp_lock.h>
  40. #include <linux/kernel.h>
  41. #include <linux/moduleparam.h>
  42. #include <linux/sched.h>
  43. #include <linux/types.h>
  44. #include <linux/fcntl.h>
  45. #include <linux/interrupt.h>
  46. #include <linux/string.h>
  47. #include <linux/pci.h>
  48. #include <linux/vmalloc.h>
  49. #include <linux/firmware.h>
  50. #include <linux/crc32.h>
  51. #include <linux/i2c.h>
  52. #include <asm/system.h>
  53. #include <linux/dvb/frontend.h>
  54. #include "dvb_frontend.h"
  55. #include "ttpci-eeprom.h"
  56. #include "av7110.h"
  57. #include "av7110_hw.h"
  58. #include "av7110_av.h"
  59. #include "av7110_ca.h"
  60. #include "av7110_ipack.h"
  61. #include "bsbe1.h"
  62. #include "lnbp21.h"
  63. #include "bsru6.h"
  64. #define TS_WIDTH 376
  65. #define TS_HEIGHT 512
  66. #define TS_BUFLEN (TS_WIDTH*TS_HEIGHT)
  67. #define TS_MAX_PACKETS (TS_BUFLEN/TS_SIZE)
  68. int av7110_debug;
  69. static int vidmode = CVBS_RGB_OUT;
  70. static int pids_off;
  71. static int adac = DVB_ADAC_TI;
  72. static int hw_sections;
  73. static int rgb_on;
  74. static int volume = 255;
  75. static int budgetpatch;
  76. static int wss_cfg_4_3 = 0x4008;
  77. static int wss_cfg_16_9 = 0x0007;
  78. module_param_named(debug, av7110_debug, int, 0644);
  79. MODULE_PARM_DESC(debug, "debug level (bitmask, default 0)");
  80. module_param(vidmode, int, 0444);
  81. MODULE_PARM_DESC(vidmode,"analog video out: 0 off, 1 CVBS+RGB (default), 2 CVBS+YC, 3 YC");
  82. module_param(pids_off, int, 0444);
  83. MODULE_PARM_DESC(pids_off,"clear video/audio/PCR PID filters when demux is closed");
  84. module_param(adac, int, 0444);
  85. MODULE_PARM_DESC(adac,"audio DAC type: 0 TI, 1 CRYSTAL, 2 MSP (use if autodetection fails)");
  86. module_param(hw_sections, int, 0444);
  87. MODULE_PARM_DESC(hw_sections, "0 use software section filter, 1 use hardware");
  88. module_param(rgb_on, int, 0444);
  89. MODULE_PARM_DESC(rgb_on, "For Siemens DVB-C cards only: Enable RGB control"
  90. " signal on SCART pin 16 to switch SCART video mode from CVBS to RGB");
  91. module_param(volume, int, 0444);
  92. MODULE_PARM_DESC(volume, "initial volume: default 255 (range 0-255)");
  93. module_param(budgetpatch, int, 0444);
  94. MODULE_PARM_DESC(budgetpatch, "use budget-patch hardware modification: default 0 (0 no, 1 autodetect, 2 always)");
  95. module_param(wss_cfg_4_3, int, 0444);
  96. MODULE_PARM_DESC(wss_cfg_4_3, "WSS 4:3 - default 0x4008 - bit 15: disable, 14: burst mode, 13..0: wss data");
  97. module_param(wss_cfg_16_9, int, 0444);
  98. MODULE_PARM_DESC(wss_cfg_16_9, "WSS 16:9 - default 0x0007 - bit 15: disable, 14: burst mode, 13..0: wss data");
  99. static void restart_feeds(struct av7110 *av7110);
  100. static int av7110_num;
  101. #define FE_FUNC_OVERRIDE(fe_func, av7110_copy, av7110_func) \
  102. {\
  103. if (fe_func != NULL) { \
  104. av7110_copy = fe_func; \
  105. fe_func = av7110_func; \
  106. } \
  107. }
  108. static void init_av7110_av(struct av7110 *av7110)
  109. {
  110. int ret;
  111. struct saa7146_dev *dev = av7110->dev;
  112. /* set internal volume control to maximum */
  113. av7110->adac_type = DVB_ADAC_TI;
  114. ret = av7110_set_volume(av7110, av7110->mixer.volume_left, av7110->mixer.volume_right);
  115. if (ret < 0)
  116. printk("dvb-ttpci:cannot set internal volume to maximum:%d\n",ret);
  117. ret = av7110_fw_cmd(av7110, COMTYPE_ENCODER, SetWSSConfig, 2, 2, wss_cfg_4_3);
  118. if (ret < 0)
  119. printk("dvb-ttpci: unable to configure 4:3 wss\n");
  120. ret = av7110_fw_cmd(av7110, COMTYPE_ENCODER, SetWSSConfig, 2, 3, wss_cfg_16_9);
  121. if (ret < 0)
  122. printk("dvb-ttpci: unable to configure 16:9 wss\n");
  123. ret = av7710_set_video_mode(av7110, vidmode);
  124. if (ret < 0)
  125. printk("dvb-ttpci:cannot set video mode:%d\n",ret);
  126. /* handle different card types */
  127. /* remaining inits according to card and frontend type */
  128. av7110->analog_tuner_flags = 0;
  129. av7110->current_input = 0;
  130. if (dev->pci->subsystem_vendor == 0x13c2 && dev->pci->subsystem_device == 0x000a) {
  131. printk("dvb-ttpci: MSP3415 audio DAC @ card %d\n",
  132. av7110->dvb_adapter.num);
  133. av7110->adac_type = DVB_ADAC_MSP34x5;
  134. av7110_fw_cmd(av7110, COMTYPE_AUDIODAC, ADSwitch, 1, 0); // SPDIF on
  135. }
  136. else if (i2c_writereg(av7110, 0x20, 0x00, 0x00) == 1) {
  137. printk ("dvb-ttpci: Crystal audio DAC @ card %d detected\n",
  138. av7110->dvb_adapter.num);
  139. av7110->adac_type = DVB_ADAC_CRYSTAL;
  140. i2c_writereg(av7110, 0x20, 0x01, 0xd2);
  141. i2c_writereg(av7110, 0x20, 0x02, 0x49);
  142. i2c_writereg(av7110, 0x20, 0x03, 0x00);
  143. i2c_writereg(av7110, 0x20, 0x04, 0x00);
  144. /**
  145. * some special handling for the Siemens DVB-C cards...
  146. */
  147. } else if (0 == av7110_init_analog_module(av7110)) {
  148. /* done. */
  149. }
  150. else if (dev->pci->subsystem_vendor == 0x110a) {
  151. printk("dvb-ttpci: DVB-C w/o analog module @ card %d detected\n",
  152. av7110->dvb_adapter.num);
  153. av7110->adac_type = DVB_ADAC_NONE;
  154. }
  155. else {
  156. av7110->adac_type = adac;
  157. printk("dvb-ttpci: adac type set to %d @ card %d\n",
  158. av7110->adac_type, av7110->dvb_adapter.num);
  159. }
  160. if (av7110->adac_type == DVB_ADAC_NONE || av7110->adac_type == DVB_ADAC_MSP34x0) {
  161. // switch DVB SCART on
  162. ret = av7110_fw_cmd(av7110, COMTYPE_AUDIODAC, MainSwitch, 1, 0);
  163. if (ret < 0)
  164. printk("dvb-ttpci:cannot switch on SCART(Main):%d\n",ret);
  165. ret = av7110_fw_cmd(av7110, COMTYPE_AUDIODAC, ADSwitch, 1, 1);
  166. if (ret < 0)
  167. printk("dvb-ttpci:cannot switch on SCART(AD):%d\n",ret);
  168. if (rgb_on &&
  169. ((av7110->dev->pci->subsystem_vendor == 0x110a) ||
  170. (av7110->dev->pci->subsystem_vendor == 0x13c2)) &&
  171. (av7110->dev->pci->subsystem_device == 0x0000)) {
  172. saa7146_setgpio(dev, 1, SAA7146_GPIO_OUTHI); // RGB on, SCART pin 16
  173. //saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTLO); // SCARTpin 8
  174. }
  175. }
  176. if (dev->pci->subsystem_vendor == 0x13c2 && dev->pci->subsystem_device == 0x000e)
  177. av7110_fw_cmd(av7110, COMTYPE_AUDIODAC, SpdifSwitch, 1, 0); // SPDIF on
  178. ret = av7110_set_volume(av7110, av7110->mixer.volume_left, av7110->mixer.volume_right);
  179. if (ret < 0)
  180. printk("dvb-ttpci:cannot set volume :%d\n",ret);
  181. }
  182. static void recover_arm(struct av7110 *av7110)
  183. {
  184. dprintk(4, "%p\n",av7110);
  185. av7110_bootarm(av7110);
  186. msleep(100);
  187. init_av7110_av(av7110);
  188. /* card-specific recovery */
  189. if (av7110->recover)
  190. av7110->recover(av7110);
  191. restart_feeds(av7110);
  192. av7110_fw_cmd(av7110, COMTYPE_PIDFILTER, SetIR, 1, av7110->ir_config);
  193. }
  194. static void av7110_arm_sync(struct av7110 *av7110)
  195. {
  196. av7110->arm_rmmod = 1;
  197. wake_up_interruptible(&av7110->arm_wait);
  198. while (av7110->arm_thread)
  199. msleep(1);
  200. }
  201. static int arm_thread(void *data)
  202. {
  203. struct av7110 *av7110 = data;
  204. u16 newloops = 0;
  205. int timeout;
  206. dprintk(4, "%p\n",av7110);
  207. lock_kernel();
  208. daemonize("arm_mon");
  209. sigfillset(&current->blocked);
  210. unlock_kernel();
  211. av7110->arm_thread = current;
  212. for (;;) {
  213. timeout = wait_event_interruptible_timeout(av7110->arm_wait,
  214. av7110->arm_rmmod, 5 * HZ);
  215. if (-ERESTARTSYS == timeout || av7110->arm_rmmod) {
  216. /* got signal or told to quit*/
  217. break;
  218. }
  219. if (!av7110->arm_ready)
  220. continue;
  221. if (mutex_lock_interruptible(&av7110->dcomlock))
  222. break;
  223. newloops = rdebi(av7110, DEBINOSWAP, STATUS_LOOPS, 0, 2);
  224. mutex_unlock(&av7110->dcomlock);
  225. if (newloops == av7110->arm_loops || av7110->arm_errors > 3) {
  226. printk(KERN_ERR "dvb-ttpci: ARM crashed @ card %d\n",
  227. av7110->dvb_adapter.num);
  228. recover_arm(av7110);
  229. if (mutex_lock_interruptible(&av7110->dcomlock))
  230. break;
  231. newloops = rdebi(av7110, DEBINOSWAP, STATUS_LOOPS, 0, 2) - 1;
  232. mutex_unlock(&av7110->dcomlock);
  233. }
  234. av7110->arm_loops = newloops;
  235. av7110->arm_errors = 0;
  236. }
  237. av7110->arm_thread = NULL;
  238. return 0;
  239. }
  240. /****************************************************************************
  241. * IRQ handling
  242. ****************************************************************************/
  243. static int DvbDmxFilterCallback(u8 *buffer1, size_t buffer1_len,
  244. u8 *buffer2, size_t buffer2_len,
  245. struct dvb_demux_filter *dvbdmxfilter,
  246. enum dmx_success success,
  247. struct av7110 *av7110)
  248. {
  249. if (!dvbdmxfilter->feed->demux->dmx.frontend)
  250. return 0;
  251. if (dvbdmxfilter->feed->demux->dmx.frontend->source == DMX_MEMORY_FE)
  252. return 0;
  253. switch (dvbdmxfilter->type) {
  254. case DMX_TYPE_SEC:
  255. if ((((buffer1[1] << 8) | buffer1[2]) & 0xfff) + 3 != buffer1_len)
  256. return 0;
  257. if (dvbdmxfilter->doneq) {
  258. struct dmx_section_filter *filter = &dvbdmxfilter->filter;
  259. int i;
  260. u8 xor, neq = 0;
  261. for (i = 0; i < DVB_DEMUX_MASK_MAX; i++) {
  262. xor = filter->filter_value[i] ^ buffer1[i];
  263. neq |= dvbdmxfilter->maskandnotmode[i] & xor;
  264. }
  265. if (!neq)
  266. return 0;
  267. }
  268. return dvbdmxfilter->feed->cb.sec(buffer1, buffer1_len,
  269. buffer2, buffer2_len,
  270. &dvbdmxfilter->filter,
  271. DMX_OK);
  272. case DMX_TYPE_TS:
  273. if (!(dvbdmxfilter->feed->ts_type & TS_PACKET))
  274. return 0;
  275. if (dvbdmxfilter->feed->ts_type & TS_PAYLOAD_ONLY)
  276. return dvbdmxfilter->feed->cb.ts(buffer1, buffer1_len,
  277. buffer2, buffer2_len,
  278. &dvbdmxfilter->feed->feed.ts,
  279. DMX_OK);
  280. else
  281. av7110_p2t_write(buffer1, buffer1_len,
  282. dvbdmxfilter->feed->pid,
  283. &av7110->p2t_filter[dvbdmxfilter->index]);
  284. default:
  285. return 0;
  286. }
  287. }
  288. //#define DEBUG_TIMING
  289. static inline void print_time(char *s)
  290. {
  291. #ifdef DEBUG_TIMING
  292. struct timeval tv;
  293. do_gettimeofday(&tv);
  294. printk("%s: %d.%d\n", s, (int)tv.tv_sec, (int)tv.tv_usec);
  295. #endif
  296. }
  297. #define DEBI_READ 0
  298. #define DEBI_WRITE 1
  299. static inline void start_debi_dma(struct av7110 *av7110, int dir,
  300. unsigned long addr, unsigned int len)
  301. {
  302. dprintk(8, "%c %08lx %u\n", dir == DEBI_READ ? 'R' : 'W', addr, len);
  303. if (saa7146_wait_for_debi_done(av7110->dev, 0)) {
  304. printk(KERN_ERR "%s: saa7146_wait_for_debi_done timed out\n", __FUNCTION__);
  305. return;
  306. }
  307. SAA7146_ISR_CLEAR(av7110->dev, MASK_19); /* for good measure */
  308. SAA7146_IER_ENABLE(av7110->dev, MASK_19);
  309. if (len < 5)
  310. len = 5; /* we want a real DEBI DMA */
  311. if (dir == DEBI_WRITE)
  312. iwdebi(av7110, DEBISWAB, addr, 0, (len + 3) & ~3);
  313. else
  314. irdebi(av7110, DEBISWAB, addr, 0, len);
  315. }
  316. static void debiirq(unsigned long data)
  317. {
  318. struct av7110 *av7110 = (struct av7110 *) data;
  319. int type = av7110->debitype;
  320. int handle = (type >> 8) & 0x1f;
  321. unsigned int xfer = 0;
  322. print_time("debi");
  323. dprintk(4, "type 0x%04x\n", type);
  324. if (type == -1) {
  325. printk("DEBI irq oops @ %ld, psr:0x%08x, ssr:0x%08x\n",
  326. jiffies, saa7146_read(av7110->dev, PSR),
  327. saa7146_read(av7110->dev, SSR));
  328. goto debi_done;
  329. }
  330. av7110->debitype = -1;
  331. switch (type & 0xff) {
  332. case DATA_TS_RECORD:
  333. dvb_dmx_swfilter_packets(&av7110->demux,
  334. (const u8 *) av7110->debi_virt,
  335. av7110->debilen / 188);
  336. xfer = RX_BUFF;
  337. break;
  338. case DATA_PES_RECORD:
  339. if (av7110->demux.recording)
  340. av7110_record_cb(&av7110->p2t[handle],
  341. (u8 *) av7110->debi_virt,
  342. av7110->debilen);
  343. xfer = RX_BUFF;
  344. break;
  345. case DATA_IPMPE:
  346. case DATA_FSECTION:
  347. case DATA_PIPING:
  348. if (av7110->handle2filter[handle])
  349. DvbDmxFilterCallback((u8 *)av7110->debi_virt,
  350. av7110->debilen, NULL, 0,
  351. av7110->handle2filter[handle],
  352. DMX_OK, av7110);
  353. xfer = RX_BUFF;
  354. break;
  355. case DATA_CI_GET:
  356. {
  357. u8 *data = av7110->debi_virt;
  358. if ((data[0] < 2) && data[2] == 0xff) {
  359. int flags = 0;
  360. if (data[5] > 0)
  361. flags |= CA_CI_MODULE_PRESENT;
  362. if (data[5] > 5)
  363. flags |= CA_CI_MODULE_READY;
  364. av7110->ci_slot[data[0]].flags = flags;
  365. } else
  366. ci_get_data(&av7110->ci_rbuffer,
  367. av7110->debi_virt,
  368. av7110->debilen);
  369. xfer = RX_BUFF;
  370. break;
  371. }
  372. case DATA_COMMON_INTERFACE:
  373. CI_handle(av7110, (u8 *)av7110->debi_virt, av7110->debilen);
  374. #if 0
  375. {
  376. int i;
  377. printk("av7110%d: ", av7110->num);
  378. printk("%02x ", *(u8 *)av7110->debi_virt);
  379. printk("%02x ", *(1+(u8 *)av7110->debi_virt));
  380. for (i = 2; i < av7110->debilen; i++)
  381. printk("%02x ", (*(i+(unsigned char *)av7110->debi_virt)));
  382. for (i = 2; i < av7110->debilen; i++)
  383. printk("%c", chtrans(*(i+(unsigned char *)av7110->debi_virt)));
  384. printk("\n");
  385. }
  386. #endif
  387. xfer = RX_BUFF;
  388. break;
  389. case DATA_DEBUG_MESSAGE:
  390. ((s8*)av7110->debi_virt)[Reserved_SIZE - 1] = 0;
  391. printk("%s\n", (s8 *) av7110->debi_virt);
  392. xfer = RX_BUFF;
  393. break;
  394. case DATA_CI_PUT:
  395. dprintk(4, "debi DATA_CI_PUT\n");
  396. case DATA_MPEG_PLAY:
  397. dprintk(4, "debi DATA_MPEG_PLAY\n");
  398. case DATA_BMP_LOAD:
  399. dprintk(4, "debi DATA_BMP_LOAD\n");
  400. xfer = TX_BUFF;
  401. break;
  402. default:
  403. break;
  404. }
  405. debi_done:
  406. spin_lock(&av7110->debilock);
  407. if (xfer)
  408. iwdebi(av7110, DEBINOSWAP, xfer, 0, 2);
  409. ARM_ClearMailBox(av7110);
  410. spin_unlock(&av7110->debilock);
  411. }
  412. /* irq from av7110 firmware writing the mailbox register in the DPRAM */
  413. static void gpioirq(unsigned long data)
  414. {
  415. struct av7110 *av7110 = (struct av7110 *) data;
  416. u32 rxbuf, txbuf;
  417. int len;
  418. if (av7110->debitype != -1)
  419. /* we shouldn't get any irq while a debi xfer is running */
  420. printk("dvb-ttpci: GPIO0 irq oops @ %ld, psr:0x%08x, ssr:0x%08x\n",
  421. jiffies, saa7146_read(av7110->dev, PSR),
  422. saa7146_read(av7110->dev, SSR));
  423. if (saa7146_wait_for_debi_done(av7110->dev, 0)) {
  424. printk(KERN_ERR "%s: saa7146_wait_for_debi_done timed out\n", __FUNCTION__);
  425. BUG(); /* maybe we should try resetting the debi? */
  426. }
  427. spin_lock(&av7110->debilock);
  428. ARM_ClearIrq(av7110);
  429. /* see what the av7110 wants */
  430. av7110->debitype = irdebi(av7110, DEBINOSWAP, IRQ_STATE, 0, 2);
  431. av7110->debilen = irdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
  432. rxbuf = irdebi(av7110, DEBINOSWAP, RX_BUFF, 0, 2);
  433. txbuf = irdebi(av7110, DEBINOSWAP, TX_BUFF, 0, 2);
  434. len = (av7110->debilen + 3) & ~3;
  435. print_time("gpio");
  436. dprintk(8, "GPIO0 irq 0x%04x %d\n", av7110->debitype, av7110->debilen);
  437. switch (av7110->debitype & 0xff) {
  438. case DATA_TS_PLAY:
  439. case DATA_PES_PLAY:
  440. break;
  441. case DATA_MPEG_VIDEO_EVENT:
  442. {
  443. u32 h_ar;
  444. struct video_event event;
  445. av7110->video_size.w = irdebi(av7110, DEBINOSWAP, STATUS_MPEG_WIDTH, 0, 2);
  446. h_ar = irdebi(av7110, DEBINOSWAP, STATUS_MPEG_HEIGHT_AR, 0, 2);
  447. iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
  448. iwdebi(av7110, DEBINOSWAP, RX_BUFF, 0, 2);
  449. av7110->video_size.h = h_ar & 0xfff;
  450. event.type = VIDEO_EVENT_SIZE_CHANGED;
  451. event.u.size.w = av7110->video_size.w;
  452. event.u.size.h = av7110->video_size.h;
  453. switch ((h_ar >> 12) & 0xf)
  454. {
  455. case 3:
  456. av7110->video_size.aspect_ratio = VIDEO_FORMAT_16_9;
  457. event.u.size.aspect_ratio = VIDEO_FORMAT_16_9;
  458. av7110->videostate.video_format = VIDEO_FORMAT_16_9;
  459. break;
  460. case 4:
  461. av7110->video_size.aspect_ratio = VIDEO_FORMAT_221_1;
  462. event.u.size.aspect_ratio = VIDEO_FORMAT_221_1;
  463. av7110->videostate.video_format = VIDEO_FORMAT_221_1;
  464. break;
  465. default:
  466. av7110->video_size.aspect_ratio = VIDEO_FORMAT_4_3;
  467. event.u.size.aspect_ratio = VIDEO_FORMAT_4_3;
  468. av7110->videostate.video_format = VIDEO_FORMAT_4_3;
  469. }
  470. dprintk(8, "GPIO0 irq: DATA_MPEG_VIDEO_EVENT: w/h/ar = %u/%u/%u\n",
  471. av7110->video_size.w, av7110->video_size.h,
  472. av7110->video_size.aspect_ratio);
  473. dvb_video_add_event(av7110, &event);
  474. break;
  475. }
  476. case DATA_CI_PUT:
  477. {
  478. int avail;
  479. struct dvb_ringbuffer *cibuf = &av7110->ci_wbuffer;
  480. avail = dvb_ringbuffer_avail(cibuf);
  481. if (avail <= 2) {
  482. iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
  483. iwdebi(av7110, DEBINOSWAP, TX_LEN, 0, 2);
  484. iwdebi(av7110, DEBINOSWAP, TX_BUFF, 0, 2);
  485. break;
  486. }
  487. len = DVB_RINGBUFFER_PEEK(cibuf, 0) << 8;
  488. len |= DVB_RINGBUFFER_PEEK(cibuf, 1);
  489. if (avail < len + 2) {
  490. iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
  491. iwdebi(av7110, DEBINOSWAP, TX_LEN, 0, 2);
  492. iwdebi(av7110, DEBINOSWAP, TX_BUFF, 0, 2);
  493. break;
  494. }
  495. DVB_RINGBUFFER_SKIP(cibuf, 2);
  496. dvb_ringbuffer_read(cibuf, av7110->debi_virt, len, 0);
  497. iwdebi(av7110, DEBINOSWAP, TX_LEN, len, 2);
  498. iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, len, 2);
  499. dprintk(8, "DMA: CI\n");
  500. start_debi_dma(av7110, DEBI_WRITE, DPRAM_BASE + txbuf, len);
  501. spin_unlock(&av7110->debilock);
  502. wake_up(&cibuf->queue);
  503. return;
  504. }
  505. case DATA_MPEG_PLAY:
  506. if (!av7110->playing) {
  507. iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
  508. iwdebi(av7110, DEBINOSWAP, TX_LEN, 0, 2);
  509. iwdebi(av7110, DEBINOSWAP, TX_BUFF, 0, 2);
  510. break;
  511. }
  512. len = 0;
  513. if (av7110->debitype & 0x100) {
  514. spin_lock(&av7110->aout.lock);
  515. len = av7110_pes_play(av7110->debi_virt, &av7110->aout, 2048);
  516. spin_unlock(&av7110->aout.lock);
  517. }
  518. if (len <= 0 && (av7110->debitype & 0x200)
  519. &&av7110->videostate.play_state != VIDEO_FREEZED) {
  520. spin_lock(&av7110->avout.lock);
  521. len = av7110_pes_play(av7110->debi_virt, &av7110->avout, 2048);
  522. spin_unlock(&av7110->avout.lock);
  523. }
  524. if (len <= 0) {
  525. iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
  526. iwdebi(av7110, DEBINOSWAP, TX_LEN, 0, 2);
  527. iwdebi(av7110, DEBINOSWAP, TX_BUFF, 0, 2);
  528. break;
  529. }
  530. dprintk(8, "GPIO0 PES_PLAY len=%04x\n", len);
  531. iwdebi(av7110, DEBINOSWAP, TX_LEN, len, 2);
  532. iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, len, 2);
  533. dprintk(8, "DMA: MPEG_PLAY\n");
  534. start_debi_dma(av7110, DEBI_WRITE, DPRAM_BASE + txbuf, len);
  535. spin_unlock(&av7110->debilock);
  536. return;
  537. case DATA_BMP_LOAD:
  538. len = av7110->debilen;
  539. dprintk(8, "gpio DATA_BMP_LOAD len %d\n", len);
  540. if (!len) {
  541. av7110->bmp_state = BMP_LOADED;
  542. iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
  543. iwdebi(av7110, DEBINOSWAP, TX_LEN, 0, 2);
  544. iwdebi(av7110, DEBINOSWAP, TX_BUFF, 0, 2);
  545. wake_up(&av7110->bmpq);
  546. dprintk(8, "gpio DATA_BMP_LOAD done\n");
  547. break;
  548. }
  549. if (len > av7110->bmplen)
  550. len = av7110->bmplen;
  551. if (len > 2 * 1024)
  552. len = 2 * 1024;
  553. iwdebi(av7110, DEBINOSWAP, TX_LEN, len, 2);
  554. iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, len, 2);
  555. memcpy(av7110->debi_virt, av7110->bmpbuf+av7110->bmpp, len);
  556. av7110->bmpp += len;
  557. av7110->bmplen -= len;
  558. dprintk(8, "gpio DATA_BMP_LOAD DMA len %d\n", len);
  559. start_debi_dma(av7110, DEBI_WRITE, DPRAM_BASE+txbuf, len);
  560. spin_unlock(&av7110->debilock);
  561. return;
  562. case DATA_CI_GET:
  563. case DATA_COMMON_INTERFACE:
  564. case DATA_FSECTION:
  565. case DATA_IPMPE:
  566. case DATA_PIPING:
  567. if (!len || len > 4 * 1024) {
  568. iwdebi(av7110, DEBINOSWAP, RX_BUFF, 0, 2);
  569. break;
  570. }
  571. /* fall through */
  572. case DATA_TS_RECORD:
  573. case DATA_PES_RECORD:
  574. dprintk(8, "DMA: TS_REC etc.\n");
  575. start_debi_dma(av7110, DEBI_READ, DPRAM_BASE+rxbuf, len);
  576. spin_unlock(&av7110->debilock);
  577. return;
  578. case DATA_DEBUG_MESSAGE:
  579. if (!len || len > 0xff) {
  580. iwdebi(av7110, DEBINOSWAP, RX_BUFF, 0, 2);
  581. break;
  582. }
  583. start_debi_dma(av7110, DEBI_READ, Reserved, len);
  584. spin_unlock(&av7110->debilock);
  585. return;
  586. case DATA_IRCOMMAND:
  587. if (av7110->ir_handler)
  588. av7110->ir_handler(av7110,
  589. swahw32(irdebi(av7110, DEBINOSWAP, Reserved, 0, 4)));
  590. iwdebi(av7110, DEBINOSWAP, RX_BUFF, 0, 2);
  591. break;
  592. default:
  593. printk("dvb-ttpci: gpioirq unknown type=%d len=%d\n",
  594. av7110->debitype, av7110->debilen);
  595. break;
  596. }
  597. av7110->debitype = -1;
  598. ARM_ClearMailBox(av7110);
  599. spin_unlock(&av7110->debilock);
  600. }
  601. #ifdef CONFIG_DVB_AV7110_OSD
  602. static int dvb_osd_ioctl(struct inode *inode, struct file *file,
  603. unsigned int cmd, void *parg)
  604. {
  605. struct dvb_device *dvbdev = (struct dvb_device *) file->private_data;
  606. struct av7110 *av7110 = (struct av7110 *) dvbdev->priv;
  607. dprintk(4, "%p\n", av7110);
  608. if (cmd == OSD_SEND_CMD)
  609. return av7110_osd_cmd(av7110, (osd_cmd_t *) parg);
  610. if (cmd == OSD_GET_CAPABILITY)
  611. return av7110_osd_capability(av7110, (osd_cap_t *) parg);
  612. return -EINVAL;
  613. }
  614. static struct file_operations dvb_osd_fops = {
  615. .owner = THIS_MODULE,
  616. .ioctl = dvb_generic_ioctl,
  617. .open = dvb_generic_open,
  618. .release = dvb_generic_release,
  619. };
  620. static struct dvb_device dvbdev_osd = {
  621. .priv = NULL,
  622. .users = 1,
  623. .writers = 1,
  624. .fops = &dvb_osd_fops,
  625. .kernel_ioctl = dvb_osd_ioctl,
  626. };
  627. #endif /* CONFIG_DVB_AV7110_OSD */
  628. static inline int SetPIDs(struct av7110 *av7110, u16 vpid, u16 apid, u16 ttpid,
  629. u16 subpid, u16 pcrpid)
  630. {
  631. u16 aflags = 0;
  632. dprintk(4, "%p\n", av7110);
  633. if (vpid == 0x1fff || apid == 0x1fff ||
  634. ttpid == 0x1fff || subpid == 0x1fff || pcrpid == 0x1fff) {
  635. vpid = apid = ttpid = subpid = pcrpid = 0;
  636. av7110->pids[DMX_PES_VIDEO] = 0;
  637. av7110->pids[DMX_PES_AUDIO] = 0;
  638. av7110->pids[DMX_PES_TELETEXT] = 0;
  639. av7110->pids[DMX_PES_PCR] = 0;
  640. }
  641. if (av7110->audiostate.bypass_mode)
  642. aflags |= 0x8000;
  643. return av7110_fw_cmd(av7110, COMTYPE_PIDFILTER, MultiPID, 6,
  644. pcrpid, vpid, apid, ttpid, subpid, aflags);
  645. }
  646. int ChangePIDs(struct av7110 *av7110, u16 vpid, u16 apid, u16 ttpid,
  647. u16 subpid, u16 pcrpid)
  648. {
  649. int ret = 0;
  650. dprintk(4, "%p\n", av7110);
  651. if (mutex_lock_interruptible(&av7110->pid_mutex))
  652. return -ERESTARTSYS;
  653. if (!(vpid & 0x8000))
  654. av7110->pids[DMX_PES_VIDEO] = vpid;
  655. if (!(apid & 0x8000))
  656. av7110->pids[DMX_PES_AUDIO] = apid;
  657. if (!(ttpid & 0x8000))
  658. av7110->pids[DMX_PES_TELETEXT] = ttpid;
  659. if (!(pcrpid & 0x8000))
  660. av7110->pids[DMX_PES_PCR] = pcrpid;
  661. av7110->pids[DMX_PES_SUBTITLE] = 0;
  662. if (av7110->fe_synced) {
  663. pcrpid = av7110->pids[DMX_PES_PCR];
  664. ret = SetPIDs(av7110, vpid, apid, ttpid, subpid, pcrpid);
  665. }
  666. mutex_unlock(&av7110->pid_mutex);
  667. return ret;
  668. }
  669. /******************************************************************************
  670. * hardware filter functions
  671. ******************************************************************************/
  672. static int StartHWFilter(struct dvb_demux_filter *dvbdmxfilter)
  673. {
  674. struct dvb_demux_feed *dvbdmxfeed = dvbdmxfilter->feed;
  675. struct av7110 *av7110 = (struct av7110 *) dvbdmxfeed->demux->priv;
  676. u16 buf[20];
  677. int ret, i;
  678. u16 handle;
  679. // u16 mode = 0x0320;
  680. u16 mode = 0xb96a;
  681. dprintk(4, "%p\n", av7110);
  682. if (dvbdmxfilter->type == DMX_TYPE_SEC) {
  683. if (hw_sections) {
  684. buf[4] = (dvbdmxfilter->filter.filter_value[0] << 8) |
  685. dvbdmxfilter->maskandmode[0];
  686. for (i = 3; i < 18; i++)
  687. buf[i + 4 - 2] =
  688. (dvbdmxfilter->filter.filter_value[i] << 8) |
  689. dvbdmxfilter->maskandmode[i];
  690. mode = 4;
  691. }
  692. } else if ((dvbdmxfeed->ts_type & TS_PACKET) &&
  693. !(dvbdmxfeed->ts_type & TS_PAYLOAD_ONLY)) {
  694. av7110_p2t_init(&av7110->p2t_filter[dvbdmxfilter->index], dvbdmxfeed);
  695. }
  696. buf[0] = (COMTYPE_PID_FILTER << 8) + AddPIDFilter;
  697. buf[1] = 16;
  698. buf[2] = dvbdmxfeed->pid;
  699. buf[3] = mode;
  700. ret = av7110_fw_request(av7110, buf, 20, &handle, 1);
  701. if (ret != 0 || handle >= 32) {
  702. printk("dvb-ttpci: %s error buf %04x %04x %04x %04x "
  703. "ret %d handle %04x\n",
  704. __FUNCTION__, buf[0], buf[1], buf[2], buf[3],
  705. ret, handle);
  706. dvbdmxfilter->hw_handle = 0xffff;
  707. if (!ret)
  708. ret = -1;
  709. return ret;
  710. }
  711. av7110->handle2filter[handle] = dvbdmxfilter;
  712. dvbdmxfilter->hw_handle = handle;
  713. return ret;
  714. }
  715. static int StopHWFilter(struct dvb_demux_filter *dvbdmxfilter)
  716. {
  717. struct av7110 *av7110 = (struct av7110 *) dvbdmxfilter->feed->demux->priv;
  718. u16 buf[3];
  719. u16 answ[2];
  720. int ret;
  721. u16 handle;
  722. dprintk(4, "%p\n", av7110);
  723. handle = dvbdmxfilter->hw_handle;
  724. if (handle >= 32) {
  725. printk("%s tried to stop invalid filter %04x, filter type = %x\n",
  726. __FUNCTION__, handle, dvbdmxfilter->type);
  727. return -EINVAL;
  728. }
  729. av7110->handle2filter[handle] = NULL;
  730. buf[0] = (COMTYPE_PID_FILTER << 8) + DelPIDFilter;
  731. buf[1] = 1;
  732. buf[2] = handle;
  733. ret = av7110_fw_request(av7110, buf, 3, answ, 2);
  734. if (ret != 0 || answ[1] != handle) {
  735. printk("dvb-ttpci: %s error cmd %04x %04x %04x ret %x "
  736. "resp %04x %04x pid %d\n",
  737. __FUNCTION__, buf[0], buf[1], buf[2], ret,
  738. answ[0], answ[1], dvbdmxfilter->feed->pid);
  739. if (!ret)
  740. ret = -1;
  741. }
  742. return ret;
  743. }
  744. static int dvb_feed_start_pid(struct dvb_demux_feed *dvbdmxfeed)
  745. {
  746. struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
  747. struct av7110 *av7110 = (struct av7110 *) dvbdmx->priv;
  748. u16 *pid = dvbdmx->pids, npids[5];
  749. int i;
  750. int ret = 0;
  751. dprintk(4, "%p\n", av7110);
  752. npids[0] = npids[1] = npids[2] = npids[3] = npids[4] = 0xffff;
  753. i = dvbdmxfeed->pes_type;
  754. npids[i] = (pid[i]&0x8000) ? 0 : pid[i];
  755. if ((i == 2) && npids[i] && (dvbdmxfeed->ts_type & TS_PACKET)) {
  756. npids[i] = 0;
  757. ret = ChangePIDs(av7110, npids[1], npids[0], npids[2], npids[3], npids[4]);
  758. if (!ret)
  759. ret = StartHWFilter(dvbdmxfeed->filter);
  760. return ret;
  761. }
  762. if (dvbdmxfeed->pes_type <= 2 || dvbdmxfeed->pes_type == 4) {
  763. ret = ChangePIDs(av7110, npids[1], npids[0], npids[2], npids[3], npids[4]);
  764. if (ret)
  765. return ret;
  766. }
  767. if (dvbdmxfeed->pes_type < 2 && npids[0])
  768. if (av7110->fe_synced)
  769. {
  770. ret = av7110_fw_cmd(av7110, COMTYPE_PIDFILTER, Scan, 0);
  771. if (ret)
  772. return ret;
  773. }
  774. if ((dvbdmxfeed->ts_type & TS_PACKET)) {
  775. if (dvbdmxfeed->pes_type == 0 && !(dvbdmx->pids[0] & 0x8000))
  776. ret = av7110_av_start_record(av7110, RP_AUDIO, dvbdmxfeed);
  777. if (dvbdmxfeed->pes_type == 1 && !(dvbdmx->pids[1] & 0x8000))
  778. ret = av7110_av_start_record(av7110, RP_VIDEO, dvbdmxfeed);
  779. }
  780. return ret;
  781. }
  782. static int dvb_feed_stop_pid(struct dvb_demux_feed *dvbdmxfeed)
  783. {
  784. struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
  785. struct av7110 *av7110 = (struct av7110 *) dvbdmx->priv;
  786. u16 *pid = dvbdmx->pids, npids[5];
  787. int i;
  788. int ret = 0;
  789. dprintk(4, "%p\n", av7110);
  790. if (dvbdmxfeed->pes_type <= 1) {
  791. ret = av7110_av_stop(av7110, dvbdmxfeed->pes_type ? RP_VIDEO : RP_AUDIO);
  792. if (ret)
  793. return ret;
  794. if (!av7110->rec_mode)
  795. dvbdmx->recording = 0;
  796. if (!av7110->playing)
  797. dvbdmx->playing = 0;
  798. }
  799. npids[0] = npids[1] = npids[2] = npids[3] = npids[4] = 0xffff;
  800. i = dvbdmxfeed->pes_type;
  801. switch (i) {
  802. case 2: //teletext
  803. if (dvbdmxfeed->ts_type & TS_PACKET)
  804. ret = StopHWFilter(dvbdmxfeed->filter);
  805. npids[2] = 0;
  806. break;
  807. case 0:
  808. case 1:
  809. case 4:
  810. if (!pids_off)
  811. return 0;
  812. npids[i] = (pid[i]&0x8000) ? 0 : pid[i];
  813. break;
  814. }
  815. if (!ret)
  816. ret = ChangePIDs(av7110, npids[1], npids[0], npids[2], npids[3], npids[4]);
  817. return ret;
  818. }
  819. static int av7110_start_feed(struct dvb_demux_feed *feed)
  820. {
  821. struct dvb_demux *demux = feed->demux;
  822. struct av7110 *av7110 = demux->priv;
  823. int ret = 0;
  824. dprintk(4, "%p\n", av7110);
  825. if (!demux->dmx.frontend)
  826. return -EINVAL;
  827. if (feed->pid > 0x1fff)
  828. return -EINVAL;
  829. if (feed->type == DMX_TYPE_TS) {
  830. if ((feed->ts_type & TS_DECODER) &&
  831. (feed->pes_type < DMX_TS_PES_OTHER)) {
  832. switch (demux->dmx.frontend->source) {
  833. case DMX_MEMORY_FE:
  834. if (feed->ts_type & TS_DECODER)
  835. if (feed->pes_type < 2 &&
  836. !(demux->pids[0] & 0x8000) &&
  837. !(demux->pids[1] & 0x8000)) {
  838. dvb_ringbuffer_flush_spinlock_wakeup(&av7110->avout);
  839. dvb_ringbuffer_flush_spinlock_wakeup(&av7110->aout);
  840. ret = av7110_av_start_play(av7110,RP_AV);
  841. if (!ret)
  842. demux->playing = 1;
  843. }
  844. break;
  845. default:
  846. ret = dvb_feed_start_pid(feed);
  847. break;
  848. }
  849. } else if ((feed->ts_type & TS_PACKET) &&
  850. (demux->dmx.frontend->source != DMX_MEMORY_FE)) {
  851. ret = StartHWFilter(feed->filter);
  852. }
  853. }
  854. else if (feed->type == DMX_TYPE_SEC) {
  855. int i;
  856. for (i = 0; i < demux->filternum; i++) {
  857. if (demux->filter[i].state != DMX_STATE_READY)
  858. continue;
  859. if (demux->filter[i].type != DMX_TYPE_SEC)
  860. continue;
  861. if (demux->filter[i].filter.parent != &feed->feed.sec)
  862. continue;
  863. demux->filter[i].state = DMX_STATE_GO;
  864. if (demux->dmx.frontend->source != DMX_MEMORY_FE) {
  865. ret = StartHWFilter(&demux->filter[i]);
  866. if (ret)
  867. break;
  868. }
  869. }
  870. }
  871. return ret;
  872. }
  873. static int av7110_stop_feed(struct dvb_demux_feed *feed)
  874. {
  875. struct dvb_demux *demux = feed->demux;
  876. struct av7110 *av7110 = demux->priv;
  877. int i, rc, ret = 0;
  878. dprintk(4, "%p\n", av7110);
  879. if (feed->type == DMX_TYPE_TS) {
  880. if (feed->ts_type & TS_DECODER) {
  881. if (feed->pes_type >= DMX_TS_PES_OTHER ||
  882. !demux->pesfilter[feed->pes_type])
  883. return -EINVAL;
  884. demux->pids[feed->pes_type] |= 0x8000;
  885. demux->pesfilter[feed->pes_type] = NULL;
  886. }
  887. if (feed->ts_type & TS_DECODER &&
  888. feed->pes_type < DMX_TS_PES_OTHER) {
  889. ret = dvb_feed_stop_pid(feed);
  890. } else
  891. if ((feed->ts_type & TS_PACKET) &&
  892. (demux->dmx.frontend->source != DMX_MEMORY_FE))
  893. ret = StopHWFilter(feed->filter);
  894. }
  895. if (!ret && feed->type == DMX_TYPE_SEC) {
  896. for (i = 0; i<demux->filternum; i++) {
  897. if (demux->filter[i].state == DMX_STATE_GO &&
  898. demux->filter[i].filter.parent == &feed->feed.sec) {
  899. demux->filter[i].state = DMX_STATE_READY;
  900. if (demux->dmx.frontend->source != DMX_MEMORY_FE) {
  901. rc = StopHWFilter(&demux->filter[i]);
  902. if (!ret)
  903. ret = rc;
  904. /* keep going, stop as many filters as possible */
  905. }
  906. }
  907. }
  908. }
  909. return ret;
  910. }
  911. static void restart_feeds(struct av7110 *av7110)
  912. {
  913. struct dvb_demux *dvbdmx = &av7110->demux;
  914. struct dvb_demux_feed *feed;
  915. int mode;
  916. int i, j;
  917. dprintk(4, "%p\n", av7110);
  918. mode = av7110->playing;
  919. av7110->playing = 0;
  920. av7110->rec_mode = 0;
  921. for (i = 0; i < dvbdmx->feednum; i++) {
  922. feed = &dvbdmx->feed[i];
  923. if (feed->state == DMX_STATE_GO) {
  924. if (feed->type == DMX_TYPE_SEC) {
  925. for (j = 0; j < dvbdmx->filternum; j++) {
  926. if (dvbdmx->filter[j].type != DMX_TYPE_SEC)
  927. continue;
  928. if (dvbdmx->filter[j].filter.parent != &feed->feed.sec)
  929. continue;
  930. if (dvbdmx->filter[j].state == DMX_STATE_GO)
  931. dvbdmx->filter[j].state = DMX_STATE_READY;
  932. }
  933. }
  934. av7110_start_feed(feed);
  935. }
  936. }
  937. if (mode)
  938. av7110_av_start_play(av7110, mode);
  939. }
  940. static int dvb_get_stc(struct dmx_demux *demux, unsigned int num,
  941. uint64_t *stc, unsigned int *base)
  942. {
  943. int ret;
  944. u16 fwstc[4];
  945. u16 tag = ((COMTYPE_REQUEST << 8) + ReqSTC);
  946. struct dvb_demux *dvbdemux;
  947. struct av7110 *av7110;
  948. /* pointer casting paranoia... */
  949. BUG_ON(!demux);
  950. dvbdemux = (struct dvb_demux *) demux->priv;
  951. BUG_ON(!dvbdemux);
  952. av7110 = (struct av7110 *) dvbdemux->priv;
  953. dprintk(4, "%p\n", av7110);
  954. if (num != 0)
  955. return -EINVAL;
  956. ret = av7110_fw_request(av7110, &tag, 0, fwstc, 4);
  957. if (ret) {
  958. printk(KERN_ERR "%s: av7110_fw_request error\n", __FUNCTION__);
  959. return ret;
  960. }
  961. dprintk(2, "fwstc = %04hx %04hx %04hx %04hx\n",
  962. fwstc[0], fwstc[1], fwstc[2], fwstc[3]);
  963. *stc = (((uint64_t) ((fwstc[3] & 0x8000) >> 15)) << 32) |
  964. (((uint64_t) fwstc[1]) << 16) | ((uint64_t) fwstc[0]);
  965. *base = 1;
  966. dprintk(4, "stc = %lu\n", (unsigned long)*stc);
  967. return 0;
  968. }
  969. /******************************************************************************
  970. * SEC device file operations
  971. ******************************************************************************/
  972. static int av7110_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone)
  973. {
  974. struct av7110* av7110 = (struct av7110*) fe->dvb->priv;
  975. switch (tone) {
  976. case SEC_TONE_ON:
  977. return Set22K(av7110, 1);
  978. case SEC_TONE_OFF:
  979. return Set22K(av7110, 0);
  980. default:
  981. return -EINVAL;
  982. }
  983. }
  984. static int av7110_diseqc_send_master_cmd(struct dvb_frontend* fe,
  985. struct dvb_diseqc_master_cmd* cmd)
  986. {
  987. struct av7110* av7110 = fe->dvb->priv;
  988. return av7110_diseqc_send(av7110, cmd->msg_len, cmd->msg, -1);
  989. }
  990. static int av7110_diseqc_send_burst(struct dvb_frontend* fe,
  991. fe_sec_mini_cmd_t minicmd)
  992. {
  993. struct av7110* av7110 = fe->dvb->priv;
  994. return av7110_diseqc_send(av7110, 0, NULL, minicmd);
  995. }
  996. /* simplified code from budget-core.c */
  997. static int stop_ts_capture(struct av7110 *budget)
  998. {
  999. dprintk(2, "budget: %p\n", budget);
  1000. if (--budget->feeding1)
  1001. return budget->feeding1;
  1002. saa7146_write(budget->dev, MC1, MASK_20); /* DMA3 off */
  1003. SAA7146_IER_DISABLE(budget->dev, MASK_10);
  1004. SAA7146_ISR_CLEAR(budget->dev, MASK_10);
  1005. return 0;
  1006. }
  1007. static int start_ts_capture(struct av7110 *budget)
  1008. {
  1009. dprintk(2, "budget: %p\n", budget);
  1010. if (budget->feeding1)
  1011. return ++budget->feeding1;
  1012. memset(budget->grabbing, 0x00, TS_HEIGHT * TS_WIDTH);
  1013. budget->tsf = 0xff;
  1014. budget->ttbp = 0;
  1015. SAA7146_IER_ENABLE(budget->dev, MASK_10); /* VPE */
  1016. saa7146_write(budget->dev, MC1, (MASK_04 | MASK_20)); /* DMA3 on */
  1017. return ++budget->feeding1;
  1018. }
  1019. static int budget_start_feed(struct dvb_demux_feed *feed)
  1020. {
  1021. struct dvb_demux *demux = feed->demux;
  1022. struct av7110 *budget = (struct av7110 *) demux->priv;
  1023. int status;
  1024. dprintk(2, "av7110: %p\n", budget);
  1025. spin_lock(&budget->feedlock1);
  1026. feed->pusi_seen = 0; /* have a clean section start */
  1027. status = start_ts_capture(budget);
  1028. spin_unlock(&budget->feedlock1);
  1029. return status;
  1030. }
  1031. static int budget_stop_feed(struct dvb_demux_feed *feed)
  1032. {
  1033. struct dvb_demux *demux = feed->demux;
  1034. struct av7110 *budget = (struct av7110 *) demux->priv;
  1035. int status;
  1036. dprintk(2, "budget: %p\n", budget);
  1037. spin_lock(&budget->feedlock1);
  1038. status = stop_ts_capture(budget);
  1039. spin_unlock(&budget->feedlock1);
  1040. return status;
  1041. }
  1042. static void vpeirq(unsigned long data)
  1043. {
  1044. struct av7110 *budget = (struct av7110 *) data;
  1045. u8 *mem = (u8 *) (budget->grabbing);
  1046. u32 olddma = budget->ttbp;
  1047. u32 newdma = saa7146_read(budget->dev, PCI_VDP3);
  1048. if (!budgetpatch) {
  1049. printk("av7110.c: vpeirq() called while budgetpatch disabled!"
  1050. " check saa7146 IER register\n");
  1051. BUG();
  1052. }
  1053. /* nearest lower position divisible by 188 */
  1054. newdma -= newdma % 188;
  1055. if (newdma >= TS_BUFLEN)
  1056. return;
  1057. budget->ttbp = newdma;
  1058. if (!budget->feeding1 || (newdma == olddma))
  1059. return;
  1060. #if 0
  1061. /* track rps1 activity */
  1062. printk("vpeirq: %02x Event Counter 1 0x%04x\n",
  1063. mem[olddma],
  1064. saa7146_read(budget->dev, EC1R) & 0x3fff);
  1065. #endif
  1066. if (newdma > olddma)
  1067. /* no wraparound, dump olddma..newdma */
  1068. dvb_dmx_swfilter_packets(&budget->demux1, mem + olddma, (newdma - olddma) / 188);
  1069. else {
  1070. /* wraparound, dump olddma..buflen and 0..newdma */
  1071. dvb_dmx_swfilter_packets(&budget->demux1, mem + olddma, (TS_BUFLEN - olddma) / 188);
  1072. dvb_dmx_swfilter_packets(&budget->demux1, mem, newdma / 188);
  1073. }
  1074. }
  1075. static int av7110_register(struct av7110 *av7110)
  1076. {
  1077. int ret, i;
  1078. struct dvb_demux *dvbdemux = &av7110->demux;
  1079. struct dvb_demux *dvbdemux1 = &av7110->demux1;
  1080. dprintk(4, "%p\n", av7110);
  1081. if (av7110->registered)
  1082. return -1;
  1083. av7110->registered = 1;
  1084. dvbdemux->priv = (void *) av7110;
  1085. for (i = 0; i < 32; i++)
  1086. av7110->handle2filter[i] = NULL;
  1087. dvbdemux->filternum = 32;
  1088. dvbdemux->feednum = 32;
  1089. dvbdemux->start_feed = av7110_start_feed;
  1090. dvbdemux->stop_feed = av7110_stop_feed;
  1091. dvbdemux->write_to_decoder = av7110_write_to_decoder;
  1092. dvbdemux->dmx.capabilities = (DMX_TS_FILTERING | DMX_SECTION_FILTERING |
  1093. DMX_MEMORY_BASED_FILTERING);
  1094. dvb_dmx_init(&av7110->demux);
  1095. av7110->demux.dmx.get_stc = dvb_get_stc;
  1096. av7110->dmxdev.filternum = 32;
  1097. av7110->dmxdev.demux = &dvbdemux->dmx;
  1098. av7110->dmxdev.capabilities = 0;
  1099. dvb_dmxdev_init(&av7110->dmxdev, &av7110->dvb_adapter);
  1100. av7110->hw_frontend.source = DMX_FRONTEND_0;
  1101. ret = dvbdemux->dmx.add_frontend(&dvbdemux->dmx, &av7110->hw_frontend);
  1102. if (ret < 0)
  1103. return ret;
  1104. av7110->mem_frontend.source = DMX_MEMORY_FE;
  1105. ret = dvbdemux->dmx.add_frontend(&dvbdemux->dmx, &av7110->mem_frontend);
  1106. if (ret < 0)
  1107. return ret;
  1108. ret = dvbdemux->dmx.connect_frontend(&dvbdemux->dmx,
  1109. &av7110->hw_frontend);
  1110. if (ret < 0)
  1111. return ret;
  1112. av7110_av_register(av7110);
  1113. av7110_ca_register(av7110);
  1114. #ifdef CONFIG_DVB_AV7110_OSD
  1115. dvb_register_device(&av7110->dvb_adapter, &av7110->osd_dev,
  1116. &dvbdev_osd, av7110, DVB_DEVICE_OSD);
  1117. #endif
  1118. dvb_net_init(&av7110->dvb_adapter, &av7110->dvb_net, &dvbdemux->dmx);
  1119. if (budgetpatch) {
  1120. /* initialize software demux1 without its own frontend
  1121. * demux1 hardware is connected to frontend0 of demux0
  1122. */
  1123. dvbdemux1->priv = (void *) av7110;
  1124. dvbdemux1->filternum = 256;
  1125. dvbdemux1->feednum = 256;
  1126. dvbdemux1->start_feed = budget_start_feed;
  1127. dvbdemux1->stop_feed = budget_stop_feed;
  1128. dvbdemux1->write_to_decoder = NULL;
  1129. dvbdemux1->dmx.capabilities = (DMX_TS_FILTERING | DMX_SECTION_FILTERING |
  1130. DMX_MEMORY_BASED_FILTERING);
  1131. dvb_dmx_init(&av7110->demux1);
  1132. av7110->dmxdev1.filternum = 256;
  1133. av7110->dmxdev1.demux = &dvbdemux1->dmx;
  1134. av7110->dmxdev1.capabilities = 0;
  1135. dvb_dmxdev_init(&av7110->dmxdev1, &av7110->dvb_adapter);
  1136. dvb_net_init(&av7110->dvb_adapter, &av7110->dvb_net1, &dvbdemux1->dmx);
  1137. printk("dvb-ttpci: additional demux1 for budget-patch registered\n");
  1138. }
  1139. return 0;
  1140. }
  1141. static void dvb_unregister(struct av7110 *av7110)
  1142. {
  1143. struct dvb_demux *dvbdemux = &av7110->demux;
  1144. struct dvb_demux *dvbdemux1 = &av7110->demux1;
  1145. dprintk(4, "%p\n", av7110);
  1146. if (!av7110->registered)
  1147. return;
  1148. if (budgetpatch) {
  1149. dvb_net_release(&av7110->dvb_net1);
  1150. dvbdemux->dmx.close(&dvbdemux1->dmx);
  1151. dvb_dmxdev_release(&av7110->dmxdev1);
  1152. dvb_dmx_release(&av7110->demux1);
  1153. }
  1154. dvb_net_release(&av7110->dvb_net);
  1155. dvbdemux->dmx.close(&dvbdemux->dmx);
  1156. dvbdemux->dmx.remove_frontend(&dvbdemux->dmx, &av7110->hw_frontend);
  1157. dvbdemux->dmx.remove_frontend(&dvbdemux->dmx, &av7110->mem_frontend);
  1158. dvb_dmxdev_release(&av7110->dmxdev);
  1159. dvb_dmx_release(&av7110->demux);
  1160. if (av7110->fe != NULL)
  1161. dvb_unregister_frontend(av7110->fe);
  1162. dvb_unregister_device(av7110->osd_dev);
  1163. av7110_av_unregister(av7110);
  1164. av7110_ca_unregister(av7110);
  1165. }
  1166. /****************************************************************************
  1167. * I2C client commands
  1168. ****************************************************************************/
  1169. int i2c_writereg(struct av7110 *av7110, u8 id, u8 reg, u8 val)
  1170. {
  1171. u8 msg[2] = { reg, val };
  1172. struct i2c_msg msgs;
  1173. msgs.flags = 0;
  1174. msgs.addr = id / 2;
  1175. msgs.len = 2;
  1176. msgs.buf = msg;
  1177. return i2c_transfer(&av7110->i2c_adap, &msgs, 1);
  1178. }
  1179. #if 0
  1180. u8 i2c_readreg(struct av7110 *av7110, u8 id, u8 reg)
  1181. {
  1182. u8 mm1[] = {0x00};
  1183. u8 mm2[] = {0x00};
  1184. struct i2c_msg msgs[2];
  1185. msgs[0].flags = 0;
  1186. msgs[1].flags = I2C_M_RD;
  1187. msgs[0].addr = msgs[1].addr = id / 2;
  1188. mm1[0] = reg;
  1189. msgs[0].len = 1; msgs[1].len = 1;
  1190. msgs[0].buf = mm1; msgs[1].buf = mm2;
  1191. i2c_transfer(&av7110->i2c_adap, msgs, 2);
  1192. return mm2[0];
  1193. }
  1194. #endif
  1195. /****************************************************************************
  1196. * INITIALIZATION
  1197. ****************************************************************************/
  1198. static int check_firmware(struct av7110* av7110)
  1199. {
  1200. u32 crc = 0, len = 0;
  1201. unsigned char *ptr;
  1202. /* check for firmware magic */
  1203. ptr = av7110->bin_fw;
  1204. if (ptr[0] != 'A' || ptr[1] != 'V' ||
  1205. ptr[2] != 'F' || ptr[3] != 'W') {
  1206. printk("dvb-ttpci: this is not an av7110 firmware\n");
  1207. return -EINVAL;
  1208. }
  1209. ptr += 4;
  1210. /* check dpram file */
  1211. crc = ntohl(*(u32*) ptr);
  1212. ptr += 4;
  1213. len = ntohl(*(u32*) ptr);
  1214. ptr += 4;
  1215. if (len >= 512) {
  1216. printk("dvb-ttpci: dpram file is way too big.\n");
  1217. return -EINVAL;
  1218. }
  1219. if (crc != crc32_le(0, ptr, len)) {
  1220. printk("dvb-ttpci: crc32 of dpram file does not match.\n");
  1221. return -EINVAL;
  1222. }
  1223. av7110->bin_dpram = ptr;
  1224. av7110->size_dpram = len;
  1225. ptr += len;
  1226. /* check root file */
  1227. crc = ntohl(*(u32*) ptr);
  1228. ptr += 4;
  1229. len = ntohl(*(u32*) ptr);
  1230. ptr += 4;
  1231. if (len <= 200000 || len >= 300000 ||
  1232. len > ((av7110->bin_fw + av7110->size_fw) - ptr)) {
  1233. printk("dvb-ttpci: root file has strange size (%d). aborting.\n", len);
  1234. return -EINVAL;
  1235. }
  1236. if( crc != crc32_le(0, ptr, len)) {
  1237. printk("dvb-ttpci: crc32 of root file does not match.\n");
  1238. return -EINVAL;
  1239. }
  1240. av7110->bin_root = ptr;
  1241. av7110->size_root = len;
  1242. return 0;
  1243. }
  1244. #ifdef CONFIG_DVB_AV7110_FIRMWARE_FILE
  1245. #include "av7110_firm.h"
  1246. static void put_firmware(struct av7110* av7110)
  1247. {
  1248. av7110->bin_fw = NULL;
  1249. }
  1250. static inline int get_firmware(struct av7110* av7110)
  1251. {
  1252. av7110->bin_fw = dvb_ttpci_fw;
  1253. av7110->size_fw = sizeof(dvb_ttpci_fw);
  1254. return check_firmware(av7110);
  1255. }
  1256. #else
  1257. static void put_firmware(struct av7110* av7110)
  1258. {
  1259. vfree(av7110->bin_fw);
  1260. }
  1261. static int get_firmware(struct av7110* av7110)
  1262. {
  1263. int ret;
  1264. const struct firmware *fw;
  1265. /* request the av7110 firmware, this will block until someone uploads it */
  1266. ret = request_firmware(&fw, "dvb-ttpci-01.fw", &av7110->dev->pci->dev);
  1267. if (ret) {
  1268. if (ret == -ENOENT) {
  1269. printk(KERN_ERR "dvb-ttpci: could not load firmware,"
  1270. " file not found: dvb-ttpci-01.fw\n");
  1271. printk(KERN_ERR "dvb-ttpci: usually this should be in "
  1272. "/usr/lib/hotplug/firmware or /lib/firmware\n");
  1273. printk(KERN_ERR "dvb-ttpci: and can be downloaded from"
  1274. " http://www.linuxtv.org/download/dvb/firmware/\n");
  1275. } else
  1276. printk(KERN_ERR "dvb-ttpci: cannot request firmware"
  1277. " (error %i)\n", ret);
  1278. return -EINVAL;
  1279. }
  1280. if (fw->size <= 200000) {
  1281. printk("dvb-ttpci: this firmware is way too small.\n");
  1282. release_firmware(fw);
  1283. return -EINVAL;
  1284. }
  1285. /* check if the firmware is available */
  1286. av7110->bin_fw = (unsigned char *) vmalloc(fw->size);
  1287. if (NULL == av7110->bin_fw) {
  1288. dprintk(1, "out of memory\n");
  1289. release_firmware(fw);
  1290. return -ENOMEM;
  1291. }
  1292. memcpy(av7110->bin_fw, fw->data, fw->size);
  1293. av7110->size_fw = fw->size;
  1294. if ((ret = check_firmware(av7110)))
  1295. vfree(av7110->bin_fw);
  1296. release_firmware(fw);
  1297. return ret;
  1298. }
  1299. #endif
  1300. static int alps_bsrv2_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params)
  1301. {
  1302. struct av7110* av7110 = (struct av7110*) fe->dvb->priv;
  1303. u8 pwr = 0;
  1304. u8 buf[4];
  1305. struct i2c_msg msg = { .addr = 0x61, .flags = 0, .buf = buf, .len = sizeof(buf) };
  1306. u32 div = (params->frequency + 479500) / 125;
  1307. if (params->frequency > 2000000) pwr = 3;
  1308. else if (params->frequency > 1800000) pwr = 2;
  1309. else if (params->frequency > 1600000) pwr = 1;
  1310. else if (params->frequency > 1200000) pwr = 0;
  1311. else if (params->frequency >= 1100000) pwr = 1;
  1312. else pwr = 2;
  1313. buf[0] = (div >> 8) & 0x7f;
  1314. buf[1] = div & 0xff;
  1315. buf[2] = ((div & 0x18000) >> 10) | 0x95;
  1316. buf[3] = (pwr << 6) | 0x30;
  1317. // NOTE: since we're using a prescaler of 2, we set the
  1318. // divisor frequency to 62.5kHz and divide by 125 above
  1319. if (i2c_transfer (&av7110->i2c_adap, &msg, 1) != 1)
  1320. return -EIO;
  1321. return 0;
  1322. }
  1323. static struct ves1x93_config alps_bsrv2_config = {
  1324. .demod_address = 0x08,
  1325. .xin = 90100000UL,
  1326. .invert_pwm = 0,
  1327. .pll_set = alps_bsrv2_pll_set,
  1328. };
  1329. static int alps_tdbe2_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params)
  1330. {
  1331. struct av7110* av7110 = fe->dvb->priv;
  1332. u32 div;
  1333. u8 data[4];
  1334. struct i2c_msg msg = { .addr = 0x62, .flags = 0, .buf = data, .len = sizeof(data) };
  1335. div = (params->frequency + 35937500 + 31250) / 62500;
  1336. data[0] = (div >> 8) & 0x7f;
  1337. data[1] = div & 0xff;
  1338. data[2] = 0x85 | ((div >> 10) & 0x60);
  1339. data[3] = (params->frequency < 174000000 ? 0x88 : params->frequency < 470000000 ? 0x84 : 0x81);
  1340. if (i2c_transfer(&av7110->i2c_adap, &msg, 1) != 1)
  1341. return -EIO;
  1342. return 0;
  1343. }
  1344. static struct ves1820_config alps_tdbe2_config = {
  1345. .demod_address = 0x09,
  1346. .xin = 57840000UL,
  1347. .invert = 1,
  1348. .selagc = VES1820_SELAGC_SIGNAMPERR,
  1349. .pll_set = alps_tdbe2_pll_set,
  1350. };
  1351. static int grundig_29504_451_pll_set(struct dvb_frontend* fe,
  1352. struct dvb_frontend_parameters* params)
  1353. {
  1354. struct av7110* av7110 = fe->dvb->priv;
  1355. u32 div;
  1356. u8 data[4];
  1357. struct i2c_msg msg = { .addr = 0x61, .flags = 0, .buf = data, .len = sizeof(data) };
  1358. div = params->frequency / 125;
  1359. data[0] = (div >> 8) & 0x7f;
  1360. data[1] = div & 0xff;
  1361. data[2] = 0x8e;
  1362. data[3] = 0x00;
  1363. if (i2c_transfer(&av7110->i2c_adap, &msg, 1) != 1)
  1364. return -EIO;
  1365. return 0;
  1366. }
  1367. static struct tda8083_config grundig_29504_451_config = {
  1368. .demod_address = 0x68,
  1369. .pll_set = grundig_29504_451_pll_set,
  1370. };
  1371. static int philips_cd1516_pll_set(struct dvb_frontend* fe,
  1372. struct dvb_frontend_parameters* params)
  1373. {
  1374. struct av7110* av7110 = fe->dvb->priv;
  1375. u32 div;
  1376. u32 f = params->frequency;
  1377. u8 data[4];
  1378. struct i2c_msg msg = { .addr = 0x61, .flags = 0, .buf = data, .len = sizeof(data) };
  1379. div = (f + 36125000 + 31250) / 62500;
  1380. data[0] = (div >> 8) & 0x7f;
  1381. data[1] = div & 0xff;
  1382. data[2] = 0x8e;
  1383. data[3] = (f < 174000000 ? 0xa1 : f < 470000000 ? 0x92 : 0x34);
  1384. if (i2c_transfer(&av7110->i2c_adap, &msg, 1) != 1)
  1385. return -EIO;
  1386. return 0;
  1387. }
  1388. static struct ves1820_config philips_cd1516_config = {
  1389. .demod_address = 0x09,
  1390. .xin = 57840000UL,
  1391. .invert = 1,
  1392. .selagc = VES1820_SELAGC_SIGNAMPERR,
  1393. .pll_set = philips_cd1516_pll_set,
  1394. };
  1395. static int alps_tdlb7_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params)
  1396. {
  1397. struct av7110* av7110 = fe->dvb->priv;
  1398. u32 div, pwr;
  1399. u8 data[4];
  1400. struct i2c_msg msg = { .addr = 0x60, .flags = 0, .buf = data, .len = sizeof(data) };
  1401. div = (params->frequency + 36200000) / 166666;
  1402. if (params->frequency <= 782000000)
  1403. pwr = 1;
  1404. else
  1405. pwr = 2;
  1406. data[0] = (div >> 8) & 0x7f;
  1407. data[1] = div & 0xff;
  1408. data[2] = 0x85;
  1409. data[3] = pwr << 6;
  1410. if (i2c_transfer(&av7110->i2c_adap, &msg, 1) != 1)
  1411. return -EIO;
  1412. return 0;
  1413. }
  1414. static int alps_tdlb7_request_firmware(struct dvb_frontend* fe, const struct firmware **fw, char* name)
  1415. {
  1416. struct av7110* av7110 = (struct av7110*) fe->dvb->priv;
  1417. return request_firmware(fw, name, &av7110->dev->pci->dev);
  1418. }
  1419. static struct sp8870_config alps_tdlb7_config = {
  1420. .demod_address = 0x71,
  1421. .pll_set = alps_tdlb7_pll_set,
  1422. .request_firmware = alps_tdlb7_request_firmware,
  1423. };
  1424. static u8 nexusca_stv0297_inittab[] = {
  1425. 0x80, 0x01,
  1426. 0x80, 0x00,
  1427. 0x81, 0x01,
  1428. 0x81, 0x00,
  1429. 0x00, 0x09,
  1430. 0x01, 0x69,
  1431. 0x03, 0x00,
  1432. 0x04, 0x00,
  1433. 0x07, 0x00,
  1434. 0x08, 0x00,
  1435. 0x20, 0x00,
  1436. 0x21, 0x40,
  1437. 0x22, 0x00,
  1438. 0x23, 0x00,
  1439. 0x24, 0x40,
  1440. 0x25, 0x88,
  1441. 0x30, 0xff,
  1442. 0x31, 0x00,
  1443. 0x32, 0xff,
  1444. 0x33, 0x00,
  1445. 0x34, 0x50,
  1446. 0x35, 0x7f,
  1447. 0x36, 0x00,
  1448. 0x37, 0x20,
  1449. 0x38, 0x00,
  1450. 0x40, 0x1c,
  1451. 0x41, 0xff,
  1452. 0x42, 0x29,
  1453. 0x43, 0x00,
  1454. 0x44, 0xff,
  1455. 0x45, 0x00,
  1456. 0x46, 0x00,
  1457. 0x49, 0x04,
  1458. 0x4a, 0x00,
  1459. 0x4b, 0x7b,
  1460. 0x52, 0x30,
  1461. 0x55, 0xae,
  1462. 0x56, 0x47,
  1463. 0x57, 0xe1,
  1464. 0x58, 0x3a,
  1465. 0x5a, 0x1e,
  1466. 0x5b, 0x34,
  1467. 0x60, 0x00,
  1468. 0x63, 0x00,
  1469. 0x64, 0x00,
  1470. 0x65, 0x00,
  1471. 0x66, 0x00,
  1472. 0x67, 0x00,
  1473. 0x68, 0x00,
  1474. 0x69, 0x00,
  1475. 0x6a, 0x02,
  1476. 0x6b, 0x00,
  1477. 0x70, 0xff,
  1478. 0x71, 0x00,
  1479. 0x72, 0x00,
  1480. 0x73, 0x00,
  1481. 0x74, 0x0c,
  1482. 0x80, 0x00,
  1483. 0x81, 0x00,
  1484. 0x82, 0x00,
  1485. 0x83, 0x00,
  1486. 0x84, 0x04,
  1487. 0x85, 0x80,
  1488. 0x86, 0x24,
  1489. 0x87, 0x78,
  1490. 0x88, 0x10,
  1491. 0x89, 0x00,
  1492. 0x90, 0x01,
  1493. 0x91, 0x01,
  1494. 0xa0, 0x04,
  1495. 0xa1, 0x00,
  1496. 0xa2, 0x00,
  1497. 0xb0, 0x91,
  1498. 0xb1, 0x0b,
  1499. 0xc0, 0x53,
  1500. 0xc1, 0x70,
  1501. 0xc2, 0x12,
  1502. 0xd0, 0x00,
  1503. 0xd1, 0x00,
  1504. 0xd2, 0x00,
  1505. 0xd3, 0x00,
  1506. 0xd4, 0x00,
  1507. 0xd5, 0x00,
  1508. 0xde, 0x00,
  1509. 0xdf, 0x00,
  1510. 0x61, 0x49,
  1511. 0x62, 0x0b,
  1512. 0x53, 0x08,
  1513. 0x59, 0x08,
  1514. 0xff, 0xff,
  1515. };
  1516. static int nexusca_stv0297_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params)
  1517. {
  1518. struct av7110* av7110 = fe->dvb->priv;
  1519. u32 div;
  1520. u8 data[4];
  1521. struct i2c_msg msg = { .addr = 0x63, .flags = 0, .buf = data, .len = sizeof(data) };
  1522. struct i2c_msg readmsg = { .addr = 0x63, .flags = I2C_M_RD, .buf = data, .len = 1 };
  1523. int i;
  1524. div = (params->frequency + 36150000 + 31250) / 62500;
  1525. data[0] = (div >> 8) & 0x7f;
  1526. data[1] = div & 0xff;
  1527. data[2] = 0xce;
  1528. if (params->frequency < 45000000)
  1529. return -EINVAL;
  1530. else if (params->frequency < 137000000)
  1531. data[3] = 0x01;
  1532. else if (params->frequency < 403000000)
  1533. data[3] = 0x02;
  1534. else if (params->frequency < 860000000)
  1535. data[3] = 0x04;
  1536. else
  1537. return -EINVAL;
  1538. stv0297_enable_plli2c(fe);
  1539. if (i2c_transfer(&av7110->i2c_adap, &msg, 1) != 1) {
  1540. printk("nexusca: pll transfer failed!\n");
  1541. return -EIO;
  1542. }
  1543. // wait for PLL lock
  1544. for(i = 0; i < 20; i++) {
  1545. stv0297_enable_plli2c(fe);
  1546. if (i2c_transfer(&av7110->i2c_adap, &readmsg, 1) == 1)
  1547. if (data[0] & 0x40) break;
  1548. msleep(10);
  1549. }
  1550. return 0;
  1551. }
  1552. static struct stv0297_config nexusca_stv0297_config = {
  1553. .demod_address = 0x1C,
  1554. .inittab = nexusca_stv0297_inittab,
  1555. .invert = 1,
  1556. .pll_set = nexusca_stv0297_pll_set,
  1557. };
  1558. static int grundig_29504_401_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params)
  1559. {
  1560. struct av7110* av7110 = (struct av7110*) fe->dvb->priv;
  1561. u32 div;
  1562. u8 cfg, cpump, band_select;
  1563. u8 data[4];
  1564. struct i2c_msg msg = { .addr = 0x61, .flags = 0, .buf = data, .len = sizeof(data) };
  1565. div = (36125000 + params->frequency) / 166666;
  1566. cfg = 0x88;
  1567. if (params->frequency < 175000000) cpump = 2;
  1568. else if (params->frequency < 390000000) cpump = 1;
  1569. else if (params->frequency < 470000000) cpump = 2;
  1570. else if (params->frequency < 750000000) cpump = 1;
  1571. else cpump = 3;
  1572. if (params->frequency < 175000000) band_select = 0x0e;
  1573. else if (params->frequency < 470000000) band_select = 0x05;
  1574. else band_select = 0x03;
  1575. data[0] = (div >> 8) & 0x7f;
  1576. data[1] = div & 0xff;
  1577. data[2] = ((div >> 10) & 0x60) | cfg;
  1578. data[3] = (cpump << 6) | band_select;
  1579. if (i2c_transfer (&av7110->i2c_adap, &msg, 1) != 1) return -EIO;
  1580. return 0;
  1581. }
  1582. static struct l64781_config grundig_29504_401_config = {
  1583. .demod_address = 0x55,
  1584. .pll_set = grundig_29504_401_pll_set,
  1585. };
  1586. static int av7110_fe_lock_fix(struct av7110* av7110, fe_status_t status)
  1587. {
  1588. int ret = 0;
  1589. int synced = (status & FE_HAS_LOCK) ? 1 : 0;
  1590. av7110->fe_status = status;
  1591. if (av7110->fe_synced == synced)
  1592. return 0;
  1593. if (av7110->playing)
  1594. return 0;
  1595. if (mutex_lock_interruptible(&av7110->pid_mutex))
  1596. return -ERESTARTSYS;
  1597. if (synced) {
  1598. ret = SetPIDs(av7110, av7110->pids[DMX_PES_VIDEO],
  1599. av7110->pids[DMX_PES_AUDIO],
  1600. av7110->pids[DMX_PES_TELETEXT], 0,
  1601. av7110->pids[DMX_PES_PCR]);
  1602. if (!ret)
  1603. ret = av7110_fw_cmd(av7110, COMTYPE_PIDFILTER, Scan, 0);
  1604. } else {
  1605. ret = SetPIDs(av7110, 0, 0, 0, 0, 0);
  1606. if (!ret) {
  1607. ret = av7110_fw_cmd(av7110, COMTYPE_PID_FILTER, FlushTSQueue, 0);
  1608. if (!ret)
  1609. ret = av7110_wait_msgstate(av7110, GPMQBusy);
  1610. }
  1611. }
  1612. if (!ret)
  1613. av7110->fe_synced = synced;
  1614. mutex_unlock(&av7110->pid_mutex);
  1615. return ret;
  1616. }
  1617. static int av7110_fe_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters* params)
  1618. {
  1619. struct av7110* av7110 = fe->dvb->priv;
  1620. int ret = av7110_fe_lock_fix(av7110, 0);
  1621. if (!ret) {
  1622. av7110->saved_fe_params = *params;
  1623. ret = av7110->fe_set_frontend(fe, params);
  1624. }
  1625. return ret;
  1626. }
  1627. static int av7110_fe_init(struct dvb_frontend* fe)
  1628. {
  1629. struct av7110* av7110 = fe->dvb->priv;
  1630. int ret = av7110_fe_lock_fix(av7110, 0);
  1631. if (!ret)
  1632. ret = av7110->fe_init(fe);
  1633. return ret;
  1634. }
  1635. static int av7110_fe_read_status(struct dvb_frontend* fe, fe_status_t* status)
  1636. {
  1637. struct av7110* av7110 = fe->dvb->priv;
  1638. /* call the real implementation */
  1639. int ret = av7110->fe_read_status(fe, status);
  1640. if (!ret)
  1641. if (((*status ^ av7110->fe_status) & FE_HAS_LOCK) && (*status & FE_HAS_LOCK))
  1642. ret = av7110_fe_lock_fix(av7110, *status);
  1643. return ret;
  1644. }
  1645. static int av7110_fe_diseqc_reset_overload(struct dvb_frontend* fe)
  1646. {
  1647. struct av7110* av7110 = fe->dvb->priv;
  1648. int ret = av7110_fe_lock_fix(av7110, 0);
  1649. if (!ret)
  1650. ret = av7110->fe_diseqc_reset_overload(fe);
  1651. return ret;
  1652. }
  1653. static int av7110_fe_diseqc_send_master_cmd(struct dvb_frontend* fe,
  1654. struct dvb_diseqc_master_cmd* cmd)
  1655. {
  1656. struct av7110* av7110 = fe->dvb->priv;
  1657. int ret = av7110_fe_lock_fix(av7110, 0);
  1658. if (!ret) {
  1659. av7110->saved_master_cmd = *cmd;
  1660. ret = av7110->fe_diseqc_send_master_cmd(fe, cmd);
  1661. }
  1662. return ret;
  1663. }
  1664. static int av7110_fe_diseqc_send_burst(struct dvb_frontend* fe, fe_sec_mini_cmd_t minicmd)
  1665. {
  1666. struct av7110* av7110 = fe->dvb->priv;
  1667. int ret = av7110_fe_lock_fix(av7110, 0);
  1668. if (!ret) {
  1669. av7110->saved_minicmd = minicmd;
  1670. ret = av7110->fe_diseqc_send_burst(fe, minicmd);
  1671. }
  1672. return ret;
  1673. }
  1674. static int av7110_fe_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone)
  1675. {
  1676. struct av7110* av7110 = fe->dvb->priv;
  1677. int ret = av7110_fe_lock_fix(av7110, 0);
  1678. if (!ret) {
  1679. av7110->saved_tone = tone;
  1680. ret = av7110->fe_set_tone(fe, tone);
  1681. }
  1682. return ret;
  1683. }
  1684. static int av7110_fe_set_voltage(struct dvb_frontend* fe, fe_sec_voltage_t voltage)
  1685. {
  1686. struct av7110* av7110 = fe->dvb->priv;
  1687. int ret = av7110_fe_lock_fix(av7110, 0);
  1688. if (!ret) {
  1689. av7110->saved_voltage = voltage;
  1690. ret = av7110->fe_set_voltage(fe, voltage);
  1691. }
  1692. return ret;
  1693. }
  1694. static int av7110_fe_dishnetwork_send_legacy_command(struct dvb_frontend* fe, unsigned long cmd)
  1695. {
  1696. struct av7110* av7110 = fe->dvb->priv;
  1697. int ret = av7110_fe_lock_fix(av7110, 0);
  1698. if (!ret)
  1699. ret = av7110->fe_dishnetwork_send_legacy_command(fe, cmd);
  1700. return ret;
  1701. }
  1702. static void dvb_s_recover(struct av7110* av7110)
  1703. {
  1704. av7110_fe_init(av7110->fe);
  1705. av7110_fe_set_voltage(av7110->fe, av7110->saved_voltage);
  1706. if (av7110->saved_master_cmd.msg_len) {
  1707. msleep(20);
  1708. av7110_fe_diseqc_send_master_cmd(av7110->fe, &av7110->saved_master_cmd);
  1709. }
  1710. msleep(20);
  1711. av7110_fe_diseqc_send_burst(av7110->fe, av7110->saved_minicmd);
  1712. msleep(20);
  1713. av7110_fe_set_tone(av7110->fe, av7110->saved_tone);
  1714. av7110_fe_set_frontend(av7110->fe, &av7110->saved_fe_params);
  1715. }
  1716. static u8 read_pwm(struct av7110* av7110)
  1717. {
  1718. u8 b = 0xff;
  1719. u8 pwm;
  1720. struct i2c_msg msg[] = { { .addr = 0x50,.flags = 0,.buf = &b,.len = 1 },
  1721. { .addr = 0x50,.flags = I2C_M_RD,.buf = &pwm,.len = 1} };
  1722. if ((i2c_transfer(&av7110->i2c_adap, msg, 2) != 2) || (pwm == 0xff))
  1723. pwm = 0x48;
  1724. return pwm;
  1725. }
  1726. static int frontend_init(struct av7110 *av7110)
  1727. {
  1728. int ret;
  1729. if (av7110->dev->pci->subsystem_vendor == 0x110a) {
  1730. switch(av7110->dev->pci->subsystem_device) {
  1731. case 0x0000: // Fujitsu/Siemens DVB-Cable (ves1820/Philips CD1516(??))
  1732. av7110->fe = ves1820_attach(&philips_cd1516_config,
  1733. &av7110->i2c_adap, read_pwm(av7110));
  1734. break;
  1735. }
  1736. } else if (av7110->dev->pci->subsystem_vendor == 0x13c2) {
  1737. switch(av7110->dev->pci->subsystem_device) {
  1738. case 0x0000: // Hauppauge/TT WinTV DVB-S rev1.X
  1739. case 0x0003: // Hauppauge/TT WinTV Nexus-S Rev 2.X
  1740. case 0x1002: // Hauppauge/TT WinTV DVB-S rev1.3SE
  1741. // try the ALPS BSRV2 first of all
  1742. av7110->fe = ves1x93_attach(&alps_bsrv2_config, &av7110->i2c_adap);
  1743. if (av7110->fe) {
  1744. av7110->fe->ops->diseqc_send_master_cmd = av7110_diseqc_send_master_cmd;
  1745. av7110->fe->ops->diseqc_send_burst = av7110_diseqc_send_burst;
  1746. av7110->fe->ops->set_tone = av7110_set_tone;
  1747. av7110->recover = dvb_s_recover;
  1748. break;
  1749. }
  1750. // try the ALPS BSRU6 now
  1751. av7110->fe = stv0299_attach(&alps_bsru6_config, &av7110->i2c_adap);
  1752. if (av7110->fe) {
  1753. av7110->fe->ops->diseqc_send_master_cmd = av7110_diseqc_send_master_cmd;
  1754. av7110->fe->ops->diseqc_send_burst = av7110_diseqc_send_burst;
  1755. av7110->fe->ops->set_tone = av7110_set_tone;
  1756. av7110->recover = dvb_s_recover;
  1757. break;
  1758. }
  1759. // Try the grundig 29504-451
  1760. av7110->fe = tda8083_attach(&grundig_29504_451_config, &av7110->i2c_adap);
  1761. if (av7110->fe) {
  1762. av7110->fe->ops->diseqc_send_master_cmd = av7110_diseqc_send_master_cmd;
  1763. av7110->fe->ops->diseqc_send_burst = av7110_diseqc_send_burst;
  1764. av7110->fe->ops->set_tone = av7110_set_tone;
  1765. av7110->recover = dvb_s_recover;
  1766. break;
  1767. }
  1768. /* Try DVB-C cards */
  1769. switch(av7110->dev->pci->subsystem_device) {
  1770. case 0x0000:
  1771. /* Siemens DVB-C (full-length card) VES1820/Philips CD1516 */
  1772. av7110->fe = ves1820_attach(&philips_cd1516_config, &av7110->i2c_adap,
  1773. read_pwm(av7110));
  1774. break;
  1775. case 0x0003:
  1776. /* Hauppauge DVB-C 2.1 VES1820/ALPS TDBE2 */
  1777. av7110->fe = ves1820_attach(&alps_tdbe2_config, &av7110->i2c_adap,
  1778. read_pwm(av7110));
  1779. break;
  1780. }
  1781. break;
  1782. case 0x0001: // Hauppauge/TT Nexus-T premium rev1.X
  1783. // ALPS TDLB7
  1784. av7110->fe = sp8870_attach(&alps_tdlb7_config, &av7110->i2c_adap);
  1785. break;
  1786. case 0x0002: // Hauppauge/TT DVB-C premium rev2.X
  1787. av7110->fe = ves1820_attach(&alps_tdbe2_config, &av7110->i2c_adap, read_pwm(av7110));
  1788. break;
  1789. case 0x0004: // Galaxis DVB-S rev1.3
  1790. /* ALPS BSRV2 */
  1791. av7110->fe = ves1x93_attach(&alps_bsrv2_config, &av7110->i2c_adap);
  1792. if (av7110->fe) {
  1793. av7110->fe->ops->diseqc_send_master_cmd = av7110_diseqc_send_master_cmd;
  1794. av7110->fe->ops->diseqc_send_burst = av7110_diseqc_send_burst;
  1795. av7110->fe->ops->set_tone = av7110_set_tone;
  1796. av7110->recover = dvb_s_recover;
  1797. }
  1798. break;
  1799. case 0x0006: /* Fujitsu-Siemens DVB-S rev 1.6 */
  1800. /* Grundig 29504-451 */
  1801. av7110->fe = tda8083_attach(&grundig_29504_451_config, &av7110->i2c_adap);
  1802. if (av7110->fe) {
  1803. av7110->fe->ops->diseqc_send_master_cmd = av7110_diseqc_send_master_cmd;
  1804. av7110->fe->ops->diseqc_send_burst = av7110_diseqc_send_burst;
  1805. av7110->fe->ops->set_tone = av7110_set_tone;
  1806. av7110->recover = dvb_s_recover;
  1807. }
  1808. break;
  1809. case 0x0008: // Hauppauge/TT DVB-T
  1810. av7110->fe = l64781_attach(&grundig_29504_401_config, &av7110->i2c_adap);
  1811. break;
  1812. case 0x000A: // Hauppauge/TT Nexus-CA rev1.X
  1813. av7110->fe = stv0297_attach(&nexusca_stv0297_config, &av7110->i2c_adap);
  1814. if (av7110->fe) {
  1815. /* set TDA9819 into DVB mode */
  1816. saa7146_setgpio(av7110->dev, 1, SAA7146_GPIO_OUTLO); // TDA9198 pin9(STD)
  1817. saa7146_setgpio(av7110->dev, 3, SAA7146_GPIO_OUTLO); // TDA9198 pin30(VIF)
  1818. /* tuner on this needs a slower i2c bus speed */
  1819. av7110->dev->i2c_bitrate = SAA7146_I2C_BUS_BIT_RATE_240;
  1820. break;
  1821. }
  1822. break;
  1823. case 0x000E: /* Hauppauge/TT Nexus-S rev 2.3 */
  1824. /* ALPS BSBE1 */
  1825. av7110->fe = stv0299_attach(&alps_bsbe1_config, &av7110->i2c_adap);
  1826. if (av7110->fe) {
  1827. if (lnbp21_init(av7110->fe, &av7110->i2c_adap, 0, 0)) {
  1828. printk("dvb-ttpci: LNBP21 not found!\n");
  1829. if (av7110->fe->ops->release)
  1830. av7110->fe->ops->release(av7110->fe);
  1831. av7110->fe = NULL;
  1832. } else {
  1833. av7110->fe->ops->dishnetwork_send_legacy_command = NULL;
  1834. av7110->recover = dvb_s_recover;
  1835. }
  1836. }
  1837. break;
  1838. }
  1839. }
  1840. if (!av7110->fe) {
  1841. /* FIXME: propagate the failure code from the lower layers */
  1842. ret = -ENOMEM;
  1843. printk("dvb-ttpci: A frontend driver was not found for device %04x/%04x subsystem %04x/%04x\n",
  1844. av7110->dev->pci->vendor,
  1845. av7110->dev->pci->device,
  1846. av7110->dev->pci->subsystem_vendor,
  1847. av7110->dev->pci->subsystem_device);
  1848. } else {
  1849. FE_FUNC_OVERRIDE(av7110->fe->ops->init, av7110->fe_init, av7110_fe_init);
  1850. FE_FUNC_OVERRIDE(av7110->fe->ops->read_status, av7110->fe_read_status, av7110_fe_read_status);
  1851. FE_FUNC_OVERRIDE(av7110->fe->ops->diseqc_reset_overload, av7110->fe_diseqc_reset_overload, av7110_fe_diseqc_reset_overload);
  1852. FE_FUNC_OVERRIDE(av7110->fe->ops->diseqc_send_master_cmd, av7110->fe_diseqc_send_master_cmd, av7110_fe_diseqc_send_master_cmd);
  1853. FE_FUNC_OVERRIDE(av7110->fe->ops->diseqc_send_burst, av7110->fe_diseqc_send_burst, av7110_fe_diseqc_send_burst);
  1854. FE_FUNC_OVERRIDE(av7110->fe->ops->set_tone, av7110->fe_set_tone, av7110_fe_set_tone);
  1855. FE_FUNC_OVERRIDE(av7110->fe->ops->set_voltage, av7110->fe_set_voltage, av7110_fe_set_voltage;)
  1856. FE_FUNC_OVERRIDE(av7110->fe->ops->dishnetwork_send_legacy_command, av7110->fe_dishnetwork_send_legacy_command, av7110_fe_dishnetwork_send_legacy_command);
  1857. FE_FUNC_OVERRIDE(av7110->fe->ops->set_frontend, av7110->fe_set_frontend, av7110_fe_set_frontend);
  1858. ret = dvb_register_frontend(&av7110->dvb_adapter, av7110->fe);
  1859. if (ret < 0) {
  1860. printk("av7110: Frontend registration failed!\n");
  1861. if (av7110->fe->ops->release)
  1862. av7110->fe->ops->release(av7110->fe);
  1863. av7110->fe = NULL;
  1864. }
  1865. }
  1866. return ret;
  1867. }
  1868. /* Budgetpatch note:
  1869. * Original hardware design by Roberto Deza:
  1870. * There is a DVB_Wiki at
  1871. * http://212.227.36.83/linuxtv/wiki/index.php/Main_Page
  1872. * where is described this 'DVB TT Budget Patch', on Card Modding:
  1873. * http://212.227.36.83/linuxtv/wiki/index.php/DVB_TT_Budget_Patch
  1874. * On the short description there is also a link to a external file,
  1875. * with more details:
  1876. * http://perso.wanadoo.es/jesussolano/Ttf_tsc1.zip
  1877. *
  1878. * New software triggering design by Emard that works on
  1879. * original Roberto Deza's hardware:
  1880. *
  1881. * rps1 code for budgetpatch will copy internal HS event to GPIO3 pin.
  1882. * GPIO3 is in budget-patch hardware connectd to port B VSYNC
  1883. * HS is an internal event of 7146, accessible with RPS
  1884. * and temporarily raised high every n lines
  1885. * (n in defined in the RPS_THRESH1 counter threshold)
  1886. * I think HS is raised high on the beginning of the n-th line
  1887. * and remains high until this n-th line that triggered
  1888. * it is completely received. When the receiption of n-th line
  1889. * ends, HS is lowered.
  1890. *
  1891. * To transmit data over DMA, 7146 needs changing state at
  1892. * port B VSYNC pin. Any changing of port B VSYNC will
  1893. * cause some DMA data transfer, with more or less packets loss.
  1894. * It depends on the phase and frequency of VSYNC and
  1895. * the way of 7146 is instructed to trigger on port B (defined
  1896. * in DD1_INIT register, 3rd nibble from the right valid
  1897. * numbers are 0-7, see datasheet)
  1898. *
  1899. * The correct triggering can minimize packet loss,
  1900. * dvbtraffic should give this stable bandwidths:
  1901. * 22k transponder = 33814 kbit/s
  1902. * 27.5k transponder = 38045 kbit/s
  1903. * by experiment it is found that the best results
  1904. * (stable bandwidths and almost no packet loss)
  1905. * are obtained using DD1_INIT triggering number 2
  1906. * (Va at rising edge of VS Fa = HS x VS-failing forced toggle)
  1907. * and a VSYNC phase that occurs in the middle of DMA transfer
  1908. * (about byte 188*512=96256 in the DMA window).
  1909. *
  1910. * Phase of HS is still not clear to me how to control,
  1911. * It just happens to be so. It can be seen if one enables
  1912. * RPS_IRQ and print Event Counter 1 in vpeirq(). Every
  1913. * time RPS_INTERRUPT is called, the Event Counter 1 will
  1914. * increment. That's how the 7146 is programmed to do event
  1915. * counting in this budget-patch.c
  1916. * I *think* HPS setting has something to do with the phase
  1917. * of HS but I cant be 100% sure in that.
  1918. *
  1919. * hardware debug note: a working budget card (including budget patch)
  1920. * with vpeirq() interrupt setup in mode "0x90" (every 64K) will
  1921. * generate 3 interrupts per 25-Hz DMA frame of 2*188*512 bytes
  1922. * and that means 3*25=75 Hz of interrupt freqency, as seen by
  1923. * watch cat /proc/interrupts
  1924. *
  1925. * If this frequency is 3x lower (and data received in the DMA
  1926. * buffer don't start with 0x47, but in the middle of packets,
  1927. * whose lengths appear to be like 188 292 188 104 etc.
  1928. * this means VSYNC line is not connected in the hardware.
  1929. * (check soldering pcb and pins)
  1930. * The same behaviour of missing VSYNC can be duplicated on budget
  1931. * cards, by seting DD1_INIT trigger mode 7 in 3rd nibble.
  1932. */
  1933. static int __devinit av7110_attach(struct saa7146_dev* dev,
  1934. struct saa7146_pci_extension_data *pci_ext)
  1935. {
  1936. const int length = TS_WIDTH * TS_HEIGHT;
  1937. struct pci_dev *pdev = dev->pci;
  1938. struct av7110 *av7110;
  1939. int ret, count = 0;
  1940. dprintk(4, "dev: %p\n", dev);
  1941. /* Set RPS_IRQ to 1 to track rps1 activity.
  1942. * Enabling this won't send any interrupt to PC CPU.
  1943. */
  1944. #define RPS_IRQ 0
  1945. if (budgetpatch == 1) {
  1946. budgetpatch = 0;
  1947. /* autodetect the presence of budget patch
  1948. * this only works if saa7146 has been recently
  1949. * reset with with MASK_31 to MC1
  1950. *
  1951. * will wait for VBI_B event (vertical blank at port B)
  1952. * and will reset GPIO3 after VBI_B is detected.
  1953. * (GPIO3 should be raised high by CPU to
  1954. * test if GPIO3 will generate vertical blank signal
  1955. * in budget patch GPIO3 is connected to VSYNC_B
  1956. */
  1957. /* RESET SAA7146 */
  1958. saa7146_write(dev, MC1, MASK_31);
  1959. /* autodetection success seems to be time-dependend after reset */
  1960. /* Fix VSYNC level */
  1961. saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTLO);
  1962. /* set vsync_b triggering */
  1963. saa7146_write(dev, DD1_STREAM_B, 0);
  1964. /* port B VSYNC at rising edge */
  1965. saa7146_write(dev, DD1_INIT, 0x00000200);
  1966. saa7146_write(dev, BRS_CTRL, 0x00000000); // VBI
  1967. saa7146_write(dev, MC2,
  1968. 1 * (MASK_08 | MASK_24) | // BRS control
  1969. 0 * (MASK_09 | MASK_25) | // a
  1970. 1 * (MASK_10 | MASK_26) | // b
  1971. 0 * (MASK_06 | MASK_22) | // HPS_CTRL1
  1972. 0 * (MASK_05 | MASK_21) | // HPS_CTRL2
  1973. 0 * (MASK_01 | MASK_15) // DEBI
  1974. );
  1975. /* start writing RPS1 code from beginning */
  1976. count = 0;
  1977. /* Disable RPS1 */
  1978. saa7146_write(dev, MC1, MASK_29);
  1979. /* RPS1 timeout disable */
  1980. saa7146_write(dev, RPS_TOV1, 0);
  1981. WRITE_RPS1(cpu_to_le32(CMD_PAUSE | EVT_VBI_B));
  1982. WRITE_RPS1(cpu_to_le32(CMD_WR_REG_MASK | (GPIO_CTRL>>2)));
  1983. WRITE_RPS1(cpu_to_le32(GPIO3_MSK));
  1984. WRITE_RPS1(cpu_to_le32(SAA7146_GPIO_OUTLO<<24));
  1985. #if RPS_IRQ
  1986. /* issue RPS1 interrupt to increment counter */
  1987. WRITE_RPS1(cpu_to_le32(CMD_INTERRUPT));
  1988. #endif
  1989. WRITE_RPS1(cpu_to_le32(CMD_STOP));
  1990. /* Jump to begin of RPS program as safety measure (p37) */
  1991. WRITE_RPS1(cpu_to_le32(CMD_JUMP));
  1992. WRITE_RPS1(cpu_to_le32(dev->d_rps1.dma_handle));
  1993. #if RPS_IRQ
  1994. /* set event counter 1 source as RPS1 interrupt (0x03) (rE4 p53)
  1995. * use 0x03 to track RPS1 interrupts - increase by 1 every gpio3 is toggled
  1996. * use 0x15 to track VPE interrupts - increase by 1 every vpeirq() is called
  1997. */
  1998. saa7146_write(dev, EC1SSR, (0x03<<2) | 3 );
  1999. /* set event counter 1 treshold to maximum allowed value (rEC p55) */
  2000. saa7146_write(dev, ECT1R, 0x3fff );
  2001. #endif
  2002. /* Set RPS1 Address register to point to RPS code (r108 p42) */
  2003. saa7146_write(dev, RPS_ADDR1, dev->d_rps1.dma_handle);
  2004. /* Enable RPS1, (rFC p33) */
  2005. saa7146_write(dev, MC1, (MASK_13 | MASK_29 ));
  2006. mdelay(10);
  2007. /* now send VSYNC_B to rps1 by rising GPIO3 */
  2008. saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTHI);
  2009. mdelay(10);
  2010. /* if rps1 responded by lowering the GPIO3,
  2011. * then we have budgetpatch hardware
  2012. */
  2013. if ((saa7146_read(dev, GPIO_CTRL) & 0x10000000) == 0) {
  2014. budgetpatch = 1;
  2015. printk("dvb-ttpci: BUDGET-PATCH DETECTED.\n");
  2016. }
  2017. /* Disable RPS1 */
  2018. saa7146_write(dev, MC1, ( MASK_29 ));
  2019. #if RPS_IRQ
  2020. printk("dvb-ttpci: Event Counter 1 0x%04x\n", saa7146_read(dev, EC1R) & 0x3fff );
  2021. #endif
  2022. }
  2023. /* prepare the av7110 device struct */
  2024. av7110 = kzalloc(sizeof(struct av7110), GFP_KERNEL);
  2025. if (!av7110) {
  2026. dprintk(1, "out of memory\n");
  2027. return -ENOMEM;
  2028. }
  2029. av7110->card_name = (char*) pci_ext->ext_priv;
  2030. av7110->dev = dev;
  2031. dev->ext_priv = av7110;
  2032. ret = get_firmware(av7110);
  2033. if (ret < 0)
  2034. goto err_kfree_0;
  2035. ret = dvb_register_adapter(&av7110->dvb_adapter, av7110->card_name,
  2036. THIS_MODULE);
  2037. if (ret < 0)
  2038. goto err_put_firmware_1;
  2039. /* the Siemens DVB needs this if you want to have the i2c chips
  2040. get recognized before the main driver is fully loaded */
  2041. saa7146_write(dev, GPIO_CTRL, 0x500000);
  2042. #ifdef I2C_ADAP_CLASS_TV_DIGITAL
  2043. av7110->i2c_adap.class = I2C_ADAP_CLASS_TV_DIGITAL;
  2044. #else
  2045. av7110->i2c_adap.class = I2C_CLASS_TV_DIGITAL;
  2046. #endif
  2047. strlcpy(av7110->i2c_adap.name, pci_ext->ext_priv, sizeof(av7110->i2c_adap.name));
  2048. saa7146_i2c_adapter_prepare(dev, &av7110->i2c_adap, SAA7146_I2C_BUS_BIT_RATE_120); /* 275 kHz */
  2049. ret = i2c_add_adapter(&av7110->i2c_adap);
  2050. if (ret < 0)
  2051. goto err_dvb_unregister_adapter_2;
  2052. ttpci_eeprom_parse_mac(&av7110->i2c_adap,
  2053. av7110->dvb_adapter.proposed_mac);
  2054. ret = -ENOMEM;
  2055. if (budgetpatch) {
  2056. spin_lock_init(&av7110->feedlock1);
  2057. av7110->grabbing = saa7146_vmalloc_build_pgtable(pdev, length,
  2058. &av7110->pt);
  2059. if (!av7110->grabbing)
  2060. goto err_i2c_del_3;
  2061. saa7146_write(dev, PCI_BT_V1, 0x1c1f101f);
  2062. saa7146_write(dev, BCS_CTRL, 0x80400040);
  2063. /* set dd1 stream a & b */
  2064. saa7146_write(dev, DD1_STREAM_B, 0x00000000);
  2065. saa7146_write(dev, DD1_INIT, 0x03000200);
  2066. saa7146_write(dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26));
  2067. saa7146_write(dev, BRS_CTRL, 0x60000000);
  2068. saa7146_write(dev, BASE_ODD3, 0);
  2069. saa7146_write(dev, BASE_EVEN3, 0);
  2070. saa7146_write(dev, PROT_ADDR3, TS_WIDTH * TS_HEIGHT);
  2071. saa7146_write(dev, BASE_PAGE3, av7110->pt.dma | ME1 | 0x90);
  2072. saa7146_write(dev, PITCH3, TS_WIDTH);
  2073. saa7146_write(dev, NUM_LINE_BYTE3, (TS_HEIGHT << 16) | TS_WIDTH);
  2074. /* upload all */
  2075. saa7146_write(dev, MC2, 0x077c077c);
  2076. saa7146_write(dev, GPIO_CTRL, 0x000000);
  2077. #if RPS_IRQ
  2078. /* set event counter 1 source as RPS1 interrupt (0x03) (rE4 p53)
  2079. * use 0x03 to track RPS1 interrupts - increase by 1 every gpio3 is toggled
  2080. * use 0x15 to track VPE interrupts - increase by 1 every vpeirq() is called
  2081. */
  2082. saa7146_write(dev, EC1SSR, (0x03<<2) | 3 );
  2083. /* set event counter 1 treshold to maximum allowed value (rEC p55) */
  2084. saa7146_write(dev, ECT1R, 0x3fff );
  2085. #endif
  2086. /* Setup BUDGETPATCH MAIN RPS1 "program" (p35) */
  2087. count = 0;
  2088. /* Wait Source Line Counter Threshold (p36) */
  2089. WRITE_RPS1(cpu_to_le32(CMD_PAUSE | EVT_HS));
  2090. /* Set GPIO3=1 (p42) */
  2091. WRITE_RPS1(cpu_to_le32(CMD_WR_REG_MASK | (GPIO_CTRL>>2)));
  2092. WRITE_RPS1(cpu_to_le32(GPIO3_MSK));
  2093. WRITE_RPS1(cpu_to_le32(SAA7146_GPIO_OUTHI<<24));
  2094. #if RPS_IRQ
  2095. /* issue RPS1 interrupt */
  2096. WRITE_RPS1(cpu_to_le32(CMD_INTERRUPT));
  2097. #endif
  2098. /* Wait reset Source Line Counter Threshold (p36) */
  2099. WRITE_RPS1(cpu_to_le32(CMD_PAUSE | RPS_INV | EVT_HS));
  2100. /* Set GPIO3=0 (p42) */
  2101. WRITE_RPS1(cpu_to_le32(CMD_WR_REG_MASK | (GPIO_CTRL>>2)));
  2102. WRITE_RPS1(cpu_to_le32(GPIO3_MSK));
  2103. WRITE_RPS1(cpu_to_le32(SAA7146_GPIO_OUTLO<<24));
  2104. #if RPS_IRQ
  2105. /* issue RPS1 interrupt */
  2106. WRITE_RPS1(cpu_to_le32(CMD_INTERRUPT));
  2107. #endif
  2108. /* Jump to begin of RPS program (p37) */
  2109. WRITE_RPS1(cpu_to_le32(CMD_JUMP));
  2110. WRITE_RPS1(cpu_to_le32(dev->d_rps1.dma_handle));
  2111. /* Fix VSYNC level */
  2112. saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTLO);
  2113. /* Set RPS1 Address register to point to RPS code (r108 p42) */
  2114. saa7146_write(dev, RPS_ADDR1, dev->d_rps1.dma_handle);
  2115. /* Set Source Line Counter Threshold, using BRS (rCC p43)
  2116. * It generates HS event every TS_HEIGHT lines
  2117. * this is related to TS_WIDTH set in register
  2118. * NUM_LINE_BYTE3. If NUM_LINE_BYTE low 16 bits
  2119. * are set to TS_WIDTH bytes (TS_WIDTH=2*188),
  2120. * then RPS_THRESH1 should be set to trigger
  2121. * every TS_HEIGHT (512) lines.
  2122. */
  2123. saa7146_write(dev, RPS_THRESH1, (TS_HEIGHT*1) | MASK_12 );
  2124. /* Enable RPS1 (rFC p33) */
  2125. saa7146_write(dev, MC1, (MASK_13 | MASK_29));
  2126. /* end of budgetpatch register initialization */
  2127. tasklet_init (&av7110->vpe_tasklet, vpeirq, (unsigned long) av7110);
  2128. } else {
  2129. saa7146_write(dev, PCI_BT_V1, 0x1c00101f);
  2130. saa7146_write(dev, BCS_CTRL, 0x80400040);
  2131. /* set dd1 stream a & b */
  2132. saa7146_write(dev, DD1_STREAM_B, 0x00000000);
  2133. saa7146_write(dev, DD1_INIT, 0x03000000);
  2134. saa7146_write(dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26));
  2135. /* upload all */
  2136. saa7146_write(dev, MC2, 0x077c077c);
  2137. saa7146_write(dev, GPIO_CTRL, 0x000000);
  2138. }
  2139. tasklet_init (&av7110->debi_tasklet, debiirq, (unsigned long) av7110);
  2140. tasklet_init (&av7110->gpio_tasklet, gpioirq, (unsigned long) av7110);
  2141. mutex_init(&av7110->pid_mutex);
  2142. /* locks for data transfers from/to AV7110 */
  2143. spin_lock_init(&av7110->debilock);
  2144. mutex_init(&av7110->dcomlock);
  2145. av7110->debitype = -1;
  2146. /* default OSD window */
  2147. av7110->osdwin = 1;
  2148. mutex_init(&av7110->osd_mutex);
  2149. /* ARM "watchdog" */
  2150. init_waitqueue_head(&av7110->arm_wait);
  2151. av7110->arm_thread = NULL;
  2152. /* allocate and init buffers */
  2153. av7110->debi_virt = pci_alloc_consistent(pdev, 8192, &av7110->debi_bus);
  2154. if (!av7110->debi_virt)
  2155. goto err_saa71466_vfree_4;
  2156. av7110->iobuf = vmalloc(AVOUTLEN+AOUTLEN+BMPLEN+4*IPACKS);
  2157. if (!av7110->iobuf)
  2158. goto err_pci_free_5;
  2159. ret = av7110_av_init(av7110);
  2160. if (ret < 0)
  2161. goto err_iobuf_vfree_6;
  2162. /* init BMP buffer */
  2163. av7110->bmpbuf = av7110->iobuf+AVOUTLEN+AOUTLEN;
  2164. init_waitqueue_head(&av7110->bmpq);
  2165. ret = av7110_ca_init(av7110);
  2166. if (ret < 0)
  2167. goto err_av7110_av_exit_7;
  2168. /* load firmware into AV7110 cards */
  2169. ret = av7110_bootarm(av7110);
  2170. if (ret < 0)
  2171. goto err_av7110_ca_exit_8;
  2172. ret = av7110_firmversion(av7110);
  2173. if (ret < 0)
  2174. goto err_stop_arm_9;
  2175. if (FW_VERSION(av7110->arm_app)<0x2501)
  2176. printk ("dvb-ttpci: Warning, firmware version 0x%04x is too old. "
  2177. "System might be unstable!\n", FW_VERSION(av7110->arm_app));
  2178. ret = kernel_thread(arm_thread, (void *) av7110, 0);
  2179. if (ret < 0)
  2180. goto err_stop_arm_9;
  2181. /* set initial volume in mixer struct */
  2182. av7110->mixer.volume_left = volume;
  2183. av7110->mixer.volume_right = volume;
  2184. init_av7110_av(av7110);
  2185. ret = av7110_register(av7110);
  2186. if (ret < 0)
  2187. goto err_arm_thread_stop_10;
  2188. /* special case DVB-C: these cards have an analog tuner
  2189. plus need some special handling, so we have separate
  2190. saa7146_ext_vv data for these... */
  2191. ret = av7110_init_v4l(av7110);
  2192. if (ret < 0)
  2193. goto err_av7110_unregister_11;
  2194. av7110->dvb_adapter.priv = av7110;
  2195. ret = frontend_init(av7110);
  2196. if (ret < 0)
  2197. goto err_av7110_exit_v4l_12;
  2198. #if defined(CONFIG_INPUT_EVDEV) || defined(CONFIG_INPUT_EVDEV_MODULE)
  2199. av7110_ir_init(av7110);
  2200. #endif
  2201. printk(KERN_INFO "dvb-ttpci: found av7110-%d.\n", av7110_num);
  2202. av7110_num++;
  2203. out:
  2204. return ret;
  2205. err_av7110_exit_v4l_12:
  2206. av7110_exit_v4l(av7110);
  2207. err_av7110_unregister_11:
  2208. dvb_unregister(av7110);
  2209. err_arm_thread_stop_10:
  2210. av7110_arm_sync(av7110);
  2211. err_stop_arm_9:
  2212. /* Nothing to do. Rejoice. */
  2213. err_av7110_ca_exit_8:
  2214. av7110_ca_exit(av7110);
  2215. err_av7110_av_exit_7:
  2216. av7110_av_exit(av7110);
  2217. err_iobuf_vfree_6:
  2218. vfree(av7110->iobuf);
  2219. err_pci_free_5:
  2220. pci_free_consistent(pdev, 8192, av7110->debi_virt, av7110->debi_bus);
  2221. err_saa71466_vfree_4:
  2222. if (!av7110->grabbing)
  2223. saa7146_pgtable_free(pdev, &av7110->pt);
  2224. err_i2c_del_3:
  2225. i2c_del_adapter(&av7110->i2c_adap);
  2226. err_dvb_unregister_adapter_2:
  2227. dvb_unregister_adapter(&av7110->dvb_adapter);
  2228. err_put_firmware_1:
  2229. put_firmware(av7110);
  2230. err_kfree_0:
  2231. kfree(av7110);
  2232. goto out;
  2233. }
  2234. static int __devexit av7110_detach(struct saa7146_dev* saa)
  2235. {
  2236. struct av7110 *av7110 = saa->ext_priv;
  2237. dprintk(4, "%p\n", av7110);
  2238. #if defined(CONFIG_INPUT_EVDEV) || defined(CONFIG_INPUT_EVDEV_MODULE)
  2239. av7110_ir_exit(av7110);
  2240. #endif
  2241. if (budgetpatch) {
  2242. /* Disable RPS1 */
  2243. saa7146_write(saa, MC1, MASK_29);
  2244. /* VSYNC LOW (inactive) */
  2245. saa7146_setgpio(saa, 3, SAA7146_GPIO_OUTLO);
  2246. saa7146_write(saa, MC1, MASK_20); /* DMA3 off */
  2247. SAA7146_IER_DISABLE(saa, MASK_10);
  2248. SAA7146_ISR_CLEAR(saa, MASK_10);
  2249. msleep(50);
  2250. tasklet_kill(&av7110->vpe_tasklet);
  2251. saa7146_pgtable_free(saa->pci, &av7110->pt);
  2252. }
  2253. av7110_exit_v4l(av7110);
  2254. av7110_arm_sync(av7110);
  2255. tasklet_kill(&av7110->debi_tasklet);
  2256. tasklet_kill(&av7110->gpio_tasklet);
  2257. dvb_unregister(av7110);
  2258. SAA7146_IER_DISABLE(saa, MASK_19 | MASK_03);
  2259. SAA7146_ISR_CLEAR(saa, MASK_19 | MASK_03);
  2260. av7110_ca_exit(av7110);
  2261. av7110_av_exit(av7110);
  2262. vfree(av7110->iobuf);
  2263. pci_free_consistent(saa->pci, 8192, av7110->debi_virt,
  2264. av7110->debi_bus);
  2265. i2c_del_adapter(&av7110->i2c_adap);
  2266. dvb_unregister_adapter (&av7110->dvb_adapter);
  2267. av7110_num--;
  2268. put_firmware(av7110);
  2269. kfree(av7110);
  2270. saa->ext_priv = NULL;
  2271. return 0;
  2272. }
  2273. static void av7110_irq(struct saa7146_dev* dev, u32 *isr)
  2274. {
  2275. struct av7110 *av7110 = dev->ext_priv;
  2276. //print_time("av7110_irq");
  2277. /* Note: Don't try to handle the DEBI error irq (MASK_18), in
  2278. * intel mode the timeout is asserted all the time...
  2279. */
  2280. if (*isr & MASK_19) {
  2281. //printk("av7110_irq: DEBI\n");
  2282. /* Note 1: The DEBI irq is level triggered: We must enable it
  2283. * only after we started a DMA xfer, and disable it here
  2284. * immediately, or it will be signalled all the time while
  2285. * DEBI is idle.
  2286. * Note 2: You would think that an irq which is masked is
  2287. * not signalled by the hardware. Not so for the SAA7146:
  2288. * An irq is signalled as long as the corresponding bit
  2289. * in the ISR is set, and disabling irqs just prevents the
  2290. * hardware from setting the ISR bit. This means a) that we
  2291. * must clear the ISR *after* disabling the irq (which is why
  2292. * we must do it here even though saa7146_core did it already),
  2293. * and b) that if we were to disable an edge triggered irq
  2294. * (like the gpio irqs sadly are) temporarily we would likely
  2295. * loose some. This sucks :-(
  2296. */
  2297. SAA7146_IER_DISABLE(av7110->dev, MASK_19);
  2298. SAA7146_ISR_CLEAR(av7110->dev, MASK_19);
  2299. tasklet_schedule(&av7110->debi_tasklet);
  2300. }
  2301. if (*isr & MASK_03) {
  2302. //printk("av7110_irq: GPIO\n");
  2303. tasklet_schedule(&av7110->gpio_tasklet);
  2304. }
  2305. if ((*isr & MASK_10) && budgetpatch)
  2306. tasklet_schedule(&av7110->vpe_tasklet);
  2307. }
  2308. static struct saa7146_extension av7110_extension;
  2309. #define MAKE_AV7110_INFO(x_var,x_name) \
  2310. static struct saa7146_pci_extension_data x_var = { \
  2311. .ext_priv = x_name, \
  2312. .ext = &av7110_extension }
  2313. MAKE_AV7110_INFO(tts_1_X_fsc,"Technotrend/Hauppauge WinTV DVB-S rev1.X or Fujitsu Siemens DVB-C");
  2314. MAKE_AV7110_INFO(ttt_1_X, "Technotrend/Hauppauge WinTV DVB-T rev1.X");
  2315. MAKE_AV7110_INFO(ttc_1_X, "Technotrend/Hauppauge WinTV Nexus-CA rev1.X");
  2316. MAKE_AV7110_INFO(ttc_2_X, "Technotrend/Hauppauge WinTV DVB-C rev2.X");
  2317. MAKE_AV7110_INFO(tts_2_X, "Technotrend/Hauppauge WinTV Nexus-S rev2.X");
  2318. MAKE_AV7110_INFO(tts_2_3, "Technotrend/Hauppauge WinTV Nexus-S rev2.3");
  2319. MAKE_AV7110_INFO(tts_1_3se, "Technotrend/Hauppauge WinTV DVB-S rev1.3 SE");
  2320. MAKE_AV7110_INFO(ttt, "Technotrend/Hauppauge DVB-T");
  2321. MAKE_AV7110_INFO(fsc, "Fujitsu Siemens DVB-C");
  2322. MAKE_AV7110_INFO(fss, "Fujitsu Siemens DVB-S rev1.6");
  2323. MAKE_AV7110_INFO(gxs_1_3, "Galaxis DVB-S rev1.3");
  2324. static struct pci_device_id pci_tbl[] = {
  2325. MAKE_EXTENSION_PCI(fsc, 0x110a, 0x0000),
  2326. MAKE_EXTENSION_PCI(tts_1_X_fsc, 0x13c2, 0x0000),
  2327. MAKE_EXTENSION_PCI(ttt_1_X, 0x13c2, 0x0001),
  2328. MAKE_EXTENSION_PCI(ttc_2_X, 0x13c2, 0x0002),
  2329. MAKE_EXTENSION_PCI(tts_2_X, 0x13c2, 0x0003),
  2330. MAKE_EXTENSION_PCI(gxs_1_3, 0x13c2, 0x0004),
  2331. MAKE_EXTENSION_PCI(fss, 0x13c2, 0x0006),
  2332. MAKE_EXTENSION_PCI(ttt, 0x13c2, 0x0008),
  2333. MAKE_EXTENSION_PCI(ttc_1_X, 0x13c2, 0x000a),
  2334. MAKE_EXTENSION_PCI(tts_2_3, 0x13c2, 0x000e),
  2335. MAKE_EXTENSION_PCI(tts_1_3se, 0x13c2, 0x1002),
  2336. /* MAKE_EXTENSION_PCI(???, 0x13c2, 0x0005), UNDEFINED CARD */ // Technisat SkyStar1
  2337. /* MAKE_EXTENSION_PCI(???, 0x13c2, 0x0009), UNDEFINED CARD */ // TT/Hauppauge WinTV Nexus-CA v????
  2338. {
  2339. .vendor = 0,
  2340. }
  2341. };
  2342. MODULE_DEVICE_TABLE(pci, pci_tbl);
  2343. static struct saa7146_extension av7110_extension = {
  2344. .name = "dvb\0",
  2345. .flags = SAA7146_I2C_SHORT_DELAY,
  2346. .module = THIS_MODULE,
  2347. .pci_tbl = &pci_tbl[0],
  2348. .attach = av7110_attach,
  2349. .detach = __devexit_p(av7110_detach),
  2350. .irq_mask = MASK_19 | MASK_03 | MASK_10,
  2351. .irq_func = av7110_irq,
  2352. };
  2353. static int __init av7110_init(void)
  2354. {
  2355. int retval;
  2356. retval = saa7146_register_extension(&av7110_extension);
  2357. return retval;
  2358. }
  2359. static void __exit av7110_exit(void)
  2360. {
  2361. saa7146_unregister_extension(&av7110_extension);
  2362. }
  2363. module_init(av7110_init);
  2364. module_exit(av7110_exit);
  2365. MODULE_DESCRIPTION("driver for the SAA7146 based AV110 PCI DVB cards by "
  2366. "Siemens, Technotrend, Hauppauge");
  2367. MODULE_AUTHOR("Ralph Metzler, Marcus Metzler, others");
  2368. MODULE_LICENSE("GPL");