Merge branch 'master' of git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux-2.6
[linux-2.6] / drivers / media / dvb / ttpci / budget-patch.c
1 /*
2  * budget-patch.c: driver for Budget Patch,
3  * hardware modification of DVB-S cards enabling full TS
4  *
5  * Written by Emard <emard@softhome.net>
6  *
7  * Original idea by Roberto Deza <rdeza@unav.es>
8  *
9  * Special thanks to Holger Waechtler, Michael Hunold, Marian Durkovic
10  * and Metzlerbros
11  *
12  * This program is free software; you can redistribute it and/or
13  * modify it under the terms of the GNU General Public License
14  * as published by the Free Software Foundation; either version 2
15  * of the License, or (at your option) any later version.
16  *
17  *
18  * This program is distributed in the hope that it will be useful,
19  * but WITHOUT ANY WARRANTY; without even the implied warranty of
20  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
21  * GNU General Public License for more details.
22  *
23  *
24  * You should have received a copy of the GNU General Public License
25  * along with this program; if not, write to the Free Software
26  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
27  * Or, point your browser to http://www.gnu.org/copyleft/gpl.html
28  *
29  *
30  * the project's page is at http://www.linuxtv.org/dvb/
31  */
32
33 #include "av7110.h"
34 #include "av7110_hw.h"
35 #include "budget.h"
36 #include "stv0299.h"
37 #include "ves1x93.h"
38 #include "tda8083.h"
39
40 #include "bsru6.h"
41
42 #define budget_patch budget
43
44 static struct saa7146_extension budget_extension;
45
46 MAKE_BUDGET_INFO(ttbp, "TT-Budget/Patch DVB-S 1.x PCI", BUDGET_PATCH);
47 //MAKE_BUDGET_INFO(satel,"TT-Budget/Patch SATELCO PCI", BUDGET_TT_HW_DISEQC);
48
49 static struct pci_device_id pci_tbl[] = {
50         MAKE_EXTENSION_PCI(ttbp,0x13c2, 0x0000),
51 //        MAKE_EXTENSION_PCI(satel, 0x13c2, 0x1013),
52         {
53                 .vendor    = 0,
54         }
55 };
56
57 /* those lines are for budget-patch to be tried
58 ** on a true budget card and observe the
59 ** behaviour of VSYNC generated by rps1.
60 ** this code was shamelessly copy/pasted from budget.c
61 */
62 static void gpio_Set22K (struct budget *budget, int state)
63 {
64         struct saa7146_dev *dev=budget->dev;
65         dprintk(2, "budget: %p\n", budget);
66         saa7146_setgpio(dev, 3, (state ? SAA7146_GPIO_OUTHI : SAA7146_GPIO_OUTLO));
67 }
68
69 /* Diseqc functions only for TT Budget card */
70 /* taken from the Skyvision DVB driver by
71    Ralph Metzler <rjkm@metzlerbros.de> */
72
73 static void DiseqcSendBit (struct budget *budget, int data)
74 {
75         struct saa7146_dev *dev=budget->dev;
76         dprintk(2, "budget: %p\n", budget);
77
78         saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTHI);
79         udelay(data ? 500 : 1000);
80         saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTLO);
81         udelay(data ? 1000 : 500);
82 }
83
84 static void DiseqcSendByte (struct budget *budget, int data)
85 {
86         int i, par=1, d;
87
88         dprintk(2, "budget: %p\n", budget);
89
90         for (i=7; i>=0; i--) {
91                 d = (data>>i)&1;
92                 par ^= d;
93                 DiseqcSendBit(budget, d);
94         }
95
96         DiseqcSendBit(budget, par);
97 }
98
99 static int SendDiSEqCMsg (struct budget *budget, int len, u8 *msg, unsigned long burst)
100 {
101         struct saa7146_dev *dev=budget->dev;
102         int i;
103
104         dprintk(2, "budget: %p\n", budget);
105
106         saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTLO);
107         mdelay(16);
108
109         for (i=0; i<len; i++)
110                 DiseqcSendByte(budget, msg[i]);
111
112         mdelay(16);
113
114         if (burst!=-1) {
115                 if (burst)
116                         DiseqcSendByte(budget, 0xff);
117                 else {
118                         saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTHI);
119                         udelay(12500);
120                         saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTLO);
121                 }
122                 msleep(20);
123         }
124
125         return 0;
126 }
127
128 /* shamelessly copy/pasted from budget.c
129 */
130 static int budget_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone)
131 {
132         struct budget* budget = (struct budget*) fe->dvb->priv;
133
134         switch (tone) {
135         case SEC_TONE_ON:
136                 gpio_Set22K (budget, 1);
137                 break;
138
139         case SEC_TONE_OFF:
140                 gpio_Set22K (budget, 0);
141                 break;
142
143         default:
144                 return -EINVAL;
145         }
146
147         return 0;
148 }
149
150 static int budget_diseqc_send_master_cmd(struct dvb_frontend* fe, struct dvb_diseqc_master_cmd* cmd)
151 {
152         struct budget* budget = (struct budget*) fe->dvb->priv;
153
154         SendDiSEqCMsg (budget, cmd->msg_len, cmd->msg, 0);
155
156         return 0;
157 }
158
159 static int budget_diseqc_send_burst(struct dvb_frontend* fe, fe_sec_mini_cmd_t minicmd)
160 {
161         struct budget* budget = (struct budget*) fe->dvb->priv;
162
163         SendDiSEqCMsg (budget, 0, NULL, minicmd);
164
165         return 0;
166 }
167
168 static int budget_av7110_send_fw_cmd(struct budget_patch *budget, u16* buf, int length)
169 {
170         int i;
171
172         dprintk(2, "budget: %p\n", budget);
173
174         for (i = 2; i < length; i++)
175         {
176                   ttpci_budget_debiwrite(budget, DEBINOSWAP, COMMAND + 2*i, 2, (u32) buf[i], 0,0);
177                   msleep(5);
178         }
179         if (length)
180                   ttpci_budget_debiwrite(budget, DEBINOSWAP, COMMAND + 2, 2, (u32) buf[1], 0,0);
181         else
182                   ttpci_budget_debiwrite(budget, DEBINOSWAP, COMMAND + 2, 2, 0, 0,0);
183         msleep(5);
184         ttpci_budget_debiwrite(budget, DEBINOSWAP, COMMAND, 2, (u32) buf[0], 0,0);
185         msleep(5);
186         return 0;
187 }
188
189 static void av7110_set22k(struct budget_patch *budget, int state)
190 {
191         u16 buf[2] = {( COMTYPE_AUDIODAC << 8) | (state ? ON22K : OFF22K), 0};
192
193         dprintk(2, "budget: %p\n", budget);
194         budget_av7110_send_fw_cmd(budget, buf, 2);
195 }
196
197 static int av7110_send_diseqc_msg(struct budget_patch *budget, int len, u8 *msg, int burst)
198 {
199         int i;
200         u16 buf[18] = { ((COMTYPE_AUDIODAC << 8) | SendDiSEqC),
201                 16, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
202
203         dprintk(2, "budget: %p\n", budget);
204
205         if (len>10)
206                 len=10;
207
208         buf[1] = len+2;
209         buf[2] = len;
210
211         if (burst != -1)
212                 buf[3]=burst ? 0x01 : 0x00;
213         else
214                 buf[3]=0xffff;
215
216         for (i=0; i<len; i++)
217                 buf[i+4]=msg[i];
218
219         budget_av7110_send_fw_cmd(budget, buf, 18);
220         return 0;
221 }
222
223 static int budget_patch_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone)
224 {
225         struct budget_patch* budget = (struct budget_patch*) fe->dvb->priv;
226
227         switch (tone) {
228         case SEC_TONE_ON:
229                 av7110_set22k (budget, 1);
230                 break;
231
232         case SEC_TONE_OFF:
233                 av7110_set22k (budget, 0);
234                 break;
235
236         default:
237                 return -EINVAL;
238         }
239
240         return 0;
241 }
242
243 static int budget_patch_diseqc_send_master_cmd(struct dvb_frontend* fe, struct dvb_diseqc_master_cmd* cmd)
244 {
245         struct budget_patch* budget = (struct budget_patch*) fe->dvb->priv;
246
247         av7110_send_diseqc_msg (budget, cmd->msg_len, cmd->msg, 0);
248
249         return 0;
250 }
251
252 static int budget_patch_diseqc_send_burst(struct dvb_frontend* fe, fe_sec_mini_cmd_t minicmd)
253 {
254         struct budget_patch* budget = (struct budget_patch*) fe->dvb->priv;
255
256         av7110_send_diseqc_msg (budget, 0, NULL, minicmd);
257
258         return 0;
259 }
260
261 static int alps_bsrv2_tuner_set_params(struct dvb_frontend* fe, struct dvb_frontend_parameters* params)
262 {
263         struct budget_patch* budget = (struct budget_patch*) fe->dvb->priv;
264         u8 pwr = 0;
265         u8 buf[4];
266         struct i2c_msg msg = { .addr = 0x61, .flags = 0, .buf = buf, .len = sizeof(buf) };
267         u32 div = (params->frequency + 479500) / 125;
268
269         if (params->frequency > 2000000) pwr = 3;
270         else if (params->frequency > 1800000) pwr = 2;
271         else if (params->frequency > 1600000) pwr = 1;
272         else if (params->frequency > 1200000) pwr = 0;
273         else if (params->frequency >= 1100000) pwr = 1;
274         else pwr = 2;
275
276         buf[0] = (div >> 8) & 0x7f;
277         buf[1] = div & 0xff;
278         buf[2] = ((div & 0x18000) >> 10) | 0x95;
279         buf[3] = (pwr << 6) | 0x30;
280
281         // NOTE: since we're using a prescaler of 2, we set the
282         // divisor frequency to 62.5kHz and divide by 125 above
283
284         if (fe->ops.i2c_gate_ctrl)
285                 fe->ops.i2c_gate_ctrl(fe, 1);
286         if (i2c_transfer (&budget->i2c_adap, &msg, 1) != 1)
287                 return -EIO;
288         return 0;
289 }
290
291 static struct ves1x93_config alps_bsrv2_config = {
292         .demod_address = 0x08,
293         .xin = 90100000UL,
294         .invert_pwm = 0,
295 };
296
297 static int grundig_29504_451_tuner_set_params(struct dvb_frontend* fe, struct dvb_frontend_parameters* params)
298 {
299         struct budget_patch* budget = (struct budget_patch*) fe->dvb->priv;
300         u32 div;
301         u8 data[4];
302         struct i2c_msg msg = { .addr = 0x61, .flags = 0, .buf = data, .len = sizeof(data) };
303
304         div = params->frequency / 125;
305         data[0] = (div >> 8) & 0x7f;
306         data[1] = div & 0xff;
307         data[2] = 0x8e;
308         data[3] = 0x00;
309
310         if (fe->ops.i2c_gate_ctrl)
311                 fe->ops.i2c_gate_ctrl(fe, 1);
312         if (i2c_transfer (&budget->i2c_adap, &msg, 1) != 1)
313                 return -EIO;
314         return 0;
315 }
316
317 static struct tda8083_config grundig_29504_451_config = {
318         .demod_address = 0x68,
319 };
320
321 static void frontend_init(struct budget_patch* budget)
322 {
323         switch(budget->dev->pci->subsystem_device) {
324         case 0x0000: // Hauppauge/TT WinTV DVB-S rev1.X
325         case 0x1013: // SATELCO Multimedia PCI
326
327                 // try the ALPS BSRV2 first of all
328                 budget->dvb_frontend = dvb_attach(ves1x93_attach, &alps_bsrv2_config, &budget->i2c_adap);
329                 if (budget->dvb_frontend) {
330                         budget->dvb_frontend->ops.tuner_ops.set_params = alps_bsrv2_tuner_set_params;
331                         budget->dvb_frontend->ops.diseqc_send_master_cmd = budget_patch_diseqc_send_master_cmd;
332                         budget->dvb_frontend->ops.diseqc_send_burst = budget_patch_diseqc_send_burst;
333                         budget->dvb_frontend->ops.set_tone = budget_patch_set_tone;
334                         break;
335                 }
336
337                 // try the ALPS BSRU6 now
338                 budget->dvb_frontend = dvb_attach(stv0299_attach, &alps_bsru6_config, &budget->i2c_adap);
339                 if (budget->dvb_frontend) {
340                         budget->dvb_frontend->ops.tuner_ops.set_params = alps_bsru6_tuner_set_params;
341                         budget->dvb_frontend->tuner_priv = &budget->i2c_adap;
342
343                         budget->dvb_frontend->ops.diseqc_send_master_cmd = budget_diseqc_send_master_cmd;
344                         budget->dvb_frontend->ops.diseqc_send_burst = budget_diseqc_send_burst;
345                         budget->dvb_frontend->ops.set_tone = budget_set_tone;
346                         break;
347                 }
348
349                 // Try the grundig 29504-451
350                 budget->dvb_frontend = dvb_attach(tda8083_attach, &grundig_29504_451_config, &budget->i2c_adap);
351                 if (budget->dvb_frontend) {
352                         budget->dvb_frontend->ops.tuner_ops.set_params = grundig_29504_451_tuner_set_params;
353                         budget->dvb_frontend->ops.diseqc_send_master_cmd = budget_diseqc_send_master_cmd;
354                         budget->dvb_frontend->ops.diseqc_send_burst = budget_diseqc_send_burst;
355                         budget->dvb_frontend->ops.set_tone = budget_set_tone;
356                         break;
357                 }
358                 break;
359         }
360
361         if (budget->dvb_frontend == NULL) {
362                 printk("dvb-ttpci: A frontend driver was not found for device %04x/%04x subsystem %04x/%04x\n",
363                        budget->dev->pci->vendor,
364                        budget->dev->pci->device,
365                        budget->dev->pci->subsystem_vendor,
366                        budget->dev->pci->subsystem_device);
367         } else {
368                 if (dvb_register_frontend(&budget->dvb_adapter, budget->dvb_frontend)) {
369                         printk("budget-av: Frontend registration failed!\n");
370                         dvb_frontend_detach(budget->dvb_frontend);
371                         budget->dvb_frontend = NULL;
372                 }
373         }
374 }
375
376 /* written by Emard */
377 static int budget_patch_attach (struct saa7146_dev* dev, struct saa7146_pci_extension_data *info)
378 {
379         struct budget_patch *budget;
380         int err;
381         int count = 0;
382         int detected = 0;
383
384 #define PATCH_RESET 0
385 #define RPS_IRQ 0
386 #define HPS_SETUP 0
387 #if PATCH_RESET
388         saa7146_write(dev, MC1, MASK_31);
389         msleep(40);
390 #endif
391 #if HPS_SETUP
392         // initialize registers. Better to have it like this
393         // than leaving something unconfigured
394         saa7146_write(dev, DD1_STREAM_B, 0);
395         // port B VSYNC at rising edge
396         saa7146_write(dev, DD1_INIT, 0x00000200);  // have this in budget-core too!
397         saa7146_write(dev, BRS_CTRL, 0x00000000);  // VBI
398
399         // debi config
400         // saa7146_write(dev, DEBI_CONFIG, MASK_30|MASK_28|MASK_18);
401
402         // zero all HPS registers
403         saa7146_write(dev, HPS_H_PRESCALE, 0);                  // r68
404         saa7146_write(dev, HPS_H_SCALE, 0);                     // r6c
405         saa7146_write(dev, BCS_CTRL, 0);                        // r70
406         saa7146_write(dev, HPS_V_SCALE, 0);                     // r60
407         saa7146_write(dev, HPS_V_GAIN, 0);                      // r64
408         saa7146_write(dev, CHROMA_KEY_RANGE, 0);                // r74
409         saa7146_write(dev, CLIP_FORMAT_CTRL, 0);                // r78
410         // Set HPS prescaler for port B input
411         saa7146_write(dev, HPS_CTRL, (1<<30) | (0<<29) | (1<<28) | (0<<12) );
412         saa7146_write(dev, MC2,
413           0 * (MASK_08 | MASK_24)  |   // BRS control
414           0 * (MASK_09 | MASK_25)  |   // a
415           0 * (MASK_10 | MASK_26)  |   // b
416           1 * (MASK_06 | MASK_22)  |   // HPS_CTRL1
417           1 * (MASK_05 | MASK_21)  |   // HPS_CTRL2
418           0 * (MASK_01 | MASK_15)      // DEBI
419            );
420 #endif
421         // Disable RPS1 and RPS0
422         saa7146_write(dev, MC1, ( MASK_29 | MASK_28));
423         // RPS1 timeout disable
424         saa7146_write(dev, RPS_TOV1, 0);
425
426         // code for autodetection
427         // will wait for VBI_B event (vertical blank at port B)
428         // and will reset GPIO3 after VBI_B is detected.
429         // (GPIO3 should be raised high by CPU to
430         // test if GPIO3 will generate vertical blank signal
431         // in budget patch GPIO3 is connected to VSYNC_B
432         count = 0;
433 #if 0
434         WRITE_RPS1(cpu_to_le32(CMD_UPLOAD |
435           MASK_10 | MASK_09 | MASK_08 | MASK_06 | MASK_05 | MASK_04 | MASK_03 | MASK_02 ));
436 #endif
437         WRITE_RPS1(cpu_to_le32(CMD_PAUSE | EVT_VBI_B));
438         WRITE_RPS1(cpu_to_le32(CMD_WR_REG_MASK | (GPIO_CTRL>>2)));
439         WRITE_RPS1(cpu_to_le32(GPIO3_MSK));
440         WRITE_RPS1(cpu_to_le32(SAA7146_GPIO_OUTLO<<24));
441 #if RPS_IRQ
442         // issue RPS1 interrupt to increment counter
443         WRITE_RPS1(cpu_to_le32(CMD_INTERRUPT));
444         // at least a NOP is neede between two interrupts
445         WRITE_RPS1(cpu_to_le32(CMD_NOP));
446         // interrupt again
447         WRITE_RPS1(cpu_to_le32(CMD_INTERRUPT));
448 #endif
449         WRITE_RPS1(cpu_to_le32(CMD_STOP));
450
451 #if RPS_IRQ
452         // set event counter 1 source as RPS1 interrupt (0x03)          (rE4 p53)
453         // use 0x03 to track RPS1 interrupts - increase by 1 every gpio3 is toggled
454         // use 0x15 to track VPE  interrupts - increase by 1 every vpeirq() is called
455         saa7146_write(dev, EC1SSR, (0x03<<2) | 3 );
456         // set event counter 1 treshold to maximum allowed value        (rEC p55)
457         saa7146_write(dev, ECT1R,  0x3fff );
458 #endif
459         // Fix VSYNC level
460         saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTLO);
461         // Set RPS1 Address register to point to RPS code               (r108 p42)
462         saa7146_write(dev, RPS_ADDR1, dev->d_rps1.dma_handle);
463         // Enable RPS1,                                                 (rFC p33)
464         saa7146_write(dev, MC1, (MASK_13 | MASK_29 ));
465
466
467         mdelay(50);
468         saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTHI);
469         mdelay(150);
470
471
472         if( (saa7146_read(dev, GPIO_CTRL) & 0x10000000) == 0)
473                 detected = 1;
474
475 #if RPS_IRQ
476         printk("Event Counter 1 0x%04x\n", saa7146_read(dev, EC1R) & 0x3fff );
477 #endif
478         // Disable RPS1
479         saa7146_write(dev, MC1, ( MASK_29 ));
480
481         if(detected == 0)
482                 printk("budget-patch not detected or saa7146 in non-default state.\n"
483                        "try enabling ressetting of 7146 with MASK_31 in MC1 register\n");
484
485         else
486                 printk("BUDGET-PATCH DETECTED.\n");
487
488
489 /*      OLD (Original design by Roberto Deza):
490 **      This code will setup the SAA7146_RPS1 to generate a square
491 **      wave on GPIO3, changing when a field (TS_HEIGHT/2 "lines" of
492 **      TS_WIDTH packets) has been acquired on SAA7146_D1B video port;
493 **      then, this GPIO3 output which is connected to the D1B_VSYNC
494 **      input, will trigger the acquisition of the alternate field
495 **      and so on.
496 **      Currently, the TT_budget / WinTV_Nova cards have two ICs
497 **      (74HCT4040, LVC74) for the generation of this VSYNC signal,
498 **      which seems that can be done perfectly without this :-)).
499 */
500
501 /*      New design (By Emard)
502 **      this rps1 code will copy internal HS event to GPIO3 pin.
503 **      GPIO3 is in budget-patch hardware connected to port B VSYNC
504
505 **      HS is an internal event of 7146, accessible with RPS
506 **      and temporarily raised high every n lines
507 **      (n in defined in the RPS_THRESH1 counter threshold)
508 **      I think HS is raised high on the beginning of the n-th line
509 **      and remains high until this n-th line that triggered
510 **      it is completely received. When the reception of n-th line
511 **      ends, HS is lowered.
512
513 **      To transmit data over DMA, 7146 needs changing state at
514 **      port B VSYNC pin. Any changing of port B VSYNC will
515 **      cause some DMA data transfer, with more or less packets loss.
516 **      It depends on the phase and frequency of VSYNC and
517 **      the way of 7146 is instructed to trigger on port B (defined
518 **      in DD1_INIT register, 3rd nibble from the right valid
519 **      numbers are 0-7, see datasheet)
520 **
521 **      The correct triggering can minimize packet loss,
522 **      dvbtraffic should give this stable bandwidths:
523 **        22k transponder = 33814 kbit/s
524 **      27.5k transponder = 38045 kbit/s
525 **      by experiment it is found that the best results
526 **      (stable bandwidths and almost no packet loss)
527 **      are obtained using DD1_INIT triggering number 2
528 **      (Va at rising edge of VS Fa = HS x VS-failing forced toggle)
529 **      and a VSYNC phase that occurs in the middle of DMA transfer
530 **      (about byte 188*512=96256 in the DMA window).
531 **
532 **      Phase of HS is still not clear to me how to control,
533 **      It just happens to be so. It can be seen if one enables
534 **      RPS_IRQ and print Event Counter 1 in vpeirq(). Every
535 **      time RPS_INTERRUPT is called, the Event Counter 1 will
536 **      increment. That's how the 7146 is programmed to do event
537 **      counting in this budget-patch.c
538 **      I *think* HPS setting has something to do with the phase
539 **      of HS but I cant be 100% sure in that.
540
541 **      hardware debug note: a working budget card (including budget patch)
542 **      with vpeirq() interrupt setup in mode "0x90" (every 64K) will
543 **      generate 3 interrupts per 25-Hz DMA frame of 2*188*512 bytes
544 **      and that means 3*25=75 Hz of interrupt frequency, as seen by
545 **      watch cat /proc/interrupts
546 **
547 **      If this frequency is 3x lower (and data received in the DMA
548 **      buffer don't start with 0x47, but in the middle of packets,
549 **      whose lengths appear to be like 188 292 188 104 etc.
550 **      this means VSYNC line is not connected in the hardware.
551 **      (check soldering pcb and pins)
552 **      The same behaviour of missing VSYNC can be duplicated on budget
553 **      cards, by setting DD1_INIT trigger mode 7 in 3rd nibble.
554 */
555
556         // Setup RPS1 "program" (p35)
557         count = 0;
558
559
560         // Wait Source Line Counter Threshold                           (p36)
561         WRITE_RPS1(cpu_to_le32(CMD_PAUSE | EVT_HS));
562         // Set GPIO3=1                                                  (p42)
563         WRITE_RPS1(cpu_to_le32(CMD_WR_REG_MASK | (GPIO_CTRL>>2)));
564         WRITE_RPS1(cpu_to_le32(GPIO3_MSK));
565         WRITE_RPS1(cpu_to_le32(SAA7146_GPIO_OUTHI<<24));
566 #if RPS_IRQ
567         // issue RPS1 interrupt
568         WRITE_RPS1(cpu_to_le32(CMD_INTERRUPT));
569 #endif
570         // Wait reset Source Line Counter Threshold                     (p36)
571         WRITE_RPS1(cpu_to_le32(CMD_PAUSE | RPS_INV | EVT_HS));
572         // Set GPIO3=0                                                  (p42)
573         WRITE_RPS1(cpu_to_le32(CMD_WR_REG_MASK | (GPIO_CTRL>>2)));
574         WRITE_RPS1(cpu_to_le32(GPIO3_MSK));
575         WRITE_RPS1(cpu_to_le32(SAA7146_GPIO_OUTLO<<24));
576 #if RPS_IRQ
577         // issue RPS1 interrupt
578         WRITE_RPS1(cpu_to_le32(CMD_INTERRUPT));
579 #endif
580         // Jump to begin of RPS program                                 (p37)
581         WRITE_RPS1(cpu_to_le32(CMD_JUMP));
582         WRITE_RPS1(cpu_to_le32(dev->d_rps1.dma_handle));
583
584         // Fix VSYNC level
585         saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTLO);
586         // Set RPS1 Address register to point to RPS code               (r108 p42)
587         saa7146_write(dev, RPS_ADDR1, dev->d_rps1.dma_handle);
588
589         if (!(budget = kmalloc (sizeof(struct budget_patch), GFP_KERNEL)))
590                 return -ENOMEM;
591
592         dprintk(2, "budget: %p\n", budget);
593
594         if ((err = ttpci_budget_init (budget, dev, info, THIS_MODULE))) {
595                 kfree (budget);
596                 return err;
597         }
598
599         // Set Source Line Counter Threshold, using BRS                 (rCC p43)
600         // It generates HS event every TS_HEIGHT lines
601         // this is related to TS_WIDTH set in register
602         // NUM_LINE_BYTE3 in budget-core.c. If NUM_LINE_BYTE
603         // low 16 bits are set to TS_WIDTH bytes (TS_WIDTH=2*188
604         //,then RPS_THRESH1
605         // should be set to trigger every TS_HEIGHT (512) lines.
606         //
607         saa7146_write(dev, RPS_THRESH1, budget->buffer_height | MASK_12 );
608
609         // saa7146_write(dev, RPS_THRESH0, ((TS_HEIGHT/2)<<16) |MASK_28| (TS_HEIGHT/2) |MASK_12 );
610         // Enable RPS1                                                  (rFC p33)
611         saa7146_write(dev, MC1, (MASK_13 | MASK_29));
612
613
614         dev->ext_priv = budget;
615
616         budget->dvb_adapter.priv = budget;
617         frontend_init(budget);
618
619         ttpci_budget_init_hooks(budget);
620
621         return 0;
622 }
623
624 static int budget_patch_detach (struct saa7146_dev* dev)
625 {
626         struct budget_patch *budget = (struct budget_patch*) dev->ext_priv;
627         int err;
628
629         if (budget->dvb_frontend) {
630                 dvb_unregister_frontend(budget->dvb_frontend);
631                 dvb_frontend_detach(budget->dvb_frontend);
632         }
633         err = ttpci_budget_deinit (budget);
634
635         kfree (budget);
636
637         return err;
638 }
639
640 static int __init budget_patch_init(void)
641 {
642         return saa7146_register_extension(&budget_extension);
643 }
644
645 static void __exit budget_patch_exit(void)
646 {
647         saa7146_unregister_extension(&budget_extension);
648 }
649
650 static struct saa7146_extension budget_extension = {
651         .name           = "budget_patch dvb",
652         .flags          = 0,
653
654         .module         = THIS_MODULE,
655         .pci_tbl        = pci_tbl,
656         .attach         = budget_patch_attach,
657         .detach         = budget_patch_detach,
658
659         .irq_mask       = MASK_10,
660         .irq_func       = ttpci_budget_irq10_handler,
661 };
662
663 module_init(budget_patch_init);
664 module_exit(budget_patch_exit);
665
666 MODULE_LICENSE("GPL");
667 MODULE_AUTHOR("Emard, Roberto Deza, Holger Waechtler, Michael Hunold, others");
668 MODULE_DESCRIPTION("Driver for full TS modified DVB-S SAA7146+AV7110 "
669                    "based so-called Budget Patch cards");