diff options
author | David Woodhouse <dwmw2@shinybook.infradead.org> | 2005-05-19 06:54:00 -0400 |
---|---|---|
committer | David Woodhouse <dwmw2@shinybook.infradead.org> | 2005-05-19 06:54:00 -0400 |
commit | 7063e6c717f6108c4b3fc3135a516c86ef944870 (patch) | |
tree | ec6eec10b4dc93474100e6e366df028bd3314fda | |
parent | 7ca0026495dbb644b4e32ede76be44072cb2bc7a (diff) | |
parent | 05d3794aa8bd3b2c9f7920a05003c331cdeb75c5 (diff) |
Merge with master.kernel.org:/pub/scm/linux/kernel/git/torvalds/linux-2.6.git
206 files changed, 8570 insertions, 3748 deletions
@@ -882,13 +882,12 @@ S: Blacksburg, Virginia 24061 | |||
882 | S: USA | 882 | S: USA |
883 | 883 | ||
884 | N: Randy Dunlap | 884 | N: Randy Dunlap |
885 | E: rddunlap@osdl.org | 885 | E: rdunlap@xenotime.net |
886 | W: http://www.xenotime.net/linux/linux.html | 886 | W: http://www.xenotime.net/linux/linux.html |
887 | W: http://www.linux-usb.org | 887 | W: http://www.linux-usb.org |
888 | D: Linux-USB subsystem, USB core/UHCI/printer/storage drivers | 888 | D: Linux-USB subsystem, USB core/UHCI/printer/storage drivers |
889 | D: x86 SMP, ACPI, bootflag hacking | 889 | D: x86 SMP, ACPI, bootflag hacking |
890 | S: 12725 SW Millikan Way, Suite 400 | 890 | S: (ask for current address) |
891 | S: Beaverton, Oregon 97005 | ||
892 | S: USA | 891 | S: USA |
893 | 892 | ||
894 | N: Bob Dunlop | 893 | N: Bob Dunlop |
diff --git a/Documentation/dvb/README.flexcop b/Documentation/dvb/README.flexcop new file mode 100644 index 000000000000..a50c70f9ca72 --- /dev/null +++ b/Documentation/dvb/README.flexcop | |||
@@ -0,0 +1,205 @@ | |||
1 | This README escorted the skystar2-driver rewriting procedure. It describes the | ||
2 | state of the new flexcop-driver set and some internals are written down here | ||
3 | too. | ||
4 | |||
5 | This document hopefully describes things about the flexcop and its | ||
6 | device-offsprings. Goal was to write an easy-to-write and easy-to-read set of | ||
7 | drivers based on the skystar2.c and other information. | ||
8 | |||
9 | Remark: flexcop-pci.c was a copy of skystar2.c, but every line has been | ||
10 | touched and rewritten. | ||
11 | |||
12 | History & News | ||
13 | ============== | ||
14 | 2005-04-01 - correct USB ISOC transfers (thanks to Vadim Catana) | ||
15 | |||
16 | |||
17 | |||
18 | |||
19 | General coding processing | ||
20 | ========================= | ||
21 | |||
22 | We should proceed as follows (as long as no one complains): | ||
23 | |||
24 | 0) Think before start writing code! | ||
25 | |||
26 | 1) rewriting the skystar2.c with the help of the flexcop register descriptions | ||
27 | and splitting up the files to a pci-bus-part and a flexcop-part. | ||
28 | The new driver will be called b2c2-flexcop-pci.ko/b2c2-flexcop-usb.ko for the | ||
29 | device-specific part and b2c2-flexcop.ko for the common flexcop-functions. | ||
30 | |||
31 | 2) Search for errors in the leftover of flexcop-pci.c (compare with pluto2.c | ||
32 | and other pci drivers) | ||
33 | |||
34 | 3) make some beautification (see 'Improvements when rewriting (refactoring) is | ||
35 | done') | ||
36 | |||
37 | 4) Testing the new driver and maybe substitute the skystar2.c with it, to reach | ||
38 | a wider tester audience. | ||
39 | |||
40 | 5) creating an usb-bus-part using the already written flexcop code for the pci | ||
41 | card. | ||
42 | |||
43 | Idea: create a kernel-object for the flexcop and export all important | ||
44 | functions. This option saves kernel-memory, but maybe a lot of functions have | ||
45 | to be exported to kernel namespace. | ||
46 | |||
47 | |||
48 | Current situation | ||
49 | ================= | ||
50 | |||
51 | 0) Done :) | ||
52 | 1) Done (some minor issues left) | ||
53 | 2) Done | ||
54 | 3) Not ready yet, more information is necessary | ||
55 | 4) next to be done (see the table below) | ||
56 | 5) USB driver is working (yes, there are some minor issues) | ||
57 | |||
58 | What seems to be ready? | ||
59 | ----------------------- | ||
60 | |||
61 | 1) Rewriting | ||
62 | 1a) i2c is cut off from the flexcop-pci.c and seems to work | ||
63 | 1b) moved tuner and demod stuff from flexcop-pci.c to flexcop-tuner-fe.c | ||
64 | 1c) moved lnb and diseqc stuff from flexcop-pci.c to flexcop-tuner-fe.c | ||
65 | 1e) eeprom (reading MAC address) | ||
66 | 1d) sram (no dynamic sll size detection (commented out) (using default as JJ told me)) | ||
67 | 1f) misc. register accesses for reading parameters (e.g. resetting, revision) | ||
68 | 1g) pid/mac filter (flexcop-hw-filter.c) | ||
69 | 1i) dvb-stuff initialization in flexcop.c (done) | ||
70 | 1h) dma stuff (now just using the size-irq, instead of all-together, to be done) | ||
71 | 1j) remove flexcop initialization from flexcop-pci.c completely (done) | ||
72 | 1l) use a well working dma IRQ method (done, see 'Known bugs and problems and TODO') | ||
73 | 1k) cleanup flexcop-files (remove unused EXPORT_SYMBOLs, make static from | ||
74 | non-static where possible, moved code to proper places) | ||
75 | |||
76 | 2) Search for errors in the leftover of flexcop-pci.c (partially done) | ||
77 | 5a) add MAC address reading | ||
78 | 5c) feeding of ISOC data to the software demux (format of the isochronous data | ||
79 | and speed optimization, no real error) (thanks to Vadim Catana) | ||
80 | |||
81 | What to do in the near future? | ||
82 | -------------------------------------- | ||
83 | (no special order here) | ||
84 | |||
85 | 5) USB driver | ||
86 | 5b) optimize isoc-transfer (submitting/killing isoc URBs when transfer is starting) | ||
87 | |||
88 | Testing changes | ||
89 | --------------- | ||
90 | |||
91 | O = item is working | ||
92 | P = item is partially working | ||
93 | X = item is not working | ||
94 | N = item does not apply here | ||
95 | <empty field> = item need to be examined | ||
96 | |||
97 | | PCI | USB | ||
98 | item | mt352 | nxt2002 | stv0299 | mt312 | mt352 | nxt2002 | stv0299 | mt312 | ||
99 | -------+-------+---------+---------+-------+-------+---------+---------+------- | ||
100 | 1a) | O | | | | N | N | N | N | ||
101 | 1b) | O | | | | | | O | | ||
102 | 1c) | N | N | | | N | N | O | | ||
103 | 1d) | O | O | ||
104 | 1e) | O | O | ||
105 | 1f) | P | ||
106 | 1g) | O | ||
107 | 1h) | P | | ||
108 | 1i) | O | N | ||
109 | 1j) | O | N | ||
110 | 1l) | O | N | ||
111 | 2) | O | N | ||
112 | 5a) | N | O | ||
113 | 5b)* | N | | ||
114 | 5c) | N | O | ||
115 | |||
116 | * - not done yet | ||
117 | |||
118 | Known bugs and problems and TODO | ||
119 | -------------------------------- | ||
120 | |||
121 | 1g/h/l) when pid filtering is enabled on the pci card | ||
122 | |||
123 | DMA usage currently: | ||
124 | The DMA is splitted in 2 equal-sized subbuffers. The Flexcop writes to first | ||
125 | address and triggers an IRQ when it's full and starts writing to the second | ||
126 | address. When the second address is full, the IRQ is triggered again, and | ||
127 | the flexcop writes to first address again, and so on. | ||
128 | The buffersize of each address is currently 640*188 bytes. | ||
129 | |||
130 | Problem is, when using hw-pid-filtering and doing some low-bandwidth | ||
131 | operation (like scanning) the buffers won't be filled enough to trigger | ||
132 | the IRQ. That's why: | ||
133 | |||
134 | When PID filtering is activated, the timer IRQ is used. Every 1.97 ms the IRQ | ||
135 | is triggered. Is the current write address of DMA1 different to the one | ||
136 | during the last IRQ, then the data is passed to the demuxer. | ||
137 | |||
138 | There is an additional DMA-IRQ-method: packet count IRQ. This isn't | ||
139 | implemented correctly yet. | ||
140 | |||
141 | The solution is to disable HW PID filtering, but I don't know how the DVB | ||
142 | API software demux behaves on slow systems with 45MBit/s TS. | ||
143 | |||
144 | Solved bugs :) | ||
145 | -------------- | ||
146 | 1g) pid-filtering (somehow pid index 4 and 5 (EMM_PID and ECM_PID) aren't | ||
147 | working) | ||
148 | SOLUTION: also index 0 was affected, because net_translation is done for | ||
149 | these indexes by default | ||
150 | |||
151 | 5b) isochronous transfer does only work in the first attempt (for the Sky2PC | ||
152 | USB, Air2PC is working) SOLUTION: the flexcop was going asleep and never really | ||
153 | woke up again (don't know if this need fixes, see | ||
154 | flexcop-fe-tuner.c:flexcop_sleep) | ||
155 | |||
156 | NEWS: when the driver is loaded and unloaded and loaded again (w/o doing | ||
157 | anything in the while the driver is loaded the first time), no transfers take | ||
158 | place anymore. | ||
159 | |||
160 | Improvements when rewriting (refactoring) is done | ||
161 | ================================================= | ||
162 | |||
163 | - split sleeping of the flexcop (misc_204.ACPI3_sig = 1;) from lnb_control | ||
164 | (enable sleeping for other demods than dvb-s) | ||
165 | - add support for CableStar (stv0297 Microtune 203x/ALPS) (almost done, incompatibilities with the Nexus-CA) | ||
166 | |||
167 | Debugging | ||
168 | --------- | ||
169 | - add verbose debugging to skystar2.c (dump the reg_dw_data) and compare it | ||
170 | with this flexcop, this is important, because i2c is now using the | ||
171 | flexcop_ibi_value union from flexcop-reg.h (do you have a better idea for | ||
172 | that, please tell us so). | ||
173 | |||
174 | Everything which is identical in the following table, can be put into a common | ||
175 | flexcop-module. | ||
176 | |||
177 | PCI USB | ||
178 | ------------------------------------------------------------------------------- | ||
179 | Different: | ||
180 | Register access: accessing IO memory USB control message | ||
181 | I2C bus: I2C bus of the FC USB control message | ||
182 | Data transfer: DMA isochronous transfer | ||
183 | EEPROM transfer: through i2c bus not clear yet | ||
184 | |||
185 | Identical: | ||
186 | Streaming: accessing registers | ||
187 | PID Filtering: accessing registers | ||
188 | Sram destinations: accessing registers | ||
189 | Tuner/Demod: I2C bus | ||
190 | DVB-stuff: can be written for common use | ||
191 | |||
192 | Acknowledgements (just for the rewriting part) | ||
193 | ================ | ||
194 | |||
195 | Bjarne Steinsbo thought a lot in the first place of the pci part for this code | ||
196 | sharing idea. | ||
197 | |||
198 | Andreas Oberritter for providing a recent PCI initialization template | ||
199 | (pluto2.c). | ||
200 | |||
201 | Boleslaw Ciesielski for pointing out a problem with firmware loader. | ||
202 | |||
203 | Vadim Catana for correcting the USB transfer. | ||
204 | |||
205 | comments, critics and ideas to linux-dvb@linuxtv.org. | ||
diff --git a/Documentation/dvb/bt8xx.txt b/Documentation/dvb/bt8xx.txt index e3cacf4f2345..d64430bf4bb6 100644 --- a/Documentation/dvb/bt8xx.txt +++ b/Documentation/dvb/bt8xx.txt | |||
@@ -17,74 +17,53 @@ Because of this, you need to enable | |||
17 | "Device drivers" => "Multimedia devices" | 17 | "Device drivers" => "Multimedia devices" |
18 | => "Video For Linux" => "BT848 Video For Linux" | 18 | => "Video For Linux" => "BT848 Video For Linux" |
19 | 19 | ||
20 | Furthermore you need to enable | ||
21 | "Device drivers" => "Multimedia devices" => "Digital Video Broadcasting Devices" | ||
22 | => "DVB for Linux" "DVB Core Support" "Nebula/Pinnacle PCTV/TwinHan PCI Cards" | ||
23 | |||
20 | 2) Loading Modules | 24 | 2) Loading Modules |
21 | ================== | 25 | ================== |
22 | 26 | ||
23 | In general you need to load the bttv driver, which will handle the gpio and | 27 | In general you need to load the bttv driver, which will handle the gpio and |
24 | i2c communication for us. Next you need the common dvb-bt8xx device driver | 28 | i2c communication for us, plus the common dvb-bt8xx device driver. |
25 | and one frontend driver. | 29 | The frontends for Nebula (nxt6000), Pinnacle PCTV (cx24110) and |
26 | 30 | TwinHan (dst) are loaded automatically by the dvb-bt8xx device driver. | |
27 | The bttv driver will HANG YOUR SYSTEM IF YOU DO NOT SPECIFY THE CORRECT | ||
28 | CARD ID! | ||
29 | |||
30 | (If you don't get your card running and you suspect that the card id you're | ||
31 | using is wrong, have a look at "bttv-cards.c" for a list of possible card | ||
32 | ids.) | ||
33 | |||
34 | Pay attention to failures when you load the frontend drivers | ||
35 | (e.g. dmesg, /var/log/messages). | ||
36 | 31 | ||
37 | 3a) Nebula / Pinnacle PCTV | 32 | 3a) Nebula / Pinnacle PCTV |
38 | -------------------------- | 33 | -------------------------- |
39 | 34 | ||
40 | $ modprobe bttv i2c_hw=1 card=0x68 | 35 | $ modprobe bttv (normally bttv is being loaded automatically by kmod) |
41 | $ modprobe dvb-bt8xx | 36 | $ modprobe dvb-bt8xx (or just place dvb-bt8xx in /etc/modules for automatic loading) |
42 | |||
43 | For Nebula cards use the "nxt6000" frontend driver: | ||
44 | $ modprobe nxt6000 | ||
45 | 37 | ||
46 | For Pinnacle PCTV cards use the "cx24110" frontend driver: | ||
47 | $ modprobe cx24110 | ||
48 | 38 | ||
49 | 3b) TwinHan | 39 | 3b) TwinHan and Clones |
50 | ----------- | 40 | -------------------------- |
51 | 41 | ||
52 | $ modprobe bttv i2c_hw=1 card=0x71 | 42 | $ modprobe bttv i2c_hw=1 card=0x71 |
53 | $ modprobe dvb-bt8xx | 43 | $ modprobe dvb-bt8xx |
54 | $ modprobe dst | 44 | $ modprobe dst |
55 | 45 | ||
56 | The value 0x71 will override the PCI type detection for dvb-bt8xx, which | 46 | The value 0x71 will override the PCI type detection for dvb-bt8xx, |
57 | is necessary for TwinHan cards.# | 47 | which is necessary for TwinHan cards. |
58 | 48 | ||
59 | If you're having an older card (blue color circuit) and card=0x71 locks your | 49 | If you're having an older card (blue color circuit) and card=0x71 locks |
60 | machine, try using 0x68, too. If that does not work, ask on the DVB mailing list. | 50 | your machine, try using 0x68, too. If that does not work, ask on the |
51 | mailing list. | ||
61 | 52 | ||
62 | The DST module takes a couple of useful parameters, in case the | 53 | The DST module takes a couple of useful parameters. |
63 | dst drivers fails to detect your type of card correctly. | ||
64 | 54 | ||
65 | dst_type takes values 0 (satellite), 1 (terrestial TV), 2 (cable). | 55 | verbose takes values 0 to 5. These values control the verbosity level. |
66 | 56 | ||
67 | dst_type_flags takes bit combined values: | 57 | debug takes values 0 and 1. You can either disable or enable debugging. |
68 | 1 = new tuner type packets. You can use this if your card is detected | ||
69 | and you have debug and you continually see the tuner packets not | ||
70 | working (make sure not a basic problem like dish alignment etc.) | ||
71 | 58 | ||
72 | 2 = TS 204. If your card tunes OK, but the picture is terrible, seemingly | 59 | dst_addons takes values 0 and 0x20. A value of 0 means it is a FTA card. |
73 | breaking up in one half continually, and crc fails a lot, then | 60 | 0x20 means it has a Conditional Access slot. |
74 | this is worth a try (or trying to turn off) | ||
75 | 61 | ||
76 | 4 = has symdiv. Some cards, mostly without new tuner packets, require | 62 | The autodected values are determined bythe cards 'response |
77 | a symbol division algorithm. Doesn't apply to terrestial TV. | ||
78 | |||
79 | You can also specify a value to have the autodetected values turned off | ||
80 | (e.g. 0). The autodected values are determined bythe cards 'response | ||
81 | string' which you can see in your logs e.g. | 63 | string' which you can see in your logs e.g. |
82 | 64 | ||
83 | dst_check_ci: recognize DST-MOT | 65 | dst_get_device_id: Recognise [DSTMCI] |
84 | |||
85 | or | ||
86 | 66 | ||
87 | dst_check_ci: unable to recognize DSTXCI or STXCI | ||
88 | 67 | ||
89 | -- | 68 | -- |
90 | Authors: Richard Walker, Jamie Honan, Michael Hunold | 69 | Authors: Richard Walker, Jamie Honan, Michael Hunold, Manu Abraham |
diff --git a/Documentation/dvb/ci.txt b/Documentation/dvb/ci.txt new file mode 100644 index 000000000000..62e0701b542a --- /dev/null +++ b/Documentation/dvb/ci.txt | |||
@@ -0,0 +1,219 @@ | |||
1 | * For the user | ||
2 | ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
3 | NOTE: This document describes the usage of the high level CI API as | ||
4 | in accordance to the Linux DVB API. This is a not a documentation for the, | ||
5 | existing low level CI API. | ||
6 | ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
7 | |||
8 | To utilize the High Level CI capabilities, | ||
9 | |||
10 | (1*) This point is valid only for the Twinhan/clones | ||
11 | For the Twinhan/Twinhan clones, the dst_ca module handles the CI | ||
12 | hardware handling.This module is loaded automatically if a CI | ||
13 | (Common Interface, that holds the CAM (Conditional Access Module) | ||
14 | is detected. | ||
15 | |||
16 | (2) one requires a userspace application, ca_zap. This small userland | ||
17 | application is in charge of sending the descrambling related information | ||
18 | to the CAM. | ||
19 | |||
20 | This application requires the following to function properly as of now. | ||
21 | |||
22 | (a) Tune to a valid channel, with szap. | ||
23 | eg: $ szap -c channels.conf -r "TMC" -x | ||
24 | |||
25 | (b) a channels.conf containing a valid PMT PID | ||
26 | |||
27 | eg: TMC:11996:h:0:27500:278:512:650:321 | ||
28 | |||
29 | here 278 is a valid PMT PID. the rest of the values are the | ||
30 | same ones that szap uses. | ||
31 | |||
32 | (c) after running a szap, you have to run ca_zap, for the | ||
33 | descrambler to function, | ||
34 | |||
35 | eg: $ ca_zap patched_channels.conf "TMC" | ||
36 | |||
37 | The patched means a patch to apply to scan, such that scan can | ||
38 | generate a channels.conf_with pmt, which has this PMT PID info | ||
39 | (NOTE: szap cannot use this channels.conf with the PMT_PID) | ||
40 | |||
41 | |||
42 | (d) Hopeflly Enjoy your favourite subscribed channel as you do with | ||
43 | a FTA card. | ||
44 | |||
45 | (3) Currently ca_zap, and dst_test, both are meant for demonstration | ||
46 | purposes only, they can become full fledged applications if necessary. | ||
47 | |||
48 | |||
49 | * Cards that fall in this category | ||
50 | ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
51 | At present the cards that fall in this category are the Twinhan and it's | ||
52 | clones, these cards are available as VVMER, Tomato, Hercules, Orange and | ||
53 | so on. | ||
54 | |||
55 | * CI modules that are supported | ||
56 | ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
57 | The CI module support is largely dependant upon the firmware on the cards | ||
58 | Some cards do support almost all of the available CI modules. There is | ||
59 | nothing much that can be done in order to make additional CI modules | ||
60 | working with these cards. | ||
61 | |||
62 | Modules that have been tested by this driver at present are | ||
63 | |||
64 | (1) Irdeto 1 and 2 from SCM | ||
65 | (2) Viaccess from SCM | ||
66 | (3) Dragoncam | ||
67 | |||
68 | * The High level CI API | ||
69 | ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
70 | |||
71 | * For the programmer | ||
72 | ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
73 | With the High Level CI approach any new card with almost any random | ||
74 | architecture can be implemented with this style, the definitions | ||
75 | insidethe switch statement can be easily adapted for any card, thereby | ||
76 | eliminating the need for any additional ioctls. | ||
77 | |||
78 | The disadvantage is that the driver/hardware has to manage the rest. For | ||
79 | the application programmer it would be as simple as sending/receiving an | ||
80 | array to/from the CI ioctls as defined in the Linux DVB API. No changes | ||
81 | have been made in the API to accomodate this feature. | ||
82 | |||
83 | |||
84 | * Why the need for another CI interface ? | ||
85 | ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
86 | This is one of the most commonly asked question. Well a nice question. | ||
87 | Strictly speaking this is not a new interface. | ||
88 | |||
89 | The CI interface is defined in the DVB API in ca.h as | ||
90 | |||
91 | typedef struct ca_slot_info { | ||
92 | int num; /* slot number */ | ||
93 | |||
94 | int type; /* CA interface this slot supports */ | ||
95 | #define CA_CI 1 /* CI high level interface */ | ||
96 | #define CA_CI_LINK 2 /* CI link layer level interface */ | ||
97 | #define CA_CI_PHYS 4 /* CI physical layer level interface */ | ||
98 | #define CA_DESCR 8 /* built-in descrambler */ | ||
99 | #define CA_SC 128 /* simple smart card interface */ | ||
100 | |||
101 | unsigned int flags; | ||
102 | #define CA_CI_MODULE_PRESENT 1 /* module (or card) inserted */ | ||
103 | #define CA_CI_MODULE_READY 2 | ||
104 | } ca_slot_info_t; | ||
105 | |||
106 | |||
107 | |||
108 | This CI interface follows the CI high level interface, which is not | ||
109 | implemented by most applications. Hence this area is revisited. | ||
110 | |||
111 | This CI interface is quite different in the case that it tries to | ||
112 | accomodate all other CI based devices, that fall into the other categories | ||
113 | |||
114 | This means that this CI interface handles the EN50221 style tags in the | ||
115 | Application layer only and no session management is taken care of by the | ||
116 | application. The driver/hardware will take care of all that. | ||
117 | |||
118 | This interface is purely an EN50221 interface exchanging APDU's. This | ||
119 | means that no session management, link layer or a transport layer do | ||
120 | exist in this case in the application to driver communication. It is | ||
121 | as simple as that. The driver/hardware has to take care of that. | ||
122 | |||
123 | |||
124 | With this High Level CI interface, the interface can be defined with the | ||
125 | regular ioctls. | ||
126 | |||
127 | All these ioctls are also valid for the High level CI interface | ||
128 | |||
129 | #define CA_RESET _IO('o', 128) | ||
130 | #define CA_GET_CAP _IOR('o', 129, ca_caps_t) | ||
131 | #define CA_GET_SLOT_INFO _IOR('o', 130, ca_slot_info_t) | ||
132 | #define CA_GET_DESCR_INFO _IOR('o', 131, ca_descr_info_t) | ||
133 | #define CA_GET_MSG _IOR('o', 132, ca_msg_t) | ||
134 | #define CA_SEND_MSG _IOW('o', 133, ca_msg_t) | ||
135 | #define CA_SET_DESCR _IOW('o', 134, ca_descr_t) | ||
136 | #define CA_SET_PID _IOW('o', 135, ca_pid_t) | ||
137 | |||
138 | |||
139 | On querying the device, the device yields information thus | ||
140 | |||
141 | CA_GET_SLOT_INFO | ||
142 | ---------------------------- | ||
143 | Command = [info] | ||
144 | APP: Number=[1] | ||
145 | APP: Type=[1] | ||
146 | APP: flags=[1] | ||
147 | APP: CI High level interface | ||
148 | APP: CA/CI Module Present | ||
149 | |||
150 | CA_GET_CAP | ||
151 | ---------------------------- | ||
152 | Command = [caps] | ||
153 | APP: Slots=[1] | ||
154 | APP: Type=[1] | ||
155 | APP: Descrambler keys=[16] | ||
156 | APP: Type=[1] | ||
157 | |||
158 | CA_SEND_MSG | ||
159 | ---------------------------- | ||
160 | Descriptors(Program Level)=[ 09 06 06 04 05 50 ff f1] | ||
161 | Found CA descriptor @ program level | ||
162 | |||
163 | (20) ES type=[2] ES pid=[201] ES length =[0 (0x0)] | ||
164 | (25) ES type=[4] ES pid=[301] ES length =[0 (0x0)] | ||
165 | ca_message length is 25 (0x19) bytes | ||
166 | EN50221 CA MSG=[ 9f 80 32 19 03 01 2d d1 f0 08 01 09 06 06 04 05 50 ff f1 02 e0 c9 00 00 04 e1 2d 00 00] | ||
167 | |||
168 | |||
169 | Not all ioctl's are implemented in the driver from the API, the other | ||
170 | features of the hardware that cannot be implemented by the API are achieved | ||
171 | using the CA_GET_MSG and CA_SEND_MSG ioctls. An EN50221 style wrapper is | ||
172 | used to exchange the data to maintain compatibility with other hardware. | ||
173 | |||
174 | |||
175 | /* a message to/from a CI-CAM */ | ||
176 | typedef struct ca_msg { | ||
177 | unsigned int index; | ||
178 | unsigned int type; | ||
179 | unsigned int length; | ||
180 | unsigned char msg[256]; | ||
181 | } ca_msg_t; | ||
182 | |||
183 | |||
184 | The flow of data can be described thus, | ||
185 | |||
186 | |||
187 | |||
188 | |||
189 | |||
190 | App (User) | ||
191 | ----- | ||
192 | parse | ||
193 | | | ||
194 | | | ||
195 | v | ||
196 | en50221 APDU (package) | ||
197 | -------------------------------------- | ||
198 | | | | High Level CI driver | ||
199 | | | | | ||
200 | | v | | ||
201 | | en50221 APDU (unpackage) | | ||
202 | | | | | ||
203 | | | | | ||
204 | | v | | ||
205 | | sanity checks | | ||
206 | | | | | ||
207 | | | | | ||
208 | | v | | ||
209 | | do (H/W dep) | | ||
210 | -------------------------------------- | ||
211 | | Hardware | ||
212 | | | ||
213 | v | ||
214 | |||
215 | |||
216 | |||
217 | |||
218 | The High Level CI interface uses the EN50221 DVB standard, following a | ||
219 | standard ensures futureproofness. | ||
diff --git a/Documentation/dvb/get_dvb_firmware b/Documentation/dvb/get_dvb_firmware index 3ffdcb394299..a750f0101d9d 100644 --- a/Documentation/dvb/get_dvb_firmware +++ b/Documentation/dvb/get_dvb_firmware | |||
@@ -107,7 +107,7 @@ sub tda10045 { | |||
107 | sub tda10046 { | 107 | sub tda10046 { |
108 | my $sourcefile = "tt_budget_217g.zip"; | 108 | my $sourcefile = "tt_budget_217g.zip"; |
109 | my $url = "http://www.technotrend.de/new/217g/$sourcefile"; | 109 | my $url = "http://www.technotrend.de/new/217g/$sourcefile"; |
110 | my $hash = "a25b579e37109af60f4a36c37893957c"; | 110 | my $hash = "6a7e1e2f2644b162ff0502367553c72d"; |
111 | my $outfile = "dvb-fe-tda10046.fw"; | 111 | my $outfile = "dvb-fe-tda10046.fw"; |
112 | my $tmpdir = tempdir(DIR => "/tmp", CLEANUP => 1); | 112 | my $tmpdir = tempdir(DIR => "/tmp", CLEANUP => 1); |
113 | 113 | ||
@@ -115,7 +115,7 @@ sub tda10046 { | |||
115 | 115 | ||
116 | wgetfile($sourcefile, $url); | 116 | wgetfile($sourcefile, $url); |
117 | unzip($sourcefile, $tmpdir); | 117 | unzip($sourcefile, $tmpdir); |
118 | extract("$tmpdir/software/OEM/PCI/App/ttlcdacc.dll", 0x3f731, 24479, "$tmpdir/fwtmp"); | 118 | extract("$tmpdir/software/OEM/PCI/App/ttlcdacc.dll", 0x3f731, 24478, "$tmpdir/fwtmp"); |
119 | verify("$tmpdir/fwtmp", $hash); | 119 | verify("$tmpdir/fwtmp", $hash); |
120 | copy("$tmpdir/fwtmp", $outfile); | 120 | copy("$tmpdir/fwtmp", $outfile); |
121 | 121 | ||
diff --git a/Documentation/feature-removal-schedule.txt b/Documentation/feature-removal-schedule.txt index d3c52dd24a2a..b9eb209318ab 100644 --- a/Documentation/feature-removal-schedule.txt +++ b/Documentation/feature-removal-schedule.txt | |||
@@ -63,3 +63,23 @@ Why: Outside of Linux, the only implementations of anything even | |||
63 | people, who might be using implementations that I am not aware | 63 | people, who might be using implementations that I am not aware |
64 | of, to adjust to this upcoming change. | 64 | of, to adjust to this upcoming change. |
65 | Who: Paul E. McKenney <paulmck@us.ibm.com> | 65 | Who: Paul E. McKenney <paulmck@us.ibm.com> |
66 | |||
67 | --------------------------- | ||
68 | |||
69 | What: IEEE1394 Audio and Music Data Transmission Protocol driver, | ||
70 | Connection Management Procedures driver | ||
71 | When: November 2005 | ||
72 | Files: drivers/ieee1394/{amdtp,cmp}* | ||
73 | Why: These are incomplete, have never worked, and are better implemented | ||
74 | in userland via raw1394 (see http://freebob.sourceforge.net/ for | ||
75 | example.) | ||
76 | Who: Jody McIntyre <scjody@steamballoon.com> | ||
77 | |||
78 | --------------------------- | ||
79 | |||
80 | What: raw1394: requests of type RAW1394_REQ_ISO_SEND, RAW1394_REQ_ISO_LISTEN | ||
81 | When: November 2005 | ||
82 | Why: Deprecated in favour of the new ioctl-based rawiso interface, which is | ||
83 | more efficient. You should really be using libraw1394 for raw1394 | ||
84 | access anyway. | ||
85 | Who: Jody McIntyre <scjody@steamballoon.com> | ||
diff --git a/Documentation/filesystems/sysfs-pci.txt b/Documentation/filesystems/sysfs-pci.txt index e97d024eae77..988a62fae11f 100644 --- a/Documentation/filesystems/sysfs-pci.txt +++ b/Documentation/filesystems/sysfs-pci.txt | |||
@@ -7,7 +7,6 @@ that support it. For example, a given bus might look like this: | |||
7 | |-- 0000:17:00.0 | 7 | |-- 0000:17:00.0 |
8 | | |-- class | 8 | | |-- class |
9 | | |-- config | 9 | | |-- config |
10 | | |-- detach_state | ||
11 | | |-- device | 10 | | |-- device |
12 | | |-- irq | 11 | | |-- irq |
13 | | |-- local_cpus | 12 | | |-- local_cpus |
@@ -19,7 +18,7 @@ that support it. For example, a given bus might look like this: | |||
19 | | |-- subsystem_device | 18 | | |-- subsystem_device |
20 | | |-- subsystem_vendor | 19 | | |-- subsystem_vendor |
21 | | `-- vendor | 20 | | `-- vendor |
22 | `-- detach_state | 21 | `-- ... |
23 | 22 | ||
24 | The topmost element describes the PCI domain and bus number. In this case, | 23 | The topmost element describes the PCI domain and bus number. In this case, |
25 | the domain number is 0000 and the bus number is 17 (both values are in hex). | 24 | the domain number is 0000 and the bus number is 17 (both values are in hex). |
@@ -31,7 +30,6 @@ files, each with their own function. | |||
31 | ---- -------- | 30 | ---- -------- |
32 | class PCI class (ascii, ro) | 31 | class PCI class (ascii, ro) |
33 | config PCI config space (binary, rw) | 32 | config PCI config space (binary, rw) |
34 | detach_state connection status (bool, rw) | ||
35 | device PCI device (ascii, ro) | 33 | device PCI device (ascii, ro) |
36 | irq IRQ number (ascii, ro) | 34 | irq IRQ number (ascii, ro) |
37 | local_cpus nearby CPU mask (cpumask, ro) | 35 | local_cpus nearby CPU mask (cpumask, ro) |
@@ -85,4 +83,4 @@ useful return codes should be provided. | |||
85 | 83 | ||
86 | Legacy resources are protected by the HAVE_PCI_LEGACY define. Platforms | 84 | Legacy resources are protected by the HAVE_PCI_LEGACY define. Platforms |
87 | wishing to support legacy functionality should define it and provide | 85 | wishing to support legacy functionality should define it and provide |
88 | pci_legacy_read, pci_legacy_write and pci_mmap_legacy_page_range functions. \ No newline at end of file | 86 | pci_legacy_read, pci_legacy_write and pci_mmap_legacy_page_range functions. |
diff --git a/Documentation/power/devices.txt b/Documentation/power/devices.txt index 5d4ae9a39f1d..f987afe43e28 100644 --- a/Documentation/power/devices.txt +++ b/Documentation/power/devices.txt | |||
@@ -207,27 +207,6 @@ SYSTEM_SHUTDOWN, I do not understand this one too much. probably event | |||
207 | #READY_AFTER_RESUME | 207 | #READY_AFTER_RESUME |
208 | # | 208 | # |
209 | 209 | ||
210 | Driver Detach Power Management | ||
211 | |||
212 | The kernel now supports the ability to place a device in a low-power | ||
213 | state when it is detached from its driver, which happens when its | ||
214 | module is removed. | ||
215 | |||
216 | Each device contains a 'detach_state' file in its sysfs directory | ||
217 | which can be used to control this state. Reading from this file | ||
218 | displays what the current detach state is set to. This is 0 (On) by | ||
219 | default. A user may write a positive integer value to this file in the | ||
220 | range of 1-4 inclusive. | ||
221 | |||
222 | A value of 1-3 will indicate the device should be placed in that | ||
223 | low-power state, which will cause ->suspend() to be called for that | ||
224 | device. A value of 4 indicates that the device should be shutdown, so | ||
225 | ->shutdown() will be called for that device. | ||
226 | |||
227 | The driver is responsible for reinitializing the device when the | ||
228 | module is re-inserted during it's ->probe() (or equivalent) method. | ||
229 | The driver core will not call any extra functions when binding the | ||
230 | device to the driver. | ||
231 | 210 | ||
232 | pm_message_t meaning | 211 | pm_message_t meaning |
233 | 212 | ||
diff --git a/Documentation/powerpc/hvcs.txt b/Documentation/powerpc/hvcs.txt index c0a62e116e6e..dca75cbda6f8 100644 --- a/Documentation/powerpc/hvcs.txt +++ b/Documentation/powerpc/hvcs.txt | |||
@@ -347,8 +347,8 @@ address that is created by firmware. An example vty-server sysfs entry | |||
347 | looks like the following: | 347 | looks like the following: |
348 | 348 | ||
349 | Pow5:/sys/bus/vio/drivers/hvcs/30000004 # ls | 349 | Pow5:/sys/bus/vio/drivers/hvcs/30000004 # ls |
350 | . current_vty devspec name partner_vtys | 350 | . current_vty devspec name partner_vtys |
351 | .. detach_state index partner_clcs vterm_state | 351 | .. index partner_clcs vterm_state |
352 | 352 | ||
353 | Each entry is provided, by default with a "name" attribute. Reading the | 353 | Each entry is provided, by default with a "name" attribute. Reading the |
354 | "name" attribute will reveal the device type as shown in the following | 354 | "name" attribute will reveal the device type as shown in the following |
@@ -530,7 +530,7 @@ endif | |||
530 | include $(srctree)/arch/$(ARCH)/Makefile | 530 | include $(srctree)/arch/$(ARCH)/Makefile |
531 | 531 | ||
532 | # arch Makefile may override CC so keep this after arch Makefile is included | 532 | # arch Makefile may override CC so keep this after arch Makefile is included |
533 | NOSTDINC_FLAGS := -nostdinc -isystem $(shell $(CC) -print-file-name=include) | 533 | NOSTDINC_FLAGS += -nostdinc -isystem $(shell $(CC) -print-file-name=include) |
534 | CHECKFLAGS += $(NOSTDINC_FLAGS) | 534 | CHECKFLAGS += $(NOSTDINC_FLAGS) |
535 | 535 | ||
536 | # warn about C99 declaration after statement | 536 | # warn about C99 declaration after statement |
diff --git a/arch/alpha/kernel/osf_sys.c b/arch/alpha/kernel/osf_sys.c index 64e450dddb49..167fd89f8707 100644 --- a/arch/alpha/kernel/osf_sys.c +++ b/arch/alpha/kernel/osf_sys.c | |||
@@ -1150,16 +1150,13 @@ osf_usleep_thread(struct timeval32 __user *sleep, struct timeval32 __user *remai | |||
1150 | if (get_tv32(&tmp, sleep)) | 1150 | if (get_tv32(&tmp, sleep)) |
1151 | goto fault; | 1151 | goto fault; |
1152 | 1152 | ||
1153 | ticks = tmp.tv_usec; | 1153 | ticks = timeval_to_jiffies(&tmp); |
1154 | ticks = (ticks + (1000000 / HZ) - 1) / (1000000 / HZ); | ||
1155 | ticks += tmp.tv_sec * HZ; | ||
1156 | 1154 | ||
1157 | current->state = TASK_INTERRUPTIBLE; | 1155 | current->state = TASK_INTERRUPTIBLE; |
1158 | ticks = schedule_timeout(ticks); | 1156 | ticks = schedule_timeout(ticks); |
1159 | 1157 | ||
1160 | if (remain) { | 1158 | if (remain) { |
1161 | tmp.tv_sec = ticks / HZ; | 1159 | jiffies_to_timeval(ticks, &tmp); |
1162 | tmp.tv_usec = ticks % HZ; | ||
1163 | if (put_tv32(remain, &tmp)) | 1160 | if (put_tv32(remain, &tmp)) |
1164 | goto fault; | 1161 | goto fault; |
1165 | } | 1162 | } |
diff --git a/arch/i386/kernel/cpu/amd.c b/arch/i386/kernel/cpu/amd.c index 16dbc4151be4..fa34a06c0d79 100644 --- a/arch/i386/kernel/cpu/amd.c +++ b/arch/i386/kernel/cpu/amd.c | |||
@@ -24,9 +24,6 @@ __asm__(".align 4\nvide: ret"); | |||
24 | 24 | ||
25 | static void __init init_amd(struct cpuinfo_x86 *c) | 25 | static void __init init_amd(struct cpuinfo_x86 *c) |
26 | { | 26 | { |
27 | #ifdef CONFIG_X86_SMP | ||
28 | int cpu = c == &boot_cpu_data ? 0 : c - cpu_data; | ||
29 | #endif | ||
30 | u32 l, h; | 27 | u32 l, h; |
31 | int mbytes = num_physpages >> (20-PAGE_SHIFT); | 28 | int mbytes = num_physpages >> (20-PAGE_SHIFT); |
32 | int r; | 29 | int r; |
@@ -205,7 +202,9 @@ static void __init init_amd(struct cpuinfo_x86 *c) | |||
205 | * of two. | 202 | * of two. |
206 | */ | 203 | */ |
207 | if (c->x86_num_cores > 1) { | 204 | if (c->x86_num_cores > 1) { |
208 | cpu_core_id[cpu] = cpu >> hweight32(c->x86_num_cores - 1); | 205 | int cpu = smp_processor_id(); |
206 | /* Fix up the APIC ID following AMD specifications. */ | ||
207 | cpu_core_id[cpu] >>= hweight32(c->x86_num_cores - 1); | ||
209 | printk(KERN_INFO "CPU %d(%d) -> Core %d\n", | 208 | printk(KERN_INFO "CPU %d(%d) -> Core %d\n", |
210 | cpu, c->x86_num_cores, cpu_core_id[cpu]); | 209 | cpu, c->x86_num_cores, cpu_core_id[cpu]); |
211 | } | 210 | } |
diff --git a/arch/i386/kernel/cpu/common.c b/arch/i386/kernel/cpu/common.c index 6be0310e3cd3..11e6e6f23fa0 100644 --- a/arch/i386/kernel/cpu/common.c +++ b/arch/i386/kernel/cpu/common.c | |||
@@ -243,6 +243,13 @@ static void __init early_cpu_detect(void) | |||
243 | } | 243 | } |
244 | 244 | ||
245 | early_intel_workaround(c); | 245 | early_intel_workaround(c); |
246 | |||
247 | #ifdef CONFIG_SMP | ||
248 | #ifdef CONFIG_X86_HT | ||
249 | phys_proc_id[smp_processor_id()] = | ||
250 | #endif | ||
251 | cpu_core_id[smp_processor_id()] = (cpuid_ebx(1) >> 24) & 0xff; | ||
252 | #endif | ||
246 | } | 253 | } |
247 | 254 | ||
248 | void __init generic_identify(struct cpuinfo_x86 * c) | 255 | void __init generic_identify(struct cpuinfo_x86 * c) |
diff --git a/arch/i386/pci/fixup.c b/arch/i386/pci/fixup.c index be52c5ac4e05..8e8e895e1b5a 100644 --- a/arch/i386/pci/fixup.c +++ b/arch/i386/pci/fixup.c | |||
@@ -253,7 +253,7 @@ DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE2, pci | |||
253 | #define MAX_PCIEROOT 6 | 253 | #define MAX_PCIEROOT 6 |
254 | static int quirk_aspm_offset[MAX_PCIEROOT << 3]; | 254 | static int quirk_aspm_offset[MAX_PCIEROOT << 3]; |
255 | 255 | ||
256 | #define GET_INDEX(a, b) (((a - PCI_DEVICE_ID_INTEL_MCH_PA) << 3) + b) | 256 | #define GET_INDEX(a, b) ((((a) - PCI_DEVICE_ID_INTEL_MCH_PA) << 3) + ((b) & 7)) |
257 | 257 | ||
258 | static int quirk_pcie_aspm_read(struct pci_bus *bus, unsigned int devfn, int where, int size, u32 *value) | 258 | static int quirk_pcie_aspm_read(struct pci_bus *bus, unsigned int devfn, int where, int size, u32 *value) |
259 | { | 259 | { |
diff --git a/arch/ia64/ia32/ia32_ioctl.c b/arch/ia64/ia32/ia32_ioctl.c index 9845dabe2613..164b211f4174 100644 --- a/arch/ia64/ia32/ia32_ioctl.c +++ b/arch/ia64/ia32/ia32_ioctl.c | |||
@@ -13,7 +13,6 @@ | |||
13 | 13 | ||
14 | #define INCLUDES | 14 | #define INCLUDES |
15 | #include "compat_ioctl.c" | 15 | #include "compat_ioctl.c" |
16 | #include <asm/ioctl32.h> | ||
17 | 16 | ||
18 | #define IOCTL_NR(a) ((a) & ~(_IOC_SIZEMASK << _IOC_SIZESHIFT)) | 17 | #define IOCTL_NR(a) ((a) & ~(_IOC_SIZEMASK << _IOC_SIZESHIFT)) |
19 | 18 | ||
diff --git a/arch/mips/vr41xx/common/pmu.c b/arch/mips/vr41xx/common/pmu.c index c5f1043de938..53166f3598b2 100644 --- a/arch/mips/vr41xx/common/pmu.c +++ b/arch/mips/vr41xx/common/pmu.c | |||
@@ -1,7 +1,7 @@ | |||
1 | /* | 1 | /* |
2 | * pmu.c, Power Management Unit routines for NEC VR4100 series. | 2 | * pmu.c, Power Management Unit routines for NEC VR4100 series. |
3 | * | 3 | * |
4 | * Copyright (C) 2003-2004 Yoichi Yuasa <yuasa@hh.iij4u.or.jp> | 4 | * Copyright (C) 2003-2005 Yoichi Yuasa <yuasa@hh.iij4u.or.jp> |
5 | * | 5 | * |
6 | * This program is free software; you can redistribute it and/or modify | 6 | * This program is free software; you can redistribute it and/or modify |
7 | * it under the terms of the GNU General Public License as published by | 7 | * it under the terms of the GNU General Public License as published by |
@@ -17,7 +17,9 @@ | |||
17 | * along with this program; if not, write to the Free Software | 17 | * along with this program; if not, write to the Free Software |
18 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | 18 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
19 | */ | 19 | */ |
20 | #include <linux/errno.h> | ||
20 | #include <linux/init.h> | 21 | #include <linux/init.h> |
22 | #include <linux/ioport.h> | ||
21 | #include <linux/kernel.h> | 23 | #include <linux/kernel.h> |
22 | #include <linux/smp.h> | 24 | #include <linux/smp.h> |
23 | #include <linux/types.h> | 25 | #include <linux/types.h> |
@@ -27,20 +29,31 @@ | |||
27 | #include <asm/reboot.h> | 29 | #include <asm/reboot.h> |
28 | #include <asm/system.h> | 30 | #include <asm/system.h> |
29 | 31 | ||
30 | #define PMUCNT2REG KSEG1ADDR(0x0f0000c6) | 32 | #define PMU_TYPE1_BASE 0x0b0000a0UL |
33 | #define PMU_TYPE1_SIZE 0x0eUL | ||
34 | |||
35 | #define PMU_TYPE2_BASE 0x0f0000c0UL | ||
36 | #define PMU_TYPE2_SIZE 0x10UL | ||
37 | |||
38 | #define PMUCNT2REG 0x06 | ||
31 | #define SOFTRST 0x0010 | 39 | #define SOFTRST 0x0010 |
32 | 40 | ||
41 | static void __iomem *pmu_base; | ||
42 | |||
43 | #define pmu_read(offset) readw(pmu_base + (offset)) | ||
44 | #define pmu_write(offset, value) writew((value), pmu_base + (offset)) | ||
45 | |||
33 | static inline void software_reset(void) | 46 | static inline void software_reset(void) |
34 | { | 47 | { |
35 | uint16_t val; | 48 | uint16_t pmucnt2; |
36 | 49 | ||
37 | switch (current_cpu_data.cputype) { | 50 | switch (current_cpu_data.cputype) { |
38 | case CPU_VR4122: | 51 | case CPU_VR4122: |
39 | case CPU_VR4131: | 52 | case CPU_VR4131: |
40 | case CPU_VR4133: | 53 | case CPU_VR4133: |
41 | val = readw(PMUCNT2REG); | 54 | pmucnt2 = pmu_read(PMUCNT2REG); |
42 | val |= SOFTRST; | 55 | pmucnt2 |= SOFTRST; |
43 | writew(val, PMUCNT2REG); | 56 | pmu_write(PMUCNT2REG, pmucnt2); |
44 | break; | 57 | break; |
45 | default: | 58 | default: |
46 | break; | 59 | break; |
@@ -71,6 +84,34 @@ static void vr41xx_power_off(void) | |||
71 | 84 | ||
72 | static int __init vr41xx_pmu_init(void) | 85 | static int __init vr41xx_pmu_init(void) |
73 | { | 86 | { |
87 | unsigned long start, size; | ||
88 | |||
89 | switch (current_cpu_data.cputype) { | ||
90 | case CPU_VR4111: | ||
91 | case CPU_VR4121: | ||
92 | start = PMU_TYPE1_BASE; | ||
93 | size = PMU_TYPE1_SIZE; | ||
94 | break; | ||
95 | case CPU_VR4122: | ||
96 | case CPU_VR4131: | ||
97 | case CPU_VR4133: | ||
98 | start = PMU_TYPE2_BASE; | ||
99 | size = PMU_TYPE2_SIZE; | ||
100 | break; | ||
101 | default: | ||
102 | printk("Unexpected CPU of NEC VR4100 series\n"); | ||
103 | return -ENODEV; | ||
104 | } | ||
105 | |||
106 | if (request_mem_region(start, size, "PMU") == NULL) | ||
107 | return -EBUSY; | ||
108 | |||
109 | pmu_base = ioremap(start, size); | ||
110 | if (pmu_base == NULL) { | ||
111 | release_mem_region(start, size); | ||
112 | return -EBUSY; | ||
113 | } | ||
114 | |||
74 | _machine_restart = vr41xx_restart; | 115 | _machine_restart = vr41xx_restart; |
75 | _machine_halt = vr41xx_halt; | 116 | _machine_halt = vr41xx_halt; |
76 | _machine_power_off = vr41xx_power_off; | 117 | _machine_power_off = vr41xx_power_off; |
@@ -78,4 +119,4 @@ static int __init vr41xx_pmu_init(void) | |||
78 | return 0; | 119 | return 0; |
79 | } | 120 | } |
80 | 121 | ||
81 | early_initcall(vr41xx_pmu_init); | 122 | core_initcall(vr41xx_pmu_init); |
diff --git a/arch/ppc/kernel/setup.c b/arch/ppc/kernel/setup.c index 5dfb42f1a152..309797d7f96d 100644 --- a/arch/ppc/kernel/setup.c +++ b/arch/ppc/kernel/setup.c | |||
@@ -753,6 +753,8 @@ void __init setup_arch(char **cmdline_p) | |||
753 | strlcpy(saved_command_line, cmd_line, COMMAND_LINE_SIZE); | 753 | strlcpy(saved_command_line, cmd_line, COMMAND_LINE_SIZE); |
754 | *cmdline_p = cmd_line; | 754 | *cmdline_p = cmd_line; |
755 | 755 | ||
756 | parse_early_param(); | ||
757 | |||
756 | /* set up the bootmem stuff with available memory */ | 758 | /* set up the bootmem stuff with available memory */ |
757 | do_init_bootmem(); | 759 | do_init_bootmem(); |
758 | if ( ppc_md.progress ) ppc_md.progress("setup_arch: bootmem", 0x3eab); | 760 | if ( ppc_md.progress ) ppc_md.progress("setup_arch: bootmem", 0x3eab); |
diff --git a/arch/um/kernel/irq_user.c b/arch/um/kernel/irq_user.c index 6d6f9484b884..b3074cbaa479 100644 --- a/arch/um/kernel/irq_user.c +++ b/arch/um/kernel/irq_user.c | |||
@@ -236,9 +236,15 @@ static void free_irq_by_cb(int (*test)(struct irq_fd *, void *), void *arg) | |||
236 | (*prev)->fd, pollfds[i].fd); | 236 | (*prev)->fd, pollfds[i].fd); |
237 | goto out; | 237 | goto out; |
238 | } | 238 | } |
239 | memcpy(&pollfds[i], &pollfds[i + 1], | 239 | |
240 | (pollfds_num - i - 1) * sizeof(pollfds[0])); | ||
241 | pollfds_num--; | 240 | pollfds_num--; |
241 | |||
242 | /* This moves the *whole* array after pollfds[i] (though | ||
243 | * it doesn't spot as such)! */ | ||
244 | |||
245 | memmove(&pollfds[i], &pollfds[i + 1], | ||
246 | (pollfds_num - i) * sizeof(pollfds[0])); | ||
247 | |||
242 | if(last_irq_ptr == &old_fd->next) | 248 | if(last_irq_ptr == &old_fd->next) |
243 | last_irq_ptr = prev; | 249 | last_irq_ptr = prev; |
244 | *prev = (*prev)->next; | 250 | *prev = (*prev)->next; |
diff --git a/arch/x86_64/Kconfig b/arch/x86_64/Kconfig index 44ee7f6acf7b..82cb2a3f127a 100644 --- a/arch/x86_64/Kconfig +++ b/arch/x86_64/Kconfig | |||
@@ -303,6 +303,20 @@ config HPET_TIMER | |||
303 | as it is off-chip. You can find the HPET spec at | 303 | as it is off-chip. You can find the HPET spec at |
304 | <http://www.intel.com/labs/platcomp/hpet/hpetspec.htm>. | 304 | <http://www.intel.com/labs/platcomp/hpet/hpetspec.htm>. |
305 | 305 | ||
306 | config X86_PM_TIMER | ||
307 | bool "PM timer" | ||
308 | default y | ||
309 | help | ||
310 | Support the ACPI PM timer for time keeping. This is slow, | ||
311 | but is useful on some chipsets without HPET on systems with more | ||
312 | than one CPU. On a single processor or single socket multi core | ||
313 | system it is normally not required. | ||
314 | When the PM timer is active 64bit vsyscalls are disabled | ||
315 | and should not be enabled (/proc/sys/kernel/vsyscall64 should | ||
316 | not be changed). | ||
317 | The kernel selects the PM timer only as a last resort, so it is | ||
318 | useful to enable just in case. | ||
319 | |||
306 | config HPET_EMULATE_RTC | 320 | config HPET_EMULATE_RTC |
307 | bool "Provide RTC interrupt" | 321 | bool "Provide RTC interrupt" |
308 | depends on HPET_TIMER && RTC=y | 322 | depends on HPET_TIMER && RTC=y |
diff --git a/arch/x86_64/defconfig b/arch/x86_64/defconfig index 9ce51dee30b3..569595b74c7c 100644 --- a/arch/x86_64/defconfig +++ b/arch/x86_64/defconfig | |||
@@ -1,7 +1,7 @@ | |||
1 | # | 1 | # |
2 | # Automatically generated make config: don't edit | 2 | # Automatically generated make config: don't edit |
3 | # Linux kernel version: 2.6.11-bk7 | 3 | # Linux kernel version: 2.6.12-rc4 |
4 | # Sat Mar 12 23:43:44 2005 | 4 | # Fri May 13 06:39:11 2005 |
5 | # | 5 | # |
6 | CONFIG_X86_64=y | 6 | CONFIG_X86_64=y |
7 | CONFIG_64BIT=y | 7 | CONFIG_64BIT=y |
@@ -11,8 +11,6 @@ CONFIG_RWSEM_GENERIC_SPINLOCK=y | |||
11 | CONFIG_GENERIC_CALIBRATE_DELAY=y | 11 | CONFIG_GENERIC_CALIBRATE_DELAY=y |
12 | CONFIG_X86_CMPXCHG=y | 12 | CONFIG_X86_CMPXCHG=y |
13 | CONFIG_EARLY_PRINTK=y | 13 | CONFIG_EARLY_PRINTK=y |
14 | CONFIG_HPET_TIMER=y | ||
15 | CONFIG_HPET_EMULATE_RTC=y | ||
16 | CONFIG_GENERIC_ISA_DMA=y | 14 | CONFIG_GENERIC_ISA_DMA=y |
17 | CONFIG_GENERIC_IOMAP=y | 15 | CONFIG_GENERIC_IOMAP=y |
18 | 16 | ||
@@ -22,6 +20,7 @@ CONFIG_GENERIC_IOMAP=y | |||
22 | CONFIG_EXPERIMENTAL=y | 20 | CONFIG_EXPERIMENTAL=y |
23 | CONFIG_CLEAN_COMPILE=y | 21 | CONFIG_CLEAN_COMPILE=y |
24 | CONFIG_LOCK_KERNEL=y | 22 | CONFIG_LOCK_KERNEL=y |
23 | CONFIG_INIT_ENV_ARG_LIMIT=32 | ||
25 | 24 | ||
26 | # | 25 | # |
27 | # General setup | 26 | # General setup |
@@ -33,7 +32,6 @@ CONFIG_POSIX_MQUEUE=y | |||
33 | # CONFIG_BSD_PROCESS_ACCT is not set | 32 | # CONFIG_BSD_PROCESS_ACCT is not set |
34 | CONFIG_SYSCTL=y | 33 | CONFIG_SYSCTL=y |
35 | # CONFIG_AUDIT is not set | 34 | # CONFIG_AUDIT is not set |
36 | CONFIG_LOG_BUF_SHIFT=18 | ||
37 | # CONFIG_HOTPLUG is not set | 35 | # CONFIG_HOTPLUG is not set |
38 | CONFIG_KOBJECT_UEVENT=y | 36 | CONFIG_KOBJECT_UEVENT=y |
39 | CONFIG_IKCONFIG=y | 37 | CONFIG_IKCONFIG=y |
@@ -43,10 +41,11 @@ CONFIG_IKCONFIG_PROC=y | |||
43 | CONFIG_KALLSYMS=y | 41 | CONFIG_KALLSYMS=y |
44 | CONFIG_KALLSYMS_ALL=y | 42 | CONFIG_KALLSYMS_ALL=y |
45 | # CONFIG_KALLSYMS_EXTRA_PASS is not set | 43 | # CONFIG_KALLSYMS_EXTRA_PASS is not set |
44 | CONFIG_PRINTK=y | ||
45 | CONFIG_BUG=y | ||
46 | CONFIG_BASE_FULL=y | 46 | CONFIG_BASE_FULL=y |
47 | CONFIG_FUTEX=y | 47 | CONFIG_FUTEX=y |
48 | CONFIG_EPOLL=y | 48 | CONFIG_EPOLL=y |
49 | # CONFIG_CC_OPTIMIZE_FOR_SIZE is not set | ||
50 | CONFIG_SHMEM=y | 49 | CONFIG_SHMEM=y |
51 | CONFIG_CC_ALIGN_FUNCTIONS=0 | 50 | CONFIG_CC_ALIGN_FUNCTIONS=0 |
52 | CONFIG_CC_ALIGN_LABELS=0 | 51 | CONFIG_CC_ALIGN_LABELS=0 |
@@ -93,6 +92,9 @@ CONFIG_DISCONTIGMEM=y | |||
93 | CONFIG_NUMA=y | 92 | CONFIG_NUMA=y |
94 | CONFIG_HAVE_DEC_LOCK=y | 93 | CONFIG_HAVE_DEC_LOCK=y |
95 | CONFIG_NR_CPUS=8 | 94 | CONFIG_NR_CPUS=8 |
95 | CONFIG_HPET_TIMER=y | ||
96 | CONFIG_X86_PM_TIMER=y | ||
97 | CONFIG_HPET_EMULATE_RTC=y | ||
96 | CONFIG_GART_IOMMU=y | 98 | CONFIG_GART_IOMMU=y |
97 | CONFIG_SWIOTLB=y | 99 | CONFIG_SWIOTLB=y |
98 | CONFIG_X86_MCE=y | 100 | CONFIG_X86_MCE=y |
@@ -100,6 +102,7 @@ CONFIG_X86_MCE_INTEL=y | |||
100 | CONFIG_SECCOMP=y | 102 | CONFIG_SECCOMP=y |
101 | CONFIG_GENERIC_HARDIRQS=y | 103 | CONFIG_GENERIC_HARDIRQS=y |
102 | CONFIG_GENERIC_IRQ_PROBE=y | 104 | CONFIG_GENERIC_IRQ_PROBE=y |
105 | CONFIG_ISA_DMA_API=y | ||
103 | 106 | ||
104 | # | 107 | # |
105 | # Power management options | 108 | # Power management options |
@@ -129,7 +132,7 @@ CONFIG_ACPI_NUMA=y | |||
129 | # CONFIG_ACPI_IBM is not set | 132 | # CONFIG_ACPI_IBM is not set |
130 | CONFIG_ACPI_TOSHIBA=y | 133 | CONFIG_ACPI_TOSHIBA=y |
131 | CONFIG_ACPI_BLACKLIST_YEAR=2001 | 134 | CONFIG_ACPI_BLACKLIST_YEAR=2001 |
132 | CONFIG_ACPI_DEBUG=y | 135 | # CONFIG_ACPI_DEBUG is not set |
133 | CONFIG_ACPI_BUS=y | 136 | CONFIG_ACPI_BUS=y |
134 | CONFIG_ACPI_EC=y | 137 | CONFIG_ACPI_EC=y |
135 | CONFIG_ACPI_POWER=y | 138 | CONFIG_ACPI_POWER=y |
@@ -141,6 +144,7 @@ CONFIG_ACPI_SYSTEM=y | |||
141 | # CPU Frequency scaling | 144 | # CPU Frequency scaling |
142 | # | 145 | # |
143 | CONFIG_CPU_FREQ=y | 146 | CONFIG_CPU_FREQ=y |
147 | CONFIG_CPU_FREQ_TABLE=y | ||
144 | # CONFIG_CPU_FREQ_DEBUG is not set | 148 | # CONFIG_CPU_FREQ_DEBUG is not set |
145 | CONFIG_CPU_FREQ_STAT=y | 149 | CONFIG_CPU_FREQ_STAT=y |
146 | # CONFIG_CPU_FREQ_STAT_DETAILS is not set | 150 | # CONFIG_CPU_FREQ_STAT_DETAILS is not set |
@@ -150,7 +154,6 @@ CONFIG_CPU_FREQ_GOV_PERFORMANCE=y | |||
150 | # CONFIG_CPU_FREQ_GOV_POWERSAVE is not set | 154 | # CONFIG_CPU_FREQ_GOV_POWERSAVE is not set |
151 | CONFIG_CPU_FREQ_GOV_USERSPACE=y | 155 | CONFIG_CPU_FREQ_GOV_USERSPACE=y |
152 | CONFIG_CPU_FREQ_GOV_ONDEMAND=y | 156 | CONFIG_CPU_FREQ_GOV_ONDEMAND=y |
153 | CONFIG_CPU_FREQ_TABLE=y | ||
154 | 157 | ||
155 | # | 158 | # |
156 | # CPUFreq processor drivers | 159 | # CPUFreq processor drivers |
@@ -164,6 +167,7 @@ CONFIG_X86_ACPI_CPUFREQ=y | |||
164 | # shared options | 167 | # shared options |
165 | # | 168 | # |
166 | CONFIG_X86_ACPI_CPUFREQ_PROC_INTF=y | 169 | CONFIG_X86_ACPI_CPUFREQ_PROC_INTF=y |
170 | # CONFIG_X86_SPEEDSTEP_LIB is not set | ||
167 | 171 | ||
168 | # | 172 | # |
169 | # Bus options (PCI etc.) | 173 | # Bus options (PCI etc.) |
@@ -172,9 +176,11 @@ CONFIG_PCI=y | |||
172 | CONFIG_PCI_DIRECT=y | 176 | CONFIG_PCI_DIRECT=y |
173 | CONFIG_PCI_MMCONFIG=y | 177 | CONFIG_PCI_MMCONFIG=y |
174 | CONFIG_UNORDERED_IO=y | 178 | CONFIG_UNORDERED_IO=y |
179 | # CONFIG_PCIEPORTBUS is not set | ||
175 | CONFIG_PCI_MSI=y | 180 | CONFIG_PCI_MSI=y |
176 | # CONFIG_PCI_LEGACY_PROC is not set | 181 | # CONFIG_PCI_LEGACY_PROC is not set |
177 | # CONFIG_PCI_NAMES is not set | 182 | # CONFIG_PCI_NAMES is not set |
183 | # CONFIG_PCI_DEBUG is not set | ||
178 | 184 | ||
179 | # | 185 | # |
180 | # PCCARD (PCMCIA/CardBus) support | 186 | # PCCARD (PCMCIA/CardBus) support |
@@ -182,10 +188,6 @@ CONFIG_PCI_MSI=y | |||
182 | # CONFIG_PCCARD is not set | 188 | # CONFIG_PCCARD is not set |
183 | 189 | ||
184 | # | 190 | # |
185 | # PC-card bridges | ||
186 | # | ||
187 | |||
188 | # | ||
189 | # PCI Hotplug Support | 191 | # PCI Hotplug Support |
190 | # | 192 | # |
191 | # CONFIG_HOTPLUG_PCI is not set | 193 | # CONFIG_HOTPLUG_PCI is not set |
@@ -254,7 +256,7 @@ CONFIG_LBD=y | |||
254 | # IO Schedulers | 256 | # IO Schedulers |
255 | # | 257 | # |
256 | CONFIG_IOSCHED_NOOP=y | 258 | CONFIG_IOSCHED_NOOP=y |
257 | CONFIG_IOSCHED_AS=y | 259 | # CONFIG_IOSCHED_AS is not set |
258 | CONFIG_IOSCHED_DEADLINE=y | 260 | CONFIG_IOSCHED_DEADLINE=y |
259 | CONFIG_IOSCHED_CFQ=y | 261 | CONFIG_IOSCHED_CFQ=y |
260 | # CONFIG_ATA_OVER_ETH is not set | 262 | # CONFIG_ATA_OVER_ETH is not set |
@@ -308,7 +310,8 @@ CONFIG_BLK_DEV_AMD74XX=y | |||
308 | CONFIG_BLK_DEV_PIIX=y | 310 | CONFIG_BLK_DEV_PIIX=y |
309 | # CONFIG_BLK_DEV_NS87415 is not set | 311 | # CONFIG_BLK_DEV_NS87415 is not set |
310 | # CONFIG_BLK_DEV_PDC202XX_OLD is not set | 312 | # CONFIG_BLK_DEV_PDC202XX_OLD is not set |
311 | # CONFIG_BLK_DEV_PDC202XX_NEW is not set | 313 | CONFIG_BLK_DEV_PDC202XX_NEW=y |
314 | # CONFIG_PDC202XX_FORCE is not set | ||
312 | # CONFIG_BLK_DEV_SVWKS is not set | 315 | # CONFIG_BLK_DEV_SVWKS is not set |
313 | # CONFIG_BLK_DEV_SIIMAGE is not set | 316 | # CONFIG_BLK_DEV_SIIMAGE is not set |
314 | # CONFIG_BLK_DEV_SIS5513 is not set | 317 | # CONFIG_BLK_DEV_SIS5513 is not set |
@@ -353,7 +356,7 @@ CONFIG_BLK_DEV_SD=y | |||
353 | # | 356 | # |
354 | # SCSI low-level drivers | 357 | # SCSI low-level drivers |
355 | # | 358 | # |
356 | CONFIG_BLK_DEV_3W_XXXX_RAID=y | 359 | # CONFIG_BLK_DEV_3W_XXXX_RAID is not set |
357 | # CONFIG_SCSI_3W_9XXX is not set | 360 | # CONFIG_SCSI_3W_9XXX is not set |
358 | # CONFIG_SCSI_ACARD is not set | 361 | # CONFIG_SCSI_ACARD is not set |
359 | # CONFIG_SCSI_AACRAID is not set | 362 | # CONFIG_SCSI_AACRAID is not set |
@@ -384,7 +387,6 @@ CONFIG_SCSI_SATA_VIA=y | |||
384 | # CONFIG_SCSI_BUSLOGIC is not set | 387 | # CONFIG_SCSI_BUSLOGIC is not set |
385 | # CONFIG_SCSI_DMX3191D is not set | 388 | # CONFIG_SCSI_DMX3191D is not set |
386 | # CONFIG_SCSI_EATA is not set | 389 | # CONFIG_SCSI_EATA is not set |
387 | # CONFIG_SCSI_EATA_PIO is not set | ||
388 | # CONFIG_SCSI_FUTURE_DOMAIN is not set | 390 | # CONFIG_SCSI_FUTURE_DOMAIN is not set |
389 | # CONFIG_SCSI_GDTH is not set | 391 | # CONFIG_SCSI_GDTH is not set |
390 | # CONFIG_SCSI_IPS is not set | 392 | # CONFIG_SCSI_IPS is not set |
@@ -392,7 +394,6 @@ CONFIG_SCSI_SATA_VIA=y | |||
392 | # CONFIG_SCSI_INIA100 is not set | 394 | # CONFIG_SCSI_INIA100 is not set |
393 | # CONFIG_SCSI_SYM53C8XX_2 is not set | 395 | # CONFIG_SCSI_SYM53C8XX_2 is not set |
394 | # CONFIG_SCSI_IPR is not set | 396 | # CONFIG_SCSI_IPR is not set |
395 | # CONFIG_SCSI_QLOGIC_ISP is not set | ||
396 | # CONFIG_SCSI_QLOGIC_FC is not set | 397 | # CONFIG_SCSI_QLOGIC_FC is not set |
397 | # CONFIG_SCSI_QLOGIC_1280 is not set | 398 | # CONFIG_SCSI_QLOGIC_1280 is not set |
398 | CONFIG_SCSI_QLA2XXX=y | 399 | CONFIG_SCSI_QLA2XXX=y |
@@ -401,6 +402,7 @@ CONFIG_SCSI_QLA2XXX=y | |||
401 | # CONFIG_SCSI_QLA2300 is not set | 402 | # CONFIG_SCSI_QLA2300 is not set |
402 | # CONFIG_SCSI_QLA2322 is not set | 403 | # CONFIG_SCSI_QLA2322 is not set |
403 | # CONFIG_SCSI_QLA6312 is not set | 404 | # CONFIG_SCSI_QLA6312 is not set |
405 | # CONFIG_SCSI_LPFC is not set | ||
404 | # CONFIG_SCSI_DC395x is not set | 406 | # CONFIG_SCSI_DC395x is not set |
405 | # CONFIG_SCSI_DC390T is not set | 407 | # CONFIG_SCSI_DC390T is not set |
406 | # CONFIG_SCSI_DEBUG is not set | 408 | # CONFIG_SCSI_DEBUG is not set |
@@ -437,7 +439,6 @@ CONFIG_NET=y | |||
437 | # | 439 | # |
438 | CONFIG_PACKET=y | 440 | CONFIG_PACKET=y |
439 | # CONFIG_PACKET_MMAP is not set | 441 | # CONFIG_PACKET_MMAP is not set |
440 | # CONFIG_NETLINK_DEV is not set | ||
441 | CONFIG_UNIX=y | 442 | CONFIG_UNIX=y |
442 | # CONFIG_NET_KEY is not set | 443 | # CONFIG_NET_KEY is not set |
443 | CONFIG_INET=y | 444 | CONFIG_INET=y |
@@ -502,7 +503,7 @@ CONFIG_NETDEVICES=y | |||
502 | # CONFIG_DUMMY is not set | 503 | # CONFIG_DUMMY is not set |
503 | # CONFIG_BONDING is not set | 504 | # CONFIG_BONDING is not set |
504 | # CONFIG_EQUALIZER is not set | 505 | # CONFIG_EQUALIZER is not set |
505 | # CONFIG_TUN is not set | 506 | CONFIG_TUN=y |
506 | 507 | ||
507 | # | 508 | # |
508 | # ARCnet devices | 509 | # ARCnet devices |
@@ -525,8 +526,7 @@ CONFIG_MII=y | |||
525 | # CONFIG_HP100 is not set | 526 | # CONFIG_HP100 is not set |
526 | CONFIG_NET_PCI=y | 527 | CONFIG_NET_PCI=y |
527 | # CONFIG_PCNET32 is not set | 528 | # CONFIG_PCNET32 is not set |
528 | CONFIG_AMD8111_ETH=y | 529 | # CONFIG_AMD8111_ETH is not set |
529 | # CONFIG_AMD8111E_NAPI is not set | ||
530 | # CONFIG_ADAPTEC_STARFIRE is not set | 530 | # CONFIG_ADAPTEC_STARFIRE is not set |
531 | # CONFIG_B44 is not set | 531 | # CONFIG_B44 is not set |
532 | CONFIG_FORCEDETH=y | 532 | CONFIG_FORCEDETH=y |
@@ -536,7 +536,7 @@ CONFIG_FORCEDETH=y | |||
536 | # CONFIG_FEALNX is not set | 536 | # CONFIG_FEALNX is not set |
537 | # CONFIG_NATSEMI is not set | 537 | # CONFIG_NATSEMI is not set |
538 | # CONFIG_NE2K_PCI is not set | 538 | # CONFIG_NE2K_PCI is not set |
539 | CONFIG_8139CP=m | 539 | CONFIG_8139CP=y |
540 | CONFIG_8139TOO=y | 540 | CONFIG_8139TOO=y |
541 | # CONFIG_8139TOO_PIO is not set | 541 | # CONFIG_8139TOO_PIO is not set |
542 | # CONFIG_8139TOO_TUNE_TWISTER is not set | 542 | # CONFIG_8139TOO_TUNE_TWISTER is not set |
@@ -671,6 +671,7 @@ CONFIG_SERIAL_8250_NR_UARTS=4 | |||
671 | # | 671 | # |
672 | CONFIG_SERIAL_CORE=y | 672 | CONFIG_SERIAL_CORE=y |
673 | CONFIG_SERIAL_CORE_CONSOLE=y | 673 | CONFIG_SERIAL_CORE_CONSOLE=y |
674 | # CONFIG_SERIAL_JSM is not set | ||
674 | CONFIG_UNIX98_PTYS=y | 675 | CONFIG_UNIX98_PTYS=y |
675 | CONFIG_LEGACY_PTYS=y | 676 | CONFIG_LEGACY_PTYS=y |
676 | CONFIG_LEGACY_PTY_COUNT=256 | 677 | CONFIG_LEGACY_PTY_COUNT=256 |
@@ -696,6 +697,7 @@ CONFIG_RTC=y | |||
696 | # | 697 | # |
697 | CONFIG_AGP=y | 698 | CONFIG_AGP=y |
698 | CONFIG_AGP_AMD64=y | 699 | CONFIG_AGP_AMD64=y |
700 | CONFIG_AGP_INTEL=y | ||
699 | # CONFIG_DRM is not set | 701 | # CONFIG_DRM is not set |
700 | # CONFIG_MWAVE is not set | 702 | # CONFIG_MWAVE is not set |
701 | CONFIG_RAW_DRIVER=y | 703 | CONFIG_RAW_DRIVER=y |
@@ -703,7 +705,7 @@ CONFIG_HPET=y | |||
703 | # CONFIG_HPET_RTC_IRQ is not set | 705 | # CONFIG_HPET_RTC_IRQ is not set |
704 | CONFIG_HPET_MMAP=y | 706 | CONFIG_HPET_MMAP=y |
705 | CONFIG_MAX_RAW_DEVS=256 | 707 | CONFIG_MAX_RAW_DEVS=256 |
706 | CONFIG_HANGCHECK_TIMER=y | 708 | # CONFIG_HANGCHECK_TIMER is not set |
707 | 709 | ||
708 | # | 710 | # |
709 | # TPM devices | 711 | # TPM devices |
@@ -786,6 +788,8 @@ CONFIG_SOUND_ICH=y | |||
786 | # | 788 | # |
787 | # USB support | 789 | # USB support |
788 | # | 790 | # |
791 | CONFIG_USB_ARCH_HAS_HCD=y | ||
792 | CONFIG_USB_ARCH_HAS_OHCI=y | ||
789 | CONFIG_USB=y | 793 | CONFIG_USB=y |
790 | # CONFIG_USB_DEBUG is not set | 794 | # CONFIG_USB_DEBUG is not set |
791 | 795 | ||
@@ -797,8 +801,6 @@ CONFIG_USB_DEVICEFS=y | |||
797 | # CONFIG_USB_DYNAMIC_MINORS is not set | 801 | # CONFIG_USB_DYNAMIC_MINORS is not set |
798 | # CONFIG_USB_SUSPEND is not set | 802 | # CONFIG_USB_SUSPEND is not set |
799 | # CONFIG_USB_OTG is not set | 803 | # CONFIG_USB_OTG is not set |
800 | CONFIG_USB_ARCH_HAS_HCD=y | ||
801 | CONFIG_USB_ARCH_HAS_OHCI=y | ||
802 | 804 | ||
803 | # | 805 | # |
804 | # USB Host Controller Drivers | 806 | # USB Host Controller Drivers |
@@ -826,7 +828,6 @@ CONFIG_USB_PRINTER=y | |||
826 | # | 828 | # |
827 | CONFIG_USB_STORAGE=y | 829 | CONFIG_USB_STORAGE=y |
828 | # CONFIG_USB_STORAGE_DEBUG is not set | 830 | # CONFIG_USB_STORAGE_DEBUG is not set |
829 | # CONFIG_USB_STORAGE_RW_DETECT is not set | ||
830 | # CONFIG_USB_STORAGE_DATAFAB is not set | 831 | # CONFIG_USB_STORAGE_DATAFAB is not set |
831 | # CONFIG_USB_STORAGE_FREECOM is not set | 832 | # CONFIG_USB_STORAGE_FREECOM is not set |
832 | # CONFIG_USB_STORAGE_ISD200 is not set | 833 | # CONFIG_USB_STORAGE_ISD200 is not set |
@@ -965,7 +966,7 @@ CONFIG_AUTOFS_FS=y | |||
965 | # CD-ROM/DVD Filesystems | 966 | # CD-ROM/DVD Filesystems |
966 | # | 967 | # |
967 | CONFIG_ISO9660_FS=y | 968 | CONFIG_ISO9660_FS=y |
968 | # CONFIG_JOLIET is not set | 969 | CONFIG_JOLIET=y |
969 | # CONFIG_ZISOFS is not set | 970 | # CONFIG_ZISOFS is not set |
970 | # CONFIG_UDF_FS is not set | 971 | # CONFIG_UDF_FS is not set |
971 | 972 | ||
@@ -1092,9 +1093,10 @@ CONFIG_OPROFILE=y | |||
1092 | # | 1093 | # |
1093 | # Kernel hacking | 1094 | # Kernel hacking |
1094 | # | 1095 | # |
1096 | # CONFIG_PRINTK_TIME is not set | ||
1095 | CONFIG_DEBUG_KERNEL=y | 1097 | CONFIG_DEBUG_KERNEL=y |
1096 | CONFIG_MAGIC_SYSRQ=y | 1098 | CONFIG_MAGIC_SYSRQ=y |
1097 | # CONFIG_PRINTK_TIME is not set | 1099 | CONFIG_LOG_BUF_SHIFT=18 |
1098 | # CONFIG_SCHEDSTATS is not set | 1100 | # CONFIG_SCHEDSTATS is not set |
1099 | # CONFIG_DEBUG_SLAB is not set | 1101 | # CONFIG_DEBUG_SLAB is not set |
1100 | # CONFIG_DEBUG_SPINLOCK is not set | 1102 | # CONFIG_DEBUG_SPINLOCK is not set |
diff --git a/arch/x86_64/kernel/Makefile b/arch/x86_64/kernel/Makefile index 0a3318e08ab6..5ca4a4598fda 100644 --- a/arch/x86_64/kernel/Makefile +++ b/arch/x86_64/kernel/Makefile | |||
@@ -28,6 +28,7 @@ obj-$(CONFIG_GART_IOMMU) += pci-gart.o aperture.o | |||
28 | obj-$(CONFIG_DUMMY_IOMMU) += pci-nommu.o pci-dma.o | 28 | obj-$(CONFIG_DUMMY_IOMMU) += pci-nommu.o pci-dma.o |
29 | obj-$(CONFIG_SWIOTLB) += swiotlb.o | 29 | obj-$(CONFIG_SWIOTLB) += swiotlb.o |
30 | obj-$(CONFIG_KPROBES) += kprobes.o | 30 | obj-$(CONFIG_KPROBES) += kprobes.o |
31 | obj-$(CONFIG_X86_PM_TIMER) += pmtimer.o | ||
31 | 32 | ||
32 | obj-$(CONFIG_MODULES) += module.o | 33 | obj-$(CONFIG_MODULES) += module.o |
33 | 34 | ||
diff --git a/arch/x86_64/kernel/apic.c b/arch/x86_64/kernel/apic.c index 7e13545748e0..f8e6cc4fecd4 100644 --- a/arch/x86_64/kernel/apic.c +++ b/arch/x86_64/kernel/apic.c | |||
@@ -33,6 +33,7 @@ | |||
33 | #include <asm/mpspec.h> | 33 | #include <asm/mpspec.h> |
34 | #include <asm/pgalloc.h> | 34 | #include <asm/pgalloc.h> |
35 | #include <asm/mach_apic.h> | 35 | #include <asm/mach_apic.h> |
36 | #include <asm/nmi.h> | ||
36 | 37 | ||
37 | int apic_verbosity; | 38 | int apic_verbosity; |
38 | 39 | ||
@@ -925,7 +926,7 @@ __init int oem_force_hpet_timer(void) | |||
925 | unsigned id; | 926 | unsigned id; |
926 | DECLARE_BITMAP(clustermap, NUM_APIC_CLUSTERS); | 927 | DECLARE_BITMAP(clustermap, NUM_APIC_CLUSTERS); |
927 | 928 | ||
928 | bitmap_empty(clustermap, NUM_APIC_CLUSTERS); | 929 | bitmap_zero(clustermap, NUM_APIC_CLUSTERS); |
929 | 930 | ||
930 | for (i = 0; i < NR_CPUS; i++) { | 931 | for (i = 0; i < NR_CPUS; i++) { |
931 | id = bios_cpu_apicid[i]; | 932 | id = bios_cpu_apicid[i]; |
@@ -1056,7 +1057,7 @@ int __init APIC_init_uniprocessor (void) | |||
1056 | nr_ioapics = 0; | 1057 | nr_ioapics = 0; |
1057 | #endif | 1058 | #endif |
1058 | setup_boot_APIC_clock(); | 1059 | setup_boot_APIC_clock(); |
1059 | 1060 | check_nmi_watchdog(); | |
1060 | return 0; | 1061 | return 0; |
1061 | } | 1062 | } |
1062 | 1063 | ||
diff --git a/arch/x86_64/kernel/entry.S b/arch/x86_64/kernel/entry.S index 1086b5fcac21..28817490fdc6 100644 --- a/arch/x86_64/kernel/entry.S +++ b/arch/x86_64/kernel/entry.S | |||
@@ -220,13 +220,18 @@ sysret_careful: | |||
220 | jmp sysret_check | 220 | jmp sysret_check |
221 | 221 | ||
222 | /* Handle a signal */ | 222 | /* Handle a signal */ |
223 | /* edx: work flags (arg3) */ | ||
224 | sysret_signal: | 223 | sysret_signal: |
225 | sti | 224 | sti |
225 | testl $(_TIF_SIGPENDING|_TIF_NOTIFY_RESUME|_TIF_SINGLESTEP),%edx | ||
226 | jz 1f | ||
227 | |||
228 | /* Really a signal */ | ||
229 | /* edx: work flags (arg3) */ | ||
226 | leaq do_notify_resume(%rip),%rax | 230 | leaq do_notify_resume(%rip),%rax |
227 | leaq -ARGOFFSET(%rsp),%rdi # &pt_regs -> arg1 | 231 | leaq -ARGOFFSET(%rsp),%rdi # &pt_regs -> arg1 |
228 | xorl %esi,%esi # oldset -> arg2 | 232 | xorl %esi,%esi # oldset -> arg2 |
229 | call ptregscall_common | 233 | call ptregscall_common |
234 | 1: movl $_TIF_NEED_RESCHED,%edi | ||
230 | jmp sysret_check | 235 | jmp sysret_check |
231 | 236 | ||
232 | /* Do syscall tracing */ | 237 | /* Do syscall tracing */ |
@@ -484,6 +489,8 @@ retint_careful: | |||
484 | jmp retint_check | 489 | jmp retint_check |
485 | 490 | ||
486 | retint_signal: | 491 | retint_signal: |
492 | testl $(_TIF_SIGPENDING|_TIF_NOTIFY_RESUME|_TIF_SINGLESTEP),%edx | ||
493 | jz retint_swapgs | ||
487 | sti | 494 | sti |
488 | SAVE_REST | 495 | SAVE_REST |
489 | movq $-1,ORIG_RAX(%rsp) | 496 | movq $-1,ORIG_RAX(%rsp) |
@@ -492,8 +499,8 @@ retint_signal: | |||
492 | call do_notify_resume | 499 | call do_notify_resume |
493 | RESTORE_REST | 500 | RESTORE_REST |
494 | cli | 501 | cli |
502 | movl $_TIF_NEED_RESCHED,%edi | ||
495 | GET_THREAD_INFO(%rcx) | 503 | GET_THREAD_INFO(%rcx) |
496 | movl $_TIF_WORK_MASK,%edi | ||
497 | jmp retint_check | 504 | jmp retint_check |
498 | 505 | ||
499 | #ifdef CONFIG_PREEMPT | 506 | #ifdef CONFIG_PREEMPT |
diff --git a/arch/x86_64/kernel/io_apic.c b/arch/x86_64/kernel/io_apic.c index 60be58617eb9..ac7684324954 100644 --- a/arch/x86_64/kernel/io_apic.c +++ b/arch/x86_64/kernel/io_apic.c | |||
@@ -1804,76 +1804,6 @@ device_initcall(ioapic_init_sysfs); | |||
1804 | 1804 | ||
1805 | #define IO_APIC_MAX_ID 0xFE | 1805 | #define IO_APIC_MAX_ID 0xFE |
1806 | 1806 | ||
1807 | int __init io_apic_get_unique_id (int ioapic, int apic_id) | ||
1808 | { | ||
1809 | union IO_APIC_reg_00 reg_00; | ||
1810 | static physid_mask_t apic_id_map; | ||
1811 | unsigned long flags; | ||
1812 | int i = 0; | ||
1813 | |||
1814 | /* | ||
1815 | * The P4 platform supports up to 256 APIC IDs on two separate APIC | ||
1816 | * buses (one for LAPICs, one for IOAPICs), where predecessors only | ||
1817 | * supports up to 16 on one shared APIC bus. | ||
1818 | * | ||
1819 | * TBD: Expand LAPIC/IOAPIC support on P4-class systems to take full | ||
1820 | * advantage of new APIC bus architecture. | ||
1821 | */ | ||
1822 | |||
1823 | if (physids_empty(apic_id_map)) | ||
1824 | apic_id_map = phys_cpu_present_map; | ||
1825 | |||
1826 | spin_lock_irqsave(&ioapic_lock, flags); | ||
1827 | reg_00.raw = io_apic_read(ioapic, 0); | ||
1828 | spin_unlock_irqrestore(&ioapic_lock, flags); | ||
1829 | |||
1830 | if (apic_id >= IO_APIC_MAX_ID) { | ||
1831 | apic_printk(APIC_QUIET, KERN_WARNING "IOAPIC[%d]: Invalid apic_id %d, trying " | ||
1832 | "%d\n", ioapic, apic_id, reg_00.bits.ID); | ||
1833 | apic_id = reg_00.bits.ID; | ||
1834 | } | ||
1835 | |||
1836 | /* | ||
1837 | * Every APIC in a system must have a unique ID or we get lots of nice | ||
1838 | * 'stuck on smp_invalidate_needed IPI wait' messages. | ||
1839 | */ | ||
1840 | if (physid_isset(apic_id, apic_id_map)) { | ||
1841 | |||
1842 | for (i = 0; i < IO_APIC_MAX_ID; i++) { | ||
1843 | if (!physid_isset(i, apic_id_map)) | ||
1844 | break; | ||
1845 | } | ||
1846 | |||
1847 | if (i == IO_APIC_MAX_ID) | ||
1848 | panic("Max apic_id exceeded!\n"); | ||
1849 | |||
1850 | apic_printk(APIC_VERBOSE, KERN_WARNING "IOAPIC[%d]: apic_id %d already used, " | ||
1851 | "trying %d\n", ioapic, apic_id, i); | ||
1852 | |||
1853 | apic_id = i; | ||
1854 | } | ||
1855 | |||
1856 | physid_set(apic_id, apic_id_map); | ||
1857 | |||
1858 | if (reg_00.bits.ID != apic_id) { | ||
1859 | reg_00.bits.ID = apic_id; | ||
1860 | |||
1861 | spin_lock_irqsave(&ioapic_lock, flags); | ||
1862 | io_apic_write(ioapic, 0, reg_00.raw); | ||
1863 | reg_00.raw = io_apic_read(ioapic, 0); | ||
1864 | spin_unlock_irqrestore(&ioapic_lock, flags); | ||
1865 | |||
1866 | /* Sanity check */ | ||
1867 | if (reg_00.bits.ID != apic_id) | ||
1868 | panic("IOAPIC[%d]: Unable change apic_id!\n", ioapic); | ||
1869 | } | ||
1870 | |||
1871 | apic_printk(APIC_VERBOSE,KERN_INFO "IOAPIC[%d]: Assigned apic_id %d\n", ioapic, apic_id); | ||
1872 | |||
1873 | return apic_id; | ||
1874 | } | ||
1875 | |||
1876 | |||
1877 | int __init io_apic_get_version (int ioapic) | 1807 | int __init io_apic_get_version (int ioapic) |
1878 | { | 1808 | { |
1879 | union IO_APIC_reg_01 reg_01; | 1809 | union IO_APIC_reg_01 reg_01; |
diff --git a/arch/x86_64/kernel/mpparse.c b/arch/x86_64/kernel/mpparse.c index 7ec031c6ca10..f86d9db94bfc 100644 --- a/arch/x86_64/kernel/mpparse.c +++ b/arch/x86_64/kernel/mpparse.c | |||
@@ -107,6 +107,7 @@ static int __init mpf_checksum(unsigned char *mp, int len) | |||
107 | static void __init MP_processor_info (struct mpc_config_processor *m) | 107 | static void __init MP_processor_info (struct mpc_config_processor *m) |
108 | { | 108 | { |
109 | int ver; | 109 | int ver; |
110 | static int found_bsp=0; | ||
110 | 111 | ||
111 | if (!(m->mpc_cpuflag & CPU_ENABLED)) | 112 | if (!(m->mpc_cpuflag & CPU_ENABLED)) |
112 | return; | 113 | return; |
@@ -126,11 +127,6 @@ static void __init MP_processor_info (struct mpc_config_processor *m) | |||
126 | " Processor ignored.\n", NR_CPUS); | 127 | " Processor ignored.\n", NR_CPUS); |
127 | return; | 128 | return; |
128 | } | 129 | } |
129 | if (num_processors >= maxcpus) { | ||
130 | printk(KERN_WARNING "WARNING: maxcpus limit of %i reached." | ||
131 | " Processor ignored.\n", maxcpus); | ||
132 | return; | ||
133 | } | ||
134 | 130 | ||
135 | num_processors++; | 131 | num_processors++; |
136 | 132 | ||
@@ -150,7 +146,19 @@ static void __init MP_processor_info (struct mpc_config_processor *m) | |||
150 | ver = 0x10; | 146 | ver = 0x10; |
151 | } | 147 | } |
152 | apic_version[m->mpc_apicid] = ver; | 148 | apic_version[m->mpc_apicid] = ver; |
153 | bios_cpu_apicid[num_processors - 1] = m->mpc_apicid; | 149 | if (m->mpc_cpuflag & CPU_BOOTPROCESSOR) { |
150 | /* | ||
151 | * bios_cpu_apicid is required to have processors listed | ||
152 | * in same order as logical cpu numbers. Hence the first | ||
153 | * entry is BSP, and so on. | ||
154 | */ | ||
155 | bios_cpu_apicid[0] = m->mpc_apicid; | ||
156 | x86_cpu_to_apicid[0] = m->mpc_apicid; | ||
157 | found_bsp = 1; | ||
158 | } else { | ||
159 | bios_cpu_apicid[num_processors - found_bsp] = m->mpc_apicid; | ||
160 | x86_cpu_to_apicid[num_processors - found_bsp] = m->mpc_apicid; | ||
161 | } | ||
154 | } | 162 | } |
155 | 163 | ||
156 | static void __init MP_bus_info (struct mpc_config_bus *m) | 164 | static void __init MP_bus_info (struct mpc_config_bus *m) |
@@ -759,7 +767,7 @@ void __init mp_register_ioapic ( | |||
759 | mp_ioapics[idx].mpc_apicaddr = address; | 767 | mp_ioapics[idx].mpc_apicaddr = address; |
760 | 768 | ||
761 | set_fixmap_nocache(FIX_IO_APIC_BASE_0 + idx, address); | 769 | set_fixmap_nocache(FIX_IO_APIC_BASE_0 + idx, address); |
762 | mp_ioapics[idx].mpc_apicid = io_apic_get_unique_id(idx, id); | 770 | mp_ioapics[idx].mpc_apicid = id; |
763 | mp_ioapics[idx].mpc_apicver = io_apic_get_version(idx); | 771 | mp_ioapics[idx].mpc_apicver = io_apic_get_version(idx); |
764 | 772 | ||
765 | /* | 773 | /* |
diff --git a/arch/x86_64/kernel/nmi.c b/arch/x86_64/kernel/nmi.c index 61de0b34a01e..31c0f2e6ac91 100644 --- a/arch/x86_64/kernel/nmi.c +++ b/arch/x86_64/kernel/nmi.c | |||
@@ -33,6 +33,7 @@ | |||
33 | #include <asm/msr.h> | 33 | #include <asm/msr.h> |
34 | #include <asm/proto.h> | 34 | #include <asm/proto.h> |
35 | #include <asm/kdebug.h> | 35 | #include <asm/kdebug.h> |
36 | #include <asm/local.h> | ||
36 | 37 | ||
37 | /* | 38 | /* |
38 | * lapic_nmi_owner tracks the ownership of the lapic NMI hardware: | 39 | * lapic_nmi_owner tracks the ownership of the lapic NMI hardware: |
@@ -59,7 +60,8 @@ int panic_on_timeout; | |||
59 | 60 | ||
60 | unsigned int nmi_watchdog = NMI_DEFAULT; | 61 | unsigned int nmi_watchdog = NMI_DEFAULT; |
61 | static unsigned int nmi_hz = HZ; | 62 | static unsigned int nmi_hz = HZ; |
62 | unsigned int nmi_perfctr_msr; /* the MSR to reset in NMI handler */ | 63 | static unsigned int nmi_perfctr_msr; /* the MSR to reset in NMI handler */ |
64 | static unsigned int nmi_p4_cccr_val; | ||
63 | 65 | ||
64 | /* Note that these events don't tick when the CPU idles. This means | 66 | /* Note that these events don't tick when the CPU idles. This means |
65 | the frequency varies with CPU load. */ | 67 | the frequency varies with CPU load. */ |
@@ -71,61 +73,87 @@ unsigned int nmi_perfctr_msr; /* the MSR to reset in NMI handler */ | |||
71 | #define K7_EVENT_CYCLES_PROCESSOR_IS_RUNNING 0x76 | 73 | #define K7_EVENT_CYCLES_PROCESSOR_IS_RUNNING 0x76 |
72 | #define K7_NMI_EVENT K7_EVENT_CYCLES_PROCESSOR_IS_RUNNING | 74 | #define K7_NMI_EVENT K7_EVENT_CYCLES_PROCESSOR_IS_RUNNING |
73 | 75 | ||
74 | #define P6_EVNTSEL0_ENABLE (1 << 22) | 76 | #define MSR_P4_MISC_ENABLE 0x1A0 |
75 | #define P6_EVNTSEL_INT (1 << 20) | 77 | #define MSR_P4_MISC_ENABLE_PERF_AVAIL (1<<7) |
76 | #define P6_EVNTSEL_OS (1 << 17) | 78 | #define MSR_P4_MISC_ENABLE_PEBS_UNAVAIL (1<<12) |
77 | #define P6_EVNTSEL_USR (1 << 16) | 79 | #define MSR_P4_PERFCTR0 0x300 |
78 | #define P6_EVENT_CPU_CLOCKS_NOT_HALTED 0x79 | 80 | #define MSR_P4_CCCR0 0x360 |
79 | #define P6_NMI_EVENT P6_EVENT_CPU_CLOCKS_NOT_HALTED | 81 | #define P4_ESCR_EVENT_SELECT(N) ((N)<<25) |
82 | #define P4_ESCR_OS (1<<3) | ||
83 | #define P4_ESCR_USR (1<<2) | ||
84 | #define P4_CCCR_OVF_PMI0 (1<<26) | ||
85 | #define P4_CCCR_OVF_PMI1 (1<<27) | ||
86 | #define P4_CCCR_THRESHOLD(N) ((N)<<20) | ||
87 | #define P4_CCCR_COMPLEMENT (1<<19) | ||
88 | #define P4_CCCR_COMPARE (1<<18) | ||
89 | #define P4_CCCR_REQUIRED (3<<16) | ||
90 | #define P4_CCCR_ESCR_SELECT(N) ((N)<<13) | ||
91 | #define P4_CCCR_ENABLE (1<<12) | ||
92 | /* Set up IQ_COUNTER0 to behave like a clock, by having IQ_CCCR0 filter | ||
93 | CRU_ESCR0 (with any non-null event selector) through a complemented | ||
94 | max threshold. [IA32-Vol3, Section 14.9.9] */ | ||
95 | #define MSR_P4_IQ_COUNTER0 0x30C | ||
96 | #define P4_NMI_CRU_ESCR0 (P4_ESCR_EVENT_SELECT(0x3F)|P4_ESCR_OS|P4_ESCR_USR) | ||
97 | #define P4_NMI_IQ_CCCR0 \ | ||
98 | (P4_CCCR_OVF_PMI0|P4_CCCR_THRESHOLD(15)|P4_CCCR_COMPLEMENT| \ | ||
99 | P4_CCCR_COMPARE|P4_CCCR_REQUIRED|P4_CCCR_ESCR_SELECT(4)|P4_CCCR_ENABLE) | ||
100 | |||
101 | static __init inline int nmi_known_cpu(void) | ||
102 | { | ||
103 | switch (boot_cpu_data.x86_vendor) { | ||
104 | case X86_VENDOR_AMD: | ||
105 | return boot_cpu_data.x86 == 15; | ||
106 | case X86_VENDOR_INTEL: | ||
107 | return boot_cpu_data.x86 == 15; | ||
108 | } | ||
109 | return 0; | ||
110 | } | ||
80 | 111 | ||
81 | /* Run after command line and cpu_init init, but before all other checks */ | 112 | /* Run after command line and cpu_init init, but before all other checks */ |
82 | void __init nmi_watchdog_default(void) | 113 | void __init nmi_watchdog_default(void) |
83 | { | 114 | { |
84 | if (nmi_watchdog != NMI_DEFAULT) | 115 | if (nmi_watchdog != NMI_DEFAULT) |
85 | return; | 116 | return; |
86 | 117 | if (nmi_known_cpu()) | |
87 | /* For some reason the IO APIC watchdog doesn't work on the AMD | 118 | nmi_watchdog = NMI_LOCAL_APIC; |
88 | 8111 chipset. For now switch to local APIC mode using | 119 | else |
89 | perfctr0 there. On Intel CPUs we don't have code to handle | ||
90 | the perfctr and the IO-APIC seems to work, so use that. */ | ||
91 | |||
92 | if (boot_cpu_data.x86_vendor == X86_VENDOR_AMD) { | ||
93 | nmi_watchdog = NMI_LOCAL_APIC; | ||
94 | printk(KERN_INFO | ||
95 | "Using local APIC NMI watchdog using perfctr0\n"); | ||
96 | } else { | ||
97 | printk(KERN_INFO "Using IO APIC NMI watchdog\n"); | ||
98 | nmi_watchdog = NMI_IO_APIC; | 120 | nmi_watchdog = NMI_IO_APIC; |
99 | } | ||
100 | } | 121 | } |
101 | 122 | ||
102 | /* Why is there no CPUID flag for this? */ | 123 | #ifdef CONFIG_SMP |
103 | static __init int cpu_has_lapic(void) | 124 | /* The performance counters used by NMI_LOCAL_APIC don't trigger when |
125 | * the CPU is idle. To make sure the NMI watchdog really ticks on all | ||
126 | * CPUs during the test make them busy. | ||
127 | */ | ||
128 | static __init void nmi_cpu_busy(void *data) | ||
104 | { | 129 | { |
105 | switch (boot_cpu_data.x86_vendor) { | 130 | volatile int *endflag = data; |
106 | case X86_VENDOR_INTEL: | 131 | local_irq_enable(); |
107 | case X86_VENDOR_AMD: | 132 | /* Intentionally don't use cpu_relax here. This is |
108 | return boot_cpu_data.x86 >= 6; | 133 | to make sure that the performance counter really ticks, |
109 | /* .... add more cpus here or find a different way to figure this out. */ | 134 | even if there is a simulator or similar that catches the |
110 | default: | 135 | pause instruction. On a real HT machine this is fine because |
111 | return 0; | 136 | all other CPUs are busy with "useless" delay loops and don't |
112 | } | 137 | care if they get somewhat less cycles. */ |
138 | while (*endflag == 0) | ||
139 | barrier(); | ||
113 | } | 140 | } |
141 | #endif | ||
114 | 142 | ||
115 | static int __init check_nmi_watchdog (void) | 143 | int __init check_nmi_watchdog (void) |
116 | { | 144 | { |
117 | int counts[NR_CPUS]; | 145 | volatile int endflag = 0; |
146 | int *counts; | ||
118 | int cpu; | 147 | int cpu; |
119 | 148 | ||
120 | if (nmi_watchdog == NMI_NONE) | 149 | counts = kmalloc(NR_CPUS * sizeof(int), GFP_KERNEL); |
121 | return 0; | 150 | if (!counts) |
151 | return -1; | ||
122 | 152 | ||
123 | if (nmi_watchdog == NMI_LOCAL_APIC && !cpu_has_lapic()) { | 153 | printk(KERN_INFO "testing NMI watchdog ... "); |
124 | nmi_watchdog = NMI_NONE; | ||
125 | return -1; | ||
126 | } | ||
127 | 154 | ||
128 | printk(KERN_INFO "Testing NMI watchdog ... "); | 155 | if (nmi_watchdog == NMI_LOCAL_APIC) |
156 | smp_call_function(nmi_cpu_busy, (void *)&endflag, 0, 0); | ||
129 | 157 | ||
130 | for (cpu = 0; cpu < NR_CPUS; cpu++) | 158 | for (cpu = 0; cpu < NR_CPUS; cpu++) |
131 | counts[cpu] = cpu_pda[cpu].__nmi_count; | 159 | counts[cpu] = cpu_pda[cpu].__nmi_count; |
@@ -133,15 +161,22 @@ static int __init check_nmi_watchdog (void) | |||
133 | mdelay((10*1000)/nmi_hz); // wait 10 ticks | 161 | mdelay((10*1000)/nmi_hz); // wait 10 ticks |
134 | 162 | ||
135 | for (cpu = 0; cpu < NR_CPUS; cpu++) { | 163 | for (cpu = 0; cpu < NR_CPUS; cpu++) { |
164 | if (!cpu_online(cpu)) | ||
165 | continue; | ||
136 | if (cpu_pda[cpu].__nmi_count - counts[cpu] <= 5) { | 166 | if (cpu_pda[cpu].__nmi_count - counts[cpu] <= 5) { |
137 | printk("CPU#%d: NMI appears to be stuck (%d)!\n", | 167 | endflag = 1; |
168 | printk("CPU#%d: NMI appears to be stuck (%d->%d)!\n", | ||
138 | cpu, | 169 | cpu, |
170 | counts[cpu], | ||
139 | cpu_pda[cpu].__nmi_count); | 171 | cpu_pda[cpu].__nmi_count); |
140 | nmi_active = 0; | 172 | nmi_active = 0; |
141 | lapic_nmi_owner &= ~LAPIC_NMI_WATCHDOG; | 173 | lapic_nmi_owner &= ~LAPIC_NMI_WATCHDOG; |
174 | nmi_perfctr_msr = 0; | ||
175 | kfree(counts); | ||
142 | return -1; | 176 | return -1; |
143 | } | 177 | } |
144 | } | 178 | } |
179 | endflag = 1; | ||
145 | printk("OK.\n"); | 180 | printk("OK.\n"); |
146 | 181 | ||
147 | /* now that we know it works we can reduce NMI frequency to | 182 | /* now that we know it works we can reduce NMI frequency to |
@@ -149,10 +184,9 @@ static int __init check_nmi_watchdog (void) | |||
149 | if (nmi_watchdog == NMI_LOCAL_APIC) | 184 | if (nmi_watchdog == NMI_LOCAL_APIC) |
150 | nmi_hz = 1; | 185 | nmi_hz = 1; |
151 | 186 | ||
187 | kfree(counts); | ||
152 | return 0; | 188 | return 0; |
153 | } | 189 | } |
154 | /* Have this called later during boot so counters are updating */ | ||
155 | late_initcall(check_nmi_watchdog); | ||
156 | 190 | ||
157 | int __init setup_nmi_watchdog(char *str) | 191 | int __init setup_nmi_watchdog(char *str) |
158 | { | 192 | { |
@@ -170,7 +204,7 @@ int __init setup_nmi_watchdog(char *str) | |||
170 | 204 | ||
171 | if (nmi >= NMI_INVALID) | 205 | if (nmi >= NMI_INVALID) |
172 | return 0; | 206 | return 0; |
173 | nmi_watchdog = nmi; | 207 | nmi_watchdog = nmi; |
174 | return 1; | 208 | return 1; |
175 | } | 209 | } |
176 | 210 | ||
@@ -185,7 +219,10 @@ static void disable_lapic_nmi_watchdog(void) | |||
185 | wrmsr(MSR_K7_EVNTSEL0, 0, 0); | 219 | wrmsr(MSR_K7_EVNTSEL0, 0, 0); |
186 | break; | 220 | break; |
187 | case X86_VENDOR_INTEL: | 221 | case X86_VENDOR_INTEL: |
188 | wrmsr(MSR_IA32_EVNTSEL0, 0, 0); | 222 | if (boot_cpu_data.x86 == 15) { |
223 | wrmsr(MSR_P4_IQ_CCCR0, 0, 0); | ||
224 | wrmsr(MSR_P4_CRU_ESCR0, 0, 0); | ||
225 | } | ||
189 | break; | 226 | break; |
190 | } | 227 | } |
191 | nmi_active = -1; | 228 | nmi_active = -1; |
@@ -253,7 +290,7 @@ void enable_timer_nmi_watchdog(void) | |||
253 | 290 | ||
254 | static int nmi_pm_active; /* nmi_active before suspend */ | 291 | static int nmi_pm_active; /* nmi_active before suspend */ |
255 | 292 | ||
256 | static int lapic_nmi_suspend(struct sys_device *dev, pm_message_t state) | 293 | static int lapic_nmi_suspend(struct sys_device *dev, u32 state) |
257 | { | 294 | { |
258 | nmi_pm_active = nmi_active; | 295 | nmi_pm_active = nmi_active; |
259 | disable_lapic_nmi_watchdog(); | 296 | disable_lapic_nmi_watchdog(); |
@@ -300,22 +337,27 @@ late_initcall(init_lapic_nmi_sysfs); | |||
300 | * Original code written by Keith Owens. | 337 | * Original code written by Keith Owens. |
301 | */ | 338 | */ |
302 | 339 | ||
340 | static void clear_msr_range(unsigned int base, unsigned int n) | ||
341 | { | ||
342 | unsigned int i; | ||
343 | |||
344 | for(i = 0; i < n; ++i) | ||
345 | wrmsr(base+i, 0, 0); | ||
346 | } | ||
347 | |||
303 | static void setup_k7_watchdog(void) | 348 | static void setup_k7_watchdog(void) |
304 | { | 349 | { |
305 | int i; | 350 | int i; |
306 | unsigned int evntsel; | 351 | unsigned int evntsel; |
307 | 352 | ||
308 | /* No check, so can start with slow frequency */ | ||
309 | nmi_hz = 1; | ||
310 | |||
311 | /* XXX should check these in EFER */ | ||
312 | |||
313 | nmi_perfctr_msr = MSR_K7_PERFCTR0; | 353 | nmi_perfctr_msr = MSR_K7_PERFCTR0; |
314 | 354 | ||
315 | for(i = 0; i < 4; ++i) { | 355 | for(i = 0; i < 4; ++i) { |
316 | /* Simulator may not support it */ | 356 | /* Simulator may not support it */ |
317 | if (checking_wrmsrl(MSR_K7_EVNTSEL0+i, 0UL)) | 357 | if (checking_wrmsrl(MSR_K7_EVNTSEL0+i, 0UL)) { |
358 | nmi_perfctr_msr = 0; | ||
318 | return; | 359 | return; |
360 | } | ||
319 | wrmsrl(MSR_K7_PERFCTR0+i, 0UL); | 361 | wrmsrl(MSR_K7_PERFCTR0+i, 0UL); |
320 | } | 362 | } |
321 | 363 | ||
@@ -325,12 +367,54 @@ static void setup_k7_watchdog(void) | |||
325 | | K7_NMI_EVENT; | 367 | | K7_NMI_EVENT; |
326 | 368 | ||
327 | wrmsr(MSR_K7_EVNTSEL0, evntsel, 0); | 369 | wrmsr(MSR_K7_EVNTSEL0, evntsel, 0); |
328 | wrmsrl(MSR_K7_PERFCTR0, -((u64)cpu_khz*1000) / nmi_hz); | 370 | wrmsr(MSR_K7_PERFCTR0, -(cpu_khz/nmi_hz*1000), -1); |
329 | apic_write(APIC_LVTPC, APIC_DM_NMI); | 371 | apic_write(APIC_LVTPC, APIC_DM_NMI); |
330 | evntsel |= K7_EVNTSEL_ENABLE; | 372 | evntsel |= K7_EVNTSEL_ENABLE; |
331 | wrmsr(MSR_K7_EVNTSEL0, evntsel, 0); | 373 | wrmsr(MSR_K7_EVNTSEL0, evntsel, 0); |
332 | } | 374 | } |
333 | 375 | ||
376 | |||
377 | static int setup_p4_watchdog(void) | ||
378 | { | ||
379 | unsigned int misc_enable, dummy; | ||
380 | |||
381 | rdmsr(MSR_P4_MISC_ENABLE, misc_enable, dummy); | ||
382 | if (!(misc_enable & MSR_P4_MISC_ENABLE_PERF_AVAIL)) | ||
383 | return 0; | ||
384 | |||
385 | nmi_perfctr_msr = MSR_P4_IQ_COUNTER0; | ||
386 | nmi_p4_cccr_val = P4_NMI_IQ_CCCR0; | ||
387 | #ifdef CONFIG_SMP | ||
388 | if (smp_num_siblings == 2) | ||
389 | nmi_p4_cccr_val |= P4_CCCR_OVF_PMI1; | ||
390 | #endif | ||
391 | |||
392 | if (!(misc_enable & MSR_P4_MISC_ENABLE_PEBS_UNAVAIL)) | ||
393 | clear_msr_range(0x3F1, 2); | ||
394 | /* MSR 0x3F0 seems to have a default value of 0xFC00, but current | ||
395 | docs doesn't fully define it, so leave it alone for now. */ | ||
396 | if (boot_cpu_data.x86_model >= 0x3) { | ||
397 | /* MSR_P4_IQ_ESCR0/1 (0x3ba/0x3bb) removed */ | ||
398 | clear_msr_range(0x3A0, 26); | ||
399 | clear_msr_range(0x3BC, 3); | ||
400 | } else { | ||
401 | clear_msr_range(0x3A0, 31); | ||
402 | } | ||
403 | clear_msr_range(0x3C0, 6); | ||
404 | clear_msr_range(0x3C8, 6); | ||
405 | clear_msr_range(0x3E0, 2); | ||
406 | clear_msr_range(MSR_P4_CCCR0, 18); | ||
407 | clear_msr_range(MSR_P4_PERFCTR0, 18); | ||
408 | |||
409 | wrmsr(MSR_P4_CRU_ESCR0, P4_NMI_CRU_ESCR0, 0); | ||
410 | wrmsr(MSR_P4_IQ_CCCR0, P4_NMI_IQ_CCCR0 & ~P4_CCCR_ENABLE, 0); | ||
411 | Dprintk("setting P4_IQ_COUNTER0 to 0x%08lx\n", -(cpu_khz/nmi_hz*1000)); | ||
412 | wrmsr(MSR_P4_IQ_COUNTER0, -(cpu_khz/nmi_hz*1000), -1); | ||
413 | apic_write(APIC_LVTPC, APIC_DM_NMI); | ||
414 | wrmsr(MSR_P4_IQ_CCCR0, nmi_p4_cccr_val, 0); | ||
415 | return 1; | ||
416 | } | ||
417 | |||
334 | void setup_apic_nmi_watchdog(void) | 418 | void setup_apic_nmi_watchdog(void) |
335 | { | 419 | { |
336 | switch (boot_cpu_data.x86_vendor) { | 420 | switch (boot_cpu_data.x86_vendor) { |
@@ -341,6 +425,13 @@ void setup_apic_nmi_watchdog(void) | |||
341 | return; | 425 | return; |
342 | setup_k7_watchdog(); | 426 | setup_k7_watchdog(); |
343 | break; | 427 | break; |
428 | case X86_VENDOR_INTEL: | ||
429 | if (boot_cpu_data.x86 != 15) | ||
430 | return; | ||
431 | if (!setup_p4_watchdog()) | ||
432 | return; | ||
433 | break; | ||
434 | |||
344 | default: | 435 | default: |
345 | return; | 436 | return; |
346 | } | 437 | } |
@@ -355,56 +446,67 @@ void setup_apic_nmi_watchdog(void) | |||
355 | * | 446 | * |
356 | * as these watchdog NMI IRQs are generated on every CPU, we only | 447 | * as these watchdog NMI IRQs are generated on every CPU, we only |
357 | * have to check the current processor. | 448 | * have to check the current processor. |
358 | * | ||
359 | * since NMIs don't listen to _any_ locks, we have to be extremely | ||
360 | * careful not to rely on unsafe variables. The printk might lock | ||
361 | * up though, so we have to break up any console locks first ... | ||
362 | * [when there will be more tty-related locks, break them up | ||
363 | * here too!] | ||
364 | */ | 449 | */ |
365 | 450 | ||
366 | static unsigned int | 451 | static DEFINE_PER_CPU(unsigned, last_irq_sum); |
367 | last_irq_sums [NR_CPUS], | 452 | static DEFINE_PER_CPU(local_t, alert_counter); |
368 | alert_counter [NR_CPUS]; | 453 | static DEFINE_PER_CPU(int, nmi_touch); |
369 | 454 | ||
370 | void touch_nmi_watchdog (void) | 455 | void touch_nmi_watchdog (void) |
371 | { | 456 | { |
372 | int i; | 457 | int i; |
373 | 458 | ||
374 | /* | 459 | /* |
375 | * Just reset the alert counters, (other CPUs might be | 460 | * Tell other CPUs to reset their alert counters. We cannot |
376 | * spinning on locks we hold): | 461 | * do it ourselves because the alert count increase is not |
462 | * atomic. | ||
377 | */ | 463 | */ |
378 | for (i = 0; i < NR_CPUS; i++) | 464 | for (i = 0; i < NR_CPUS; i++) |
379 | alert_counter[i] = 0; | 465 | per_cpu(nmi_touch, i) = 1; |
380 | } | 466 | } |
381 | 467 | ||
382 | void nmi_watchdog_tick (struct pt_regs * regs, unsigned reason) | 468 | void nmi_watchdog_tick (struct pt_regs * regs, unsigned reason) |
383 | { | 469 | { |
384 | int sum, cpu; | 470 | int sum; |
471 | int touched = 0; | ||
385 | 472 | ||
386 | cpu = safe_smp_processor_id(); | ||
387 | sum = read_pda(apic_timer_irqs); | 473 | sum = read_pda(apic_timer_irqs); |
388 | if (last_irq_sums[cpu] == sum) { | 474 | if (__get_cpu_var(nmi_touch)) { |
475 | __get_cpu_var(nmi_touch) = 0; | ||
476 | touched = 1; | ||
477 | } | ||
478 | if (!touched && __get_cpu_var(last_irq_sum) == sum) { | ||
389 | /* | 479 | /* |
390 | * Ayiee, looks like this CPU is stuck ... | 480 | * Ayiee, looks like this CPU is stuck ... |
391 | * wait a few IRQs (5 seconds) before doing the oops ... | 481 | * wait a few IRQs (5 seconds) before doing the oops ... |
392 | */ | 482 | */ |
393 | alert_counter[cpu]++; | 483 | local_inc(&__get_cpu_var(alert_counter)); |
394 | if (alert_counter[cpu] == 5*nmi_hz) { | 484 | if (local_read(&__get_cpu_var(alert_counter)) == 5*nmi_hz) { |
395 | if (notify_die(DIE_NMI, "nmi", regs, reason, 2, SIGINT) | 485 | if (notify_die(DIE_NMI, "nmi", regs, reason, 2, SIGINT) |
396 | == NOTIFY_STOP) { | 486 | == NOTIFY_STOP) { |
397 | alert_counter[cpu] = 0; | 487 | local_set(&__get_cpu_var(alert_counter), 0); |
398 | return; | 488 | return; |
399 | } | 489 | } |
400 | die_nmi("NMI Watchdog detected LOCKUP on CPU%d", regs); | 490 | die_nmi("NMI Watchdog detected LOCKUP on CPU%d", regs); |
401 | } | 491 | } |
402 | } else { | 492 | } else { |
403 | last_irq_sums[cpu] = sum; | 493 | __get_cpu_var(last_irq_sum) = sum; |
404 | alert_counter[cpu] = 0; | 494 | local_set(&__get_cpu_var(alert_counter), 0); |
405 | } | 495 | } |
406 | if (nmi_perfctr_msr) | 496 | if (nmi_perfctr_msr) { |
497 | if (nmi_perfctr_msr == MSR_P4_IQ_COUNTER0) { | ||
498 | /* | ||
499 | * P4 quirks: | ||
500 | * - An overflown perfctr will assert its interrupt | ||
501 | * until the OVF flag in its CCCR is cleared. | ||
502 | * - LVTPC is masked on interrupt and must be | ||
503 | * unmasked by the LVTPC handler. | ||
504 | */ | ||
505 | wrmsr(MSR_P4_IQ_CCCR0, nmi_p4_cccr_val, 0); | ||
506 | apic_write(APIC_LVTPC, APIC_DM_NMI); | ||
507 | } | ||
407 | wrmsr(nmi_perfctr_msr, -(cpu_khz/nmi_hz*1000), -1); | 508 | wrmsr(nmi_perfctr_msr, -(cpu_khz/nmi_hz*1000), -1); |
509 | } | ||
408 | } | 510 | } |
409 | 511 | ||
410 | static int dummy_nmi_callback(struct pt_regs * regs, int cpu) | 512 | static int dummy_nmi_callback(struct pt_regs * regs, int cpu) |
diff --git a/arch/x86_64/kernel/pmtimer.c b/arch/x86_64/kernel/pmtimer.c new file mode 100644 index 000000000000..feb5f108dd26 --- /dev/null +++ b/arch/x86_64/kernel/pmtimer.c | |||
@@ -0,0 +1,101 @@ | |||
1 | /* Ported over from i386 by AK, original copyright was: | ||
2 | * | ||
3 | * (C) Dominik Brodowski <linux@brodo.de> 2003 | ||
4 | * | ||
5 | * Driver to use the Power Management Timer (PMTMR) available in some | ||
6 | * southbridges as primary timing source for the Linux kernel. | ||
7 | * | ||
8 | * Based on parts of linux/drivers/acpi/hardware/hwtimer.c, timer_pit.c, | ||
9 | * timer_hpet.c, and on Arjan van de Ven's implementation for 2.4. | ||
10 | * | ||
11 | * This file is licensed under the GPL v2. | ||
12 | * | ||
13 | * Dropped all the hardware bug workarounds for now. Hopefully they | ||
14 | * are not needed on 64bit chipsets. | ||
15 | */ | ||
16 | |||
17 | #include <linux/jiffies.h> | ||
18 | #include <linux/kernel.h> | ||
19 | #include <linux/time.h> | ||
20 | #include <linux/init.h> | ||
21 | #include <linux/cpumask.h> | ||
22 | #include <asm/io.h> | ||
23 | #include <asm/proto.h> | ||
24 | #include <asm/msr.h> | ||
25 | #include <asm/vsyscall.h> | ||
26 | |||
27 | /* The I/O port the PMTMR resides at. | ||
28 | * The location is detected during setup_arch(), | ||
29 | * in arch/i386/kernel/acpi/boot.c */ | ||
30 | u32 pmtmr_ioport; | ||
31 | |||
32 | /* value of the Power timer at last timer interrupt */ | ||
33 | static u32 offset_delay; | ||
34 | static u32 last_pmtmr_tick; | ||
35 | |||
36 | #define ACPI_PM_MASK 0xFFFFFF /* limit it to 24 bits */ | ||
37 | |||
38 | static inline u32 cyc2us(u32 cycles) | ||
39 | { | ||
40 | /* The Power Management Timer ticks at 3.579545 ticks per microsecond. | ||
41 | * 1 / PM_TIMER_FREQUENCY == 0.27936511 =~ 286/1024 [error: 0.024%] | ||
42 | * | ||
43 | * Even with HZ = 100, delta is at maximum 35796 ticks, so it can | ||
44 | * easily be multiplied with 286 (=0x11E) without having to fear | ||
45 | * u32 overflows. | ||
46 | */ | ||
47 | cycles *= 286; | ||
48 | return (cycles >> 10); | ||
49 | } | ||
50 | |||
51 | int pmtimer_mark_offset(void) | ||
52 | { | ||
53 | static int first_run = 1; | ||
54 | unsigned long tsc; | ||
55 | u32 lost; | ||
56 | |||
57 | u32 tick = inl(pmtmr_ioport); | ||
58 | u32 delta; | ||
59 | |||
60 | delta = cyc2us((tick - last_pmtmr_tick) & ACPI_PM_MASK); | ||
61 | |||
62 | last_pmtmr_tick = tick; | ||
63 | monotonic_base += delta * NSEC_PER_USEC; | ||
64 | |||
65 | delta += offset_delay; | ||
66 | |||
67 | lost = delta / (USEC_PER_SEC / HZ); | ||
68 | offset_delay = delta % (USEC_PER_SEC / HZ); | ||
69 | |||
70 | rdtscll(tsc); | ||
71 | vxtime.last_tsc = tsc - offset_delay * cpu_khz; | ||
72 | |||
73 | /* don't calculate delay for first run, | ||
74 | or if we've got less then a tick */ | ||
75 | if (first_run || (lost < 1)) { | ||
76 | first_run = 0; | ||
77 | offset_delay = 0; | ||
78 | } | ||
79 | |||
80 | return lost - 1; | ||
81 | } | ||
82 | |||
83 | unsigned int do_gettimeoffset_pm(void) | ||
84 | { | ||
85 | u32 now, offset, delta = 0; | ||
86 | |||
87 | offset = last_pmtmr_tick; | ||
88 | now = inl(pmtmr_ioport); | ||
89 | delta = (now - offset) & ACPI_PM_MASK; | ||
90 | |||
91 | return offset_delay + cyc2us(delta); | ||
92 | } | ||
93 | |||
94 | |||
95 | static int __init nopmtimer_setup(char *s) | ||
96 | { | ||
97 | pmtmr_ioport = 0; | ||
98 | return 0; | ||
99 | } | ||
100 | |||
101 | __setup("nopmtimer", nopmtimer_setup); | ||
diff --git a/arch/x86_64/kernel/ptrace.c b/arch/x86_64/kernel/ptrace.c index e26e86bb56fe..60dc9b98951d 100644 --- a/arch/x86_64/kernel/ptrace.c +++ b/arch/x86_64/kernel/ptrace.c | |||
@@ -257,13 +257,13 @@ static int putreg(struct task_struct *child, | |||
257 | value &= 0xffff; | 257 | value &= 0xffff; |
258 | return 0; | 258 | return 0; |
259 | case offsetof(struct user_regs_struct,fs_base): | 259 | case offsetof(struct user_regs_struct,fs_base): |
260 | if (!((value >> 48) == 0 || (value >> 48) == 0xffff)) | 260 | if (value >= TASK_SIZE) |
261 | return -EIO; | 261 | return -EIO; |
262 | child->thread.fs = value; | 262 | child->thread.fs = value; |
263 | return 0; | 263 | return 0; |
264 | case offsetof(struct user_regs_struct,gs_base): | 264 | case offsetof(struct user_regs_struct,gs_base): |
265 | if (!((value >> 48) == 0 || (value >> 48) == 0xffff)) | 265 | if (value >= TASK_SIZE) |
266 | return -EIO; | 266 | return -EIO; |
267 | child->thread.gs = value; | 267 | child->thread.gs = value; |
268 | return 0; | 268 | return 0; |
269 | case offsetof(struct user_regs_struct, eflags): | 269 | case offsetof(struct user_regs_struct, eflags): |
@@ -277,6 +277,11 @@ static int putreg(struct task_struct *child, | |||
277 | return -EIO; | 277 | return -EIO; |
278 | value &= 0xffff; | 278 | value &= 0xffff; |
279 | break; | 279 | break; |
280 | case offsetof(struct user_regs_struct, rip): | ||
281 | /* Check if the new RIP address is canonical */ | ||
282 | if (value >= TASK_SIZE) | ||
283 | return -EIO; | ||
284 | break; | ||
280 | } | 285 | } |
281 | put_stack_long(child, regno - sizeof(struct pt_regs), value); | 286 | put_stack_long(child, regno - sizeof(struct pt_regs), value); |
282 | return 0; | 287 | return 0; |
diff --git a/arch/x86_64/kernel/setup.c b/arch/x86_64/kernel/setup.c index 2129cf9ba6b2..b9fd0252c279 100644 --- a/arch/x86_64/kernel/setup.c +++ b/arch/x86_64/kernel/setup.c | |||
@@ -727,11 +727,12 @@ static void __init display_cacheinfo(struct cpuinfo_x86 *c) | |||
727 | static void __init amd_detect_cmp(struct cpuinfo_x86 *c) | 727 | static void __init amd_detect_cmp(struct cpuinfo_x86 *c) |
728 | { | 728 | { |
729 | #ifdef CONFIG_SMP | 729 | #ifdef CONFIG_SMP |
730 | int cpu = c->x86_apicid; | 730 | int cpu = smp_processor_id(); |
731 | int node = 0; | 731 | int node = 0; |
732 | if (c->x86_num_cores == 1) | 732 | if (c->x86_num_cores == 1) |
733 | return; | 733 | return; |
734 | cpu_core_id[cpu] = cpu >> hweight32(c->x86_num_cores - 1); | 734 | /* Fix up the APIC ID following the AMD specification. */ |
735 | cpu_core_id[cpu] >>= hweight32(c->x86_num_cores - 1); | ||
735 | 736 | ||
736 | #ifdef CONFIG_NUMA | 737 | #ifdef CONFIG_NUMA |
737 | /* When an ACPI SRAT table is available use the mappings from SRAT | 738 | /* When an ACPI SRAT table is available use the mappings from SRAT |
@@ -745,6 +746,9 @@ static void __init amd_detect_cmp(struct cpuinfo_x86 *c) | |||
745 | node = cpu_to_node[cpu]; | 746 | node = cpu_to_node[cpu]; |
746 | } | 747 | } |
747 | #endif | 748 | #endif |
749 | /* For now: - better than BAD_APIC_ID at least*/ | ||
750 | phys_proc_id[cpu] = cpu_core_id[cpu]; | ||
751 | |||
748 | printk(KERN_INFO "CPU %d(%d) -> Node %d -> Core %d\n", | 752 | printk(KERN_INFO "CPU %d(%d) -> Node %d -> Core %d\n", |
749 | cpu, c->x86_num_cores, node, cpu_core_id[cpu]); | 753 | cpu, c->x86_num_cores, node, cpu_core_id[cpu]); |
750 | #endif | 754 | #endif |
@@ -925,7 +929,6 @@ void __init early_identify_cpu(struct cpuinfo_x86 *c) | |||
925 | c->x86_clflush_size = 64; | 929 | c->x86_clflush_size = 64; |
926 | c->x86_cache_alignment = c->x86_clflush_size; | 930 | c->x86_cache_alignment = c->x86_clflush_size; |
927 | c->x86_num_cores = 1; | 931 | c->x86_num_cores = 1; |
928 | c->x86_apicid = c == &boot_cpu_data ? 0 : c - cpu_data; | ||
929 | c->extended_cpuid_level = 0; | 932 | c->extended_cpuid_level = 0; |
930 | memset(&c->x86_capability, 0, sizeof c->x86_capability); | 933 | memset(&c->x86_capability, 0, sizeof c->x86_capability); |
931 | 934 | ||
@@ -954,11 +957,15 @@ void __init early_identify_cpu(struct cpuinfo_x86 *c) | |||
954 | } | 957 | } |
955 | if (c->x86_capability[0] & (1<<19)) | 958 | if (c->x86_capability[0] & (1<<19)) |
956 | c->x86_clflush_size = ((misc >> 8) & 0xff) * 8; | 959 | c->x86_clflush_size = ((misc >> 8) & 0xff) * 8; |
957 | c->x86_apicid = misc >> 24; | ||
958 | } else { | 960 | } else { |
959 | /* Have CPUID level 0 only - unheard of */ | 961 | /* Have CPUID level 0 only - unheard of */ |
960 | c->x86 = 4; | 962 | c->x86 = 4; |
961 | } | 963 | } |
964 | |||
965 | #ifdef CONFIG_SMP | ||
966 | phys_proc_id[smp_processor_id()] = | ||
967 | cpu_core_id[smp_processor_id()] = (cpuid_ebx(1) >> 24) & 0xff; | ||
968 | #endif | ||
962 | } | 969 | } |
963 | 970 | ||
964 | /* | 971 | /* |
@@ -1088,7 +1095,7 @@ static int show_cpuinfo(struct seq_file *m, void *v) | |||
1088 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | 1095 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, |
1089 | 1096 | ||
1090 | /* Other (Linux-defined) */ | 1097 | /* Other (Linux-defined) */ |
1091 | "cxmmx", NULL, "cyrix_arr", "centaur_mcr", "k8c+", | 1098 | "cxmmx", NULL, "cyrix_arr", "centaur_mcr", NULL, |
1092 | "constant_tsc", NULL, NULL, | 1099 | "constant_tsc", NULL, NULL, |
1093 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | 1100 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, |
1094 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | 1101 | NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, |
diff --git a/arch/x86_64/kernel/smpboot.c b/arch/x86_64/kernel/smpboot.c index 73f7e8b9543a..5abdee1e16a5 100644 --- a/arch/x86_64/kernel/smpboot.c +++ b/arch/x86_64/kernel/smpboot.c | |||
@@ -56,6 +56,7 @@ | |||
56 | #include <asm/kdebug.h> | 56 | #include <asm/kdebug.h> |
57 | #include <asm/tlbflush.h> | 57 | #include <asm/tlbflush.h> |
58 | #include <asm/proto.h> | 58 | #include <asm/proto.h> |
59 | #include <asm/nmi.h> | ||
59 | 60 | ||
60 | /* Change for real CPU hotplug. Note other files need to be fixed | 61 | /* Change for real CPU hotplug. Note other files need to be fixed |
61 | first too. */ | 62 | first too. */ |
@@ -125,96 +126,210 @@ static void __cpuinit smp_store_cpu_info(int id) | |||
125 | 126 | ||
126 | *c = boot_cpu_data; | 127 | *c = boot_cpu_data; |
127 | identify_cpu(c); | 128 | identify_cpu(c); |
129 | print_cpu_info(c); | ||
128 | } | 130 | } |
129 | 131 | ||
130 | /* | 132 | /* |
131 | * Synchronize TSCs of CPUs | 133 | * New Funky TSC sync algorithm borrowed from IA64. |
134 | * Main advantage is that it doesn't reset the TSCs fully and | ||
135 | * in general looks more robust and it works better than my earlier | ||
136 | * attempts. I believe it was written by David Mosberger. Some minor | ||
137 | * adjustments for x86-64 by me -AK | ||
132 | * | 138 | * |
133 | * This new algorithm is less accurate than the old "zero TSCs" | 139 | * Original comment reproduced below. |
134 | * one, but we cannot zero TSCs anymore in the new hotplug CPU | 140 | * |
135 | * model. | 141 | * Synchronize TSC of the current (slave) CPU with the TSC of the |
142 | * MASTER CPU (normally the time-keeper CPU). We use a closed loop to | ||
143 | * eliminate the possibility of unaccounted-for errors (such as | ||
144 | * getting a machine check in the middle of a calibration step). The | ||
145 | * basic idea is for the slave to ask the master what itc value it has | ||
146 | * and to read its own itc before and after the master responds. Each | ||
147 | * iteration gives us three timestamps: | ||
148 | * | ||
149 | * slave master | ||
150 | * | ||
151 | * t0 ---\ | ||
152 | * ---\ | ||
153 | * ---> | ||
154 | * tm | ||
155 | * /--- | ||
156 | * /--- | ||
157 | * t1 <--- | ||
158 | * | ||
159 | * | ||
160 | * The goal is to adjust the slave's TSC such that tm falls exactly | ||
161 | * half-way between t0 and t1. If we achieve this, the clocks are | ||
162 | * synchronized provided the interconnect between the slave and the | ||
163 | * master is symmetric. Even if the interconnect were asymmetric, we | ||
164 | * would still know that the synchronization error is smaller than the | ||
165 | * roundtrip latency (t0 - t1). | ||
166 | * | ||
167 | * When the interconnect is quiet and symmetric, this lets us | ||
168 | * synchronize the TSC to within one or two cycles. However, we can | ||
169 | * only *guarantee* that the synchronization is accurate to within a | ||
170 | * round-trip time, which is typically in the range of several hundred | ||
171 | * cycles (e.g., ~500 cycles). In practice, this means that the TSCs | ||
172 | * are usually almost perfectly synchronized, but we shouldn't assume | ||
173 | * that the accuracy is much better than half a micro second or so. | ||
174 | * | ||
175 | * [there are other errors like the latency of RDTSC and of the | ||
176 | * WRMSR. These can also account to hundreds of cycles. So it's | ||
177 | * probably worse. It claims 153 cycles error on a dual Opteron, | ||
178 | * but I suspect the numbers are actually somewhat worse -AK] | ||
136 | */ | 179 | */ |
137 | 180 | ||
138 | static atomic_t __cpuinitdata tsc_flag; | 181 | #define MASTER 0 |
182 | #define SLAVE (SMP_CACHE_BYTES/8) | ||
183 | |||
184 | /* Intentionally don't use cpu_relax() while TSC synchronization | ||
185 | because we don't want to go into funky power save modi or cause | ||
186 | hypervisors to schedule us away. Going to sleep would likely affect | ||
187 | latency and low latency is the primary objective here. -AK */ | ||
188 | #define no_cpu_relax() barrier() | ||
189 | |||
139 | static __cpuinitdata DEFINE_SPINLOCK(tsc_sync_lock); | 190 | static __cpuinitdata DEFINE_SPINLOCK(tsc_sync_lock); |
140 | static unsigned long long __cpuinitdata bp_tsc, ap_tsc; | 191 | static volatile __cpuinitdata unsigned long go[SLAVE + 1]; |
192 | static int notscsync __cpuinitdata; | ||
193 | |||
194 | #undef DEBUG_TSC_SYNC | ||
141 | 195 | ||
142 | #define NR_LOOPS 5 | 196 | #define NUM_ROUNDS 64 /* magic value */ |
197 | #define NUM_ITERS 5 /* likewise */ | ||
143 | 198 | ||
144 | static void __cpuinit sync_tsc_bp_init(int init) | 199 | /* Callback on boot CPU */ |
200 | static __cpuinit void sync_master(void *arg) | ||
145 | { | 201 | { |
146 | if (init) | 202 | unsigned long flags, i; |
147 | _raw_spin_lock(&tsc_sync_lock); | 203 | |
148 | else | 204 | if (smp_processor_id() != boot_cpu_id) |
149 | _raw_spin_unlock(&tsc_sync_lock); | 205 | return; |
150 | atomic_set(&tsc_flag, 0); | 206 | |
207 | go[MASTER] = 0; | ||
208 | |||
209 | local_irq_save(flags); | ||
210 | { | ||
211 | for (i = 0; i < NUM_ROUNDS*NUM_ITERS; ++i) { | ||
212 | while (!go[MASTER]) | ||
213 | no_cpu_relax(); | ||
214 | go[MASTER] = 0; | ||
215 | rdtscll(go[SLAVE]); | ||
216 | } | ||
217 | } | ||
218 | local_irq_restore(flags); | ||
151 | } | 219 | } |
152 | 220 | ||
153 | /* | 221 | /* |
154 | * Synchronize TSC on AP with BP. | 222 | * Return the number of cycles by which our tsc differs from the tsc |
223 | * on the master (time-keeper) CPU. A positive number indicates our | ||
224 | * tsc is ahead of the master, negative that it is behind. | ||
155 | */ | 225 | */ |
156 | static void __cpuinit __sync_tsc_ap(void) | 226 | static inline long |
227 | get_delta(long *rt, long *master) | ||
157 | { | 228 | { |
158 | if (!cpu_has_tsc) | 229 | unsigned long best_t0 = 0, best_t1 = ~0UL, best_tm = 0; |
159 | return; | 230 | unsigned long tcenter, t0, t1, tm; |
160 | Dprintk("AP %d syncing TSC\n", smp_processor_id()); | 231 | int i; |
161 | 232 | ||
162 | while (atomic_read(&tsc_flag) != 0) | 233 | for (i = 0; i < NUM_ITERS; ++i) { |
163 | cpu_relax(); | 234 | rdtscll(t0); |
164 | atomic_inc(&tsc_flag); | 235 | go[MASTER] = 1; |
165 | mb(); | 236 | while (!(tm = go[SLAVE])) |
166 | _raw_spin_lock(&tsc_sync_lock); | 237 | no_cpu_relax(); |
167 | wrmsrl(MSR_IA32_TSC, bp_tsc); | 238 | go[SLAVE] = 0; |
168 | _raw_spin_unlock(&tsc_sync_lock); | 239 | rdtscll(t1); |
169 | rdtscll(ap_tsc); | 240 | |
170 | mb(); | 241 | if (t1 - t0 < best_t1 - best_t0) |
171 | atomic_inc(&tsc_flag); | 242 | best_t0 = t0, best_t1 = t1, best_tm = tm; |
172 | mb(); | 243 | } |
244 | |||
245 | *rt = best_t1 - best_t0; | ||
246 | *master = best_tm - best_t0; | ||
247 | |||
248 | /* average best_t0 and best_t1 without overflow: */ | ||
249 | tcenter = (best_t0/2 + best_t1/2); | ||
250 | if (best_t0 % 2 + best_t1 % 2 == 2) | ||
251 | ++tcenter; | ||
252 | return tcenter - best_tm; | ||
173 | } | 253 | } |
174 | 254 | ||
175 | static void __cpuinit sync_tsc_ap(void) | 255 | static __cpuinit void sync_tsc(void) |
176 | { | 256 | { |
177 | int i; | 257 | int i, done = 0; |
178 | for (i = 0; i < NR_LOOPS; i++) | 258 | long delta, adj, adjust_latency = 0; |
179 | __sync_tsc_ap(); | 259 | unsigned long flags, rt, master_time_stamp, bound; |
260 | #if DEBUG_TSC_SYNC | ||
261 | static struct syncdebug { | ||
262 | long rt; /* roundtrip time */ | ||
263 | long master; /* master's timestamp */ | ||
264 | long diff; /* difference between midpoint and master's timestamp */ | ||
265 | long lat; /* estimate of tsc adjustment latency */ | ||
266 | } t[NUM_ROUNDS] __cpuinitdata; | ||
267 | #endif | ||
268 | |||
269 | go[MASTER] = 1; | ||
270 | |||
271 | smp_call_function(sync_master, NULL, 1, 0); | ||
272 | |||
273 | while (go[MASTER]) /* wait for master to be ready */ | ||
274 | no_cpu_relax(); | ||
275 | |||
276 | spin_lock_irqsave(&tsc_sync_lock, flags); | ||
277 | { | ||
278 | for (i = 0; i < NUM_ROUNDS; ++i) { | ||
279 | delta = get_delta(&rt, &master_time_stamp); | ||
280 | if (delta == 0) { | ||
281 | done = 1; /* let's lock on to this... */ | ||
282 | bound = rt; | ||
283 | } | ||
284 | |||
285 | if (!done) { | ||
286 | unsigned long t; | ||
287 | if (i > 0) { | ||
288 | adjust_latency += -delta; | ||
289 | adj = -delta + adjust_latency/4; | ||
290 | } else | ||
291 | adj = -delta; | ||
292 | |||
293 | rdtscll(t); | ||
294 | wrmsrl(MSR_IA32_TSC, t + adj); | ||
295 | } | ||
296 | #if DEBUG_TSC_SYNC | ||
297 | t[i].rt = rt; | ||
298 | t[i].master = master_time_stamp; | ||
299 | t[i].diff = delta; | ||
300 | t[i].lat = adjust_latency/4; | ||
301 | #endif | ||
302 | } | ||
303 | } | ||
304 | spin_unlock_irqrestore(&tsc_sync_lock, flags); | ||
305 | |||
306 | #if DEBUG_TSC_SYNC | ||
307 | for (i = 0; i < NUM_ROUNDS; ++i) | ||
308 | printk("rt=%5ld master=%5ld diff=%5ld adjlat=%5ld\n", | ||
309 | t[i].rt, t[i].master, t[i].diff, t[i].lat); | ||
310 | #endif | ||
311 | |||
312 | printk(KERN_INFO | ||
313 | "CPU %d: synchronized TSC with CPU %u (last diff %ld cycles, " | ||
314 | "maxerr %lu cycles)\n", | ||
315 | smp_processor_id(), boot_cpu_id, delta, rt); | ||
180 | } | 316 | } |
181 | 317 | ||
182 | /* | 318 | static void __cpuinit tsc_sync_wait(void) |
183 | * Synchronize TSC from BP to AP. | ||
184 | */ | ||
185 | static void __cpuinit __sync_tsc_bp(int cpu) | ||
186 | { | 319 | { |
187 | if (!cpu_has_tsc) | 320 | if (notscsync || !cpu_has_tsc) |
188 | return; | 321 | return; |
189 | 322 | printk(KERN_INFO "CPU %d: Syncing TSC to CPU %u.\n", smp_processor_id(), | |
190 | /* Wait for AP */ | 323 | boot_cpu_id); |
191 | while (atomic_read(&tsc_flag) == 0) | 324 | sync_tsc(); |
192 | cpu_relax(); | ||
193 | /* Save BPs TSC */ | ||
194 | sync_core(); | ||
195 | rdtscll(bp_tsc); | ||
196 | /* Don't do the sync core here to avoid too much latency. */ | ||
197 | mb(); | ||
198 | /* Start the AP */ | ||
199 | _raw_spin_unlock(&tsc_sync_lock); | ||
200 | /* Wait for AP again */ | ||
201 | while (atomic_read(&tsc_flag) < 2) | ||
202 | cpu_relax(); | ||
203 | rdtscl(bp_tsc); | ||
204 | barrier(); | ||
205 | } | 325 | } |
206 | 326 | ||
207 | static void __cpuinit sync_tsc_bp(int cpu) | 327 | static __init int notscsync_setup(char *s) |
208 | { | 328 | { |
209 | int i; | 329 | notscsync = 1; |
210 | for (i = 0; i < NR_LOOPS - 1; i++) { | 330 | return 0; |
211 | __sync_tsc_bp(cpu); | ||
212 | sync_tsc_bp_init(1); | ||
213 | } | ||
214 | __sync_tsc_bp(cpu); | ||
215 | printk(KERN_INFO "Synced TSC of CPU %d difference %Ld\n", | ||
216 | cpu, ap_tsc - bp_tsc); | ||
217 | } | 331 | } |
332 | __setup("notscsync", notscsync_setup); | ||
218 | 333 | ||
219 | static atomic_t init_deasserted __cpuinitdata; | 334 | static atomic_t init_deasserted __cpuinitdata; |
220 | 335 | ||
@@ -315,11 +430,6 @@ void __cpuinit start_secondary(void) | |||
315 | cpu_init(); | 430 | cpu_init(); |
316 | smp_callin(); | 431 | smp_callin(); |
317 | 432 | ||
318 | /* | ||
319 | * Synchronize the TSC with the BP | ||
320 | */ | ||
321 | sync_tsc_ap(); | ||
322 | |||
323 | /* otherwise gcc will move up the smp_processor_id before the cpu_init */ | 433 | /* otherwise gcc will move up the smp_processor_id before the cpu_init */ |
324 | barrier(); | 434 | barrier(); |
325 | 435 | ||
@@ -334,7 +444,6 @@ void __cpuinit start_secondary(void) | |||
334 | enable_8259A_irq(0); | 444 | enable_8259A_irq(0); |
335 | } | 445 | } |
336 | 446 | ||
337 | |||
338 | enable_APIC_timer(); | 447 | enable_APIC_timer(); |
339 | 448 | ||
340 | /* | 449 | /* |
@@ -343,6 +452,11 @@ void __cpuinit start_secondary(void) | |||
343 | cpu_set(smp_processor_id(), cpu_online_map); | 452 | cpu_set(smp_processor_id(), cpu_online_map); |
344 | mb(); | 453 | mb(); |
345 | 454 | ||
455 | /* Wait for TSC sync to not schedule things before. | ||
456 | We still process interrupts, which could see an inconsistent | ||
457 | time in that window unfortunately. */ | ||
458 | tsc_sync_wait(); | ||
459 | |||
346 | cpu_idle(); | 460 | cpu_idle(); |
347 | } | 461 | } |
348 | 462 | ||
@@ -531,7 +645,6 @@ static int __cpuinit do_boot_cpu(int cpu, int apicid) | |||
531 | printk("failed fork for CPU %d\n", cpu); | 645 | printk("failed fork for CPU %d\n", cpu); |
532 | return PTR_ERR(idle); | 646 | return PTR_ERR(idle); |
533 | } | 647 | } |
534 | x86_cpu_to_apicid[cpu] = apicid; | ||
535 | 648 | ||
536 | cpu_pda[cpu].pcurrent = idle; | 649 | cpu_pda[cpu].pcurrent = idle; |
537 | 650 | ||
@@ -600,8 +713,6 @@ static int __cpuinit do_boot_cpu(int cpu, int apicid) | |||
600 | 713 | ||
601 | if (cpu_isset(cpu, cpu_callin_map)) { | 714 | if (cpu_isset(cpu, cpu_callin_map)) { |
602 | /* number CPUs logically, starting from 1 (BSP is 0) */ | 715 | /* number CPUs logically, starting from 1 (BSP is 0) */ |
603 | Dprintk("OK.\n"); | ||
604 | print_cpu_info(&cpu_data[cpu]); | ||
605 | Dprintk("CPU has booted.\n"); | 716 | Dprintk("CPU has booted.\n"); |
606 | } else { | 717 | } else { |
607 | boot_error = 1; | 718 | boot_error = 1; |
@@ -842,7 +953,6 @@ void __cpuinit smp_prepare_cpus(unsigned int max_cpus) | |||
842 | GET_APIC_ID(apic_read(APIC_ID)), boot_cpu_id); | 953 | GET_APIC_ID(apic_read(APIC_ID)), boot_cpu_id); |
843 | /* Or can we switch back to PIC here? */ | 954 | /* Or can we switch back to PIC here? */ |
844 | } | 955 | } |
845 | x86_cpu_to_apicid[0] = boot_cpu_id; | ||
846 | 956 | ||
847 | /* | 957 | /* |
848 | * Now start the IO-APICs | 958 | * Now start the IO-APICs |
@@ -889,18 +999,14 @@ int __cpuinit __cpu_up(unsigned int cpu) | |||
889 | printk("__cpu_up: bad cpu %d\n", cpu); | 999 | printk("__cpu_up: bad cpu %d\n", cpu); |
890 | return -EINVAL; | 1000 | return -EINVAL; |
891 | } | 1001 | } |
892 | sync_tsc_bp_init(1); | ||
893 | 1002 | ||
894 | /* Boot it! */ | 1003 | /* Boot it! */ |
895 | err = do_boot_cpu(cpu, apicid); | 1004 | err = do_boot_cpu(cpu, apicid); |
896 | if (err < 0) { | 1005 | if (err < 0) { |
897 | sync_tsc_bp_init(0); | ||
898 | Dprintk("do_boot_cpu failed %d\n", err); | 1006 | Dprintk("do_boot_cpu failed %d\n", err); |
899 | return err; | 1007 | return err; |
900 | } | 1008 | } |
901 | 1009 | ||
902 | sync_tsc_bp(cpu); | ||
903 | |||
904 | /* Unleash the CPU! */ | 1010 | /* Unleash the CPU! */ |
905 | Dprintk("waiting for cpu %d\n", cpu); | 1011 | Dprintk("waiting for cpu %d\n", cpu); |
906 | 1012 | ||
@@ -923,4 +1029,6 @@ void __cpuinit smp_cpus_done(unsigned int max_cpus) | |||
923 | 1029 | ||
924 | detect_siblings(); | 1030 | detect_siblings(); |
925 | time_init_gtod(); | 1031 | time_init_gtod(); |
1032 | |||
1033 | check_nmi_watchdog(); | ||
926 | } | 1034 | } |
diff --git a/arch/x86_64/kernel/time.c b/arch/x86_64/kernel/time.c index 0e3b60e1ac5b..735b6767c8ed 100644 --- a/arch/x86_64/kernel/time.c +++ b/arch/x86_64/kernel/time.c | |||
@@ -26,6 +26,8 @@ | |||
26 | #include <linux/sysdev.h> | 26 | #include <linux/sysdev.h> |
27 | #include <linux/bcd.h> | 27 | #include <linux/bcd.h> |
28 | #include <linux/kallsyms.h> | 28 | #include <linux/kallsyms.h> |
29 | #include <linux/acpi.h> | ||
30 | #include <acpi/achware.h> /* for PM timer frequency */ | ||
29 | #include <asm/8253pit.h> | 31 | #include <asm/8253pit.h> |
30 | #include <asm/pgtable.h> | 32 | #include <asm/pgtable.h> |
31 | #include <asm/vsyscall.h> | 33 | #include <asm/vsyscall.h> |
@@ -396,6 +398,10 @@ static irqreturn_t timer_interrupt(int irq, void *dev_id, struct pt_regs *regs) | |||
396 | (offset - vxtime.last)*(NSEC_PER_SEC/HZ) / hpet_tick; | 398 | (offset - vxtime.last)*(NSEC_PER_SEC/HZ) / hpet_tick; |
397 | 399 | ||
398 | vxtime.last = offset; | 400 | vxtime.last = offset; |
401 | #ifdef CONFIG_X86_PM_TIMER | ||
402 | } else if (vxtime.mode == VXTIME_PMTMR) { | ||
403 | lost = pmtimer_mark_offset(); | ||
404 | #endif | ||
399 | } else { | 405 | } else { |
400 | offset = (((tsc - vxtime.last_tsc) * | 406 | offset = (((tsc - vxtime.last_tsc) * |
401 | vxtime.tsc_quot) >> 32) - (USEC_PER_SEC / HZ); | 407 | vxtime.tsc_quot) >> 32) - (USEC_PER_SEC / HZ); |
@@ -898,6 +904,13 @@ void __init time_init(void) | |||
898 | hpet_period; | 904 | hpet_period; |
899 | cpu_khz = hpet_calibrate_tsc(); | 905 | cpu_khz = hpet_calibrate_tsc(); |
900 | timename = "HPET"; | 906 | timename = "HPET"; |
907 | #ifdef CONFIG_X86_PM_TIMER | ||
908 | } else if (pmtmr_ioport) { | ||
909 | vxtime_hz = PM_TIMER_FREQUENCY; | ||
910 | timename = "PM"; | ||
911 | pit_init(); | ||
912 | cpu_khz = pit_calibrate_tsc(); | ||
913 | #endif | ||
901 | } else { | 914 | } else { |
902 | pit_init(); | 915 | pit_init(); |
903 | cpu_khz = pit_calibrate_tsc(); | 916 | cpu_khz = pit_calibrate_tsc(); |
@@ -923,35 +936,50 @@ void __init time_init(void) | |||
923 | } | 936 | } |
924 | 937 | ||
925 | /* | 938 | /* |
939 | * Make an educated guess if the TSC is trustworthy and synchronized | ||
940 | * over all CPUs. | ||
941 | */ | ||
942 | static __init int unsynchronized_tsc(void) | ||
943 | { | ||
944 | #ifdef CONFIG_SMP | ||
945 | if (oem_force_hpet_timer()) | ||
946 | return 1; | ||
947 | /* Intel systems are normally all synchronized. Exceptions | ||
948 | are handled in the OEM check above. */ | ||
949 | if (boot_cpu_data.x86_vendor == X86_VENDOR_INTEL) | ||
950 | return 0; | ||
951 | /* All in a single socket - should be synchronized */ | ||
952 | if (cpus_weight(cpu_core_map[0]) == num_online_cpus()) | ||
953 | return 0; | ||
954 | #endif | ||
955 | /* Assume multi socket systems are not synchronized */ | ||
956 | return num_online_cpus() > 1; | ||
957 | } | ||
958 | |||
959 | /* | ||
926 | * Decide after all CPUs are booted what mode gettimeofday should use. | 960 | * Decide after all CPUs are booted what mode gettimeofday should use. |
927 | */ | 961 | */ |
928 | void __init time_init_gtod(void) | 962 | void __init time_init_gtod(void) |
929 | { | 963 | { |
930 | char *timetype; | 964 | char *timetype; |
931 | 965 | ||
932 | /* | 966 | if (unsynchronized_tsc()) |
933 | * AMD systems with more than one CPU don't have fully synchronized | ||
934 | * TSCs. Always use HPET gettimeofday for these, although it is slower. | ||
935 | * Intel SMP systems usually have synchronized TSCs, so use always | ||
936 | * the TSC. | ||
937 | * | ||
938 | * Exceptions: | ||
939 | * IBM Summit2 checked by oem_force_hpet_timer(). | ||
940 | * AMD dual core may also not need HPET. Check me. | ||
941 | * | ||
942 | * Can be turned off with "notsc". | ||
943 | */ | ||
944 | if (num_online_cpus() > 1 && | ||
945 | boot_cpu_data.x86_vendor == X86_VENDOR_AMD) | ||
946 | notsc = 1; | ||
947 | /* Some systems will want to disable TSC and use HPET. */ | ||
948 | if (oem_force_hpet_timer()) | ||
949 | notsc = 1; | 967 | notsc = 1; |
950 | if (vxtime.hpet_address && notsc) { | 968 | if (vxtime.hpet_address && notsc) { |
951 | timetype = "HPET"; | 969 | timetype = "HPET"; |
952 | vxtime.last = hpet_readl(HPET_T0_CMP) - hpet_tick; | 970 | vxtime.last = hpet_readl(HPET_T0_CMP) - hpet_tick; |
953 | vxtime.mode = VXTIME_HPET; | 971 | vxtime.mode = VXTIME_HPET; |
954 | do_gettimeoffset = do_gettimeoffset_hpet; | 972 | do_gettimeoffset = do_gettimeoffset_hpet; |
973 | #ifdef CONFIG_X86_PM_TIMER | ||
974 | /* Using PM for gettimeofday is quite slow, but we have no other | ||
975 | choice because the TSC is too unreliable on some systems. */ | ||
976 | } else if (pmtmr_ioport && !vxtime.hpet_address && notsc) { | ||
977 | timetype = "PM"; | ||
978 | do_gettimeoffset = do_gettimeoffset_pm; | ||
979 | vxtime.mode = VXTIME_PMTMR; | ||
980 | sysctl_vsyscall = 0; | ||
981 | printk(KERN_INFO "Disabling vsyscall due to use of PM timer\n"); | ||
982 | #endif | ||
955 | } else { | 983 | } else { |
956 | timetype = vxtime.hpet_address ? "HPET/TSC" : "PIT/TSC"; | 984 | timetype = vxtime.hpet_address ? "HPET/TSC" : "PIT/TSC"; |
957 | vxtime.mode = VXTIME_TSC; | 985 | vxtime.mode = VXTIME_TSC; |
diff --git a/arch/x86_64/kernel/vsyscall.c b/arch/x86_64/kernel/vsyscall.c index b4b8dc59663a..2e5734425949 100644 --- a/arch/x86_64/kernel/vsyscall.c +++ b/arch/x86_64/kernel/vsyscall.c | |||
@@ -65,7 +65,7 @@ static force_inline void do_vgettimeofday(struct timeval * tv) | |||
65 | usec = (__xtime.tv_nsec / 1000) + | 65 | usec = (__xtime.tv_nsec / 1000) + |
66 | (__jiffies - __wall_jiffies) * (1000000 / HZ); | 66 | (__jiffies - __wall_jiffies) * (1000000 / HZ); |
67 | 67 | ||
68 | if (__vxtime.mode == VXTIME_TSC) { | 68 | if (__vxtime.mode != VXTIME_HPET) { |
69 | sync_core(); | 69 | sync_core(); |
70 | rdtscll(t); | 70 | rdtscll(t); |
71 | if (t < __vxtime.last_tsc) | 71 | if (t < __vxtime.last_tsc) |
@@ -217,8 +217,9 @@ static int __init vsyscall_init(void) | |||
217 | BUG_ON((unsigned long) &vtime != VSYSCALL_ADDR(__NR_vtime)); | 217 | BUG_ON((unsigned long) &vtime != VSYSCALL_ADDR(__NR_vtime)); |
218 | BUG_ON((VSYSCALL_ADDR(0) != __fix_to_virt(VSYSCALL_FIRST_PAGE))); | 218 | BUG_ON((VSYSCALL_ADDR(0) != __fix_to_virt(VSYSCALL_FIRST_PAGE))); |
219 | map_vsyscall(); | 219 | map_vsyscall(); |
220 | sysctl_vsyscall = 1; | 220 | #ifdef CONFIG_SYSCTL |
221 | register_sysctl_table(kernel_root_table2, 0); | 221 | register_sysctl_table(kernel_root_table2, 0); |
222 | #endif | ||
222 | return 0; | 223 | return 0; |
223 | } | 224 | } |
224 | 225 | ||
diff --git a/arch/x86_64/mm/fault.c b/arch/x86_64/mm/fault.c index e03309216764..5d6b2114cc9a 100644 --- a/arch/x86_64/mm/fault.c +++ b/arch/x86_64/mm/fault.c | |||
@@ -234,6 +234,8 @@ static noinline void pgtable_bad(unsigned long address, struct pt_regs *regs, | |||
234 | 234 | ||
235 | /* | 235 | /* |
236 | * Handle a fault on the vmalloc or module mapping area | 236 | * Handle a fault on the vmalloc or module mapping area |
237 | * | ||
238 | * This assumes no large pages in there. | ||
237 | */ | 239 | */ |
238 | static int vmalloc_fault(unsigned long address) | 240 | static int vmalloc_fault(unsigned long address) |
239 | { | 241 | { |
@@ -272,7 +274,10 @@ static int vmalloc_fault(unsigned long address) | |||
272 | if (!pte_present(*pte_ref)) | 274 | if (!pte_present(*pte_ref)) |
273 | return -1; | 275 | return -1; |
274 | pte = pte_offset_kernel(pmd, address); | 276 | pte = pte_offset_kernel(pmd, address); |
275 | if (!pte_present(*pte) || pte_page(*pte) != pte_page(*pte_ref)) | 277 | /* Don't use pte_page here, because the mappings can point |
278 | outside mem_map, and the NUMA hash lookup cannot handle | ||
279 | that. */ | ||
280 | if (!pte_present(*pte) || pte_pfn(*pte) != pte_pfn(*pte_ref)) | ||
276 | BUG(); | 281 | BUG(); |
277 | __flush_tlb_all(); | 282 | __flush_tlb_all(); |
278 | return 0; | 283 | return 0; |
@@ -346,7 +351,9 @@ asmlinkage void do_page_fault(struct pt_regs *regs, unsigned long error_code) | |||
346 | * protection error (error_code & 1) == 0. | 351 | * protection error (error_code & 1) == 0. |
347 | */ | 352 | */ |
348 | if (unlikely(address >= TASK_SIZE)) { | 353 | if (unlikely(address >= TASK_SIZE)) { |
349 | if (!(error_code & 5)) { | 354 | if (!(error_code & 5) && |
355 | ((address >= VMALLOC_START && address < VMALLOC_END) || | ||
356 | (address >= MODULES_VADDR && address < MODULES_END))) { | ||
350 | if (vmalloc_fault(address) < 0) | 357 | if (vmalloc_fault(address) < 0) |
351 | goto bad_area_nosemaphore; | 358 | goto bad_area_nosemaphore; |
352 | return; | 359 | return; |
diff --git a/arch/x86_64/mm/ioremap.c b/arch/x86_64/mm/ioremap.c index 74ec8554b195..c6fb0cb69992 100644 --- a/arch/x86_64/mm/ioremap.c +++ b/arch/x86_64/mm/ioremap.c | |||
@@ -272,7 +272,7 @@ void iounmap(volatile void __iomem *addr) | |||
272 | if ((p->flags >> 20) && | 272 | if ((p->flags >> 20) && |
273 | p->phys_addr + p->size - 1 < virt_to_phys(high_memory)) { | 273 | p->phys_addr + p->size - 1 < virt_to_phys(high_memory)) { |
274 | /* p->size includes the guard page, but cpa doesn't like that */ | 274 | /* p->size includes the guard page, but cpa doesn't like that */ |
275 | change_page_attr(virt_to_page(__va(p->phys_addr)), | 275 | change_page_attr_addr((unsigned long)__va(p->phys_addr), |
276 | p->size >> PAGE_SHIFT, | 276 | p->size >> PAGE_SHIFT, |
277 | PAGE_KERNEL); | 277 | PAGE_KERNEL); |
278 | global_flush_tlb(); | 278 | global_flush_tlb(); |
diff --git a/crypto/crypto_null.c b/crypto/crypto_null.c index f691d31fa9ee..3fcf6e887e87 100644 --- a/crypto/crypto_null.c +++ b/crypto/crypto_null.c | |||
@@ -21,6 +21,7 @@ | |||
21 | #include <linux/mm.h> | 21 | #include <linux/mm.h> |
22 | #include <asm/scatterlist.h> | 22 | #include <asm/scatterlist.h> |
23 | #include <linux/crypto.h> | 23 | #include <linux/crypto.h> |
24 | #include <linux/string.h> | ||
24 | 25 | ||
25 | #define NULL_KEY_SIZE 0 | 26 | #define NULL_KEY_SIZE 0 |
26 | #define NULL_BLOCK_SIZE 1 | 27 | #define NULL_BLOCK_SIZE 1 |
@@ -28,11 +29,13 @@ | |||
28 | 29 | ||
29 | static int null_compress(void *ctx, const u8 *src, unsigned int slen, | 30 | static int null_compress(void *ctx, const u8 *src, unsigned int slen, |
30 | u8 *dst, unsigned int *dlen) | 31 | u8 *dst, unsigned int *dlen) |
31 | { return 0; } | 32 | { |
32 | 33 | if (slen > *dlen) | |
33 | static int null_decompress(void *ctx, const u8 *src, unsigned int slen, | 34 | return -EINVAL; |
34 | u8 *dst, unsigned int *dlen) | 35 | memcpy(dst, src, slen); |
35 | { return 0; } | 36 | *dlen = slen; |
37 | return 0; | ||
38 | } | ||
36 | 39 | ||
37 | static void null_init(void *ctx) | 40 | static void null_init(void *ctx) |
38 | { } | 41 | { } |
@@ -47,11 +50,10 @@ static int null_setkey(void *ctx, const u8 *key, | |||
47 | unsigned int keylen, u32 *flags) | 50 | unsigned int keylen, u32 *flags) |
48 | { return 0; } | 51 | { return 0; } |
49 | 52 | ||
50 | static void null_encrypt(void *ctx, u8 *dst, const u8 *src) | 53 | static void null_crypt(void *ctx, u8 *dst, const u8 *src) |
51 | { } | 54 | { |
52 | 55 | memcpy(dst, src, NULL_BLOCK_SIZE); | |
53 | static void null_decrypt(void *ctx, u8 *dst, const u8 *src) | 56 | } |
54 | { } | ||
55 | 57 | ||
56 | static struct crypto_alg compress_null = { | 58 | static struct crypto_alg compress_null = { |
57 | .cra_name = "compress_null", | 59 | .cra_name = "compress_null", |
@@ -62,7 +64,7 @@ static struct crypto_alg compress_null = { | |||
62 | .cra_list = LIST_HEAD_INIT(compress_null.cra_list), | 64 | .cra_list = LIST_HEAD_INIT(compress_null.cra_list), |
63 | .cra_u = { .compress = { | 65 | .cra_u = { .compress = { |
64 | .coa_compress = null_compress, | 66 | .coa_compress = null_compress, |
65 | .coa_decompress = null_decompress } } | 67 | .coa_decompress = null_compress } } |
66 | }; | 68 | }; |
67 | 69 | ||
68 | static struct crypto_alg digest_null = { | 70 | static struct crypto_alg digest_null = { |
@@ -90,8 +92,8 @@ static struct crypto_alg cipher_null = { | |||
90 | .cia_min_keysize = NULL_KEY_SIZE, | 92 | .cia_min_keysize = NULL_KEY_SIZE, |
91 | .cia_max_keysize = NULL_KEY_SIZE, | 93 | .cia_max_keysize = NULL_KEY_SIZE, |
92 | .cia_setkey = null_setkey, | 94 | .cia_setkey = null_setkey, |
93 | .cia_encrypt = null_encrypt, | 95 | .cia_encrypt = null_crypt, |
94 | .cia_decrypt = null_decrypt } } | 96 | .cia_decrypt = null_crypt } } |
95 | }; | 97 | }; |
96 | 98 | ||
97 | MODULE_ALIAS("compress_null"); | 99 | MODULE_ALIAS("compress_null"); |
diff --git a/drivers/base/Makefile b/drivers/base/Makefile index 6662b545e0a9..a47928a2e575 100644 --- a/drivers/base/Makefile +++ b/drivers/base/Makefile | |||
@@ -1,6 +1,6 @@ | |||
1 | # Makefile for the Linux device tree | 1 | # Makefile for the Linux device tree |
2 | 2 | ||
3 | obj-y := core.o sys.o interface.o bus.o \ | 3 | obj-y := core.o sys.o bus.o \ |
4 | driver.o class.o class_simple.o platform.o \ | 4 | driver.o class.o class_simple.o platform.o \ |
5 | cpu.o firmware.o init.o map.o dmapool.o \ | 5 | cpu.o firmware.o init.o map.o dmapool.o \ |
6 | attribute_container.o transport_class.o | 6 | attribute_container.o transport_class.o |
diff --git a/drivers/base/bus.c b/drivers/base/bus.c index 2b3902c867da..3cb04bb04c2b 100644 --- a/drivers/base/bus.c +++ b/drivers/base/bus.c | |||
@@ -390,7 +390,6 @@ void device_release_driver(struct device * dev) | |||
390 | sysfs_remove_link(&drv->kobj, kobject_name(&dev->kobj)); | 390 | sysfs_remove_link(&drv->kobj, kobject_name(&dev->kobj)); |
391 | sysfs_remove_link(&dev->kobj, "driver"); | 391 | sysfs_remove_link(&dev->kobj, "driver"); |
392 | list_del_init(&dev->driver_list); | 392 | list_del_init(&dev->driver_list); |
393 | device_detach_shutdown(dev); | ||
394 | if (drv->remove) | 393 | if (drv->remove) |
395 | drv->remove(dev); | 394 | drv->remove(dev); |
396 | dev->driver = NULL; | 395 | dev->driver = NULL; |
diff --git a/drivers/base/core.c b/drivers/base/core.c index 268a9c8d168b..d21eb7744496 100644 --- a/drivers/base/core.c +++ b/drivers/base/core.c | |||
@@ -31,8 +31,6 @@ int (*platform_notify_remove)(struct device * dev) = NULL; | |||
31 | #define to_dev(obj) container_of(obj, struct device, kobj) | 31 | #define to_dev(obj) container_of(obj, struct device, kobj) |
32 | #define to_dev_attr(_attr) container_of(_attr, struct device_attribute, attr) | 32 | #define to_dev_attr(_attr) container_of(_attr, struct device_attribute, attr) |
33 | 33 | ||
34 | extern struct attribute * dev_default_attrs[]; | ||
35 | |||
36 | static ssize_t | 34 | static ssize_t |
37 | dev_attr_show(struct kobject * kobj, struct attribute * attr, char * buf) | 35 | dev_attr_show(struct kobject * kobj, struct attribute * attr, char * buf) |
38 | { | 36 | { |
@@ -89,7 +87,6 @@ static void device_release(struct kobject * kobj) | |||
89 | static struct kobj_type ktype_device = { | 87 | static struct kobj_type ktype_device = { |
90 | .release = device_release, | 88 | .release = device_release, |
91 | .sysfs_ops = &dev_sysfs_ops, | 89 | .sysfs_ops = &dev_sysfs_ops, |
92 | .default_attrs = dev_default_attrs, | ||
93 | }; | 90 | }; |
94 | 91 | ||
95 | 92 | ||
diff --git a/drivers/base/interface.c b/drivers/base/interface.c deleted file mode 100644 index bd515843a0cb..000000000000 --- a/drivers/base/interface.c +++ /dev/null | |||
@@ -1,51 +0,0 @@ | |||
1 | /* | ||
2 | * drivers/base/interface.c - common driverfs interface that's exported to | ||
3 | * the world for all devices. | ||
4 | * | ||
5 | * Copyright (c) 2002-3 Patrick Mochel | ||
6 | * Copyright (c) 2002-3 Open Source Development Labs | ||
7 | * | ||
8 | * This file is released under the GPLv2 | ||
9 | * | ||
10 | */ | ||
11 | |||
12 | #include <linux/device.h> | ||
13 | #include <linux/err.h> | ||
14 | #include <linux/stat.h> | ||
15 | #include <linux/string.h> | ||
16 | |||
17 | /** | ||
18 | * detach_state - control the default power state for the device. | ||
19 | * | ||
20 | * This is the state the device enters when it's driver module is | ||
21 | * unloaded. The value is an unsigned integer, in the range of 0-4. | ||
22 | * '0' indicates 'On', so no action will be taken when the driver is | ||
23 | * unloaded. This is the default behavior. | ||
24 | * '4' indicates 'Off', meaning the driver core will call the driver's | ||
25 | * shutdown method to quiesce the device. | ||
26 | * 1-3 indicate a low-power state for the device to enter via the | ||
27 | * driver's suspend method. | ||
28 | */ | ||
29 | |||
30 | static ssize_t detach_show(struct device * dev, char * buf) | ||
31 | { | ||
32 | return sprintf(buf, "%u\n", dev->detach_state); | ||
33 | } | ||
34 | |||
35 | static ssize_t detach_store(struct device * dev, const char * buf, size_t n) | ||
36 | { | ||
37 | u32 state; | ||
38 | state = simple_strtoul(buf, NULL, 10); | ||
39 | if (state > 4) | ||
40 | return -EINVAL; | ||
41 | dev->detach_state = state; | ||
42 | return n; | ||
43 | } | ||
44 | |||
45 | static DEVICE_ATTR(detach_state, 0644, detach_show, detach_store); | ||
46 | |||
47 | |||
48 | struct attribute * dev_default_attrs[] = { | ||
49 | &dev_attr_detach_state.attr, | ||
50 | NULL, | ||
51 | }; | ||
diff --git a/drivers/base/power/power.h b/drivers/base/power/power.h index e5eda746f2a6..2e700d795cf1 100644 --- a/drivers/base/power/power.h +++ b/drivers/base/power/power.h | |||
@@ -1,18 +1,7 @@ | |||
1 | |||
2 | |||
3 | enum { | ||
4 | DEVICE_PM_ON, | ||
5 | DEVICE_PM1, | ||
6 | DEVICE_PM2, | ||
7 | DEVICE_PM3, | ||
8 | DEVICE_PM_OFF, | ||
9 | }; | ||
10 | |||
11 | /* | 1 | /* |
12 | * shutdown.c | 2 | * shutdown.c |
13 | */ | 3 | */ |
14 | 4 | ||
15 | extern int device_detach_shutdown(struct device *); | ||
16 | extern void device_shutdown(void); | 5 | extern void device_shutdown(void); |
17 | 6 | ||
18 | 7 | ||
diff --git a/drivers/base/power/resume.c b/drivers/base/power/resume.c index f8f5055754d6..26468971ef5a 100644 --- a/drivers/base/power/resume.c +++ b/drivers/base/power/resume.c | |||
@@ -22,8 +22,17 @@ extern int sysdev_resume(void); | |||
22 | 22 | ||
23 | int resume_device(struct device * dev) | 23 | int resume_device(struct device * dev) |
24 | { | 24 | { |
25 | if (dev->bus && dev->bus->resume) | 25 | if (dev->power.pm_parent |
26 | && dev->power.pm_parent->power.power_state) { | ||
27 | dev_err(dev, "PM: resume from %d, parent %s still %d\n", | ||
28 | dev->power.power_state, | ||
29 | dev->power.pm_parent->bus_id, | ||
30 | dev->power.pm_parent->power.power_state); | ||
31 | } | ||
32 | if (dev->bus && dev->bus->resume) { | ||
33 | dev_dbg(dev,"resuming\n"); | ||
26 | return dev->bus->resume(dev); | 34 | return dev->bus->resume(dev); |
35 | } | ||
27 | return 0; | 36 | return 0; |
28 | } | 37 | } |
29 | 38 | ||
diff --git a/drivers/base/power/shutdown.c b/drivers/base/power/shutdown.c index d1e023fbe169..f50a08be424b 100644 --- a/drivers/base/power/shutdown.c +++ b/drivers/base/power/shutdown.c | |||
@@ -19,20 +19,6 @@ | |||
19 | extern struct subsystem devices_subsys; | 19 | extern struct subsystem devices_subsys; |
20 | 20 | ||
21 | 21 | ||
22 | int device_detach_shutdown(struct device * dev) | ||
23 | { | ||
24 | if (!dev->detach_state) | ||
25 | return 0; | ||
26 | |||
27 | if (dev->detach_state == DEVICE_PM_OFF) { | ||
28 | if (dev->driver && dev->driver->shutdown) | ||
29 | dev->driver->shutdown(dev); | ||
30 | return 0; | ||
31 | } | ||
32 | return dpm_runtime_suspend(dev, dev->detach_state); | ||
33 | } | ||
34 | |||
35 | |||
36 | /** | 22 | /** |
37 | * We handle system devices differently - we suspend and shut them | 23 | * We handle system devices differently - we suspend and shut them |
38 | * down last and resume them first. That way, we don't do anything stupid like | 24 | * down last and resume them first. That way, we don't do anything stupid like |
@@ -52,13 +38,12 @@ void device_shutdown(void) | |||
52 | struct device * dev; | 38 | struct device * dev; |
53 | 39 | ||
54 | down_write(&devices_subsys.rwsem); | 40 | down_write(&devices_subsys.rwsem); |
55 | list_for_each_entry_reverse(dev, &devices_subsys.kset.list, kobj.entry) { | 41 | list_for_each_entry_reverse(dev, &devices_subsys.kset.list, |
56 | pr_debug("shutting down %s: ", dev->bus_id); | 42 | kobj.entry) { |
57 | if (dev->driver && dev->driver->shutdown) { | 43 | if (dev->driver && dev->driver->shutdown) { |
58 | pr_debug("Ok\n"); | 44 | dev_dbg(dev, "shutdown\n"); |
59 | dev->driver->shutdown(dev); | 45 | dev->driver->shutdown(dev); |
60 | } else | 46 | } |
61 | pr_debug("Ignored.\n"); | ||
62 | } | 47 | } |
63 | up_write(&devices_subsys.rwsem); | 48 | up_write(&devices_subsys.rwsem); |
64 | 49 | ||
diff --git a/drivers/base/power/suspend.c b/drivers/base/power/suspend.c index a0b5cf689e63..0ec44ef840be 100644 --- a/drivers/base/power/suspend.c +++ b/drivers/base/power/suspend.c | |||
@@ -39,12 +39,25 @@ int suspend_device(struct device * dev, pm_message_t state) | |||
39 | { | 39 | { |
40 | int error = 0; | 40 | int error = 0; |
41 | 41 | ||
42 | dev_dbg(dev, "suspending\n"); | 42 | if (dev->power.power_state) { |
43 | dev_dbg(dev, "PM: suspend %d-->%d\n", | ||
44 | dev->power.power_state, state); | ||
45 | } | ||
46 | if (dev->power.pm_parent | ||
47 | && dev->power.pm_parent->power.power_state) { | ||
48 | dev_err(dev, | ||
49 | "PM: suspend %d->%d, parent %s already %d\n", | ||
50 | dev->power.power_state, state, | ||
51 | dev->power.pm_parent->bus_id, | ||
52 | dev->power.pm_parent->power.power_state); | ||
53 | } | ||
43 | 54 | ||
44 | dev->power.prev_state = dev->power.power_state; | 55 | dev->power.prev_state = dev->power.power_state; |
45 | 56 | ||
46 | if (dev->bus && dev->bus->suspend && !dev->power.power_state) | 57 | if (dev->bus && dev->bus->suspend && !dev->power.power_state) { |
58 | dev_dbg(dev, "suspending\n"); | ||
47 | error = dev->bus->suspend(dev, state); | 59 | error = dev->bus->suspend(dev, state); |
60 | } | ||
48 | 61 | ||
49 | return error; | 62 | return error; |
50 | } | 63 | } |
diff --git a/drivers/block/pktcdvd.c b/drivers/block/pktcdvd.c index 82ccad0a7f1a..b9a6b7ad64f3 100644 --- a/drivers/block/pktcdvd.c +++ b/drivers/block/pktcdvd.c | |||
@@ -914,8 +914,10 @@ static int pkt_handle_queue(struct pktcdvd_device *pd) | |||
914 | bio = node->bio; | 914 | bio = node->bio; |
915 | zone = ZONE(bio->bi_sector, pd); | 915 | zone = ZONE(bio->bi_sector, pd); |
916 | list_for_each_entry(p, &pd->cdrw.pkt_active_list, list) { | 916 | list_for_each_entry(p, &pd->cdrw.pkt_active_list, list) { |
917 | if (p->sector == zone) | 917 | if (p->sector == zone) { |
918 | bio = NULL; | ||
918 | goto try_next_bio; | 919 | goto try_next_bio; |
920 | } | ||
919 | } | 921 | } |
920 | break; | 922 | break; |
921 | try_next_bio: | 923 | try_next_bio: |
diff --git a/drivers/char/raw.c b/drivers/char/raw.c index 131465e8de5a..ca5f42bcaad9 100644 --- a/drivers/char/raw.c +++ b/drivers/char/raw.c | |||
@@ -122,7 +122,7 @@ raw_ioctl(struct inode *inode, struct file *filp, | |||
122 | { | 122 | { |
123 | struct block_device *bdev = filp->private_data; | 123 | struct block_device *bdev = filp->private_data; |
124 | 124 | ||
125 | return blkdev_ioctl(bdev->bd_inode, filp, command, arg); | 125 | return blkdev_ioctl(bdev->bd_inode, NULL, command, arg); |
126 | } | 126 | } |
127 | 127 | ||
128 | static void bind_device(struct raw_config_request *rq) | 128 | static void bind_device(struct raw_config_request *rq) |
diff --git a/drivers/char/watchdog/i8xx_tco.c b/drivers/char/watchdog/i8xx_tco.c index c337978dc966..b14d642439ed 100644 --- a/drivers/char/watchdog/i8xx_tco.c +++ b/drivers/char/watchdog/i8xx_tco.c | |||
@@ -382,6 +382,7 @@ static struct pci_device_id i8xx_tco_pci_tbl[] = { | |||
382 | { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH6_2, PCI_ANY_ID, PCI_ANY_ID, }, | 382 | { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH6_2, PCI_ANY_ID, PCI_ANY_ID, }, |
383 | { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH7_0, PCI_ANY_ID, PCI_ANY_ID, }, | 383 | { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH7_0, PCI_ANY_ID, PCI_ANY_ID, }, |
384 | { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH7_1, PCI_ANY_ID, PCI_ANY_ID, }, | 384 | { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH7_1, PCI_ANY_ID, PCI_ANY_ID, }, |
385 | { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ESB_1, PCI_ANY_ID, PCI_ANY_ID, }, | ||
385 | { 0, }, /* End of list */ | 386 | { 0, }, /* End of list */ |
386 | }; | 387 | }; |
387 | MODULE_DEVICE_TABLE (pci, i8xx_tco_pci_tbl); | 388 | MODULE_DEVICE_TABLE (pci, i8xx_tco_pci_tbl); |
diff --git a/drivers/ide/ide-proc.c b/drivers/ide/ide-proc.c index bdff5ac58053..4b1e43b4118b 100644 --- a/drivers/ide/ide-proc.c +++ b/drivers/ide/ide-proc.c | |||
@@ -516,6 +516,6 @@ void proc_ide_create(void) | |||
516 | 516 | ||
517 | void proc_ide_destroy(void) | 517 | void proc_ide_destroy(void) |
518 | { | 518 | { |
519 | remove_proc_entry("ide/drivers", proc_ide_root); | 519 | remove_proc_entry("drivers", proc_ide_root); |
520 | remove_proc_entry("ide", NULL); | 520 | remove_proc_entry("ide", NULL); |
521 | } | 521 | } |
diff --git a/drivers/ieee1394/Kconfig b/drivers/ieee1394/Kconfig index 78b201fb5e8a..7d58af1ae306 100644 --- a/drivers/ieee1394/Kconfig +++ b/drivers/ieee1394/Kconfig | |||
@@ -84,11 +84,6 @@ config IEEE1394_PCILYNX | |||
84 | To compile this driver as a module, say M here: the | 84 | To compile this driver as a module, say M here: the |
85 | module will be called pcilynx. | 85 | module will be called pcilynx. |
86 | 86 | ||
87 | # Non-maintained pcilynx options | ||
88 | # if [ "$CONFIG_IEEE1394_PCILYNX" != "n" ]; then | ||
89 | # bool ' Use PCILynx local RAM' CONFIG_IEEE1394_PCILYNX_LOCALRAM | ||
90 | # bool ' Support for non-IEEE1394 local ports' CONFIG_IEEE1394_PCILYNX_PORTS | ||
91 | # fi | ||
92 | config IEEE1394_OHCI1394 | 87 | config IEEE1394_OHCI1394 |
93 | tristate "OHCI-1394 support" | 88 | tristate "OHCI-1394 support" |
94 | depends on PCI && IEEE1394 | 89 | depends on PCI && IEEE1394 |
diff --git a/drivers/ieee1394/ieee1394_core.c b/drivers/ieee1394/ieee1394_core.c index 1c5845f7e4ab..a294e45c77cd 100644 --- a/drivers/ieee1394/ieee1394_core.c +++ b/drivers/ieee1394/ieee1394_core.c | |||
@@ -520,7 +520,7 @@ int hpsb_send_packet(struct hpsb_packet *packet) | |||
520 | 520 | ||
521 | if (!packet->no_waiter || packet->expect_response) { | 521 | if (!packet->no_waiter || packet->expect_response) { |
522 | atomic_inc(&packet->refcnt); | 522 | atomic_inc(&packet->refcnt); |
523 | packet->sendtime = jiffies; | 523 | packet->sendtime = jiffies + 10 * HZ; |
524 | skb_queue_tail(&host->pending_packet_queue, packet->skb); | 524 | skb_queue_tail(&host->pending_packet_queue, packet->skb); |
525 | } | 525 | } |
526 | 526 | ||
@@ -1248,7 +1248,6 @@ EXPORT_SYMBOL(hpsb_make_phypacket); | |||
1248 | EXPORT_SYMBOL(hpsb_make_isopacket); | 1248 | EXPORT_SYMBOL(hpsb_make_isopacket); |
1249 | EXPORT_SYMBOL(hpsb_read); | 1249 | EXPORT_SYMBOL(hpsb_read); |
1250 | EXPORT_SYMBOL(hpsb_write); | 1250 | EXPORT_SYMBOL(hpsb_write); |
1251 | EXPORT_SYMBOL(hpsb_lock); | ||
1252 | EXPORT_SYMBOL(hpsb_packet_success); | 1251 | EXPORT_SYMBOL(hpsb_packet_success); |
1253 | 1252 | ||
1254 | /** highlevel.c **/ | 1253 | /** highlevel.c **/ |
diff --git a/drivers/ieee1394/ieee1394_transactions.c b/drivers/ieee1394/ieee1394_transactions.c index 09908b9564d8..0aa876360f9b 100644 --- a/drivers/ieee1394/ieee1394_transactions.c +++ b/drivers/ieee1394/ieee1394_transactions.c | |||
@@ -535,6 +535,7 @@ hpsb_write_fail: | |||
535 | return retval; | 535 | return retval; |
536 | } | 536 | } |
537 | 537 | ||
538 | #if 0 | ||
538 | 539 | ||
539 | int hpsb_lock(struct hpsb_host *host, nodeid_t node, unsigned int generation, | 540 | int hpsb_lock(struct hpsb_host *host, nodeid_t node, unsigned int generation, |
540 | u64 addr, int extcode, quadlet_t *data, quadlet_t arg) | 541 | u64 addr, int extcode, quadlet_t *data, quadlet_t arg) |
@@ -599,3 +600,5 @@ int hpsb_send_gasp(struct hpsb_host *host, int channel, unsigned int generation, | |||
599 | 600 | ||
600 | return retval; | 601 | return retval; |
601 | } | 602 | } |
603 | |||
604 | #endif /* 0 */ | ||
diff --git a/drivers/ieee1394/ieee1394_transactions.h b/drivers/ieee1394/ieee1394_transactions.h index 526a43ceb496..45ba784fe6da 100644 --- a/drivers/ieee1394/ieee1394_transactions.h +++ b/drivers/ieee1394/ieee1394_transactions.h | |||
@@ -53,12 +53,5 @@ int hpsb_read(struct hpsb_host *host, nodeid_t node, unsigned int generation, | |||
53 | u64 addr, quadlet_t *buffer, size_t length); | 53 | u64 addr, quadlet_t *buffer, size_t length); |
54 | int hpsb_write(struct hpsb_host *host, nodeid_t node, unsigned int generation, | 54 | int hpsb_write(struct hpsb_host *host, nodeid_t node, unsigned int generation, |
55 | u64 addr, quadlet_t *buffer, size_t length); | 55 | u64 addr, quadlet_t *buffer, size_t length); |
56 | int hpsb_lock(struct hpsb_host *host, nodeid_t node, unsigned int generation, | ||
57 | u64 addr, int extcode, quadlet_t *data, quadlet_t arg); | ||
58 | int hpsb_lock64(struct hpsb_host *host, nodeid_t node, unsigned int generation, | ||
59 | u64 addr, int extcode, octlet_t *data, octlet_t arg); | ||
60 | int hpsb_send_gasp(struct hpsb_host *host, int channel, unsigned int generation, | ||
61 | quadlet_t *buffer, size_t length, u32 specifier_id, | ||
62 | unsigned int version); | ||
63 | 56 | ||
64 | #endif /* _IEEE1394_TRANSACTIONS_H */ | 57 | #endif /* _IEEE1394_TRANSACTIONS_H */ |
diff --git a/drivers/ieee1394/nodemgr.c b/drivers/ieee1394/nodemgr.c index a1e30a66297b..83e66ed97ab5 100644 --- a/drivers/ieee1394/nodemgr.c +++ b/drivers/ieee1394/nodemgr.c | |||
@@ -1005,8 +1005,7 @@ static struct unit_directory *nodemgr_process_unit_directory | |||
1005 | return ud; | 1005 | return ud; |
1006 | 1006 | ||
1007 | unit_directory_error: | 1007 | unit_directory_error: |
1008 | if (ud != NULL) | 1008 | kfree(ud); |
1009 | kfree(ud); | ||
1010 | return NULL; | 1009 | return NULL; |
1011 | } | 1010 | } |
1012 | 1011 | ||
diff --git a/drivers/ieee1394/ohci1394.c b/drivers/ieee1394/ohci1394.c index 6cb0b586c297..36e25ac823dc 100644 --- a/drivers/ieee1394/ohci1394.c +++ b/drivers/ieee1394/ohci1394.c | |||
@@ -2931,7 +2931,7 @@ static void free_dma_rcv_ctx(struct dma_rcv_ctx *d) | |||
2931 | kfree(d->prg_cpu); | 2931 | kfree(d->prg_cpu); |
2932 | kfree(d->prg_bus); | 2932 | kfree(d->prg_bus); |
2933 | } | 2933 | } |
2934 | if (d->spb) kfree(d->spb); | 2934 | kfree(d->spb); |
2935 | 2935 | ||
2936 | /* Mark this context as freed. */ | 2936 | /* Mark this context as freed. */ |
2937 | d->ohci = NULL; | 2937 | d->ohci = NULL; |
diff --git a/drivers/ieee1394/ohci1394.h b/drivers/ieee1394/ohci1394.h index d1758d409610..cc66c1cae250 100644 --- a/drivers/ieee1394/ohci1394.h +++ b/drivers/ieee1394/ohci1394.h | |||
@@ -236,6 +236,9 @@ struct ti_ohci { | |||
236 | 236 | ||
237 | static inline int cross_bound(unsigned long addr, unsigned int size) | 237 | static inline int cross_bound(unsigned long addr, unsigned int size) |
238 | { | 238 | { |
239 | if (size == 0) | ||
240 | return 0; | ||
241 | |||
239 | if (size > PAGE_SIZE) | 242 | if (size > PAGE_SIZE) |
240 | return 1; | 243 | return 1; |
241 | 244 | ||
diff --git a/drivers/ieee1394/pcilynx.c b/drivers/ieee1394/pcilynx.c index a261d2b0e5ac..bdb3a85cafa6 100644 --- a/drivers/ieee1394/pcilynx.c +++ b/drivers/ieee1394/pcilynx.c | |||
@@ -43,6 +43,7 @@ | |||
43 | #include <linux/fs.h> | 43 | #include <linux/fs.h> |
44 | #include <linux/poll.h> | 44 | #include <linux/poll.h> |
45 | #include <linux/kdev_t.h> | 45 | #include <linux/kdev_t.h> |
46 | #include <linux/dma-mapping.h> | ||
46 | #include <asm/byteorder.h> | 47 | #include <asm/byteorder.h> |
47 | #include <asm/atomic.h> | 48 | #include <asm/atomic.h> |
48 | #include <asm/io.h> | 49 | #include <asm/io.h> |
@@ -834,327 +835,6 @@ static int lynx_devctl(struct hpsb_host *host, enum devctl_cmd cmd, int arg) | |||
834 | * IEEE-1394 functionality section END * | 835 | * IEEE-1394 functionality section END * |
835 | ***************************************/ | 836 | ***************************************/ |
836 | 837 | ||
837 | #ifdef CONFIG_IEEE1394_PCILYNX_PORTS | ||
838 | /* VFS functions for local bus / aux device access. Access to those | ||
839 | * is implemented as a character device instead of block devices | ||
840 | * because buffers are not wanted for this. Therefore llseek (from | ||
841 | * VFS) can be used for these char devices with obvious effects. | ||
842 | */ | ||
843 | static int mem_open(struct inode*, struct file*); | ||
844 | static int mem_release(struct inode*, struct file*); | ||
845 | static unsigned int aux_poll(struct file*, struct poll_table_struct*); | ||
846 | static loff_t mem_llseek(struct file*, loff_t, int); | ||
847 | static ssize_t mem_read (struct file*, char*, size_t, loff_t*); | ||
848 | static ssize_t mem_write(struct file*, const char*, size_t, loff_t*); | ||
849 | |||
850 | |||
851 | static struct file_operations aux_ops = { | ||
852 | .owner = THIS_MODULE, | ||
853 | .read = mem_read, | ||
854 | .write = mem_write, | ||
855 | .poll = aux_poll, | ||
856 | .llseek = mem_llseek, | ||
857 | .open = mem_open, | ||
858 | .release = mem_release, | ||
859 | }; | ||
860 | |||
861 | |||
862 | static void aux_setup_pcls(struct ti_lynx *lynx) | ||
863 | { | ||
864 | struct ti_pcl pcl; | ||
865 | |||
866 | pcl.next = PCL_NEXT_INVALID; | ||
867 | pcl.user_data = pcl_bus(lynx, lynx->dmem_pcl); | ||
868 | put_pcl(lynx, lynx->dmem_pcl, &pcl); | ||
869 | } | ||
870 | |||
871 | static int mem_open(struct inode *inode, struct file *file) | ||
872 | { | ||
873 | int cid = iminor(inode); | ||
874 | enum { t_rom, t_aux, t_ram } type; | ||
875 | struct memdata *md; | ||
876 | |||
877 | if (cid < PCILYNX_MINOR_AUX_START) { | ||
878 | /* just for completeness */ | ||
879 | return -ENXIO; | ||
880 | } else if (cid < PCILYNX_MINOR_ROM_START) { | ||
881 | cid -= PCILYNX_MINOR_AUX_START; | ||
882 | if (cid >= num_of_cards || !cards[cid].aux_port) | ||
883 | return -ENXIO; | ||
884 | type = t_aux; | ||
885 | } else if (cid < PCILYNX_MINOR_RAM_START) { | ||
886 | cid -= PCILYNX_MINOR_ROM_START; | ||
887 | if (cid >= num_of_cards || !cards[cid].local_rom) | ||
888 | return -ENXIO; | ||
889 | type = t_rom; | ||
890 | } else { | ||
891 | /* WARNING: Know what you are doing when opening RAM. | ||
892 | * It is currently used inside the driver! */ | ||
893 | cid -= PCILYNX_MINOR_RAM_START; | ||
894 | if (cid >= num_of_cards || !cards[cid].local_ram) | ||
895 | return -ENXIO; | ||
896 | type = t_ram; | ||
897 | } | ||
898 | |||
899 | md = (struct memdata *)kmalloc(sizeof(struct memdata), SLAB_KERNEL); | ||
900 | if (md == NULL) | ||
901 | return -ENOMEM; | ||
902 | |||
903 | md->lynx = &cards[cid]; | ||
904 | md->cid = cid; | ||
905 | |||
906 | switch (type) { | ||
907 | case t_rom: | ||
908 | md->type = rom; | ||
909 | break; | ||
910 | case t_ram: | ||
911 | md->type = ram; | ||
912 | break; | ||
913 | case t_aux: | ||
914 | atomic_set(&md->aux_intr_last_seen, | ||
915 | atomic_read(&cards[cid].aux_intr_seen)); | ||
916 | md->type = aux; | ||
917 | break; | ||
918 | } | ||
919 | |||
920 | file->private_data = md; | ||
921 | |||
922 | return 0; | ||
923 | } | ||
924 | |||
925 | static int mem_release(struct inode *inode, struct file *file) | ||
926 | { | ||
927 | kfree(file->private_data); | ||
928 | return 0; | ||
929 | } | ||
930 | |||
931 | static unsigned int aux_poll(struct file *file, poll_table *pt) | ||
932 | { | ||
933 | struct memdata *md = (struct memdata *)file->private_data; | ||
934 | int cid = md->cid; | ||
935 | unsigned int mask; | ||
936 | |||
937 | /* reading and writing is always allowed */ | ||
938 | mask = POLLIN | POLLRDNORM | POLLOUT | POLLWRNORM; | ||
939 | |||
940 | if (md->type == aux) { | ||
941 | poll_wait(file, &cards[cid].aux_intr_wait, pt); | ||
942 | |||
943 | if (atomic_read(&md->aux_intr_last_seen) | ||
944 | != atomic_read(&cards[cid].aux_intr_seen)) { | ||
945 | mask |= POLLPRI; | ||
946 | atomic_inc(&md->aux_intr_last_seen); | ||
947 | } | ||
948 | } | ||
949 | |||
950 | return mask; | ||
951 | } | ||
952 | |||
953 | loff_t mem_llseek(struct file *file, loff_t offs, int orig) | ||
954 | { | ||
955 | loff_t newoffs; | ||
956 | |||
957 | switch (orig) { | ||
958 | case 0: | ||
959 | newoffs = offs; | ||
960 | break; | ||
961 | case 1: | ||
962 | newoffs = offs + file->f_pos; | ||
963 | break; | ||
964 | case 2: | ||
965 | newoffs = PCILYNX_MAX_MEMORY + 1 + offs; | ||
966 | break; | ||
967 | default: | ||
968 | return -EINVAL; | ||
969 | } | ||
970 | |||
971 | if (newoffs < 0 || newoffs > PCILYNX_MAX_MEMORY + 1) return -EINVAL; | ||
972 | |||
973 | file->f_pos = newoffs; | ||
974 | return newoffs; | ||
975 | } | ||
976 | |||
977 | /* | ||
978 | * do not DMA if count is too small because this will have a serious impact | ||
979 | * on performance - the value 2400 was found by experiment and may not work | ||
980 | * everywhere as good as here - use mem_mindma option for modules to change | ||
981 | */ | ||
982 | static short mem_mindma = 2400; | ||
983 | module_param(mem_mindma, short, 0444); | ||
984 | MODULE_PARM_DESC(mem_mindma, "Minimum amount of data required to use DMA"); | ||
985 | |||
986 | static ssize_t mem_dmaread(struct memdata *md, u32 physbuf, ssize_t count, | ||
987 | int offset) | ||
988 | { | ||
989 | pcltmp_t pcltmp; | ||
990 | struct ti_pcl *pcl; | ||
991 | size_t retval; | ||
992 | int i; | ||
993 | DECLARE_WAITQUEUE(wait, current); | ||
994 | |||
995 | count &= ~3; | ||
996 | count = min(count, 53196); | ||
997 | retval = count; | ||
998 | |||
999 | if (reg_read(md->lynx, DMA_CHAN_CTRL(CHANNEL_LOCALBUS)) | ||
1000 | & DMA_CHAN_CTRL_BUSY) { | ||
1001 | PRINT(KERN_WARNING, md->lynx->id, "DMA ALREADY ACTIVE!"); | ||
1002 | } | ||
1003 | |||
1004 | reg_write(md->lynx, LBUS_ADDR, md->type | offset); | ||
1005 | |||
1006 | pcl = edit_pcl(md->lynx, md->lynx->dmem_pcl, &pcltmp); | ||
1007 | pcl->buffer[0].control = PCL_CMD_LBUS_TO_PCI | min(count, 4092); | ||
1008 | pcl->buffer[0].pointer = physbuf; | ||
1009 | count -= 4092; | ||
1010 | |||
1011 | i = 0; | ||
1012 | while (count > 0) { | ||
1013 | i++; | ||
1014 | pcl->buffer[i].control = min(count, 4092); | ||
1015 | pcl->buffer[i].pointer = physbuf + i * 4092; | ||
1016 | count -= 4092; | ||
1017 | } | ||
1018 | pcl->buffer[i].control |= PCL_LAST_BUFF; | ||
1019 | commit_pcl(md->lynx, md->lynx->dmem_pcl, &pcltmp); | ||
1020 | |||
1021 | set_current_state(TASK_INTERRUPTIBLE); | ||
1022 | add_wait_queue(&md->lynx->mem_dma_intr_wait, &wait); | ||
1023 | run_sub_pcl(md->lynx, md->lynx->dmem_pcl, 2, CHANNEL_LOCALBUS); | ||
1024 | |||
1025 | schedule(); | ||
1026 | while (reg_read(md->lynx, DMA_CHAN_CTRL(CHANNEL_LOCALBUS)) | ||
1027 | & DMA_CHAN_CTRL_BUSY) { | ||
1028 | if (signal_pending(current)) { | ||
1029 | retval = -EINTR; | ||
1030 | break; | ||
1031 | } | ||
1032 | schedule(); | ||
1033 | } | ||
1034 | |||
1035 | reg_write(md->lynx, DMA_CHAN_CTRL(CHANNEL_LOCALBUS), 0); | ||
1036 | remove_wait_queue(&md->lynx->mem_dma_intr_wait, &wait); | ||
1037 | |||
1038 | if (reg_read(md->lynx, DMA_CHAN_CTRL(CHANNEL_LOCALBUS)) | ||
1039 | & DMA_CHAN_CTRL_BUSY) { | ||
1040 | PRINT(KERN_ERR, md->lynx->id, "DMA STILL ACTIVE!"); | ||
1041 | } | ||
1042 | |||
1043 | return retval; | ||
1044 | } | ||
1045 | |||
1046 | static ssize_t mem_read(struct file *file, char *buffer, size_t count, | ||
1047 | loff_t *offset) | ||
1048 | { | ||
1049 | struct memdata *md = (struct memdata *)file->private_data; | ||
1050 | ssize_t bcount; | ||
1051 | size_t alignfix; | ||
1052 | loff_t off = *offset; /* avoid useless 64bit-arithmetic */ | ||
1053 | ssize_t retval; | ||
1054 | void *membase; | ||
1055 | |||
1056 | if ((off + count) > PCILYNX_MAX_MEMORY+1) { | ||
1057 | count = PCILYNX_MAX_MEMORY+1 - off; | ||
1058 | } | ||
1059 | if (count == 0 || off > PCILYNX_MAX_MEMORY) { | ||
1060 | return -ENOSPC; | ||
1061 | } | ||
1062 | |||
1063 | switch (md->type) { | ||
1064 | case rom: | ||
1065 | membase = md->lynx->local_rom; | ||
1066 | break; | ||
1067 | case ram: | ||
1068 | membase = md->lynx->local_ram; | ||
1069 | break; | ||
1070 | case aux: | ||
1071 | membase = md->lynx->aux_port; | ||
1072 | break; | ||
1073 | default: | ||
1074 | panic("pcilynx%d: unsupported md->type %d in %s", | ||
1075 | md->lynx->id, md->type, __FUNCTION__); | ||
1076 | } | ||
1077 | |||
1078 | down(&md->lynx->mem_dma_mutex); | ||
1079 | |||
1080 | if (count < mem_mindma) { | ||
1081 | memcpy_fromio(md->lynx->mem_dma_buffer, membase+off, count); | ||
1082 | goto out; | ||
1083 | } | ||
1084 | |||
1085 | bcount = count; | ||
1086 | alignfix = 4 - (off % 4); | ||
1087 | if (alignfix != 4) { | ||
1088 | if (bcount < alignfix) { | ||
1089 | alignfix = bcount; | ||
1090 | } | ||
1091 | memcpy_fromio(md->lynx->mem_dma_buffer, membase+off, | ||
1092 | alignfix); | ||
1093 | if (bcount == alignfix) { | ||
1094 | goto out; | ||
1095 | } | ||
1096 | bcount -= alignfix; | ||
1097 | off += alignfix; | ||
1098 | } | ||
1099 | |||
1100 | while (bcount >= 4) { | ||
1101 | retval = mem_dmaread(md, md->lynx->mem_dma_buffer_dma | ||
1102 | + count - bcount, bcount, off); | ||
1103 | if (retval < 0) return retval; | ||
1104 | |||
1105 | bcount -= retval; | ||
1106 | off += retval; | ||
1107 | } | ||
1108 | |||
1109 | if (bcount) { | ||
1110 | memcpy_fromio(md->lynx->mem_dma_buffer + count - bcount, | ||
1111 | membase+off, bcount); | ||
1112 | } | ||
1113 | |||
1114 | out: | ||
1115 | retval = copy_to_user(buffer, md->lynx->mem_dma_buffer, count); | ||
1116 | up(&md->lynx->mem_dma_mutex); | ||
1117 | |||
1118 | if (retval) return -EFAULT; | ||
1119 | *offset += count; | ||
1120 | return count; | ||
1121 | } | ||
1122 | |||
1123 | |||
1124 | static ssize_t mem_write(struct file *file, const char *buffer, size_t count, | ||
1125 | loff_t *offset) | ||
1126 | { | ||
1127 | struct memdata *md = (struct memdata *)file->private_data; | ||
1128 | |||
1129 | if (((*offset) + count) > PCILYNX_MAX_MEMORY+1) { | ||
1130 | count = PCILYNX_MAX_MEMORY+1 - *offset; | ||
1131 | } | ||
1132 | if (count == 0 || *offset > PCILYNX_MAX_MEMORY) { | ||
1133 | return -ENOSPC; | ||
1134 | } | ||
1135 | |||
1136 | /* FIXME: dereferencing pointers to PCI mem doesn't work everywhere */ | ||
1137 | switch (md->type) { | ||
1138 | case aux: | ||
1139 | if (copy_from_user(md->lynx->aux_port+(*offset), buffer, count)) | ||
1140 | return -EFAULT; | ||
1141 | break; | ||
1142 | case ram: | ||
1143 | if (copy_from_user(md->lynx->local_ram+(*offset), buffer, count)) | ||
1144 | return -EFAULT; | ||
1145 | break; | ||
1146 | case rom: | ||
1147 | /* the ROM may be writeable */ | ||
1148 | if (copy_from_user(md->lynx->local_rom+(*offset), buffer, count)) | ||
1149 | return -EFAULT; | ||
1150 | break; | ||
1151 | } | ||
1152 | |||
1153 | file->f_pos += count; | ||
1154 | return count; | ||
1155 | } | ||
1156 | #endif /* CONFIG_IEEE1394_PCILYNX_PORTS */ | ||
1157 | |||
1158 | 838 | ||
1159 | /******************************************************** | 839 | /******************************************************** |
1160 | * Global stuff (interrupt handler, init/shutdown code) * | 840 | * Global stuff (interrupt handler, init/shutdown code) * |
@@ -1181,18 +861,6 @@ static irqreturn_t lynx_irq_handler(int irq, void *dev_id, | |||
1181 | reg_write(lynx, LINK_INT_STATUS, linkint); | 861 | reg_write(lynx, LINK_INT_STATUS, linkint); |
1182 | reg_write(lynx, PCI_INT_STATUS, intmask); | 862 | reg_write(lynx, PCI_INT_STATUS, intmask); |
1183 | 863 | ||
1184 | #ifdef CONFIG_IEEE1394_PCILYNX_PORTS | ||
1185 | if (intmask & PCI_INT_AUX_INT) { | ||
1186 | atomic_inc(&lynx->aux_intr_seen); | ||
1187 | wake_up_interruptible(&lynx->aux_intr_wait); | ||
1188 | } | ||
1189 | |||
1190 | if (intmask & PCI_INT_DMA_HLT(CHANNEL_LOCALBUS)) { | ||
1191 | wake_up_interruptible(&lynx->mem_dma_intr_wait); | ||
1192 | } | ||
1193 | #endif | ||
1194 | |||
1195 | |||
1196 | if (intmask & PCI_INT_1394) { | 864 | if (intmask & PCI_INT_1394) { |
1197 | if (linkint & LINK_INT_PHY_TIMEOUT) { | 865 | if (linkint & LINK_INT_PHY_TIMEOUT) { |
1198 | PRINT(KERN_INFO, lynx->id, "PHY timeout occurred"); | 866 | PRINT(KERN_INFO, lynx->id, "PHY timeout occurred"); |
@@ -1484,15 +1152,9 @@ static void remove_card(struct pci_dev *dev) | |||
1484 | pci_free_consistent(lynx->dev, PAGE_SIZE, lynx->rcv_page, | 1152 | pci_free_consistent(lynx->dev, PAGE_SIZE, lynx->rcv_page, |
1485 | lynx->rcv_page_dma); | 1153 | lynx->rcv_page_dma); |
1486 | case have_aux_buf: | 1154 | case have_aux_buf: |
1487 | #ifdef CONFIG_IEEE1394_PCILYNX_PORTS | ||
1488 | pci_free_consistent(lynx->dev, 65536, lynx->mem_dma_buffer, | ||
1489 | lynx->mem_dma_buffer_dma); | ||
1490 | #endif | ||
1491 | case have_pcl_mem: | 1155 | case have_pcl_mem: |
1492 | #ifndef CONFIG_IEEE1394_PCILYNX_LOCALRAM | ||
1493 | pci_free_consistent(lynx->dev, LOCALRAM_SIZE, lynx->pcl_mem, | 1156 | pci_free_consistent(lynx->dev, LOCALRAM_SIZE, lynx->pcl_mem, |
1494 | lynx->pcl_mem_dma); | 1157 | lynx->pcl_mem_dma); |
1495 | #endif | ||
1496 | case clear: | 1158 | case clear: |
1497 | /* do nothing - already freed */ | 1159 | /* do nothing - already freed */ |
1498 | ; | 1160 | ; |
@@ -1524,7 +1186,7 @@ static int __devinit add_card(struct pci_dev *dev, | |||
1524 | 1186 | ||
1525 | error = -ENXIO; | 1187 | error = -ENXIO; |
1526 | 1188 | ||
1527 | if (pci_set_dma_mask(dev, 0xffffffff)) | 1189 | if (pci_set_dma_mask(dev, DMA_32BIT_MASK)) |
1528 | FAIL("DMA address limits not supported for PCILynx hardware"); | 1190 | FAIL("DMA address limits not supported for PCILynx hardware"); |
1529 | if (pci_enable_device(dev)) | 1191 | if (pci_enable_device(dev)) |
1530 | FAIL("failed to enable PCILynx hardware"); | 1192 | FAIL("failed to enable PCILynx hardware"); |
@@ -1546,7 +1208,6 @@ static int __devinit add_card(struct pci_dev *dev, | |||
1546 | spin_lock_init(&lynx->lock); | 1208 | spin_lock_init(&lynx->lock); |
1547 | spin_lock_init(&lynx->phy_reg_lock); | 1209 | spin_lock_init(&lynx->phy_reg_lock); |
1548 | 1210 | ||
1549 | #ifndef CONFIG_IEEE1394_PCILYNX_LOCALRAM | ||
1550 | lynx->pcl_mem = pci_alloc_consistent(dev, LOCALRAM_SIZE, | 1211 | lynx->pcl_mem = pci_alloc_consistent(dev, LOCALRAM_SIZE, |
1551 | &lynx->pcl_mem_dma); | 1212 | &lynx->pcl_mem_dma); |
1552 | 1213 | ||
@@ -1558,16 +1219,6 @@ static int __devinit add_card(struct pci_dev *dev, | |||
1558 | } else { | 1219 | } else { |
1559 | FAIL("failed to allocate PCL memory area"); | 1220 | FAIL("failed to allocate PCL memory area"); |
1560 | } | 1221 | } |
1561 | #endif | ||
1562 | |||
1563 | #ifdef CONFIG_IEEE1394_PCILYNX_PORTS | ||
1564 | lynx->mem_dma_buffer = pci_alloc_consistent(dev, 65536, | ||
1565 | &lynx->mem_dma_buffer_dma); | ||
1566 | if (lynx->mem_dma_buffer == NULL) { | ||
1567 | FAIL("failed to allocate DMA buffer for aux"); | ||
1568 | } | ||
1569 | lynx->state = have_aux_buf; | ||
1570 | #endif | ||
1571 | 1222 | ||
1572 | lynx->rcv_page = pci_alloc_consistent(dev, PAGE_SIZE, | 1223 | lynx->rcv_page = pci_alloc_consistent(dev, PAGE_SIZE, |
1573 | &lynx->rcv_page_dma); | 1224 | &lynx->rcv_page_dma); |
@@ -1597,13 +1248,6 @@ static int __devinit add_card(struct pci_dev *dev, | |||
1597 | FAIL("failed to remap registers - card not accessible"); | 1248 | FAIL("failed to remap registers - card not accessible"); |
1598 | } | 1249 | } |
1599 | 1250 | ||
1600 | #ifdef CONFIG_IEEE1394_PCILYNX_LOCALRAM | ||
1601 | if (lynx->local_ram == NULL) { | ||
1602 | FAIL("failed to remap local RAM which is required for " | ||
1603 | "operation"); | ||
1604 | } | ||
1605 | #endif | ||
1606 | |||
1607 | reg_set_bits(lynx, MISC_CONTROL, MISC_CONTROL_SWRESET); | 1251 | reg_set_bits(lynx, MISC_CONTROL, MISC_CONTROL_SWRESET); |
1608 | /* Fix buggy cards with autoboot pin not tied low: */ | 1252 | /* Fix buggy cards with autoboot pin not tied low: */ |
1609 | reg_write(lynx, DMA0_CHAN_CTRL, 0); | 1253 | reg_write(lynx, DMA0_CHAN_CTRL, 0); |
@@ -1624,13 +1268,6 @@ static int __devinit add_card(struct pci_dev *dev, | |||
1624 | 1268 | ||
1625 | /* alloc_pcl return values are not checked, it is expected that the | 1269 | /* alloc_pcl return values are not checked, it is expected that the |
1626 | * provided PCL space is sufficient for the initial allocations */ | 1270 | * provided PCL space is sufficient for the initial allocations */ |
1627 | #ifdef CONFIG_IEEE1394_PCILYNX_PORTS | ||
1628 | if (lynx->aux_port != NULL) { | ||
1629 | lynx->dmem_pcl = alloc_pcl(lynx); | ||
1630 | aux_setup_pcls(lynx); | ||
1631 | sema_init(&lynx->mem_dma_mutex, 1); | ||
1632 | } | ||
1633 | #endif | ||
1634 | lynx->rcv_pcl = alloc_pcl(lynx); | 1271 | lynx->rcv_pcl = alloc_pcl(lynx); |
1635 | lynx->rcv_pcl_start = alloc_pcl(lynx); | 1272 | lynx->rcv_pcl_start = alloc_pcl(lynx); |
1636 | lynx->async.pcl = alloc_pcl(lynx); | 1273 | lynx->async.pcl = alloc_pcl(lynx); |
@@ -1647,12 +1284,6 @@ static int __devinit add_card(struct pci_dev *dev, | |||
1647 | 1284 | ||
1648 | reg_write(lynx, PCI_INT_ENABLE, PCI_INT_DMA_ALL); | 1285 | reg_write(lynx, PCI_INT_ENABLE, PCI_INT_DMA_ALL); |
1649 | 1286 | ||
1650 | #ifdef CONFIG_IEEE1394_PCILYNX_PORTS | ||
1651 | reg_set_bits(lynx, PCI_INT_ENABLE, PCI_INT_AUX_INT); | ||
1652 | init_waitqueue_head(&lynx->mem_dma_intr_wait); | ||
1653 | init_waitqueue_head(&lynx->aux_intr_wait); | ||
1654 | #endif | ||
1655 | |||
1656 | tasklet_init(&lynx->iso_rcv.tq, (void (*)(unsigned long))iso_rcv_bh, | 1287 | tasklet_init(&lynx->iso_rcv.tq, (void (*)(unsigned long))iso_rcv_bh, |
1657 | (unsigned long)lynx); | 1288 | (unsigned long)lynx); |
1658 | 1289 | ||
@@ -1944,37 +1575,18 @@ static int __init pcilynx_init(void) | |||
1944 | { | 1575 | { |
1945 | int ret; | 1576 | int ret; |
1946 | 1577 | ||
1947 | #ifdef CONFIG_IEEE1394_PCILYNX_PORTS | ||
1948 | if (register_chrdev(PCILYNX_MAJOR, PCILYNX_DRIVER_NAME, &aux_ops)) { | ||
1949 | PRINT_G(KERN_ERR, "allocation of char major number %d failed", | ||
1950 | PCILYNX_MAJOR); | ||
1951 | return -EBUSY; | ||
1952 | } | ||
1953 | #endif | ||
1954 | |||
1955 | ret = pci_register_driver(&lynx_pci_driver); | 1578 | ret = pci_register_driver(&lynx_pci_driver); |
1956 | if (ret < 0) { | 1579 | if (ret < 0) { |
1957 | PRINT_G(KERN_ERR, "PCI module init failed"); | 1580 | PRINT_G(KERN_ERR, "PCI module init failed"); |
1958 | goto free_char_dev; | 1581 | return ret; |
1959 | } | 1582 | } |
1960 | 1583 | ||
1961 | return 0; | 1584 | return 0; |
1962 | |||
1963 | free_char_dev: | ||
1964 | #ifdef CONFIG_IEEE1394_PCILYNX_PORTS | ||
1965 | unregister_chrdev(PCILYNX_MAJOR, PCILYNX_DRIVER_NAME); | ||
1966 | #endif | ||
1967 | |||
1968 | return ret; | ||
1969 | } | 1585 | } |
1970 | 1586 | ||
1971 | static void __exit pcilynx_cleanup(void) | 1587 | static void __exit pcilynx_cleanup(void) |
1972 | { | 1588 | { |
1973 | pci_unregister_driver(&lynx_pci_driver); | 1589 | pci_unregister_driver(&lynx_pci_driver); |
1974 | |||
1975 | #ifdef CONFIG_IEEE1394_PCILYNX_PORTS | ||
1976 | unregister_chrdev(PCILYNX_MAJOR, PCILYNX_DRIVER_NAME); | ||
1977 | #endif | ||
1978 | } | 1590 | } |
1979 | 1591 | ||
1980 | 1592 | ||
diff --git a/drivers/ieee1394/pcilynx.h b/drivers/ieee1394/pcilynx.h index 644ec55d3d46..d631aa8383ad 100644 --- a/drivers/ieee1394/pcilynx.h +++ b/drivers/ieee1394/pcilynx.h | |||
@@ -55,16 +55,6 @@ struct ti_lynx { | |||
55 | void __iomem *aux_port; | 55 | void __iomem *aux_port; |
56 | quadlet_t bus_info_block[5]; | 56 | quadlet_t bus_info_block[5]; |
57 | 57 | ||
58 | #ifdef CONFIG_IEEE1394_PCILYNX_PORTS | ||
59 | atomic_t aux_intr_seen; | ||
60 | wait_queue_head_t aux_intr_wait; | ||
61 | |||
62 | void *mem_dma_buffer; | ||
63 | dma_addr_t mem_dma_buffer_dma; | ||
64 | struct semaphore mem_dma_mutex; | ||
65 | wait_queue_head_t mem_dma_intr_wait; | ||
66 | #endif | ||
67 | |||
68 | /* | 58 | /* |
69 | * use local RAM of LOCALRAM_SIZE bytes for PCLs, which allows for | 59 | * use local RAM of LOCALRAM_SIZE bytes for PCLs, which allows for |
70 | * LOCALRAM_SIZE * 8 PCLs (each sized 128 bytes); | 60 | * LOCALRAM_SIZE * 8 PCLs (each sized 128 bytes); |
@@ -72,11 +62,9 @@ struct ti_lynx { | |||
72 | */ | 62 | */ |
73 | u8 pcl_bmap[LOCALRAM_SIZE / 1024]; | 63 | u8 pcl_bmap[LOCALRAM_SIZE / 1024]; |
74 | 64 | ||
75 | #ifndef CONFIG_IEEE1394_PCILYNX_LOCALRAM | ||
76 | /* point to PCLs memory area if needed */ | 65 | /* point to PCLs memory area if needed */ |
77 | void *pcl_mem; | 66 | void *pcl_mem; |
78 | dma_addr_t pcl_mem_dma; | 67 | dma_addr_t pcl_mem_dma; |
79 | #endif | ||
80 | 68 | ||
81 | /* PCLs for local mem / aux transfers */ | 69 | /* PCLs for local mem / aux transfers */ |
82 | pcl_t dmem_pcl; | 70 | pcl_t dmem_pcl; |
@@ -378,39 +366,6 @@ struct ti_pcl { | |||
378 | #define pcloffs(MEMBER) (offsetof(struct ti_pcl, MEMBER)) | 366 | #define pcloffs(MEMBER) (offsetof(struct ti_pcl, MEMBER)) |
379 | 367 | ||
380 | 368 | ||
381 | #ifdef CONFIG_IEEE1394_PCILYNX_LOCALRAM | ||
382 | |||
383 | static inline void put_pcl(const struct ti_lynx *lynx, pcl_t pclid, | ||
384 | const struct ti_pcl *pcl) | ||
385 | { | ||
386 | int i; | ||
387 | u32 *in = (u32 *)pcl; | ||
388 | u32 *out = (u32 *)(lynx->local_ram + pclid * sizeof(struct ti_pcl)); | ||
389 | |||
390 | for (i = 0; i < 32; i++, out++, in++) { | ||
391 | writel(*in, out); | ||
392 | } | ||
393 | } | ||
394 | |||
395 | static inline void get_pcl(const struct ti_lynx *lynx, pcl_t pclid, | ||
396 | struct ti_pcl *pcl) | ||
397 | { | ||
398 | int i; | ||
399 | u32 *out = (u32 *)pcl; | ||
400 | u32 *in = (u32 *)(lynx->local_ram + pclid * sizeof(struct ti_pcl)); | ||
401 | |||
402 | for (i = 0; i < 32; i++, out++, in++) { | ||
403 | *out = readl(in); | ||
404 | } | ||
405 | } | ||
406 | |||
407 | static inline u32 pcl_bus(const struct ti_lynx *lynx, pcl_t pclid) | ||
408 | { | ||
409 | return pci_resource_start(lynx->dev, 1) + pclid * sizeof(struct ti_pcl); | ||
410 | } | ||
411 | |||
412 | #else /* CONFIG_IEEE1394_PCILYNX_LOCALRAM */ | ||
413 | |||
414 | static inline void put_pcl(const struct ti_lynx *lynx, pcl_t pclid, | 369 | static inline void put_pcl(const struct ti_lynx *lynx, pcl_t pclid, |
415 | const struct ti_pcl *pcl) | 370 | const struct ti_pcl *pcl) |
416 | { | 371 | { |
@@ -431,10 +386,8 @@ static inline u32 pcl_bus(const struct ti_lynx *lynx, pcl_t pclid) | |||
431 | return lynx->pcl_mem_dma + pclid * sizeof(struct ti_pcl); | 386 | return lynx->pcl_mem_dma + pclid * sizeof(struct ti_pcl); |
432 | } | 387 | } |
433 | 388 | ||
434 | #endif /* CONFIG_IEEE1394_PCILYNX_LOCALRAM */ | ||
435 | |||
436 | 389 | ||
437 | #if defined (CONFIG_IEEE1394_PCILYNX_LOCALRAM) || defined (__BIG_ENDIAN) | 390 | #if defined (__BIG_ENDIAN) |
438 | typedef struct ti_pcl pcltmp_t; | 391 | typedef struct ti_pcl pcltmp_t; |
439 | 392 | ||
440 | static inline struct ti_pcl *edit_pcl(const struct ti_lynx *lynx, pcl_t pclid, | 393 | static inline struct ti_pcl *edit_pcl(const struct ti_lynx *lynx, pcl_t pclid, |
diff --git a/drivers/ieee1394/video1394.c b/drivers/ieee1394/video1394.c index 4bedf7113f40..d68c4658f2fc 100644 --- a/drivers/ieee1394/video1394.c +++ b/drivers/ieee1394/video1394.c | |||
@@ -35,6 +35,11 @@ | |||
35 | * | 35 | * |
36 | */ | 36 | */ |
37 | 37 | ||
38 | /* Markus Tavenrath <speedygoo@speedygoo.de> : | ||
39 | - fixed checks for valid buffer-numbers in video1394_icotl | ||
40 | - changed the ways the dma prg's are used, now it's possible to use | ||
41 | even a single dma buffer | ||
42 | */ | ||
38 | #include <linux/config.h> | 43 | #include <linux/config.h> |
39 | #include <linux/kernel.h> | 44 | #include <linux/kernel.h> |
40 | #include <linux/list.h> | 45 | #include <linux/list.h> |
@@ -112,6 +117,7 @@ struct dma_iso_ctx { | |||
112 | struct it_dma_prg **it_prg; | 117 | struct it_dma_prg **it_prg; |
113 | 118 | ||
114 | unsigned int *buffer_status; | 119 | unsigned int *buffer_status; |
120 | unsigned int *buffer_prg_assignment; | ||
115 | struct timeval *buffer_time; /* time when the buffer was received */ | 121 | struct timeval *buffer_time; /* time when the buffer was received */ |
116 | unsigned int *last_used_cmd; /* For ISO Transmit with | 122 | unsigned int *last_used_cmd; /* For ISO Transmit with |
117 | variable sized packets only ! */ | 123 | variable sized packets only ! */ |
@@ -180,23 +186,14 @@ static int free_dma_iso_ctx(struct dma_iso_ctx *d) | |||
180 | kfree(d->prg_reg); | 186 | kfree(d->prg_reg); |
181 | } | 187 | } |
182 | 188 | ||
183 | if (d->ir_prg) | 189 | kfree(d->ir_prg); |
184 | kfree(d->ir_prg); | 190 | kfree(d->it_prg); |
185 | 191 | kfree(d->buffer_status); | |
186 | if (d->it_prg) | 192 | kfree(d->buffer_prg_assignment); |
187 | kfree(d->it_prg); | 193 | kfree(d->buffer_time); |
188 | 194 | kfree(d->last_used_cmd); | |
189 | if (d->buffer_status) | 195 | kfree(d->next_buffer); |
190 | kfree(d->buffer_status); | ||
191 | if (d->buffer_time) | ||
192 | kfree(d->buffer_time); | ||
193 | if (d->last_used_cmd) | ||
194 | kfree(d->last_used_cmd); | ||
195 | if (d->next_buffer) | ||
196 | kfree(d->next_buffer); | ||
197 | |||
198 | list_del(&d->link); | 196 | list_del(&d->link); |
199 | |||
200 | kfree(d); | 197 | kfree(d); |
201 | 198 | ||
202 | return 0; | 199 | return 0; |
@@ -230,7 +227,7 @@ alloc_dma_iso_ctx(struct ti_ohci *ohci, int type, int num_desc, | |||
230 | /* Init the regions for easy cleanup */ | 227 | /* Init the regions for easy cleanup */ |
231 | dma_region_init(&d->dma); | 228 | dma_region_init(&d->dma); |
232 | 229 | ||
233 | if (dma_region_alloc(&d->dma, d->num_desc * d->buf_size, ohci->dev, | 230 | if (dma_region_alloc(&d->dma, (d->num_desc - 1) * d->buf_size, ohci->dev, |
234 | PCI_DMA_BIDIRECTIONAL)) { | 231 | PCI_DMA_BIDIRECTIONAL)) { |
235 | PRINT(KERN_ERR, ohci->host->id, "Failed to allocate dma buffer"); | 232 | PRINT(KERN_ERR, ohci->host->id, "Failed to allocate dma buffer"); |
236 | free_dma_iso_ctx(d); | 233 | free_dma_iso_ctx(d); |
@@ -342,6 +339,8 @@ alloc_dma_iso_ctx(struct ti_ohci *ohci, int type, int num_desc, | |||
342 | 339 | ||
343 | d->buffer_status = kmalloc(d->num_desc * sizeof(unsigned int), | 340 | d->buffer_status = kmalloc(d->num_desc * sizeof(unsigned int), |
344 | GFP_KERNEL); | 341 | GFP_KERNEL); |
342 | d->buffer_prg_assignment = kmalloc(d->num_desc * sizeof(unsigned int), | ||
343 | GFP_KERNEL); | ||
345 | d->buffer_time = kmalloc(d->num_desc * sizeof(struct timeval), | 344 | d->buffer_time = kmalloc(d->num_desc * sizeof(struct timeval), |
346 | GFP_KERNEL); | 345 | GFP_KERNEL); |
347 | d->last_used_cmd = kmalloc(d->num_desc * sizeof(unsigned int), | 346 | d->last_used_cmd = kmalloc(d->num_desc * sizeof(unsigned int), |
@@ -354,6 +353,11 @@ alloc_dma_iso_ctx(struct ti_ohci *ohci, int type, int num_desc, | |||
354 | free_dma_iso_ctx(d); | 353 | free_dma_iso_ctx(d); |
355 | return NULL; | 354 | return NULL; |
356 | } | 355 | } |
356 | if (d->buffer_prg_assignment == NULL) { | ||
357 | PRINT(KERN_ERR, ohci->host->id, "Failed to allocate buffer_prg_assignment"); | ||
358 | free_dma_iso_ctx(d); | ||
359 | return NULL; | ||
360 | } | ||
357 | if (d->buffer_time == NULL) { | 361 | if (d->buffer_time == NULL) { |
358 | PRINT(KERN_ERR, ohci->host->id, "Failed to allocate buffer_time"); | 362 | PRINT(KERN_ERR, ohci->host->id, "Failed to allocate buffer_time"); |
359 | free_dma_iso_ctx(d); | 363 | free_dma_iso_ctx(d); |
@@ -370,6 +374,7 @@ alloc_dma_iso_ctx(struct ti_ohci *ohci, int type, int num_desc, | |||
370 | return NULL; | 374 | return NULL; |
371 | } | 375 | } |
372 | memset(d->buffer_status, 0, d->num_desc * sizeof(unsigned int)); | 376 | memset(d->buffer_status, 0, d->num_desc * sizeof(unsigned int)); |
377 | memset(d->buffer_prg_assignment, 0, d->num_desc * sizeof(unsigned int)); | ||
373 | memset(d->buffer_time, 0, d->num_desc * sizeof(struct timeval)); | 378 | memset(d->buffer_time, 0, d->num_desc * sizeof(struct timeval)); |
374 | memset(d->last_used_cmd, 0, d->num_desc * sizeof(unsigned int)); | 379 | memset(d->last_used_cmd, 0, d->num_desc * sizeof(unsigned int)); |
375 | memset(d->next_buffer, -1, d->num_desc * sizeof(int)); | 380 | memset(d->next_buffer, -1, d->num_desc * sizeof(int)); |
@@ -379,7 +384,7 @@ alloc_dma_iso_ctx(struct ti_ohci *ohci, int type, int num_desc, | |||
379 | PRINT(KERN_INFO, ohci->host->id, "Iso %s DMA: %d buffers " | 384 | PRINT(KERN_INFO, ohci->host->id, "Iso %s DMA: %d buffers " |
380 | "of size %d allocated for a frame size %d, each with %d prgs", | 385 | "of size %d allocated for a frame size %d, each with %d prgs", |
381 | (type == OHCI_ISO_RECEIVE) ? "receive" : "transmit", | 386 | (type == OHCI_ISO_RECEIVE) ? "receive" : "transmit", |
382 | d->num_desc, d->buf_size, d->frame_size, d->nb_cmd); | 387 | d->num_desc - 1, d->buf_size, d->frame_size, d->nb_cmd); |
383 | 388 | ||
384 | return d; | 389 | return d; |
385 | } | 390 | } |
@@ -394,11 +399,36 @@ static void reset_ir_status(struct dma_iso_ctx *d, int n) | |||
394 | d->ir_prg[n][i].status = cpu_to_le32(d->left_size); | 399 | d->ir_prg[n][i].status = cpu_to_le32(d->left_size); |
395 | } | 400 | } |
396 | 401 | ||
402 | static void reprogram_dma_ir_prg(struct dma_iso_ctx *d, int n, int buffer, int flags) | ||
403 | { | ||
404 | struct dma_cmd *ir_prg = d->ir_prg[n]; | ||
405 | unsigned long buf = (unsigned long)d->dma.kvirt + buffer * d->buf_size; | ||
406 | int i; | ||
407 | |||
408 | d->buffer_prg_assignment[n] = buffer; | ||
409 | |||
410 | ir_prg[0].address = cpu_to_le32(dma_region_offset_to_bus(&d->dma, buf - | ||
411 | (unsigned long)d->dma.kvirt)); | ||
412 | ir_prg[1].address = cpu_to_le32(dma_region_offset_to_bus(&d->dma, | ||
413 | (buf + 4) - (unsigned long)d->dma.kvirt)); | ||
414 | |||
415 | for (i=2;i<d->nb_cmd-1;i++) { | ||
416 | ir_prg[i].address = cpu_to_le32(dma_region_offset_to_bus(&d->dma, | ||
417 | (buf+(i-1)*PAGE_SIZE) - | ||
418 | (unsigned long)d->dma.kvirt)); | ||
419 | } | ||
420 | |||
421 | ir_prg[i].control = cpu_to_le32(DMA_CTL_INPUT_MORE | DMA_CTL_UPDATE | | ||
422 | DMA_CTL_IRQ | DMA_CTL_BRANCH | d->left_size); | ||
423 | ir_prg[i].address = cpu_to_le32(dma_region_offset_to_bus(&d->dma, | ||
424 | (buf+(i-1)*PAGE_SIZE) - (unsigned long)d->dma.kvirt)); | ||
425 | } | ||
426 | |||
397 | static void initialize_dma_ir_prg(struct dma_iso_ctx *d, int n, int flags) | 427 | static void initialize_dma_ir_prg(struct dma_iso_ctx *d, int n, int flags) |
398 | { | 428 | { |
399 | struct dma_cmd *ir_prg = d->ir_prg[n]; | 429 | struct dma_cmd *ir_prg = d->ir_prg[n]; |
400 | struct dma_prog_region *ir_reg = &d->prg_reg[n]; | 430 | struct dma_prog_region *ir_reg = &d->prg_reg[n]; |
401 | unsigned long buf = (unsigned long)d->dma.kvirt + n * d->buf_size; | 431 | unsigned long buf = (unsigned long)d->dma.kvirt; |
402 | int i; | 432 | int i; |
403 | 433 | ||
404 | /* the first descriptor will read only 4 bytes */ | 434 | /* the first descriptor will read only 4 bytes */ |
@@ -508,7 +538,7 @@ static void wakeup_dma_ir_ctx(unsigned long l) | |||
508 | for (i = 0; i < d->num_desc; i++) { | 538 | for (i = 0; i < d->num_desc; i++) { |
509 | if (d->ir_prg[i][d->nb_cmd-1].status & cpu_to_le32(0xFFFF0000)) { | 539 | if (d->ir_prg[i][d->nb_cmd-1].status & cpu_to_le32(0xFFFF0000)) { |
510 | reset_ir_status(d, i); | 540 | reset_ir_status(d, i); |
511 | d->buffer_status[i] = VIDEO1394_BUFFER_READY; | 541 | d->buffer_status[d->buffer_prg_assignment[i]] = VIDEO1394_BUFFER_READY; |
512 | do_gettimeofday(&d->buffer_time[i]); | 542 | do_gettimeofday(&d->buffer_time[i]); |
513 | } | 543 | } |
514 | } | 544 | } |
@@ -585,7 +615,7 @@ static void wakeup_dma_it_ctx(unsigned long l) | |||
585 | int next = d->next_buffer[i]; | 615 | int next = d->next_buffer[i]; |
586 | put_timestamp(ohci, d, next); | 616 | put_timestamp(ohci, d, next); |
587 | d->it_prg[i][d->last_used_cmd[i]].end.status = 0; | 617 | d->it_prg[i][d->last_used_cmd[i]].end.status = 0; |
588 | d->buffer_status[i] = VIDEO1394_BUFFER_READY; | 618 | d->buffer_status[d->buffer_prg_assignment[i]] = VIDEO1394_BUFFER_READY; |
589 | } | 619 | } |
590 | } | 620 | } |
591 | 621 | ||
@@ -595,11 +625,25 @@ static void wakeup_dma_it_ctx(unsigned long l) | |||
595 | wake_up_interruptible(&d->waitq); | 625 | wake_up_interruptible(&d->waitq); |
596 | } | 626 | } |
597 | 627 | ||
628 | static void reprogram_dma_it_prg(struct dma_iso_ctx *d, int n, int buffer) | ||
629 | { | ||
630 | struct it_dma_prg *it_prg = d->it_prg[n]; | ||
631 | unsigned long buf = (unsigned long)d->dma.kvirt + buffer * d->buf_size; | ||
632 | int i; | ||
633 | |||
634 | d->buffer_prg_assignment[n] = buffer; | ||
635 | for (i=0;i<d->nb_cmd;i++) { | ||
636 | it_prg[i].end.address = | ||
637 | cpu_to_le32(dma_region_offset_to_bus(&d->dma, | ||
638 | (buf+i*d->packet_size) - (unsigned long)d->dma.kvirt)); | ||
639 | } | ||
640 | } | ||
641 | |||
598 | static void initialize_dma_it_prg(struct dma_iso_ctx *d, int n, int sync_tag) | 642 | static void initialize_dma_it_prg(struct dma_iso_ctx *d, int n, int sync_tag) |
599 | { | 643 | { |
600 | struct it_dma_prg *it_prg = d->it_prg[n]; | 644 | struct it_dma_prg *it_prg = d->it_prg[n]; |
601 | struct dma_prog_region *it_reg = &d->prg_reg[n]; | 645 | struct dma_prog_region *it_reg = &d->prg_reg[n]; |
602 | unsigned long buf = (unsigned long)d->dma.kvirt + n * d->buf_size; | 646 | unsigned long buf = (unsigned long)d->dma.kvirt; |
603 | int i; | 647 | int i; |
604 | d->last_used_cmd[n] = d->nb_cmd - 1; | 648 | d->last_used_cmd[n] = d->nb_cmd - 1; |
605 | for (i=0;i<d->nb_cmd;i++) { | 649 | for (i=0;i<d->nb_cmd;i++) { |
@@ -796,7 +840,7 @@ static int __video1394_ioctl(struct file *file, | |||
796 | 840 | ||
797 | if (cmd == VIDEO1394_IOC_LISTEN_CHANNEL) { | 841 | if (cmd == VIDEO1394_IOC_LISTEN_CHANNEL) { |
798 | d = alloc_dma_iso_ctx(ohci, OHCI_ISO_RECEIVE, | 842 | d = alloc_dma_iso_ctx(ohci, OHCI_ISO_RECEIVE, |
799 | v.nb_buffers, v.buf_size, | 843 | v.nb_buffers + 1, v.buf_size, |
800 | v.channel, 0); | 844 | v.channel, 0); |
801 | 845 | ||
802 | if (d == NULL) { | 846 | if (d == NULL) { |
@@ -817,7 +861,7 @@ static int __video1394_ioctl(struct file *file, | |||
817 | } | 861 | } |
818 | else { | 862 | else { |
819 | d = alloc_dma_iso_ctx(ohci, OHCI_ISO_TRANSMIT, | 863 | d = alloc_dma_iso_ctx(ohci, OHCI_ISO_TRANSMIT, |
820 | v.nb_buffers, v.buf_size, | 864 | v.nb_buffers + 1, v.buf_size, |
821 | v.channel, v.packet_size); | 865 | v.channel, v.packet_size); |
822 | 866 | ||
823 | if (d == NULL) { | 867 | if (d == NULL) { |
@@ -889,6 +933,7 @@ static int __video1394_ioctl(struct file *file, | |||
889 | { | 933 | { |
890 | struct video1394_wait v; | 934 | struct video1394_wait v; |
891 | struct dma_iso_ctx *d; | 935 | struct dma_iso_ctx *d; |
936 | int next_prg; | ||
892 | 937 | ||
893 | if (copy_from_user(&v, argp, sizeof(v))) | 938 | if (copy_from_user(&v, argp, sizeof(v))) |
894 | return -EFAULT; | 939 | return -EFAULT; |
@@ -896,7 +941,7 @@ static int __video1394_ioctl(struct file *file, | |||
896 | d = find_ctx(&ctx->context_list, OHCI_ISO_RECEIVE, v.channel); | 941 | d = find_ctx(&ctx->context_list, OHCI_ISO_RECEIVE, v.channel); |
897 | if (d == NULL) return -EFAULT; | 942 | if (d == NULL) return -EFAULT; |
898 | 943 | ||
899 | if ((v.buffer<0) || (v.buffer>d->num_desc)) { | 944 | if ((v.buffer<0) || (v.buffer>=d->num_desc - 1)) { |
900 | PRINT(KERN_ERR, ohci->host->id, | 945 | PRINT(KERN_ERR, ohci->host->id, |
901 | "Buffer %d out of range",v.buffer); | 946 | "Buffer %d out of range",v.buffer); |
902 | return -EINVAL; | 947 | return -EINVAL; |
@@ -913,12 +958,14 @@ static int __video1394_ioctl(struct file *file, | |||
913 | 958 | ||
914 | d->buffer_status[v.buffer]=VIDEO1394_BUFFER_QUEUED; | 959 | d->buffer_status[v.buffer]=VIDEO1394_BUFFER_QUEUED; |
915 | 960 | ||
961 | next_prg = (d->last_buffer + 1) % d->num_desc; | ||
916 | if (d->last_buffer>=0) | 962 | if (d->last_buffer>=0) |
917 | d->ir_prg[d->last_buffer][d->nb_cmd-1].branchAddress = | 963 | d->ir_prg[d->last_buffer][d->nb_cmd-1].branchAddress = |
918 | cpu_to_le32((dma_prog_region_offset_to_bus(&d->prg_reg[v.buffer], 0) | 964 | cpu_to_le32((dma_prog_region_offset_to_bus(&d->prg_reg[next_prg], 0) |
919 | & 0xfffffff0) | 0x1); | 965 | & 0xfffffff0) | 0x1); |
920 | 966 | ||
921 | d->last_buffer = v.buffer; | 967 | d->last_buffer = next_prg; |
968 | reprogram_dma_ir_prg(d, d->last_buffer, v.buffer, d->flags); | ||
922 | 969 | ||
923 | d->ir_prg[d->last_buffer][d->nb_cmd-1].branchAddress = 0; | 970 | d->ir_prg[d->last_buffer][d->nb_cmd-1].branchAddress = 0; |
924 | 971 | ||
@@ -930,7 +977,7 @@ static int __video1394_ioctl(struct file *file, | |||
930 | 977 | ||
931 | /* Tell the controller where the first program is */ | 978 | /* Tell the controller where the first program is */ |
932 | reg_write(ohci, d->cmdPtr, | 979 | reg_write(ohci, d->cmdPtr, |
933 | dma_prog_region_offset_to_bus(&d->prg_reg[v.buffer], 0) | 0x1); | 980 | dma_prog_region_offset_to_bus(&d->prg_reg[d->last_buffer], 0) | 0x1); |
934 | 981 | ||
935 | /* Run IR context */ | 982 | /* Run IR context */ |
936 | reg_write(ohci, d->ctrlSet, 0x8000); | 983 | reg_write(ohci, d->ctrlSet, 0x8000); |
@@ -951,7 +998,7 @@ static int __video1394_ioctl(struct file *file, | |||
951 | { | 998 | { |
952 | struct video1394_wait v; | 999 | struct video1394_wait v; |
953 | struct dma_iso_ctx *d; | 1000 | struct dma_iso_ctx *d; |
954 | int i; | 1001 | int i = 0; |
955 | 1002 | ||
956 | if (copy_from_user(&v, argp, sizeof(v))) | 1003 | if (copy_from_user(&v, argp, sizeof(v))) |
957 | return -EFAULT; | 1004 | return -EFAULT; |
@@ -959,7 +1006,7 @@ static int __video1394_ioctl(struct file *file, | |||
959 | d = find_ctx(&ctx->context_list, OHCI_ISO_RECEIVE, v.channel); | 1006 | d = find_ctx(&ctx->context_list, OHCI_ISO_RECEIVE, v.channel); |
960 | if (d == NULL) return -EFAULT; | 1007 | if (d == NULL) return -EFAULT; |
961 | 1008 | ||
962 | if ((v.buffer<0) || (v.buffer>d->num_desc)) { | 1009 | if ((v.buffer<0) || (v.buffer>d->num_desc - 1)) { |
963 | PRINT(KERN_ERR, ohci->host->id, | 1010 | PRINT(KERN_ERR, ohci->host->id, |
964 | "Buffer %d out of range",v.buffer); | 1011 | "Buffer %d out of range",v.buffer); |
965 | return -EINVAL; | 1012 | return -EINVAL; |
@@ -1005,9 +1052,9 @@ static int __video1394_ioctl(struct file *file, | |||
1005 | * Look ahead to see how many more buffers have been received | 1052 | * Look ahead to see how many more buffers have been received |
1006 | */ | 1053 | */ |
1007 | i=0; | 1054 | i=0; |
1008 | while (d->buffer_status[(v.buffer+1)%d->num_desc]== | 1055 | while (d->buffer_status[(v.buffer+1)%(d->num_desc - 1)]== |
1009 | VIDEO1394_BUFFER_READY) { | 1056 | VIDEO1394_BUFFER_READY) { |
1010 | v.buffer=(v.buffer+1)%d->num_desc; | 1057 | v.buffer=(v.buffer+1)%(d->num_desc - 1); |
1011 | i++; | 1058 | i++; |
1012 | } | 1059 | } |
1013 | spin_unlock_irqrestore(&d->lock, flags); | 1060 | spin_unlock_irqrestore(&d->lock, flags); |
@@ -1023,6 +1070,7 @@ static int __video1394_ioctl(struct file *file, | |||
1023 | struct video1394_wait v; | 1070 | struct video1394_wait v; |
1024 | unsigned int *psizes = NULL; | 1071 | unsigned int *psizes = NULL; |
1025 | struct dma_iso_ctx *d; | 1072 | struct dma_iso_ctx *d; |
1073 | int next_prg; | ||
1026 | 1074 | ||
1027 | if (copy_from_user(&v, argp, sizeof(v))) | 1075 | if (copy_from_user(&v, argp, sizeof(v))) |
1028 | return -EFAULT; | 1076 | return -EFAULT; |
@@ -1030,7 +1078,7 @@ static int __video1394_ioctl(struct file *file, | |||
1030 | d = find_ctx(&ctx->context_list, OHCI_ISO_TRANSMIT, v.channel); | 1078 | d = find_ctx(&ctx->context_list, OHCI_ISO_TRANSMIT, v.channel); |
1031 | if (d == NULL) return -EFAULT; | 1079 | if (d == NULL) return -EFAULT; |
1032 | 1080 | ||
1033 | if ((v.buffer<0) || (v.buffer>d->num_desc)) { | 1081 | if ((v.buffer<0) || (v.buffer>=d->num_desc - 1)) { |
1034 | PRINT(KERN_ERR, ohci->host->id, | 1082 | PRINT(KERN_ERR, ohci->host->id, |
1035 | "Buffer %d out of range",v.buffer); | 1083 | "Buffer %d out of range",v.buffer); |
1036 | return -EINVAL; | 1084 | return -EINVAL; |
@@ -1056,19 +1104,19 @@ static int __video1394_ioctl(struct file *file, | |||
1056 | 1104 | ||
1057 | spin_lock_irqsave(&d->lock,flags); | 1105 | spin_lock_irqsave(&d->lock,flags); |
1058 | 1106 | ||
1107 | // last_buffer is last_prg | ||
1108 | next_prg = (d->last_buffer + 1) % d->num_desc; | ||
1059 | if (d->buffer_status[v.buffer]!=VIDEO1394_BUFFER_FREE) { | 1109 | if (d->buffer_status[v.buffer]!=VIDEO1394_BUFFER_FREE) { |
1060 | PRINT(KERN_ERR, ohci->host->id, | 1110 | PRINT(KERN_ERR, ohci->host->id, |
1061 | "Buffer %d is already used",v.buffer); | 1111 | "Buffer %d is already used",v.buffer); |
1062 | spin_unlock_irqrestore(&d->lock,flags); | 1112 | spin_unlock_irqrestore(&d->lock,flags); |
1063 | if (psizes) | 1113 | kfree(psizes); |
1064 | kfree(psizes); | ||
1065 | return -EBUSY; | 1114 | return -EBUSY; |
1066 | } | 1115 | } |
1067 | 1116 | ||
1068 | if (d->flags & VIDEO1394_VARIABLE_PACKET_SIZE) { | 1117 | if (d->flags & VIDEO1394_VARIABLE_PACKET_SIZE) { |
1069 | initialize_dma_it_prg_var_packet_queue( | 1118 | initialize_dma_it_prg_var_packet_queue( |
1070 | d, v.buffer, psizes, | 1119 | d, next_prg, psizes, ohci); |
1071 | ohci); | ||
1072 | } | 1120 | } |
1073 | 1121 | ||
1074 | d->buffer_status[v.buffer]=VIDEO1394_BUFFER_QUEUED; | 1122 | d->buffer_status[v.buffer]=VIDEO1394_BUFFER_QUEUED; |
@@ -1076,16 +1124,17 @@ static int __video1394_ioctl(struct file *file, | |||
1076 | if (d->last_buffer >= 0) { | 1124 | if (d->last_buffer >= 0) { |
1077 | d->it_prg[d->last_buffer] | 1125 | d->it_prg[d->last_buffer] |
1078 | [ d->last_used_cmd[d->last_buffer] ].end.branchAddress = | 1126 | [ d->last_used_cmd[d->last_buffer] ].end.branchAddress = |
1079 | cpu_to_le32((dma_prog_region_offset_to_bus(&d->prg_reg[v.buffer], | 1127 | cpu_to_le32((dma_prog_region_offset_to_bus(&d->prg_reg[next_prg], |
1080 | 0) & 0xfffffff0) | 0x3); | 1128 | 0) & 0xfffffff0) | 0x3); |
1081 | 1129 | ||
1082 | d->it_prg[d->last_buffer] | 1130 | d->it_prg[d->last_buffer] |
1083 | [ d->last_used_cmd[d->last_buffer] ].begin.branchAddress = | 1131 | [ d->last_used_cmd[d->last_buffer] ].begin.branchAddress = |
1084 | cpu_to_le32((dma_prog_region_offset_to_bus(&d->prg_reg[v.buffer], | 1132 | cpu_to_le32((dma_prog_region_offset_to_bus(&d->prg_reg[next_prg], |
1085 | 0) & 0xfffffff0) | 0x3); | 1133 | 0) & 0xfffffff0) | 0x3); |
1086 | d->next_buffer[d->last_buffer] = v.buffer; | 1134 | d->next_buffer[d->last_buffer] = (v.buffer + 1) % (d->num_desc - 1); |
1087 | } | 1135 | } |
1088 | d->last_buffer = v.buffer; | 1136 | d->last_buffer = next_prg; |
1137 | reprogram_dma_it_prg(d, d->last_buffer, v.buffer); | ||
1089 | d->next_buffer[d->last_buffer] = -1; | 1138 | d->next_buffer[d->last_buffer] = -1; |
1090 | 1139 | ||
1091 | d->it_prg[d->last_buffer][d->last_used_cmd[d->last_buffer]].end.branchAddress = 0; | 1140 | d->it_prg[d->last_buffer][d->last_used_cmd[d->last_buffer]].end.branchAddress = 0; |
@@ -1100,7 +1149,7 @@ static int __video1394_ioctl(struct file *file, | |||
1100 | 1149 | ||
1101 | /* Tell the controller where the first program is */ | 1150 | /* Tell the controller where the first program is */ |
1102 | reg_write(ohci, d->cmdPtr, | 1151 | reg_write(ohci, d->cmdPtr, |
1103 | dma_prog_region_offset_to_bus(&d->prg_reg[v.buffer], 0) | 0x3); | 1152 | dma_prog_region_offset_to_bus(&d->prg_reg[next_prg], 0) | 0x3); |
1104 | 1153 | ||
1105 | /* Run IT context */ | 1154 | /* Run IT context */ |
1106 | reg_write(ohci, d->ctrlSet, 0x8000); | 1155 | reg_write(ohci, d->ctrlSet, 0x8000); |
@@ -1116,9 +1165,7 @@ static int __video1394_ioctl(struct file *file, | |||
1116 | } | 1165 | } |
1117 | } | 1166 | } |
1118 | 1167 | ||
1119 | if (psizes) | 1168 | kfree(psizes); |
1120 | kfree(psizes); | ||
1121 | |||
1122 | return 0; | 1169 | return 0; |
1123 | 1170 | ||
1124 | } | 1171 | } |
@@ -1133,7 +1180,7 @@ static int __video1394_ioctl(struct file *file, | |||
1133 | d = find_ctx(&ctx->context_list, OHCI_ISO_TRANSMIT, v.channel); | 1180 | d = find_ctx(&ctx->context_list, OHCI_ISO_TRANSMIT, v.channel); |
1134 | if (d == NULL) return -EFAULT; | 1181 | if (d == NULL) return -EFAULT; |
1135 | 1182 | ||
1136 | if ((v.buffer<0) || (v.buffer>d->num_desc)) { | 1183 | if ((v.buffer<0) || (v.buffer>=d->num_desc-1)) { |
1137 | PRINT(KERN_ERR, ohci->host->id, | 1184 | PRINT(KERN_ERR, ohci->host->id, |
1138 | "Buffer %d out of range",v.buffer); | 1185 | "Buffer %d out of range",v.buffer); |
1139 | return -EINVAL; | 1186 | return -EINVAL; |
diff --git a/drivers/input/keyboard/atkbd.c b/drivers/input/keyboard/atkbd.c index ff66ed4ee2cd..79c332f16fc7 100644 --- a/drivers/input/keyboard/atkbd.c +++ b/drivers/input/keyboard/atkbd.c | |||
@@ -465,8 +465,10 @@ static int atkbd_event(struct input_dev *dev, unsigned int type, unsigned int co | |||
465 | if (atkbd->softrepeat) return 0; | 465 | if (atkbd->softrepeat) return 0; |
466 | 466 | ||
467 | i = j = 0; | 467 | i = j = 0; |
468 | while (i < 32 && period[i] < dev->rep[REP_PERIOD]) i++; | 468 | while (i < 31 && period[i] < dev->rep[REP_PERIOD]) |
469 | while (j < 4 && delay[j] < dev->rep[REP_DELAY]) j++; | 469 | i++; |
470 | while (j < 3 && delay[j] < dev->rep[REP_DELAY]) | ||
471 | j++; | ||
470 | dev->rep[REP_PERIOD] = period[i]; | 472 | dev->rep[REP_PERIOD] = period[i]; |
471 | dev->rep[REP_DELAY] = delay[j]; | 473 | dev->rep[REP_DELAY] = delay[j]; |
472 | param[0] = i | (j << 5); | 474 | param[0] = i | (j << 5); |
diff --git a/drivers/input/mouse/alps.c b/drivers/input/mouse/alps.c index 1f85a9718c89..42a9f7f6f8cb 100644 --- a/drivers/input/mouse/alps.c +++ b/drivers/input/mouse/alps.c | |||
@@ -341,6 +341,8 @@ static int alps_reconnect(struct psmouse *psmouse) | |||
341 | unsigned char param[4]; | 341 | unsigned char param[4]; |
342 | int version; | 342 | int version; |
343 | 343 | ||
344 | psmouse_reset(psmouse); | ||
345 | |||
344 | if (!(priv->i = alps_get_model(psmouse, &version))) | 346 | if (!(priv->i = alps_get_model(psmouse, &version))) |
345 | return -1; | 347 | return -1; |
346 | 348 | ||
@@ -395,7 +397,7 @@ int alps_init(struct psmouse *psmouse) | |||
395 | } | 397 | } |
396 | 398 | ||
397 | if (param[0] & 0x04) { | 399 | if (param[0] & 0x04) { |
398 | printk(KERN_INFO " Enabling hardware tapping\n"); | 400 | printk(KERN_INFO "alps.c: Enabling hardware tapping\n"); |
399 | if (alps_tap_mode(psmouse, 1)) | 401 | if (alps_tap_mode(psmouse, 1)) |
400 | printk(KERN_WARNING "alps.c: Failed to enable hardware tapping\n"); | 402 | printk(KERN_WARNING "alps.c: Failed to enable hardware tapping\n"); |
401 | } | 403 | } |
diff --git a/drivers/input/serio/serio.c b/drivers/input/serio/serio.c index 3313e2daeab0..0beacb77ee18 100644 --- a/drivers/input/serio/serio.c +++ b/drivers/input/serio/serio.c | |||
@@ -388,6 +388,24 @@ static ssize_t serio_show_id_extra(struct device *dev, char *buf) | |||
388 | return sprintf(buf, "%02x\n", serio->id.extra); | 388 | return sprintf(buf, "%02x\n", serio->id.extra); |
389 | } | 389 | } |
390 | 390 | ||
391 | static DEVICE_ATTR(type, S_IRUGO, serio_show_id_type, NULL); | ||
392 | static DEVICE_ATTR(proto, S_IRUGO, serio_show_id_proto, NULL); | ||
393 | static DEVICE_ATTR(id, S_IRUGO, serio_show_id_id, NULL); | ||
394 | static DEVICE_ATTR(extra, S_IRUGO, serio_show_id_extra, NULL); | ||
395 | |||
396 | static struct attribute *serio_device_id_attrs[] = { | ||
397 | &dev_attr_type.attr, | ||
398 | &dev_attr_proto.attr, | ||
399 | &dev_attr_id.attr, | ||
400 | &dev_attr_extra.attr, | ||
401 | NULL | ||
402 | }; | ||
403 | |||
404 | static struct attribute_group serio_id_attr_group = { | ||
405 | .name = "id", | ||
406 | .attrs = serio_device_id_attrs, | ||
407 | }; | ||
408 | |||
391 | static ssize_t serio_rebind_driver(struct device *dev, const char *buf, size_t count) | 409 | static ssize_t serio_rebind_driver(struct device *dev, const char *buf, size_t count) |
392 | { | 410 | { |
393 | struct serio *serio = to_serio_port(dev); | 411 | struct serio *serio = to_serio_port(dev); |
@@ -444,10 +462,6 @@ static ssize_t serio_set_bind_mode(struct device *dev, const char *buf, size_t c | |||
444 | 462 | ||
445 | static struct device_attribute serio_device_attrs[] = { | 463 | static struct device_attribute serio_device_attrs[] = { |
446 | __ATTR(description, S_IRUGO, serio_show_description, NULL), | 464 | __ATTR(description, S_IRUGO, serio_show_description, NULL), |
447 | __ATTR(id_type, S_IRUGO, serio_show_id_type, NULL), | ||
448 | __ATTR(id_proto, S_IRUGO, serio_show_id_proto, NULL), | ||
449 | __ATTR(id_id, S_IRUGO, serio_show_id_id, NULL), | ||
450 | __ATTR(id_extra, S_IRUGO, serio_show_id_extra, NULL), | ||
451 | __ATTR(drvctl, S_IWUSR, NULL, serio_rebind_driver), | 465 | __ATTR(drvctl, S_IWUSR, NULL, serio_rebind_driver), |
452 | __ATTR(bind_mode, S_IWUSR | S_IRUGO, serio_show_bind_mode, serio_set_bind_mode), | 466 | __ATTR(bind_mode, S_IWUSR | S_IRUGO, serio_show_bind_mode, serio_set_bind_mode), |
453 | __ATTR_NULL | 467 | __ATTR_NULL |
@@ -498,6 +512,7 @@ static void serio_add_port(struct serio *serio) | |||
498 | if (serio->start) | 512 | if (serio->start) |
499 | serio->start(serio); | 513 | serio->start(serio); |
500 | device_add(&serio->dev); | 514 | device_add(&serio->dev); |
515 | sysfs_create_group(&serio->dev.kobj, &serio_id_attr_group); | ||
501 | serio->registered = 1; | 516 | serio->registered = 1; |
502 | } | 517 | } |
503 | 518 | ||
@@ -526,6 +541,7 @@ static void serio_destroy_port(struct serio *serio) | |||
526 | } | 541 | } |
527 | 542 | ||
528 | if (serio->registered) { | 543 | if (serio->registered) { |
544 | sysfs_remove_group(&serio->dev.kobj, &serio_id_attr_group); | ||
529 | device_del(&serio->dev); | 545 | device_del(&serio->dev); |
530 | list_del_init(&serio->node); | 546 | list_del_init(&serio->node); |
531 | serio->registered = 0; | 547 | serio->registered = 0; |
@@ -779,7 +795,6 @@ static int serio_resume(struct device *dev) | |||
779 | struct serio *serio = to_serio_port(dev); | 795 | struct serio *serio = to_serio_port(dev); |
780 | 796 | ||
781 | if (!serio->drv || !serio->drv->reconnect || serio->drv->reconnect(serio)) { | 797 | if (!serio->drv || !serio->drv->reconnect || serio->drv->reconnect(serio)) { |
782 | serio_disconnect_port(serio); | ||
783 | /* | 798 | /* |
784 | * Driver re-probing can take a while, so better let kseriod | 799 | * Driver re-probing can take a while, so better let kseriod |
785 | * deal with it. | 800 | * deal with it. |
diff --git a/drivers/input/serio/serport.c b/drivers/input/serio/serport.c index 22f73683952b..f6b85222ba3d 100644 --- a/drivers/input/serio/serport.c +++ b/drivers/input/serio/serport.c | |||
@@ -27,11 +27,15 @@ MODULE_LICENSE("GPL"); | |||
27 | MODULE_ALIAS_LDISC(N_MOUSE); | 27 | MODULE_ALIAS_LDISC(N_MOUSE); |
28 | 28 | ||
29 | #define SERPORT_BUSY 1 | 29 | #define SERPORT_BUSY 1 |
30 | #define SERPORT_ACTIVE 2 | ||
31 | #define SERPORT_DEAD 3 | ||
30 | 32 | ||
31 | struct serport { | 33 | struct serport { |
32 | struct tty_struct *tty; | 34 | struct tty_struct *tty; |
33 | wait_queue_head_t wait; | 35 | wait_queue_head_t wait; |
34 | struct serio *serio; | 36 | struct serio *serio; |
37 | struct serio_device_id id; | ||
38 | spinlock_t lock; | ||
35 | unsigned long flags; | 39 | unsigned long flags; |
36 | }; | 40 | }; |
37 | 41 | ||
@@ -45,11 +49,29 @@ static int serport_serio_write(struct serio *serio, unsigned char data) | |||
45 | return -(serport->tty->driver->write(serport->tty, &data, 1) != 1); | 49 | return -(serport->tty->driver->write(serport->tty, &data, 1) != 1); |
46 | } | 50 | } |
47 | 51 | ||
52 | static int serport_serio_open(struct serio *serio) | ||
53 | { | ||
54 | struct serport *serport = serio->port_data; | ||
55 | unsigned long flags; | ||
56 | |||
57 | spin_lock_irqsave(&serport->lock, flags); | ||
58 | set_bit(SERPORT_ACTIVE, &serport->flags); | ||
59 | spin_unlock_irqrestore(&serport->lock, flags); | ||
60 | |||
61 | return 0; | ||
62 | } | ||
63 | |||
64 | |||
48 | static void serport_serio_close(struct serio *serio) | 65 | static void serport_serio_close(struct serio *serio) |
49 | { | 66 | { |
50 | struct serport *serport = serio->port_data; | 67 | struct serport *serport = serio->port_data; |
68 | unsigned long flags; | ||
69 | |||
70 | spin_lock_irqsave(&serport->lock, flags); | ||
71 | clear_bit(SERPORT_ACTIVE, &serport->flags); | ||
72 | set_bit(SERPORT_DEAD, &serport->flags); | ||
73 | spin_unlock_irqrestore(&serport->lock, flags); | ||
51 | 74 | ||
52 | serport->serio->id.type = 0; | ||
53 | wake_up_interruptible(&serport->wait); | 75 | wake_up_interruptible(&serport->wait); |
54 | } | 76 | } |
55 | 77 | ||
@@ -61,36 +83,21 @@ static void serport_serio_close(struct serio *serio) | |||
61 | static int serport_ldisc_open(struct tty_struct *tty) | 83 | static int serport_ldisc_open(struct tty_struct *tty) |
62 | { | 84 | { |
63 | struct serport *serport; | 85 | struct serport *serport; |
64 | struct serio *serio; | ||
65 | char name[64]; | ||
66 | 86 | ||
67 | if (!capable(CAP_SYS_ADMIN)) | 87 | if (!capable(CAP_SYS_ADMIN)) |
68 | return -EPERM; | 88 | return -EPERM; |
69 | 89 | ||
70 | serport = kmalloc(sizeof(struct serport), GFP_KERNEL); | 90 | serport = kcalloc(1, sizeof(struct serport), GFP_KERNEL); |
71 | serio = kmalloc(sizeof(struct serio), GFP_KERNEL); | 91 | if (!serport) |
72 | if (unlikely(!serport || !serio)) { | ||
73 | kfree(serport); | ||
74 | kfree(serio); | ||
75 | return -ENOMEM; | 92 | return -ENOMEM; |
76 | } | ||
77 | 93 | ||
78 | memset(serport, 0, sizeof(struct serport)); | ||
79 | serport->serio = serio; | ||
80 | set_bit(TTY_DO_WRITE_WAKEUP, &tty->flags); | ||
81 | serport->tty = tty; | 94 | serport->tty = tty; |
82 | tty->disc_data = serport; | 95 | spin_lock_init(&serport->lock); |
83 | |||
84 | memset(serio, 0, sizeof(struct serio)); | ||
85 | strlcpy(serio->name, "Serial port", sizeof(serio->name)); | ||
86 | snprintf(serio->phys, sizeof(serio->phys), "%s/serio0", tty_name(tty, name)); | ||
87 | serio->id.type = SERIO_RS232; | ||
88 | serio->write = serport_serio_write; | ||
89 | serio->close = serport_serio_close; | ||
90 | serio->port_data = serport; | ||
91 | |||
92 | init_waitqueue_head(&serport->wait); | 96 | init_waitqueue_head(&serport->wait); |
93 | 97 | ||
98 | tty->disc_data = serport; | ||
99 | set_bit(TTY_DO_WRITE_WAKEUP, &tty->flags); | ||
100 | |||
94 | return 0; | 101 | return 0; |
95 | } | 102 | } |
96 | 103 | ||
@@ -100,7 +107,8 @@ static int serport_ldisc_open(struct tty_struct *tty) | |||
100 | 107 | ||
101 | static void serport_ldisc_close(struct tty_struct *tty) | 108 | static void serport_ldisc_close(struct tty_struct *tty) |
102 | { | 109 | { |
103 | struct serport *serport = (struct serport*) tty->disc_data; | 110 | struct serport *serport = (struct serport *) tty->disc_data; |
111 | |||
104 | kfree(serport); | 112 | kfree(serport); |
105 | } | 113 | } |
106 | 114 | ||
@@ -116,9 +124,19 @@ static void serport_ldisc_close(struct tty_struct *tty) | |||
116 | static void serport_ldisc_receive(struct tty_struct *tty, const unsigned char *cp, char *fp, int count) | 124 | static void serport_ldisc_receive(struct tty_struct *tty, const unsigned char *cp, char *fp, int count) |
117 | { | 125 | { |
118 | struct serport *serport = (struct serport*) tty->disc_data; | 126 | struct serport *serport = (struct serport*) tty->disc_data; |
127 | unsigned long flags; | ||
119 | int i; | 128 | int i; |
129 | |||
130 | spin_lock_irqsave(&serport->lock, flags); | ||
131 | |||
132 | if (!test_bit(SERPORT_ACTIVE, &serport->flags)) | ||
133 | goto out; | ||
134 | |||
120 | for (i = 0; i < count; i++) | 135 | for (i = 0; i < count; i++) |
121 | serio_interrupt(serport->serio, cp[i], 0, NULL); | 136 | serio_interrupt(serport->serio, cp[i], 0, NULL); |
137 | |||
138 | out: | ||
139 | spin_unlock_irqrestore(&serport->lock, flags); | ||
122 | } | 140 | } |
123 | 141 | ||
124 | /* | 142 | /* |
@@ -141,16 +159,33 @@ static int serport_ldisc_room(struct tty_struct *tty) | |||
141 | static ssize_t serport_ldisc_read(struct tty_struct * tty, struct file * file, unsigned char __user * buf, size_t nr) | 159 | static ssize_t serport_ldisc_read(struct tty_struct * tty, struct file * file, unsigned char __user * buf, size_t nr) |
142 | { | 160 | { |
143 | struct serport *serport = (struct serport*) tty->disc_data; | 161 | struct serport *serport = (struct serport*) tty->disc_data; |
162 | struct serio *serio; | ||
144 | char name[64]; | 163 | char name[64]; |
145 | 164 | ||
146 | if (test_and_set_bit(SERPORT_BUSY, &serport->flags)) | 165 | if (test_and_set_bit(SERPORT_BUSY, &serport->flags)) |
147 | return -EBUSY; | 166 | return -EBUSY; |
148 | 167 | ||
168 | serport->serio = serio = kcalloc(1, sizeof(struct serio), GFP_KERNEL); | ||
169 | if (!serio) | ||
170 | return -ENOMEM; | ||
171 | |||
172 | strlcpy(serio->name, "Serial port", sizeof(serio->name)); | ||
173 | snprintf(serio->phys, sizeof(serio->phys), "%s/serio0", tty_name(tty, name)); | ||
174 | serio->id = serport->id; | ||
175 | serio->id.type = SERIO_RS232; | ||
176 | serio->write = serport_serio_write; | ||
177 | serio->open = serport_serio_open; | ||
178 | serio->close = serport_serio_close; | ||
179 | serio->port_data = serport; | ||
180 | |||
149 | serio_register_port(serport->serio); | 181 | serio_register_port(serport->serio); |
150 | printk(KERN_INFO "serio: Serial port %s\n", tty_name(tty, name)); | 182 | printk(KERN_INFO "serio: Serial port %s\n", tty_name(tty, name)); |
151 | wait_event_interruptible(serport->wait, !serport->serio->id.type); | 183 | |
184 | wait_event_interruptible(serport->wait, test_bit(SERPORT_DEAD, &serport->flags)); | ||
152 | serio_unregister_port(serport->serio); | 185 | serio_unregister_port(serport->serio); |
186 | serport->serio = NULL; | ||
153 | 187 | ||
188 | clear_bit(SERPORT_DEAD, &serport->flags); | ||
154 | clear_bit(SERPORT_BUSY, &serport->flags); | 189 | clear_bit(SERPORT_BUSY, &serport->flags); |
155 | 190 | ||
156 | return 0; | 191 | return 0; |
@@ -163,16 +198,15 @@ static ssize_t serport_ldisc_read(struct tty_struct * tty, struct file * file, u | |||
163 | static int serport_ldisc_ioctl(struct tty_struct * tty, struct file * file, unsigned int cmd, unsigned long arg) | 198 | static int serport_ldisc_ioctl(struct tty_struct * tty, struct file * file, unsigned int cmd, unsigned long arg) |
164 | { | 199 | { |
165 | struct serport *serport = (struct serport*) tty->disc_data; | 200 | struct serport *serport = (struct serport*) tty->disc_data; |
166 | struct serio *serio = serport->serio; | ||
167 | unsigned long type; | 201 | unsigned long type; |
168 | 202 | ||
169 | if (cmd == SPIOCSTYPE) { | 203 | if (cmd == SPIOCSTYPE) { |
170 | if (get_user(type, (unsigned long __user *) arg)) | 204 | if (get_user(type, (unsigned long __user *) arg)) |
171 | return -EFAULT; | 205 | return -EFAULT; |
172 | 206 | ||
173 | serio->id.proto = type & 0x000000ff; | 207 | serport->id.proto = type & 0x000000ff; |
174 | serio->id.id = (type & 0x0000ff00) >> 8; | 208 | serport->id.id = (type & 0x0000ff00) >> 8; |
175 | serio->id.extra = (type & 0x00ff0000) >> 16; | 209 | serport->id.extra = (type & 0x00ff0000) >> 16; |
176 | 210 | ||
177 | return 0; | 211 | return 0; |
178 | } | 212 | } |
@@ -182,9 +216,13 @@ static int serport_ldisc_ioctl(struct tty_struct * tty, struct file * file, unsi | |||
182 | 216 | ||
183 | static void serport_ldisc_write_wakeup(struct tty_struct * tty) | 217 | static void serport_ldisc_write_wakeup(struct tty_struct * tty) |
184 | { | 218 | { |
185 | struct serport *sp = (struct serport *) tty->disc_data; | 219 | struct serport *serport = (struct serport *) tty->disc_data; |
220 | unsigned long flags; | ||
186 | 221 | ||
187 | serio_drv_write_wakeup(sp->serio); | 222 | spin_lock_irqsave(&serport->lock, flags); |
223 | if (test_bit(SERPORT_ACTIVE, &serport->flags)) | ||
224 | serio_drv_write_wakeup(serport->serio); | ||
225 | spin_unlock_irqrestore(&serport->lock, flags); | ||
188 | } | 226 | } |
189 | 227 | ||
190 | /* | 228 | /* |
diff --git a/drivers/md/linear.c b/drivers/md/linear.c index 161e9aa87291..b1941b887f46 100644 --- a/drivers/md/linear.c +++ b/drivers/md/linear.c | |||
@@ -269,9 +269,8 @@ static int linear_make_request (request_queue_t *q, struct bio *bio) | |||
269 | * split it. | 269 | * split it. |
270 | */ | 270 | */ |
271 | struct bio_pair *bp; | 271 | struct bio_pair *bp; |
272 | bp = bio_split(bio, bio_split_pool, | 272 | bp = bio_split(bio, bio_split_pool, |
273 | (bio->bi_sector + (bio->bi_size >> 9) - | 273 | ((tmp_dev->offset + tmp_dev->size)<<1) - bio->bi_sector); |
274 | (tmp_dev->offset + tmp_dev->size))<<1); | ||
275 | if (linear_make_request(q, &bp->bio1)) | 274 | if (linear_make_request(q, &bp->bio1)) |
276 | generic_make_request(&bp->bio1); | 275 | generic_make_request(&bp->bio1); |
277 | if (linear_make_request(q, &bp->bio2)) | 276 | if (linear_make_request(q, &bp->bio2)) |
diff --git a/drivers/md/multipath.c b/drivers/md/multipath.c index 4e4bfde3db5d..2ae2d709cb15 100644 --- a/drivers/md/multipath.c +++ b/drivers/md/multipath.c | |||
@@ -462,10 +462,6 @@ static int multipath_run (mddev_t *mddev) | |||
462 | } | 462 | } |
463 | memset(conf->multipaths, 0, sizeof(struct multipath_info)*mddev->raid_disks); | 463 | memset(conf->multipaths, 0, sizeof(struct multipath_info)*mddev->raid_disks); |
464 | 464 | ||
465 | mddev->queue->unplug_fn = multipath_unplug; | ||
466 | |||
467 | mddev->queue->issue_flush_fn = multipath_issue_flush; | ||
468 | |||
469 | conf->working_disks = 0; | 465 | conf->working_disks = 0; |
470 | ITERATE_RDEV(mddev,rdev,tmp) { | 466 | ITERATE_RDEV(mddev,rdev,tmp) { |
471 | disk_idx = rdev->raid_disk; | 467 | disk_idx = rdev->raid_disk; |
@@ -528,6 +524,10 @@ static int multipath_run (mddev_t *mddev) | |||
528 | * Ok, everything is just fine now | 524 | * Ok, everything is just fine now |
529 | */ | 525 | */ |
530 | mddev->array_size = mddev->size; | 526 | mddev->array_size = mddev->size; |
527 | |||
528 | mddev->queue->unplug_fn = multipath_unplug; | ||
529 | mddev->queue->issue_flush_fn = multipath_issue_flush; | ||
530 | |||
531 | return 0; | 531 | return 0; |
532 | 532 | ||
533 | out_free_conf: | 533 | out_free_conf: |
diff --git a/drivers/md/raid1.c b/drivers/md/raid1.c index 83380b5d6593..1db5de52d376 100644 --- a/drivers/md/raid1.c +++ b/drivers/md/raid1.c | |||
@@ -1197,10 +1197,6 @@ static int run(mddev_t *mddev) | |||
1197 | if (!conf->r1bio_pool) | 1197 | if (!conf->r1bio_pool) |
1198 | goto out_no_mem; | 1198 | goto out_no_mem; |
1199 | 1199 | ||
1200 | mddev->queue->unplug_fn = raid1_unplug; | ||
1201 | |||
1202 | mddev->queue->issue_flush_fn = raid1_issue_flush; | ||
1203 | |||
1204 | ITERATE_RDEV(mddev, rdev, tmp) { | 1200 | ITERATE_RDEV(mddev, rdev, tmp) { |
1205 | disk_idx = rdev->raid_disk; | 1201 | disk_idx = rdev->raid_disk; |
1206 | if (disk_idx >= mddev->raid_disks | 1202 | if (disk_idx >= mddev->raid_disks |
@@ -1282,6 +1278,9 @@ static int run(mddev_t *mddev) | |||
1282 | */ | 1278 | */ |
1283 | mddev->array_size = mddev->size; | 1279 | mddev->array_size = mddev->size; |
1284 | 1280 | ||
1281 | mddev->queue->unplug_fn = raid1_unplug; | ||
1282 | mddev->queue->issue_flush_fn = raid1_issue_flush; | ||
1283 | |||
1285 | return 0; | 1284 | return 0; |
1286 | 1285 | ||
1287 | out_no_mem: | 1286 | out_no_mem: |
diff --git a/drivers/md/raid10.c b/drivers/md/raid10.c index e9dc2876a626..3c37be6423d7 100644 --- a/drivers/md/raid10.c +++ b/drivers/md/raid10.c | |||
@@ -1639,9 +1639,6 @@ static int run(mddev_t *mddev) | |||
1639 | mdname(mddev)); | 1639 | mdname(mddev)); |
1640 | goto out_free_conf; | 1640 | goto out_free_conf; |
1641 | } | 1641 | } |
1642 | mddev->queue->unplug_fn = raid10_unplug; | ||
1643 | |||
1644 | mddev->queue->issue_flush_fn = raid10_issue_flush; | ||
1645 | 1642 | ||
1646 | ITERATE_RDEV(mddev, rdev, tmp) { | 1643 | ITERATE_RDEV(mddev, rdev, tmp) { |
1647 | disk_idx = rdev->raid_disk; | 1644 | disk_idx = rdev->raid_disk; |
@@ -1713,6 +1710,9 @@ static int run(mddev_t *mddev) | |||
1713 | mddev->array_size = size/2; | 1710 | mddev->array_size = size/2; |
1714 | mddev->resync_max_sectors = size; | 1711 | mddev->resync_max_sectors = size; |
1715 | 1712 | ||
1713 | mddev->queue->unplug_fn = raid10_unplug; | ||
1714 | mddev->queue->issue_flush_fn = raid10_issue_flush; | ||
1715 | |||
1716 | /* Calculate max read-ahead size. | 1716 | /* Calculate max read-ahead size. |
1717 | * We need to readahead at least twice a whole stripe.... | 1717 | * We need to readahead at least twice a whole stripe.... |
1718 | * maybe... | 1718 | * maybe... |
diff --git a/drivers/md/raid5.c b/drivers/md/raid5.c index e96e2a10a9c9..3cb11ac232fa 100644 --- a/drivers/md/raid5.c +++ b/drivers/md/raid5.c | |||
@@ -1620,9 +1620,6 @@ static int run (mddev_t *mddev) | |||
1620 | atomic_set(&conf->active_stripes, 0); | 1620 | atomic_set(&conf->active_stripes, 0); |
1621 | atomic_set(&conf->preread_active_stripes, 0); | 1621 | atomic_set(&conf->preread_active_stripes, 0); |
1622 | 1622 | ||
1623 | mddev->queue->unplug_fn = raid5_unplug_device; | ||
1624 | mddev->queue->issue_flush_fn = raid5_issue_flush; | ||
1625 | |||
1626 | PRINTK("raid5: run(%s) called.\n", mdname(mddev)); | 1623 | PRINTK("raid5: run(%s) called.\n", mdname(mddev)); |
1627 | 1624 | ||
1628 | ITERATE_RDEV(mddev,rdev,tmp) { | 1625 | ITERATE_RDEV(mddev,rdev,tmp) { |
@@ -1728,6 +1725,10 @@ memory = conf->max_nr_stripes * (sizeof(struct stripe_head) + | |||
1728 | } | 1725 | } |
1729 | 1726 | ||
1730 | /* Ok, everything is just fine now */ | 1727 | /* Ok, everything is just fine now */ |
1728 | |||
1729 | mddev->queue->unplug_fn = raid5_unplug_device; | ||
1730 | mddev->queue->issue_flush_fn = raid5_issue_flush; | ||
1731 | |||
1731 | mddev->array_size = mddev->size * (mddev->raid_disks - 1); | 1732 | mddev->array_size = mddev->size * (mddev->raid_disks - 1); |
1732 | return 0; | 1733 | return 0; |
1733 | abort: | 1734 | abort: |
diff --git a/drivers/md/raid6main.c b/drivers/md/raid6main.c index 8a33f351e092..908edd78a792 100644 --- a/drivers/md/raid6main.c +++ b/drivers/md/raid6main.c | |||
@@ -1779,9 +1779,6 @@ static int run (mddev_t *mddev) | |||
1779 | atomic_set(&conf->active_stripes, 0); | 1779 | atomic_set(&conf->active_stripes, 0); |
1780 | atomic_set(&conf->preread_active_stripes, 0); | 1780 | atomic_set(&conf->preread_active_stripes, 0); |
1781 | 1781 | ||
1782 | mddev->queue->unplug_fn = raid6_unplug_device; | ||
1783 | mddev->queue->issue_flush_fn = raid6_issue_flush; | ||
1784 | |||
1785 | PRINTK("raid6: run(%s) called.\n", mdname(mddev)); | 1782 | PRINTK("raid6: run(%s) called.\n", mdname(mddev)); |
1786 | 1783 | ||
1787 | ITERATE_RDEV(mddev,rdev,tmp) { | 1784 | ITERATE_RDEV(mddev,rdev,tmp) { |
@@ -1895,6 +1892,9 @@ static int run (mddev_t *mddev) | |||
1895 | 1892 | ||
1896 | /* Ok, everything is just fine now */ | 1893 | /* Ok, everything is just fine now */ |
1897 | mddev->array_size = mddev->size * (mddev->raid_disks - 2); | 1894 | mddev->array_size = mddev->size * (mddev->raid_disks - 2); |
1895 | |||
1896 | mddev->queue->unplug_fn = raid6_unplug_device; | ||
1897 | mddev->queue->issue_flush_fn = raid6_issue_flush; | ||
1898 | return 0; | 1898 | return 0; |
1899 | abort: | 1899 | abort: |
1900 | if (conf) { | 1900 | if (conf) { |
diff --git a/drivers/media/common/saa7146_core.c b/drivers/media/common/saa7146_core.c index 9f6c19ac1285..50e8b8654018 100644 --- a/drivers/media/common/saa7146_core.c +++ b/drivers/media/common/saa7146_core.c | |||
@@ -23,9 +23,9 @@ | |||
23 | LIST_HEAD(saa7146_devices); | 23 | LIST_HEAD(saa7146_devices); |
24 | DECLARE_MUTEX(saa7146_devices_lock); | 24 | DECLARE_MUTEX(saa7146_devices_lock); |
25 | 25 | ||
26 | static int saa7146_num = 0; | 26 | static int saa7146_num; |
27 | 27 | ||
28 | unsigned int saa7146_debug = 0; | 28 | unsigned int saa7146_debug; |
29 | 29 | ||
30 | module_param(saa7146_debug, int, 0644); | 30 | module_param(saa7146_debug, int, 0644); |
31 | MODULE_PARM_DESC(saa7146_debug, "debug level (default: 0)"); | 31 | MODULE_PARM_DESC(saa7146_debug, "debug level (default: 0)"); |
diff --git a/drivers/media/dvb/Kconfig b/drivers/media/dvb/Kconfig index 883ec08490f4..4983e1b1bb1d 100644 --- a/drivers/media/dvb/Kconfig +++ b/drivers/media/dvb/Kconfig | |||
@@ -33,7 +33,7 @@ source "drivers/media/dvb/dibusb/Kconfig" | |||
33 | source "drivers/media/dvb/cinergyT2/Kconfig" | 33 | source "drivers/media/dvb/cinergyT2/Kconfig" |
34 | 34 | ||
35 | comment "Supported FlexCopII (B2C2) Adapters" | 35 | comment "Supported FlexCopII (B2C2) Adapters" |
36 | depends on DVB_CORE && PCI | 36 | depends on DVB_CORE && (PCI || USB) |
37 | source "drivers/media/dvb/b2c2/Kconfig" | 37 | source "drivers/media/dvb/b2c2/Kconfig" |
38 | 38 | ||
39 | comment "Supported BT878 Adapters" | 39 | comment "Supported BT878 Adapters" |
diff --git a/drivers/media/dvb/b2c2/Kconfig b/drivers/media/dvb/b2c2/Kconfig index 52596907a0be..99bd675df955 100644 --- a/drivers/media/dvb/b2c2/Kconfig +++ b/drivers/media/dvb/b2c2/Kconfig | |||
@@ -1,26 +1,50 @@ | |||
1 | config DVB_B2C2_SKYSTAR | 1 | config DVB_B2C2_FLEXCOP |
2 | tristate "B2C2/Technisat Air/Sky/CableStar 2 PCI" | 2 | tristate "Technisat/B2C2 FlexCopII(b) and FlexCopIII adapters" |
3 | depends on DVB_CORE && PCI | 3 | depends on DVB_CORE |
4 | select DVB_STV0299 | 4 | select DVB_STV0299 |
5 | select DVB_MT352 | 5 | select DVB_MT352 |
6 | select DVB_MT312 | 6 | select DVB_MT312 |
7 | select DVB_NXT2002 | 7 | select DVB_NXT2002 |
8 | select DVB_STV0297 | ||
8 | help | 9 | help |
9 | Support for the Skystar2 PCI DVB card by Technisat, which | 10 | Support for the digital TV receiver chip made by B2C2 Inc. included in |
10 | is equipped with the FlexCopII chipset by B2C2, and | 11 | Technisats PCI cards and USB boxes. |
11 | for the B2C2/BBTI Air2PC-ATSC card. | ||
12 | 12 | ||
13 | Say Y if you own such a device and want to use it. | 13 | Say Y if you own such a device and want to use it. |
14 | 14 | ||
15 | config DVB_B2C2_USB | 15 | config DVB_B2C2_FLEXCOP_PCI |
16 | tristate "B2C2/Technisat Air/Sky/Cable2PC USB" | 16 | tristate "Technisat/B2C2 Air/Sky/Cable2PC PCI" |
17 | depends on DVB_CORE && USB && EXPERIMENTAL | 17 | depends on DVB_B2C2_FLEXCOP && PCI |
18 | help | ||
19 | Support for the Air/Sky/CableStar2 PCI card (DVB/ATSC) by Technisat/B2C2. | ||
20 | |||
21 | Say Y if you own such a device and want to use it. | ||
22 | |||
23 | config DVB_B2C2_FLEXCOP_USB | ||
24 | tristate "Technisat/B2C2 Air/Sky/Cable2PC USB" | ||
25 | depends on DVB_B2C2_FLEXCOP && USB | ||
26 | help | ||
27 | Support for the Air/Sky/Cable2PC USB1.1 box (DVB/ATSC) by Technisat/B2C2, | ||
28 | |||
29 | Say Y if you own such a device and want to use it. | ||
30 | |||
31 | config DVB_B2C2_FLEXCOP_DEBUG | ||
32 | bool "Enable debug for the B2C2 FlexCop drivers" | ||
33 | depends on DVB_B2C2_FLEXCOP | ||
34 | help | ||
35 | Say Y if you want to enable the module option to control debug messages | ||
36 | of all B2C2 FlexCop drivers. | ||
37 | |||
38 | config DVB_B2C2_SKYSTAR | ||
39 | tristate "B2C2/Technisat Air/Sky/CableStar 2 PCI" | ||
40 | depends on DVB_CORE && PCI | ||
18 | select DVB_STV0299 | 41 | select DVB_STV0299 |
19 | select DVB_MT352 | 42 | select DVB_MT352 |
43 | select DVB_MT312 | ||
44 | select DVB_NXT2002 | ||
20 | help | 45 | help |
21 | Support for the Air/Sky/Cable2PC USB DVB device by B2C2. Currently | 46 | Support for the Skystar2 PCI DVB card by Technisat, which |
22 | the does nothing, but providing basic function for the used usb | 47 | is equipped with the FlexCopII chipset by B2C2, and |
23 | protocol. | 48 | for the B2C2/BBTI Air2PC-ATSC card. |
24 | 49 | ||
25 | Say Y if you own such a device and want to use it. | 50 | Say Y if you own such a device and want to use it. |
26 | |||
diff --git a/drivers/media/dvb/b2c2/Makefile b/drivers/media/dvb/b2c2/Makefile index 9fb1247bfab8..7703812af34f 100644 --- a/drivers/media/dvb/b2c2/Makefile +++ b/drivers/media/dvb/b2c2/Makefile | |||
@@ -1,6 +1,14 @@ | |||
1 | obj-b2c2-usb = b2c2-usb-core.o b2c2-common.o | 1 | b2c2-flexcop-objs = flexcop.o flexcop-fe-tuner.o flexcop-i2c.o \ |
2 | flexcop-sram.o flexcop-eeprom.o flexcop-misc.o flexcop-hw-filter.o \ | ||
3 | flexcop-dma.o | ||
4 | obj-$(CONFIG_DVB_B2C2_FLEXCOP) += b2c2-flexcop.o | ||
5 | |||
6 | b2c2-flexcop-pci-objs = flexcop-pci.o | ||
7 | obj-$(CONFIG_DVB_B2C2_FLEXCOP_PCI) += b2c2-flexcop-pci.o | ||
8 | |||
9 | b2c2-flexcop-usb-objs = flexcop-usb.o | ||
10 | obj-$(CONFIG_DVB_B2C2_FLEXCOP_USB) += b2c2-flexcop-usb.o | ||
2 | 11 | ||
3 | obj-$(CONFIG_DVB_B2C2_SKYSTAR) += skystar2.o | 12 | obj-$(CONFIG_DVB_B2C2_SKYSTAR) += skystar2.o |
4 | obj-$(CONFIG_DVB_B2C2_USB) + = b2c2-usb.o | ||
5 | 13 | ||
6 | EXTRA_CFLAGS = -Idrivers/media/dvb/dvb-core/ -Idrivers/media/dvb/frontends/ | 14 | EXTRA_CFLAGS = -Idrivers/media/dvb/dvb-core/ -Idrivers/media/dvb/frontends/ |
diff --git a/drivers/media/dvb/b2c2/b2c2-common.c b/drivers/media/dvb/b2c2/b2c2-common.c deleted file mode 100644 index 000d60c405e3..000000000000 --- a/drivers/media/dvb/b2c2/b2c2-common.c +++ /dev/null | |||
@@ -1,214 +0,0 @@ | |||
1 | /* | ||
2 | * b2c2-common.c - common methods for the B2C2/Technisat SkyStar2 PCI DVB card and | ||
3 | * for the B2C2/Technisat Sky/Cable/AirStar USB devices | ||
4 | * based on the FlexCopII/FlexCopIII by B2C2, Inc. | ||
5 | * | ||
6 | * Copyright (C) 2003 Vadim Catana, skystar@moldova.cc | ||
7 | * | ||
8 | * FIX: DISEQC Tone Burst in flexcop_diseqc_ioctl() | ||
9 | * FIX: FULL soft DiSEqC for skystar2 (FlexCopII rev 130) VP310 equipped | ||
10 | * Vincenzo Di Massa, hawk.it at tiscalinet.it | ||
11 | * | ||
12 | * Converted to Linux coding style | ||
13 | * Misc reorganization, polishing, restyling | ||
14 | * Roberto Ragusa, r.ragusa at libero.it | ||
15 | * | ||
16 | * Added hardware filtering support, | ||
17 | * Niklas Peinecke, peinecke at gdv.uni-hannover.de | ||
18 | * | ||
19 | * This program is free software; you can redistribute it and/or | ||
20 | * modify it under the terms of the GNU Lesser General Public License | ||
21 | * as published by the Free Software Foundation; either version 2.1 | ||
22 | * of the License, or (at your option) any later version. | ||
23 | * | ||
24 | * This program is distributed in the hope that it will be useful, | ||
25 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
26 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
27 | * GNU General Public License for more details. | ||
28 | * | ||
29 | * You should have received a copy of the GNU Lesser General Public License | ||
30 | * along with this program; if not, write to the Free Software | ||
31 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | ||
32 | * | ||
33 | */ | ||
34 | #include "stv0299.h" | ||
35 | #include "mt352.h" | ||
36 | #include "mt312.h" | ||
37 | |||
38 | static int samsung_tbmu24112_set_symbol_rate(struct dvb_frontend* fe, u32 srate, u32 ratio) | ||
39 | { | ||
40 | u8 aclk = 0; | ||
41 | u8 bclk = 0; | ||
42 | |||
43 | if (srate < 1500000) { aclk = 0xb7; bclk = 0x47; } | ||
44 | else if (srate < 3000000) { aclk = 0xb7; bclk = 0x4b; } | ||
45 | else if (srate < 7000000) { aclk = 0xb7; bclk = 0x4f; } | ||
46 | else if (srate < 14000000) { aclk = 0xb7; bclk = 0x53; } | ||
47 | else if (srate < 30000000) { aclk = 0xb6; bclk = 0x53; } | ||
48 | else if (srate < 45000000) { aclk = 0xb4; bclk = 0x51; } | ||
49 | |||
50 | stv0299_writereg (fe, 0x13, aclk); | ||
51 | stv0299_writereg (fe, 0x14, bclk); | ||
52 | stv0299_writereg (fe, 0x1f, (ratio >> 16) & 0xff); | ||
53 | stv0299_writereg (fe, 0x20, (ratio >> 8) & 0xff); | ||
54 | stv0299_writereg (fe, 0x21, (ratio ) & 0xf0); | ||
55 | |||
56 | return 0; | ||
57 | } | ||
58 | |||
59 | static int samsung_tbmu24112_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params) | ||
60 | { | ||
61 | u8 buf[4]; | ||
62 | u32 div; | ||
63 | struct i2c_msg msg = { .addr = 0x61, .flags = 0, .buf = buf, .len = sizeof(buf) }; | ||
64 | // struct adapter* adapter = (struct adapter*) fe->dvb->priv; | ||
65 | |||
66 | div = params->frequency / 125; | ||
67 | |||
68 | buf[0] = (div >> 8) & 0x7f; | ||
69 | buf[1] = div & 0xff; | ||
70 | buf[2] = 0x84; // 0xC4 | ||
71 | buf[3] = 0x08; | ||
72 | |||
73 | if (params->frequency < 1500000) buf[3] |= 0x10; | ||
74 | |||
75 | // if (i2c_transfer (&adapter->i2c_adap, &msg, 1) != 1) return -EIO; | ||
76 | return 0; | ||
77 | } | ||
78 | |||
79 | static u8 samsung_tbmu24112_inittab[] = { | ||
80 | 0x01, 0x15, | ||
81 | 0x02, 0x30, | ||
82 | 0x03, 0x00, | ||
83 | 0x04, 0x7D, | ||
84 | 0x05, 0x35, | ||
85 | 0x06, 0x02, | ||
86 | 0x07, 0x00, | ||
87 | 0x08, 0xC3, | ||
88 | 0x0C, 0x00, | ||
89 | 0x0D, 0x81, | ||
90 | 0x0E, 0x23, | ||
91 | 0x0F, 0x12, | ||
92 | 0x10, 0x7E, | ||
93 | 0x11, 0x84, | ||
94 | 0x12, 0xB9, | ||
95 | 0x13, 0x88, | ||
96 | 0x14, 0x89, | ||
97 | 0x15, 0xC9, | ||
98 | 0x16, 0x00, | ||
99 | 0x17, 0x5C, | ||
100 | 0x18, 0x00, | ||
101 | 0x19, 0x00, | ||
102 | 0x1A, 0x00, | ||
103 | 0x1C, 0x00, | ||
104 | 0x1D, 0x00, | ||
105 | 0x1E, 0x00, | ||
106 | 0x1F, 0x3A, | ||
107 | 0x20, 0x2E, | ||
108 | 0x21, 0x80, | ||
109 | 0x22, 0xFF, | ||
110 | 0x23, 0xC1, | ||
111 | 0x28, 0x00, | ||
112 | 0x29, 0x1E, | ||
113 | 0x2A, 0x14, | ||
114 | 0x2B, 0x0F, | ||
115 | 0x2C, 0x09, | ||
116 | 0x2D, 0x05, | ||
117 | 0x31, 0x1F, | ||
118 | 0x32, 0x19, | ||
119 | 0x33, 0xFE, | ||
120 | 0x34, 0x93, | ||
121 | 0xff, 0xff, | ||
122 | }; | ||
123 | |||
124 | static struct stv0299_config samsung_tbmu24112_config = { | ||
125 | .demod_address = 0x68, | ||
126 | .inittab = samsung_tbmu24112_inittab, | ||
127 | .mclk = 88000000UL, | ||
128 | .invert = 0, | ||
129 | .enhanced_tuning = 0, | ||
130 | .skip_reinit = 0, | ||
131 | .lock_output = STV0229_LOCKOUTPUT_LK, | ||
132 | .volt13_op0_op1 = STV0299_VOLT13_OP1, | ||
133 | .min_delay_ms = 100, | ||
134 | .set_symbol_rate = samsung_tbmu24112_set_symbol_rate, | ||
135 | .pll_set = samsung_tbmu24112_pll_set, | ||
136 | }; | ||
137 | |||
138 | |||
139 | |||
140 | |||
141 | |||
142 | static int samsung_tdtc9251dh0_demod_init(struct dvb_frontend* fe) | ||
143 | { | ||
144 | static u8 mt352_clock_config [] = { 0x89, 0x10, 0x2d }; | ||
145 | static u8 mt352_reset [] = { 0x50, 0x80 }; | ||
146 | static u8 mt352_adc_ctl_1_cfg [] = { 0x8E, 0x40 }; | ||
147 | static u8 mt352_agc_cfg [] = { 0x67, 0x28, 0xa1 }; | ||
148 | static u8 mt352_capt_range_cfg[] = { 0x75, 0x32 }; | ||
149 | |||
150 | mt352_write(fe, mt352_clock_config, sizeof(mt352_clock_config)); | ||
151 | udelay(2000); | ||
152 | mt352_write(fe, mt352_reset, sizeof(mt352_reset)); | ||
153 | mt352_write(fe, mt352_adc_ctl_1_cfg, sizeof(mt352_adc_ctl_1_cfg)); | ||
154 | |||
155 | mt352_write(fe, mt352_agc_cfg, sizeof(mt352_agc_cfg)); | ||
156 | mt352_write(fe, mt352_capt_range_cfg, sizeof(mt352_capt_range_cfg)); | ||
157 | |||
158 | return 0; | ||
159 | } | ||
160 | |||
161 | static int samsung_tdtc9251dh0_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params, u8* pllbuf) | ||
162 | { | ||
163 | u32 div; | ||
164 | unsigned char bs = 0; | ||
165 | |||
166 | #define IF_FREQUENCYx6 217 /* 6 * 36.16666666667MHz */ | ||
167 | div = (((params->frequency + 83333) * 3) / 500000) + IF_FREQUENCYx6; | ||
168 | |||
169 | if (params->frequency >= 48000000 && params->frequency <= 154000000) bs = 0x09; | ||
170 | if (params->frequency >= 161000000 && params->frequency <= 439000000) bs = 0x0a; | ||
171 | if (params->frequency >= 447000000 && params->frequency <= 863000000) bs = 0x08; | ||
172 | |||
173 | pllbuf[0] = 0xc2; // Note: non-linux standard PLL i2c address | ||
174 | pllbuf[1] = div >> 8; | ||
175 | pllbuf[2] = div & 0xff; | ||
176 | pllbuf[3] = 0xcc; | ||
177 | pllbuf[4] = bs; | ||
178 | |||
179 | return 0; | ||
180 | } | ||
181 | |||
182 | static struct mt352_config samsung_tdtc9251dh0_config = { | ||
183 | |||
184 | .demod_address = 0x0f, | ||
185 | .demod_init = samsung_tdtc9251dh0_demod_init, | ||
186 | .pll_set = samsung_tdtc9251dh0_pll_set, | ||
187 | }; | ||
188 | |||
189 | static int skystar23_samsung_tbdu18132_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params) | ||
190 | { | ||
191 | u8 buf[4]; | ||
192 | u32 div; | ||
193 | struct i2c_msg msg = { .addr = 0x61, .flags = 0, .buf = buf, .len = sizeof(buf) }; | ||
194 | // struct adapter* adapter = (struct adapter*) fe->dvb->priv; | ||
195 | |||
196 | div = (params->frequency + (125/2)) / 125; | ||
197 | |||
198 | buf[0] = (div >> 8) & 0x7f; | ||
199 | buf[1] = (div >> 0) & 0xff; | ||
200 | buf[2] = 0x84 | ((div >> 10) & 0x60); | ||
201 | buf[3] = 0x80; | ||
202 | |||
203 | if (params->frequency < 1550000) | ||
204 | buf[3] |= 0x02; | ||
205 | |||
206 | //if (i2c_transfer (&adapter->i2c_adap, &msg, 1) != 1) return -EIO; | ||
207 | return 0; | ||
208 | } | ||
209 | |||
210 | static struct mt312_config skystar23_samsung_tbdu18132_config = { | ||
211 | |||
212 | .demod_address = 0x0e, | ||
213 | .pll_set = skystar23_samsung_tbdu18132_pll_set, | ||
214 | }; | ||
diff --git a/drivers/media/dvb/b2c2/b2c2-usb-core.c b/drivers/media/dvb/b2c2/b2c2-usb-core.c deleted file mode 100644 index 9306da046c91..000000000000 --- a/drivers/media/dvb/b2c2/b2c2-usb-core.c +++ /dev/null | |||
@@ -1,549 +0,0 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2004 Patrick Boettcher <patrick.boettcher@desy.de>, | ||
3 | * Luca Bertagnolio <>, | ||
4 | * | ||
5 | * based on information provided by John Jurrius from BBTI, Inc. | ||
6 | * | ||
7 | * This program is free software; you can redistribute it and/or | ||
8 | * modify it under the terms of the GNU General Public License as | ||
9 | * published by the Free Software Foundation, version 2. | ||
10 | * | ||
11 | */ | ||
12 | |||
13 | #include <linux/config.h> | ||
14 | #include <linux/kernel.h> | ||
15 | #include <linux/usb.h> | ||
16 | #include <linux/moduleparam.h> | ||
17 | #include <linux/pci.h> | ||
18 | #include <linux/version.h> | ||
19 | |||
20 | #include "dmxdev.h" | ||
21 | #include "dvb_demux.h" | ||
22 | #include "dvb_filter.h" | ||
23 | #include "dvb_net.h" | ||
24 | #include "dvb_frontend.h" | ||
25 | |||
26 | /* debug */ | ||
27 | #define dprintk(level,args...) \ | ||
28 | do { if ((debug & level)) { printk(args); } } while (0) | ||
29 | #define debug_dump(b,l) if (debug) {\ | ||
30 | int i; deb_xfer("%s: %d > ",__FUNCTION__,l); \ | ||
31 | for (i = 0; i < l; i++) deb_xfer("%02x ", b[i]); \ | ||
32 | deb_xfer("\n");\ | ||
33 | } | ||
34 | |||
35 | static int debug; | ||
36 | module_param(debug, int, 0644); | ||
37 | MODULE_PARM_DESC(debug, "set debugging level (1=info,ts=2,ctrl=4 (or-able))."); | ||
38 | |||
39 | #define deb_info(args...) dprintk(0x01,args) | ||
40 | #define deb_ts(args...) dprintk(0x02,args) | ||
41 | #define deb_ctrl(args...) dprintk(0x04,args) | ||
42 | |||
43 | /* Version information */ | ||
44 | #define DRIVER_VERSION "0.0" | ||
45 | #define DRIVER_DESC "Driver for B2C2/Technisat Air/Cable/Sky-2-PC USB devices" | ||
46 | #define DRIVER_AUTHOR "Patrick Boettcher, patrick.boettcher@desy.de" | ||
47 | |||
48 | /* transfer parameters */ | ||
49 | #define B2C2_USB_FRAMES_PER_ISO 4 | ||
50 | #define B2C2_USB_NUM_ISO_URB 4 /* TODO check out a good value */ | ||
51 | |||
52 | #define B2C2_USB_CTRL_PIPE_IN usb_rcvctrlpipe(b2c2->udev,0) | ||
53 | #define B2C2_USB_CTRL_PIPE_OUT usb_sndctrlpipe(b2c2->udev,0) | ||
54 | #define B2C2_USB_DATA_PIPE usb_rcvisocpipe(b2c2->udev,0x81) | ||
55 | |||
56 | struct usb_b2c2_usb { | ||
57 | struct usb_device *udev; | ||
58 | struct usb_interface *uintf; | ||
59 | |||
60 | u8 *iso_buffer; | ||
61 | int buffer_size; | ||
62 | dma_addr_t iso_dma_handle; | ||
63 | struct urb *iso_urb[B2C2_USB_NUM_ISO_URB]; | ||
64 | }; | ||
65 | |||
66 | |||
67 | /* | ||
68 | * USB | ||
69 | * 10 90 34 12 78 56 04 00 | ||
70 | * usb_control_msg(udev, usb_sndctrlpipe(udev,0), | ||
71 | * 0x90, | ||
72 | * 0x10, | ||
73 | * 0x1234, | ||
74 | * 0x5678, | ||
75 | * buf, | ||
76 | * 4, | ||
77 | * 5*HZ); | ||
78 | * | ||
79 | * extern int usb_control_msg(struct usb_device *dev, unsigned int pipe, | ||
80 | * __u8 request, | ||
81 | * __u8 requesttype, | ||
82 | * __u16 value, | ||
83 | * __u16 index, | ||
84 | * void *data, | ||
85 | * __u16 size, | ||
86 | * int timeout); | ||
87 | * | ||
88 | */ | ||
89 | |||
90 | /* request types */ | ||
91 | typedef enum { | ||
92 | |||
93 | /* something is wrong with this part | ||
94 | RTYPE_READ_DW = (1 << 6), | ||
95 | RTYPE_WRITE_DW_1 = (3 << 6), | ||
96 | RTYPE_READ_V8_MEMORY = (6 << 6), | ||
97 | RTYPE_WRITE_V8_MEMORY = (7 << 6), | ||
98 | RTYPE_WRITE_V8_FLASH = (8 << 6), | ||
99 | RTYPE_GENERIC = (9 << 6), | ||
100 | */ | ||
101 | RTYPE_READ_DW = (3 << 6), | ||
102 | RTYPE_WRITE_DW_1 = (1 << 6), | ||
103 | |||
104 | RTYPE_READ_V8_MEMORY = (6 << 6), | ||
105 | RTYPE_WRITE_V8_MEMORY = (7 << 6), | ||
106 | RTYPE_WRITE_V8_FLASH = (8 << 6), | ||
107 | RTYPE_GENERIC = (9 << 6), | ||
108 | } b2c2_usb_request_type_t; | ||
109 | |||
110 | /* request */ | ||
111 | typedef enum { | ||
112 | B2C2_USB_WRITE_V8_MEM = 0x04, | ||
113 | B2C2_USB_READ_V8_MEM = 0x05, | ||
114 | B2C2_USB_READ_REG = 0x08, | ||
115 | B2C2_USB_WRITE_REG = 0x0A, | ||
116 | /* B2C2_USB_WRITEREGLO = 0x0A, */ | ||
117 | B2C2_USB_WRITEREGHI = 0x0B, | ||
118 | B2C2_USB_FLASH_BLOCK = 0x10, | ||
119 | B2C2_USB_I2C_REQUEST = 0x11, | ||
120 | B2C2_USB_UTILITY = 0x12, | ||
121 | } b2c2_usb_request_t; | ||
122 | |||
123 | /* function definition for I2C_REQUEST */ | ||
124 | typedef enum { | ||
125 | USB_FUNC_I2C_WRITE = 0x01, | ||
126 | USB_FUNC_I2C_MULTIWRITE = 0x02, | ||
127 | USB_FUNC_I2C_READ = 0x03, | ||
128 | USB_FUNC_I2C_REPEATWRITE = 0x04, | ||
129 | USB_FUNC_GET_DESCRIPTOR = 0x05, | ||
130 | USB_FUNC_I2C_REPEATREAD = 0x06, | ||
131 | /* DKT 020208 - add this to support special case of DiSEqC */ | ||
132 | USB_FUNC_I2C_CHECKWRITE = 0x07, | ||
133 | USB_FUNC_I2C_CHECKRESULT = 0x08, | ||
134 | } b2c2_usb_i2c_function_t; | ||
135 | |||
136 | /* | ||
137 | * function definition for UTILITY request 0x12 | ||
138 | * DKT 020304 - new utility function | ||
139 | */ | ||
140 | typedef enum { | ||
141 | UTILITY_SET_FILTER = 0x01, | ||
142 | UTILITY_DATA_ENABLE = 0x02, | ||
143 | UTILITY_FLEX_MULTIWRITE = 0x03, | ||
144 | UTILITY_SET_BUFFER_SIZE = 0x04, | ||
145 | UTILITY_FLEX_OPERATOR = 0x05, | ||
146 | UTILITY_FLEX_RESET300_START = 0x06, | ||
147 | UTILITY_FLEX_RESET300_STOP = 0x07, | ||
148 | UTILITY_FLEX_RESET300 = 0x08, | ||
149 | UTILITY_SET_ISO_SIZE = 0x09, | ||
150 | UTILITY_DATA_RESET = 0x0A, | ||
151 | UTILITY_GET_DATA_STATUS = 0x10, | ||
152 | UTILITY_GET_V8_REG = 0x11, | ||
153 | /* DKT 020326 - add function for v1.14 */ | ||
154 | UTILITY_SRAM_WRITE = 0x12, | ||
155 | UTILITY_SRAM_READ = 0x13, | ||
156 | UTILITY_SRAM_TESTFILL = 0x14, | ||
157 | UTILITY_SRAM_TESTSET = 0x15, | ||
158 | UTILITY_SRAM_TESTVERIFY = 0x16, | ||
159 | } b2c2_usb_utility_function_t; | ||
160 | |||
161 | #define B2C2_WAIT_FOR_OPERATION_RW 1 // 1 s | ||
162 | #define B2C2_WAIT_FOR_OPERATION_RDW 3 // 3 s | ||
163 | #define B2C2_WAIT_FOR_OPERATION_WDW 1 // 1 s | ||
164 | |||
165 | #define B2C2_WAIT_FOR_OPERATION_V8READ 3 // 3 s | ||
166 | #define B2C2_WAIT_FOR_OPERATION_V8WRITE 3 // 3 s | ||
167 | #define B2C2_WAIT_FOR_OPERATION_V8FLASH 3 // 3 s | ||
168 | |||
169 | /* JLP 111700: we will include the 1 bit gap between the upper and lower 3 bits | ||
170 | * in the IBI address, to make the V8 code simpler. | ||
171 | * PCI ADDRESS FORMAT: 0x71C -> 0000 0111 0001 1100 (these are the six bits used) | ||
172 | * in general: 0000 0HHH 000L LL00 | ||
173 | * IBI ADDRESS FORMAT: RHHH BLLL | ||
174 | * | ||
175 | * where R is the read(1)/write(0) bit, B is the busy bit | ||
176 | * and HHH and LLL are the two sets of three bits from the PCI address. | ||
177 | */ | ||
178 | #define B2C2_FLEX_PCIOFFSET_TO_INTERNALADDR(usPCI) (u8) (((usPCI >> 2) & 0x07) + ((usPCI >> 4) & 0x70)) | ||
179 | #define B2C2_FLEX_INTERNALADDR_TO_PCIOFFSET(ucAddr) (u16) (((ucAddr & 0x07) << 2) + ((ucAddr & 0x70) << 4)) | ||
180 | |||
181 | /* | ||
182 | * DKT 020228 - forget about this VENDOR_BUFFER_SIZE, read and write register | ||
183 | * deal with DWORD or 4 bytes, that should be should from now on | ||
184 | */ | ||
185 | static u32 b2c2_usb_read_dw(struct usb_b2c2_usb *b2c2, u16 wRegOffsPCI) | ||
186 | { | ||
187 | u32 val; | ||
188 | u16 wAddress = B2C2_FLEX_PCIOFFSET_TO_INTERNALADDR(wRegOffsPCI) | 0x0080; | ||
189 | int len = usb_control_msg(b2c2->udev, | ||
190 | B2C2_USB_CTRL_PIPE_IN, | ||
191 | B2C2_USB_READ_REG, | ||
192 | RTYPE_READ_DW, | ||
193 | wAddress, | ||
194 | 0, | ||
195 | &val, | ||
196 | sizeof(u32), | ||
197 | B2C2_WAIT_FOR_OPERATION_RDW * 1000); | ||
198 | |||
199 | if (len != sizeof(u32)) { | ||
200 | err("error while reading dword from %d (%d).",wAddress,wRegOffsPCI); | ||
201 | return -EIO; | ||
202 | } else | ||
203 | return val; | ||
204 | } | ||
205 | |||
206 | /* | ||
207 | * DKT 020228 - from now on, we don't support anything older than firm 1.00 | ||
208 | * I eliminated the write register as a 2 trip of writing hi word and lo word | ||
209 | * and force this to write only 4 bytes at a time. | ||
210 | * NOTE: this should work with all the firmware from 1.00 and newer | ||
211 | */ | ||
212 | static int b2c2_usb_write_dw(struct usb_b2c2_usb *b2c2, u16 wRegOffsPCI, u32 val) | ||
213 | { | ||
214 | u16 wAddress = B2C2_FLEX_PCIOFFSET_TO_INTERNALADDR(wRegOffsPCI); | ||
215 | int len = usb_control_msg(b2c2->udev, | ||
216 | B2C2_USB_CTRL_PIPE_OUT, | ||
217 | B2C2_USB_WRITE_REG, | ||
218 | RTYPE_WRITE_DW_1, | ||
219 | wAddress, | ||
220 | 0, | ||
221 | &val, | ||
222 | sizeof(u32), | ||
223 | B2C2_WAIT_FOR_OPERATION_RDW * 1000); | ||
224 | |||
225 | if (len != sizeof(u32)) { | ||
226 | err("error while reading dword from %d (%d).",wAddress,wRegOffsPCI); | ||
227 | return -EIO; | ||
228 | } else | ||
229 | return 0; | ||
230 | } | ||
231 | |||
232 | /* | ||
233 | * DKT 010817 - add support for V8 memory read/write and flash update | ||
234 | */ | ||
235 | static int b2c2_usb_v8_memory_req(struct usb_b2c2_usb *b2c2, | ||
236 | b2c2_usb_request_t req, u8 page, u16 wAddress, | ||
237 | u16 buflen, u8 *pbBuffer) | ||
238 | { | ||
239 | u8 dwRequestType; | ||
240 | u16 wIndex; | ||
241 | int nWaitTime,pipe,len; | ||
242 | |||
243 | wIndex = page << 8; | ||
244 | |||
245 | switch (req) { | ||
246 | case B2C2_USB_READ_V8_MEM: | ||
247 | nWaitTime = B2C2_WAIT_FOR_OPERATION_V8READ; | ||
248 | dwRequestType = (u8) RTYPE_READ_V8_MEMORY; | ||
249 | pipe = B2C2_USB_CTRL_PIPE_IN; | ||
250 | break; | ||
251 | case B2C2_USB_WRITE_V8_MEM: | ||
252 | wIndex |= pbBuffer[0]; | ||
253 | nWaitTime = B2C2_WAIT_FOR_OPERATION_V8WRITE; | ||
254 | dwRequestType = (u8) RTYPE_WRITE_V8_MEMORY; | ||
255 | pipe = B2C2_USB_CTRL_PIPE_OUT; | ||
256 | break; | ||
257 | case B2C2_USB_FLASH_BLOCK: | ||
258 | nWaitTime = B2C2_WAIT_FOR_OPERATION_V8FLASH; | ||
259 | dwRequestType = (u8) RTYPE_WRITE_V8_FLASH; | ||
260 | pipe = B2C2_USB_CTRL_PIPE_OUT; | ||
261 | break; | ||
262 | default: | ||
263 | deb_info("unsupported request for v8_mem_req %x.\n",req); | ||
264 | return -EINVAL; | ||
265 | } | ||
266 | len = usb_control_msg(b2c2->udev,pipe, | ||
267 | req, | ||
268 | dwRequestType, | ||
269 | wAddress, | ||
270 | wIndex, | ||
271 | pbBuffer, | ||
272 | buflen, | ||
273 | nWaitTime * 1000); | ||
274 | return len == buflen ? 0 : -EIO; | ||
275 | } | ||
276 | |||
277 | static int b2c2_usb_i2c_req(struct usb_b2c2_usb *b2c2, | ||
278 | b2c2_usb_request_t req, b2c2_usb_i2c_function_t func, | ||
279 | u8 port, u8 chipaddr, u8 addr, u8 buflen, u8 *buf) | ||
280 | { | ||
281 | u16 wValue, wIndex; | ||
282 | int nWaitTime,pipe,len; | ||
283 | u8 dwRequestType; | ||
284 | |||
285 | switch (func) { | ||
286 | case USB_FUNC_I2C_WRITE: | ||
287 | case USB_FUNC_I2C_MULTIWRITE: | ||
288 | case USB_FUNC_I2C_REPEATWRITE: | ||
289 | /* DKT 020208 - add this to support special case of DiSEqC */ | ||
290 | case USB_FUNC_I2C_CHECKWRITE: | ||
291 | pipe = B2C2_USB_CTRL_PIPE_OUT; | ||
292 | nWaitTime = 2; | ||
293 | dwRequestType = (u8) RTYPE_GENERIC; | ||
294 | break; | ||
295 | case USB_FUNC_I2C_READ: | ||
296 | case USB_FUNC_I2C_REPEATREAD: | ||
297 | pipe = B2C2_USB_CTRL_PIPE_IN; | ||
298 | nWaitTime = 2; | ||
299 | dwRequestType = (u8) RTYPE_GENERIC; | ||
300 | break; | ||
301 | default: | ||
302 | deb_info("unsupported function for i2c_req %x\n",func); | ||
303 | return -EINVAL; | ||
304 | } | ||
305 | wValue = (func << 8 ) | port; | ||
306 | wIndex = (chipaddr << 8 ) | addr; | ||
307 | |||
308 | len = usb_control_msg(b2c2->udev,pipe, | ||
309 | req, | ||
310 | dwRequestType, | ||
311 | addr, | ||
312 | wIndex, | ||
313 | buf, | ||
314 | buflen, | ||
315 | nWaitTime * 1000); | ||
316 | return len == buflen ? 0 : -EIO; | ||
317 | } | ||
318 | |||
319 | int static b2c2_usb_utility_req(struct usb_b2c2_usb *b2c2, int set, | ||
320 | b2c2_usb_utility_function_t func, u8 extra, u16 wIndex, | ||
321 | u16 buflen, u8 *pvBuffer) | ||
322 | { | ||
323 | u16 wValue; | ||
324 | int nWaitTime = 2, | ||
325 | pipe = set ? B2C2_USB_CTRL_PIPE_OUT : B2C2_USB_CTRL_PIPE_IN, | ||
326 | len; | ||
327 | |||
328 | wValue = (func << 8) | extra; | ||
329 | |||
330 | len = usb_control_msg(b2c2->udev,pipe, | ||
331 | B2C2_USB_UTILITY, | ||
332 | (u8) RTYPE_GENERIC, | ||
333 | wValue, | ||
334 | wIndex, | ||
335 | pvBuffer, | ||
336 | buflen, | ||
337 | nWaitTime * 1000); | ||
338 | return len == buflen ? 0 : -EIO; | ||
339 | } | ||
340 | |||
341 | |||
342 | |||
343 | static void b2c2_dumpfourreg(struct usb_b2c2_usb *b2c2, u16 offs) | ||
344 | { | ||
345 | u32 r0,r1,r2,r3; | ||
346 | r0 = r1 = r2 = r3 = 0; | ||
347 | r0 = b2c2_usb_read_dw(b2c2,offs); | ||
348 | r1 = b2c2_usb_read_dw(b2c2,offs + 0x04); | ||
349 | r2 = b2c2_usb_read_dw(b2c2,offs + 0x08); | ||
350 | r3 = b2c2_usb_read_dw(b2c2,offs + 0x0c); | ||
351 | deb_ctrl("dump: offset: %03x, %08x, %08x, %08x, %08x\n",offs,r0,r1,r2,r3); | ||
352 | } | ||
353 | |||
354 | static void b2c2_urb_complete(struct urb *urb, struct pt_regs *ptregs) | ||
355 | { | ||
356 | struct usb_b2c2_usb *b2c2 = urb->context; | ||
357 | deb_ts("urb completed, bufsize: %d\n",urb->transfer_buffer_length); | ||
358 | |||
359 | // urb_submit_urb(urb,GFP_ATOMIC); enable for real action | ||
360 | } | ||
361 | |||
362 | static void b2c2_exit_usb(struct usb_b2c2_usb *b2c2) | ||
363 | { | ||
364 | int i; | ||
365 | for (i = 0; i < B2C2_USB_NUM_ISO_URB; i++) | ||
366 | if (b2c2->iso_urb[i] != NULL) { /* not sure about unlink_urb and iso-urbs TODO */ | ||
367 | deb_info("unlinking/killing urb no. %d\n",i); | ||
368 | #if LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,7) | ||
369 | usb_unlink_urb(b2c2->iso_urb[i]); | ||
370 | #else | ||
371 | usb_kill_urb(b2c2->iso_urb[i]); | ||
372 | #endif | ||
373 | usb_free_urb(b2c2->iso_urb[i]); | ||
374 | } | ||
375 | |||
376 | if (b2c2->iso_buffer != NULL) | ||
377 | pci_free_consistent(NULL,b2c2->buffer_size, b2c2->iso_buffer, b2c2->iso_dma_handle); | ||
378 | |||
379 | } | ||
380 | |||
381 | static int b2c2_init_usb(struct usb_b2c2_usb *b2c2) | ||
382 | { | ||
383 | u16 frame_size = le16_to_cpu(b2c2->uintf->cur_altsetting->endpoint[0].desc.wMaxPacketSize); | ||
384 | int bufsize = B2C2_USB_NUM_ISO_URB * B2C2_USB_FRAMES_PER_ISO * frame_size,i,j,ret; | ||
385 | int buffer_offset = 0; | ||
386 | |||
387 | deb_info("creating %d iso-urbs with %d frames each of %d bytes size = %d.\n", | ||
388 | B2C2_USB_NUM_ISO_URB, B2C2_USB_FRAMES_PER_ISO, frame_size,bufsize); | ||
389 | |||
390 | b2c2->iso_buffer = pci_alloc_consistent(NULL,bufsize,&b2c2->iso_dma_handle); | ||
391 | if (b2c2->iso_buffer == NULL) | ||
392 | return -ENOMEM; | ||
393 | memset(b2c2->iso_buffer, 0, bufsize); | ||
394 | b2c2->buffer_size = bufsize; | ||
395 | |||
396 | /* creating iso urbs */ | ||
397 | for (i = 0; i < B2C2_USB_NUM_ISO_URB; i++) | ||
398 | if (!(b2c2->iso_urb[i] = usb_alloc_urb(B2C2_USB_FRAMES_PER_ISO,GFP_ATOMIC))) { | ||
399 | ret = -ENOMEM; | ||
400 | goto urb_error; | ||
401 | } | ||
402 | /* initialising and submitting iso urbs */ | ||
403 | for (i = 0; i < B2C2_USB_NUM_ISO_URB; i++) { | ||
404 | int frame_offset = 0; | ||
405 | struct urb *urb = b2c2->iso_urb[i]; | ||
406 | deb_info("initializing and submitting urb no. %d (buf_offset: %d).\n",i,buffer_offset); | ||
407 | |||
408 | urb->dev = b2c2->udev; | ||
409 | urb->context = b2c2; | ||
410 | urb->complete = b2c2_urb_complete; | ||
411 | urb->pipe = B2C2_USB_DATA_PIPE; | ||
412 | urb->transfer_flags = URB_ISO_ASAP; | ||
413 | urb->interval = 1; | ||
414 | urb->number_of_packets = B2C2_USB_FRAMES_PER_ISO; | ||
415 | urb->transfer_buffer_length = frame_size * B2C2_USB_FRAMES_PER_ISO; | ||
416 | urb->transfer_buffer = b2c2->iso_buffer + buffer_offset; | ||
417 | |||
418 | buffer_offset += frame_size * B2C2_USB_FRAMES_PER_ISO; | ||
419 | for (j = 0; j < B2C2_USB_FRAMES_PER_ISO; j++) { | ||
420 | deb_info("urb no: %d, frame: %d, frame_offset: %d\n",i,j,frame_offset); | ||
421 | urb->iso_frame_desc[j].offset = frame_offset; | ||
422 | urb->iso_frame_desc[j].length = frame_size; | ||
423 | frame_offset += frame_size; | ||
424 | } | ||
425 | |||
426 | if ((ret = usb_submit_urb(b2c2->iso_urb[i],GFP_ATOMIC))) { | ||
427 | err("submitting urb %d failed with %d.",i,ret); | ||
428 | goto urb_error; | ||
429 | } | ||
430 | deb_info("submitted urb no. %d.\n",i); | ||
431 | } | ||
432 | |||
433 | ret = 0; | ||
434 | goto success; | ||
435 | urb_error: | ||
436 | b2c2_exit_usb(b2c2); | ||
437 | success: | ||
438 | return ret; | ||
439 | } | ||
440 | |||
441 | static int b2c2_usb_probe(struct usb_interface *intf, | ||
442 | const struct usb_device_id *id) | ||
443 | { | ||
444 | struct usb_device *udev = interface_to_usbdev(intf); | ||
445 | struct usb_b2c2_usb *b2c2 = NULL; | ||
446 | int ret; | ||
447 | |||
448 | b2c2 = kmalloc(sizeof(struct usb_b2c2_usb),GFP_KERNEL); | ||
449 | if (b2c2 == NULL) { | ||
450 | err("no memory"); | ||
451 | return -ENOMEM; | ||
452 | } | ||
453 | b2c2->udev = udev; | ||
454 | b2c2->uintf = intf; | ||
455 | |||
456 | /* use the alternate setting with the larges buffer */ | ||
457 | usb_set_interface(udev,0,1); | ||
458 | |||
459 | if ((ret = b2c2_init_usb(b2c2))) | ||
460 | goto usb_init_error; | ||
461 | |||
462 | usb_set_intfdata(intf,b2c2); | ||
463 | |||
464 | switch (udev->speed) { | ||
465 | case USB_SPEED_LOW: | ||
466 | err("cannot handle USB speed because it is to sLOW."); | ||
467 | break; | ||
468 | case USB_SPEED_FULL: | ||
469 | info("running at FULL speed."); | ||
470 | break; | ||
471 | case USB_SPEED_HIGH: | ||
472 | info("running at HIGH speed."); | ||
473 | break; | ||
474 | case USB_SPEED_UNKNOWN: /* fall through */ | ||
475 | default: | ||
476 | err("cannot handle USB speed because it is unkown."); | ||
477 | break; | ||
478 | } | ||
479 | |||
480 | b2c2_dumpfourreg(b2c2,0x200); | ||
481 | b2c2_dumpfourreg(b2c2,0x300); | ||
482 | b2c2_dumpfourreg(b2c2,0x400); | ||
483 | b2c2_dumpfourreg(b2c2,0x700); | ||
484 | |||
485 | |||
486 | if (ret == 0) | ||
487 | info("%s successfully initialized and connected.",DRIVER_DESC); | ||
488 | else | ||
489 | info("%s error while loading driver (%d)",DRIVER_DESC,ret); | ||
490 | |||
491 | ret = 0; | ||
492 | goto success; | ||
493 | |||
494 | usb_init_error: | ||
495 | kfree(b2c2); | ||
496 | success: | ||
497 | return ret; | ||
498 | } | ||
499 | |||
500 | static void b2c2_usb_disconnect(struct usb_interface *intf) | ||
501 | { | ||
502 | struct usb_b2c2_usb *b2c2 = usb_get_intfdata(intf); | ||
503 | usb_set_intfdata(intf,NULL); | ||
504 | if (b2c2 != NULL) { | ||
505 | b2c2_exit_usb(b2c2); | ||
506 | kfree(b2c2); | ||
507 | } | ||
508 | info("%s successfully deinitialized and disconnected.",DRIVER_DESC); | ||
509 | |||
510 | } | ||
511 | |||
512 | static struct usb_device_id b2c2_usb_table [] = { | ||
513 | { USB_DEVICE(0x0af7, 0x0101) } | ||
514 | }; | ||
515 | |||
516 | /* usb specific object needed to register this driver with the usb subsystem */ | ||
517 | static struct usb_driver b2c2_usb_driver = { | ||
518 | .owner = THIS_MODULE, | ||
519 | .name = "dvb_b2c2_usb", | ||
520 | .probe = b2c2_usb_probe, | ||
521 | .disconnect = b2c2_usb_disconnect, | ||
522 | .id_table = b2c2_usb_table, | ||
523 | }; | ||
524 | |||
525 | /* module stuff */ | ||
526 | static int __init b2c2_usb_init(void) | ||
527 | { | ||
528 | int result; | ||
529 | if ((result = usb_register(&b2c2_usb_driver))) { | ||
530 | err("usb_register failed. Error number %d",result); | ||
531 | return result; | ||
532 | } | ||
533 | |||
534 | return 0; | ||
535 | } | ||
536 | |||
537 | static void __exit b2c2_usb_exit(void) | ||
538 | { | ||
539 | /* deregister this driver from the USB subsystem */ | ||
540 | usb_deregister(&b2c2_usb_driver); | ||
541 | } | ||
542 | |||
543 | module_init (b2c2_usb_init); | ||
544 | module_exit (b2c2_usb_exit); | ||
545 | |||
546 | MODULE_AUTHOR(DRIVER_AUTHOR); | ||
547 | MODULE_DESCRIPTION(DRIVER_DESC); | ||
548 | MODULE_LICENSE("GPL"); | ||
549 | MODULE_DEVICE_TABLE(usb, b2c2_usb_table); | ||
diff --git a/drivers/media/dvb/b2c2/flexcop-common.h b/drivers/media/dvb/b2c2/flexcop-common.h new file mode 100644 index 000000000000..773d158032df --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop-common.h | |||
@@ -0,0 +1,164 @@ | |||
1 | /* | ||
2 | * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III | ||
3 | * | ||
4 | * flexcop-common.h - common header file for device-specific source files also. | ||
5 | * | ||
6 | * see flexcop.c for copyright information. | ||
7 | */ | ||
8 | #ifndef __FLEXCOP_COMMON_H__ | ||
9 | #define __FLEXCOP_COMMON_H__ | ||
10 | |||
11 | #include <linux/config.h> | ||
12 | #include <linux/pci.h> | ||
13 | |||
14 | #include "flexcop-reg.h" | ||
15 | |||
16 | #include "dmxdev.h" | ||
17 | #include "dvb_demux.h" | ||
18 | #include "dvb_filter.h" | ||
19 | #include "dvb_net.h" | ||
20 | #include "dvb_frontend.h" | ||
21 | |||
22 | #define FC_MAX_FEED 256 | ||
23 | |||
24 | #ifndef FC_LOG_PREFIX | ||
25 | #warning please define a log prefix for your file, using a default one | ||
26 | #define FC_LOG_PREFIX "b2c2-undef" | ||
27 | #endif | ||
28 | |||
29 | /* Steal from usb.h */ | ||
30 | #undef err | ||
31 | #define err(format, arg...) printk(KERN_ERR FC_LOG_PREFIX ": " format "\n" , ## arg) | ||
32 | #undef info | ||
33 | #define info(format, arg...) printk(KERN_INFO FC_LOG_PREFIX ": " format "\n" , ## arg) | ||
34 | #undef warn | ||
35 | #define warn(format, arg...) printk(KERN_WARNING FC_LOG_PREFIX ": " format "\n" , ## arg) | ||
36 | |||
37 | struct flexcop_dma { | ||
38 | struct pci_dev *pdev; | ||
39 | |||
40 | u8 *cpu_addr0; | ||
41 | dma_addr_t dma_addr0; | ||
42 | u8 *cpu_addr1; | ||
43 | dma_addr_t dma_addr1; | ||
44 | u32 size; /* size of each address in bytes */ | ||
45 | }; | ||
46 | |||
47 | /* Control structure for data definitions that are common to | ||
48 | * the B2C2-based PCI and USB devices. | ||
49 | */ | ||
50 | struct flexcop_device { | ||
51 | /* general */ | ||
52 | struct device *dev; /* for firmware_class */ | ||
53 | |||
54 | #define FC_STATE_DVB_INIT 0x01 | ||
55 | #define FC_STATE_I2C_INIT 0x02 | ||
56 | #define FC_STATE_FE_INIT 0x04 | ||
57 | int init_state; | ||
58 | |||
59 | /* device information */ | ||
60 | int has_32_hw_pid_filter; | ||
61 | flexcop_revision_t rev; | ||
62 | flexcop_device_type_t dev_type; | ||
63 | flexcop_bus_t bus_type; | ||
64 | |||
65 | /* dvb stuff */ | ||
66 | struct dvb_adapter dvb_adapter; | ||
67 | struct dvb_frontend *fe; | ||
68 | struct dvb_net dvbnet; | ||
69 | struct dvb_demux demux; | ||
70 | struct dmxdev dmxdev; | ||
71 | struct dmx_frontend hw_frontend; | ||
72 | struct dmx_frontend mem_frontend; | ||
73 | int (*fe_sleep) (struct dvb_frontend *); | ||
74 | |||
75 | struct i2c_adapter i2c_adap; | ||
76 | struct semaphore i2c_sem; | ||
77 | |||
78 | struct module *owner; | ||
79 | |||
80 | /* options and status */ | ||
81 | int extra_feedcount; | ||
82 | int feedcount; | ||
83 | int pid_filtering; | ||
84 | int fullts_streaming_state; | ||
85 | |||
86 | /* bus specific callbacks */ | ||
87 | flexcop_ibi_value (*read_ibi_reg) (struct flexcop_device *, flexcop_ibi_register); | ||
88 | int (*write_ibi_reg) (struct flexcop_device *, flexcop_ibi_register, flexcop_ibi_value); | ||
89 | |||
90 | |||
91 | int (*i2c_request) (struct flexcop_device*, flexcop_access_op_t, flexcop_i2c_port_t, u8 chipaddr, u8 addr, u8 *buf, u16 len); | ||
92 | int (*stream_control) (struct flexcop_device*, int); | ||
93 | |||
94 | int (*get_mac_addr) (struct flexcop_device *fc, int extended); | ||
95 | |||
96 | void *bus_specific; | ||
97 | }; | ||
98 | |||
99 | /* exported prototypes */ | ||
100 | |||
101 | /* from flexcop.c */ | ||
102 | void flexcop_pass_dmx_data(struct flexcop_device *fc, u8 *buf, u32 len); | ||
103 | void flexcop_pass_dmx_packets(struct flexcop_device *fc, u8 *buf, u32 no); | ||
104 | |||
105 | struct flexcop_device *flexcop_device_kmalloc(size_t bus_specific_len); | ||
106 | void flexcop_device_kfree(struct flexcop_device*); | ||
107 | |||
108 | int flexcop_device_initialize(struct flexcop_device*); | ||
109 | void flexcop_device_exit(struct flexcop_device *fc); | ||
110 | |||
111 | /* from flexcop-dma.c */ | ||
112 | int flexcop_dma_allocate(struct pci_dev *pdev, struct flexcop_dma *dma, u32 size); | ||
113 | void flexcop_dma_free(struct flexcop_dma *dma); | ||
114 | |||
115 | int flexcop_dma_control_timer_irq(struct flexcop_device *fc, flexcop_dma_index_t no, int onoff); | ||
116 | int flexcop_dma_control_size_irq(struct flexcop_device *fc, flexcop_dma_index_t no, int onoff); | ||
117 | int flexcop_dma_control_packet_irq(struct flexcop_device *fc, flexcop_dma_index_t no, int onoff); | ||
118 | int flexcop_dma_config(struct flexcop_device *fc, struct flexcop_dma *dma, flexcop_dma_index_t dma_idx,flexcop_dma_addr_index_t index); | ||
119 | int flexcop_dma_config_timer(struct flexcop_device *fc, flexcop_dma_index_t dma_idx, u8 cycles); | ||
120 | int flexcop_dma_config_packet_count(struct flexcop_device *fc, flexcop_dma_index_t dma_idx, u8 packets); | ||
121 | |||
122 | /* from flexcop-eeprom.c */ | ||
123 | /* the PCI part uses this call to get the MAC address, the USB part has its own */ | ||
124 | int flexcop_eeprom_check_mac_addr(struct flexcop_device *fc, int extended); | ||
125 | |||
126 | /* from flexcop-i2c.c */ | ||
127 | /* the PCI part uses this a i2c_request callback, whereas the usb part has its own | ||
128 | * one. We have it in flexcop-i2c.c, because it is going via the actual | ||
129 | * I2C-channel of the flexcop. | ||
130 | */ | ||
131 | int flexcop_i2c_request(struct flexcop_device*, flexcop_access_op_t, | ||
132 | flexcop_i2c_port_t, u8 chipaddr, u8 addr, u8 *buf, u16 len); | ||
133 | |||
134 | /* from flexcop-sram.c */ | ||
135 | int flexcop_sram_set_dest(struct flexcop_device *fc, flexcop_sram_dest_t dest, flexcop_sram_dest_target_t target); | ||
136 | void flexcop_wan_set_speed(struct flexcop_device *fc, flexcop_wan_speed_t s); | ||
137 | void flexcop_sram_ctrl(struct flexcop_device *fc, int usb_wan, int sramdma, int maximumfill); | ||
138 | |||
139 | /* global prototypes for the flexcop-chip */ | ||
140 | /* from flexcop-fe-tuner.c */ | ||
141 | int flexcop_frontend_init(struct flexcop_device *card); | ||
142 | void flexcop_frontend_exit(struct flexcop_device *fc); | ||
143 | |||
144 | /* from flexcop-i2c.c */ | ||
145 | int flexcop_i2c_init(struct flexcop_device *fc); | ||
146 | void flexcop_i2c_exit(struct flexcop_device *fc); | ||
147 | |||
148 | /* from flexcop-sram.c */ | ||
149 | int flexcop_sram_init(struct flexcop_device *fc); | ||
150 | |||
151 | /* from flexcop-misc.c */ | ||
152 | void flexcop_determine_revision(struct flexcop_device *fc); | ||
153 | void flexcop_device_name(struct flexcop_device *fc,const char *prefix,const char *suffix); | ||
154 | |||
155 | /* from flexcop-hw-filter.c */ | ||
156 | int flexcop_pid_feed_control(struct flexcop_device *fc, struct dvb_demux_feed *dvbdmxfeed, int onoff); | ||
157 | void flexcop_hw_filter_init(struct flexcop_device *fc); | ||
158 | |||
159 | void flexcop_smc_ctrl(struct flexcop_device *fc, int onoff); | ||
160 | |||
161 | void flexcop_set_mac_filter(struct flexcop_device *fc, u8 mac[6]); | ||
162 | void flexcop_mac_filter_ctrl(struct flexcop_device *fc, int onoff); | ||
163 | |||
164 | #endif | ||
diff --git a/drivers/media/dvb/b2c2/flexcop-dma.c b/drivers/media/dvb/b2c2/flexcop-dma.c new file mode 100644 index 000000000000..8d2706075360 --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop-dma.c | |||
@@ -0,0 +1,149 @@ | |||
1 | /* | ||
2 | * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III | ||
3 | * | ||
4 | * flexcop-dma.c - methods for configuring and controlling the DMA of the FlexCop. | ||
5 | * | ||
6 | * see flexcop.c for copyright information. | ||
7 | */ | ||
8 | #include "flexcop.h" | ||
9 | |||
10 | int flexcop_dma_allocate(struct pci_dev *pdev, struct flexcop_dma *dma, u32 size) | ||
11 | { | ||
12 | u8 *tcpu; | ||
13 | dma_addr_t tdma; | ||
14 | |||
15 | if (size % 2) { | ||
16 | err("dma buffersize has to be even."); | ||
17 | return -EINVAL; | ||
18 | } | ||
19 | |||
20 | if ((tcpu = pci_alloc_consistent(pdev, size, &tdma)) != NULL) { | ||
21 | dma->pdev = pdev; | ||
22 | dma->cpu_addr0 = tcpu; | ||
23 | dma->dma_addr0 = tdma; | ||
24 | dma->cpu_addr1 = tcpu + size/2; | ||
25 | dma->dma_addr1 = tdma + size/2; | ||
26 | dma->size = size/2; | ||
27 | return 0; | ||
28 | } | ||
29 | return -ENOMEM; | ||
30 | } | ||
31 | EXPORT_SYMBOL(flexcop_dma_allocate); | ||
32 | |||
33 | void flexcop_dma_free(struct flexcop_dma *dma) | ||
34 | { | ||
35 | pci_free_consistent(dma->pdev, dma->size*2,dma->cpu_addr0, dma->dma_addr0); | ||
36 | memset(dma,0,sizeof(struct flexcop_dma)); | ||
37 | } | ||
38 | EXPORT_SYMBOL(flexcop_dma_free); | ||
39 | |||
40 | int flexcop_dma_control_timer_irq(struct flexcop_device *fc, flexcop_dma_index_t no, int onoff) | ||
41 | { | ||
42 | flexcop_ibi_value v = fc->read_ibi_reg(fc,ctrl_208); | ||
43 | |||
44 | if (no & FC_DMA_1) | ||
45 | v.ctrl_208.DMA1_Timer_Enable_sig = onoff; | ||
46 | |||
47 | if (no & FC_DMA_2) | ||
48 | v.ctrl_208.DMA2_Timer_Enable_sig = onoff; | ||
49 | |||
50 | fc->write_ibi_reg(fc,ctrl_208,v); | ||
51 | return 0; | ||
52 | } | ||
53 | EXPORT_SYMBOL(flexcop_dma_control_timer_irq); | ||
54 | |||
55 | int flexcop_dma_control_size_irq(struct flexcop_device *fc, flexcop_dma_index_t no, int onoff) | ||
56 | { | ||
57 | flexcop_ibi_value v = fc->read_ibi_reg(fc,ctrl_208); | ||
58 | |||
59 | if (no & FC_DMA_1) | ||
60 | v.ctrl_208.DMA1_IRQ_Enable_sig = onoff; | ||
61 | |||
62 | if (no & FC_DMA_2) | ||
63 | v.ctrl_208.DMA2_IRQ_Enable_sig = onoff; | ||
64 | |||
65 | fc->write_ibi_reg(fc,ctrl_208,v); | ||
66 | return 0; | ||
67 | } | ||
68 | EXPORT_SYMBOL(flexcop_dma_control_size_irq); | ||
69 | |||
70 | int flexcop_dma_control_packet_irq(struct flexcop_device *fc, flexcop_dma_index_t no, int onoff) | ||
71 | { | ||
72 | flexcop_ibi_value v = fc->read_ibi_reg(fc,ctrl_208); | ||
73 | |||
74 | if (no & FC_DMA_1) | ||
75 | v.ctrl_208.DMA1_Size_IRQ_Enable_sig = onoff; | ||
76 | |||
77 | if (no & FC_DMA_2) | ||
78 | v.ctrl_208.DMA2_Size_IRQ_Enable_sig = onoff; | ||
79 | |||
80 | fc->write_ibi_reg(fc,ctrl_208,v); | ||
81 | return 0; | ||
82 | } | ||
83 | EXPORT_SYMBOL(flexcop_dma_control_packet_irq); | ||
84 | |||
85 | int flexcop_dma_config(struct flexcop_device *fc, struct flexcop_dma *dma, flexcop_dma_index_t dma_idx,flexcop_dma_addr_index_t index) | ||
86 | { | ||
87 | |||
88 | flexcop_ibi_value v0x0,v0x4,v0xc; | ||
89 | v0x0.raw = v0x4.raw = v0xc.raw = 0; | ||
90 | |||
91 | v0x0.dma_0x0.dma_address0 = dma->dma_addr0 >> 2; | ||
92 | v0xc.dma_0xc.dma_address1 = dma->dma_addr1 >> 2; | ||
93 | v0x4.dma_0x4_write.dma_addr_size = dma->size / 4; | ||
94 | |||
95 | if (index & FC_DMA_SUBADDR_0) | ||
96 | v0x0.dma_0x0.dma_0start = 1; | ||
97 | |||
98 | if (index & FC_DMA_SUBADDR_1) | ||
99 | v0xc.dma_0xc.dma_1start = 1; | ||
100 | |||
101 | if (dma_idx & FC_DMA_1) { | ||
102 | fc->write_ibi_reg(fc,dma1_000,v0x0); | ||
103 | fc->write_ibi_reg(fc,dma1_004,v0x4); | ||
104 | fc->write_ibi_reg(fc,dma1_00c,v0xc); | ||
105 | } else { /* (dma_idx & FC_DMA_2) */ | ||
106 | fc->write_ibi_reg(fc,dma2_010,v0x0); | ||
107 | fc->write_ibi_reg(fc,dma2_014,v0x4); | ||
108 | fc->write_ibi_reg(fc,dma2_01c,v0xc); | ||
109 | } | ||
110 | |||
111 | return 0; | ||
112 | } | ||
113 | EXPORT_SYMBOL(flexcop_dma_config); | ||
114 | |||
115 | static int flexcop_dma_remap(struct flexcop_device *fc, flexcop_dma_index_t dma_idx, int onoff) | ||
116 | { | ||
117 | flexcop_ibi_register r = (dma_idx & FC_DMA_1) ? dma1_00c : dma2_01c; | ||
118 | flexcop_ibi_value v = fc->read_ibi_reg(fc,r); | ||
119 | v.dma_0xc.remap_enable = onoff; | ||
120 | fc->write_ibi_reg(fc,r,v); | ||
121 | return 0; | ||
122 | } | ||
123 | |||
124 | /* 1 cycles = 1.97 msec */ | ||
125 | int flexcop_dma_config_timer(struct flexcop_device *fc, flexcop_dma_index_t dma_idx, u8 cycles) | ||
126 | { | ||
127 | flexcop_ibi_register r = (dma_idx & FC_DMA_1) ? dma1_004 : dma2_014; | ||
128 | flexcop_ibi_value v = fc->read_ibi_reg(fc,r); | ||
129 | |||
130 | flexcop_dma_remap(fc,dma_idx,0); | ||
131 | |||
132 | v.dma_0x4_write.dmatimer = cycles >> 1; | ||
133 | fc->write_ibi_reg(fc,r,v); | ||
134 | return 0; | ||
135 | } | ||
136 | EXPORT_SYMBOL(flexcop_dma_config_timer); | ||
137 | |||
138 | int flexcop_dma_config_packet_count(struct flexcop_device *fc, flexcop_dma_index_t dma_idx, u8 packets) | ||
139 | { | ||
140 | flexcop_ibi_register r = (dma_idx & FC_DMA_1) ? dma1_004 : dma2_014; | ||
141 | flexcop_ibi_value v = fc->read_ibi_reg(fc,r); | ||
142 | |||
143 | flexcop_dma_remap(fc,dma_idx,1); | ||
144 | |||
145 | v.dma_0x4_remap.DMA_maxpackets = packets; | ||
146 | fc->write_ibi_reg(fc,r,v); | ||
147 | return 0; | ||
148 | } | ||
149 | EXPORT_SYMBOL(flexcop_dma_config_packet_count); | ||
diff --git a/drivers/media/dvb/b2c2/flexcop-eeprom.c b/drivers/media/dvb/b2c2/flexcop-eeprom.c new file mode 100644 index 000000000000..bbcf070a178d --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop-eeprom.c | |||
@@ -0,0 +1,153 @@ | |||
1 | /* | ||
2 | * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III | ||
3 | * | ||
4 | * flexcop-eeprom.c - eeprom access methods (currently only MAC address reading is used) | ||
5 | * | ||
6 | * see flexcop.c for copyright information. | ||
7 | */ | ||
8 | #include "flexcop.h" | ||
9 | |||
10 | #if 0 | ||
11 | /*EEPROM (Skystar2 has one "24LC08B" chip on board) */ | ||
12 | static int eeprom_write(struct adapter *adapter, u16 addr, u8 *buf, u16 len) | ||
13 | { | ||
14 | return flex_i2c_write(adapter, 0x20000000, 0x50, addr, buf, len); | ||
15 | } | ||
16 | |||
17 | static int eeprom_lrc_write(struct adapter *adapter, u32 addr, u32 len, u8 *wbuf, u8 *rbuf, int retries) | ||
18 | { | ||
19 | int i; | ||
20 | |||
21 | for (i = 0; i < retries; i++) { | ||
22 | if (eeprom_write(adapter, addr, wbuf, len) == len) { | ||
23 | if (eeprom_lrc_read(adapter, addr, len, rbuf, retries) == 1) | ||
24 | return 1; | ||
25 | } | ||
26 | } | ||
27 | |||
28 | return 0; | ||
29 | } | ||
30 | |||
31 | /* These functions could be used to unlock SkyStar2 cards. */ | ||
32 | |||
33 | static int eeprom_writeKey(struct adapter *adapter, u8 *key, u32 len) | ||
34 | { | ||
35 | u8 rbuf[20]; | ||
36 | u8 wbuf[20]; | ||
37 | |||
38 | if (len != 16) | ||
39 | return 0; | ||
40 | |||
41 | memcpy(wbuf, key, len); | ||
42 | |||
43 | wbuf[16] = 0; | ||
44 | wbuf[17] = 0; | ||
45 | wbuf[18] = 0; | ||
46 | wbuf[19] = calc_lrc(wbuf, 19); | ||
47 | |||
48 | return eeprom_lrc_write(adapter, 0x3e4, 20, wbuf, rbuf, 4); | ||
49 | } | ||
50 | |||
51 | static int eeprom_readKey(struct adapter *adapter, u8 *key, u32 len) | ||
52 | { | ||
53 | u8 buf[20]; | ||
54 | |||
55 | if (len != 16) | ||
56 | return 0; | ||
57 | |||
58 | if (eeprom_lrc_read(adapter, 0x3e4, 20, buf, 4) == 0) | ||
59 | return 0; | ||
60 | |||
61 | memcpy(key, buf, len); | ||
62 | |||
63 | return 1; | ||
64 | } | ||
65 | |||
66 | static char eeprom_set_mac_addr(struct adapter *adapter, char type, u8 *mac) | ||
67 | { | ||
68 | u8 tmp[8]; | ||
69 | |||
70 | if (type != 0) { | ||
71 | tmp[0] = mac[0]; | ||
72 | tmp[1] = mac[1]; | ||
73 | tmp[2] = mac[2]; | ||
74 | tmp[3] = mac[5]; | ||
75 | tmp[4] = mac[6]; | ||
76 | tmp[5] = mac[7]; | ||
77 | |||
78 | } else { | ||
79 | |||
80 | tmp[0] = mac[0]; | ||
81 | tmp[1] = mac[1]; | ||
82 | tmp[2] = mac[2]; | ||
83 | tmp[3] = mac[3]; | ||
84 | tmp[4] = mac[4]; | ||
85 | tmp[5] = mac[5]; | ||
86 | } | ||
87 | |||
88 | tmp[6] = 0; | ||
89 | tmp[7] = calc_lrc(tmp, 7); | ||
90 | |||
91 | if (eeprom_write(adapter, 0x3f8, tmp, 8) == 8) | ||
92 | return 1; | ||
93 | |||
94 | return 0; | ||
95 | } | ||
96 | |||
97 | static int flexcop_eeprom_read(struct flexcop_device *fc, u16 addr, u8 *buf, u16 len) | ||
98 | { | ||
99 | return fc->i2c_request(fc,FC_READ,FC_I2C_PORT_EEPROM,0x50,addr,buf,len); | ||
100 | } | ||
101 | |||
102 | #endif | ||
103 | |||
104 | static u8 calc_lrc(u8 *buf, int len) | ||
105 | { | ||
106 | int i; | ||
107 | u8 sum = 0; | ||
108 | for (i = 0; i < len; i++) | ||
109 | sum = sum ^ buf[i]; | ||
110 | return sum; | ||
111 | } | ||
112 | |||
113 | static int flexcop_eeprom_request(struct flexcop_device *fc, flexcop_access_op_t op, u16 addr, u8 *buf, u16 len, int retries) | ||
114 | { | ||
115 | int i,ret = 0; | ||
116 | u8 chipaddr = 0x50 | ((addr >> 8) & 3); | ||
117 | for (i = 0; i < retries; i++) | ||
118 | if ((ret = fc->i2c_request(fc,op,FC_I2C_PORT_EEPROM,chipaddr,addr & 0xff,buf,len)) == 0) | ||
119 | break; | ||
120 | return ret; | ||
121 | } | ||
122 | |||
123 | static int flexcop_eeprom_lrc_read(struct flexcop_device *fc, u16 addr, u8 *buf, u16 len, int retries) | ||
124 | { | ||
125 | int ret = flexcop_eeprom_request(fc,FC_READ,addr,buf,len,retries); | ||
126 | if (ret == 0) | ||
127 | if (calc_lrc(buf, len - 1) != buf[len - 1]) | ||
128 | ret = -EINVAL; | ||
129 | return ret; | ||
130 | } | ||
131 | |||
132 | /* JJ's comment about extended == 1: it is not presently used anywhere but was | ||
133 | * added to the low-level functions for possible support of EUI64 | ||
134 | */ | ||
135 | int flexcop_eeprom_check_mac_addr(struct flexcop_device *fc, int extended) | ||
136 | { | ||
137 | u8 buf[8]; | ||
138 | int ret = 0; | ||
139 | |||
140 | if ((ret = flexcop_eeprom_lrc_read(fc,0x3f8,buf,8,4)) == 0) { | ||
141 | if (extended != 0) { | ||
142 | err("TODO: extended (EUI64) MAC addresses aren't completely supported yet"); | ||
143 | ret = -EINVAL; | ||
144 | /* memcpy(fc->dvb_adapter.proposed_mac,buf,3); | ||
145 | mac[3] = 0xfe; | ||
146 | mac[4] = 0xff; | ||
147 | memcpy(&fc->dvb_adapter.proposed_mac[3],&buf[5],3); */ | ||
148 | } else | ||
149 | memcpy(fc->dvb_adapter.proposed_mac,buf,6); | ||
150 | } | ||
151 | return ret; | ||
152 | } | ||
153 | EXPORT_SYMBOL(flexcop_eeprom_check_mac_addr); | ||
diff --git a/drivers/media/dvb/b2c2/flexcop-fe-tuner.c b/drivers/media/dvb/b2c2/flexcop-fe-tuner.c new file mode 100644 index 000000000000..71be400e9aeb --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop-fe-tuner.c | |||
@@ -0,0 +1,403 @@ | |||
1 | /* | ||
2 | * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III | ||
3 | * | ||
4 | * flexcop-fe-tuner.c - methods for attaching a frontend and controlling DiSEqC. | ||
5 | * | ||
6 | * see flexcop.c for copyright information. | ||
7 | */ | ||
8 | #include "flexcop.h" | ||
9 | |||
10 | #include "stv0299.h" | ||
11 | #include "mt352.h" | ||
12 | #include "nxt2002.h" | ||
13 | #include "stv0297.h" | ||
14 | #include "mt312.h" | ||
15 | |||
16 | /* lnb control */ | ||
17 | |||
18 | static int flexcop_set_voltage(struct dvb_frontend *fe, fe_sec_voltage_t voltage) | ||
19 | { | ||
20 | struct flexcop_device *fc = fe->dvb->priv; | ||
21 | flexcop_ibi_value v; | ||
22 | deb_tuner("polarity/voltage = %u\n", voltage); | ||
23 | |||
24 | v = fc->read_ibi_reg(fc, misc_204); | ||
25 | switch (voltage) { | ||
26 | case SEC_VOLTAGE_OFF: | ||
27 | v.misc_204.ACPI1_sig = 1; | ||
28 | break; | ||
29 | case SEC_VOLTAGE_13: | ||
30 | v.misc_204.ACPI1_sig = 0; | ||
31 | v.misc_204.LNB_L_H_sig = 0; | ||
32 | break; | ||
33 | case SEC_VOLTAGE_18: | ||
34 | v.misc_204.ACPI1_sig = 0; | ||
35 | v.misc_204.LNB_L_H_sig = 1; | ||
36 | break; | ||
37 | default: | ||
38 | err("unknown SEC_VOLTAGE value"); | ||
39 | return -EINVAL; | ||
40 | } | ||
41 | return fc->write_ibi_reg(fc, misc_204, v); | ||
42 | } | ||
43 | |||
44 | static int flexcop_sleep(struct dvb_frontend* fe) | ||
45 | { | ||
46 | struct flexcop_device *fc = fe->dvb->priv; | ||
47 | /* flexcop_ibi_value v = fc->read_ibi_reg(fc,misc_204); */ | ||
48 | |||
49 | if (fc->fe_sleep) | ||
50 | return fc->fe_sleep(fe); | ||
51 | |||
52 | /* v.misc_204.ACPI3_sig = 1; | ||
53 | fc->write_ibi_reg(fc,misc_204,v);*/ | ||
54 | |||
55 | return 0; | ||
56 | } | ||
57 | |||
58 | static int flexcop_set_tone(struct dvb_frontend *fe, fe_sec_tone_mode_t tone) | ||
59 | { | ||
60 | /* u16 wz_half_period_for_45_mhz[] = { 0x01ff, 0x0154, 0x00ff, 0x00cc }; */ | ||
61 | struct flexcop_device *fc = fe->dvb->priv; | ||
62 | flexcop_ibi_value v; | ||
63 | u16 ax; | ||
64 | v.raw = 0; | ||
65 | |||
66 | deb_tuner("tone = %u\n",tone); | ||
67 | |||
68 | switch (tone) { | ||
69 | case SEC_TONE_ON: | ||
70 | ax = 0x01ff; | ||
71 | break; | ||
72 | case SEC_TONE_OFF: | ||
73 | ax = 0; | ||
74 | break; | ||
75 | default: | ||
76 | err("unknown SEC_TONE value"); | ||
77 | return -EINVAL; | ||
78 | } | ||
79 | |||
80 | v.lnb_switch_freq_200.LNB_CTLPrescaler_sig = 1; /* divide by 2 */ | ||
81 | |||
82 | v.lnb_switch_freq_200.LNB_CTLHighCount_sig = ax; | ||
83 | v.lnb_switch_freq_200.LNB_CTLLowCount_sig = ax == 0 ? 0x1ff : ax; | ||
84 | |||
85 | return fc->write_ibi_reg(fc,lnb_switch_freq_200,v); | ||
86 | } | ||
87 | |||
88 | static void flexcop_diseqc_send_bit(struct dvb_frontend* fe, int data) | ||
89 | { | ||
90 | flexcop_set_tone(fe, SEC_TONE_ON); | ||
91 | udelay(data ? 500 : 1000); | ||
92 | flexcop_set_tone(fe, SEC_TONE_OFF); | ||
93 | udelay(data ? 1000 : 500); | ||
94 | } | ||
95 | |||
96 | static void flexcop_diseqc_send_byte(struct dvb_frontend* fe, int data) | ||
97 | { | ||
98 | int i, par = 1, d; | ||
99 | |||
100 | for (i = 7; i >= 0; i--) { | ||
101 | d = (data >> i) & 1; | ||
102 | par ^= d; | ||
103 | flexcop_diseqc_send_bit(fe, d); | ||
104 | } | ||
105 | |||
106 | flexcop_diseqc_send_bit(fe, par); | ||
107 | } | ||
108 | |||
109 | static int flexcop_send_diseqc_msg(struct dvb_frontend* fe, int len, u8 *msg, unsigned long burst) | ||
110 | { | ||
111 | int i; | ||
112 | |||
113 | flexcop_set_tone(fe, SEC_TONE_OFF); | ||
114 | mdelay(16); | ||
115 | |||
116 | for (i = 0; i < len; i++) | ||
117 | flexcop_diseqc_send_byte(fe,msg[i]); | ||
118 | |||
119 | mdelay(16); | ||
120 | |||
121 | if (burst != -1) { | ||
122 | if (burst) | ||
123 | flexcop_diseqc_send_byte(fe, 0xff); | ||
124 | else { | ||
125 | flexcop_set_tone(fe, SEC_TONE_ON); | ||
126 | udelay(12500); | ||
127 | flexcop_set_tone(fe, SEC_TONE_OFF); | ||
128 | } | ||
129 | msleep(20); | ||
130 | } | ||
131 | return 0; | ||
132 | } | ||
133 | |||
134 | static int flexcop_diseqc_send_master_cmd(struct dvb_frontend* fe, struct dvb_diseqc_master_cmd* cmd) | ||
135 | { | ||
136 | return flexcop_send_diseqc_msg(fe, cmd->msg_len, cmd->msg, 0); | ||
137 | } | ||
138 | |||
139 | static int flexcop_diseqc_send_burst(struct dvb_frontend* fe, fe_sec_mini_cmd_t minicmd) | ||
140 | { | ||
141 | return flexcop_send_diseqc_msg(fe, 0, NULL, minicmd); | ||
142 | } | ||
143 | |||
144 | /* dvb-s stv0299 */ | ||
145 | static int samsung_tbmu24112_set_symbol_rate(struct dvb_frontend* fe, u32 srate, u32 ratio) | ||
146 | { | ||
147 | u8 aclk = 0; | ||
148 | u8 bclk = 0; | ||
149 | |||
150 | if (srate < 1500000) { aclk = 0xb7; bclk = 0x47; } | ||
151 | else if (srate < 3000000) { aclk = 0xb7; bclk = 0x4b; } | ||
152 | else if (srate < 7000000) { aclk = 0xb7; bclk = 0x4f; } | ||
153 | else if (srate < 14000000) { aclk = 0xb7; bclk = 0x53; } | ||
154 | else if (srate < 30000000) { aclk = 0xb6; bclk = 0x53; } | ||
155 | else if (srate < 45000000) { aclk = 0xb4; bclk = 0x51; } | ||
156 | |||
157 | stv0299_writereg (fe, 0x13, aclk); | ||
158 | stv0299_writereg (fe, 0x14, bclk); | ||
159 | stv0299_writereg (fe, 0x1f, (ratio >> 16) & 0xff); | ||
160 | stv0299_writereg (fe, 0x20, (ratio >> 8) & 0xff); | ||
161 | stv0299_writereg (fe, 0x21, (ratio ) & 0xf0); | ||
162 | |||
163 | return 0; | ||
164 | } | ||
165 | |||
166 | static int samsung_tbmu24112_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params) | ||
167 | { | ||
168 | u8 buf[4]; | ||
169 | u32 div; | ||
170 | struct i2c_msg msg = { .addr = 0x61, .flags = 0, .buf = buf, .len = sizeof(buf) }; | ||
171 | struct flexcop_device *fc = fe->dvb->priv; | ||
172 | |||
173 | div = params->frequency / 125; | ||
174 | |||
175 | buf[0] = (div >> 8) & 0x7f; | ||
176 | buf[1] = div & 0xff; | ||
177 | buf[2] = 0x84; /* 0xC4 */ | ||
178 | buf[3] = 0x08; | ||
179 | |||
180 | if (params->frequency < 1500000) buf[3] |= 0x10; | ||
181 | |||
182 | if (i2c_transfer(&fc->i2c_adap, &msg, 1) != 1) | ||
183 | return -EIO; | ||
184 | return 0; | ||
185 | } | ||
186 | |||
187 | static u8 samsung_tbmu24112_inittab[] = { | ||
188 | 0x01, 0x15, | ||
189 | 0x02, 0x30, | ||
190 | 0x03, 0x00, | ||
191 | 0x04, 0x7D, | ||
192 | 0x05, 0x35, | ||
193 | 0x06, 0x02, | ||
194 | 0x07, 0x00, | ||
195 | 0x08, 0xC3, | ||
196 | 0x0C, 0x00, | ||
197 | 0x0D, 0x81, | ||
198 | 0x0E, 0x23, | ||
199 | 0x0F, 0x12, | ||
200 | 0x10, 0x7E, | ||
201 | 0x11, 0x84, | ||
202 | 0x12, 0xB9, | ||
203 | 0x13, 0x88, | ||
204 | 0x14, 0x89, | ||
205 | 0x15, 0xC9, | ||
206 | 0x16, 0x00, | ||
207 | 0x17, 0x5C, | ||
208 | 0x18, 0x00, | ||
209 | 0x19, 0x00, | ||
210 | 0x1A, 0x00, | ||
211 | 0x1C, 0x00, | ||
212 | 0x1D, 0x00, | ||
213 | 0x1E, 0x00, | ||
214 | 0x1F, 0x3A, | ||
215 | 0x20, 0x2E, | ||
216 | 0x21, 0x80, | ||
217 | 0x22, 0xFF, | ||
218 | 0x23, 0xC1, | ||
219 | 0x28, 0x00, | ||
220 | 0x29, 0x1E, | ||
221 | 0x2A, 0x14, | ||
222 | 0x2B, 0x0F, | ||
223 | 0x2C, 0x09, | ||
224 | 0x2D, 0x05, | ||
225 | 0x31, 0x1F, | ||
226 | 0x32, 0x19, | ||
227 | 0x33, 0xFE, | ||
228 | 0x34, 0x93, | ||
229 | 0xff, 0xff, | ||
230 | }; | ||
231 | |||
232 | static struct stv0299_config samsung_tbmu24112_config = { | ||
233 | .demod_address = 0x68, | ||
234 | .inittab = samsung_tbmu24112_inittab, | ||
235 | .mclk = 88000000UL, | ||
236 | .invert = 0, | ||
237 | .enhanced_tuning = 0, | ||
238 | .skip_reinit = 0, | ||
239 | .lock_output = STV0229_LOCKOUTPUT_LK, | ||
240 | .volt13_op0_op1 = STV0299_VOLT13_OP1, | ||
241 | .min_delay_ms = 100, | ||
242 | .set_symbol_rate = samsung_tbmu24112_set_symbol_rate, | ||
243 | .pll_set = samsung_tbmu24112_pll_set, | ||
244 | }; | ||
245 | |||
246 | /* dvb-t mt352 */ | ||
247 | static int samsung_tdtc9251dh0_demod_init(struct dvb_frontend* fe) | ||
248 | { | ||
249 | static u8 mt352_clock_config [] = { 0x89, 0x18, 0x2d }; | ||
250 | static u8 mt352_reset [] = { 0x50, 0x80 }; | ||
251 | static u8 mt352_adc_ctl_1_cfg [] = { 0x8E, 0x40 }; | ||
252 | static u8 mt352_agc_cfg [] = { 0x67, 0x28, 0xa1 }; | ||
253 | static u8 mt352_capt_range_cfg[] = { 0x75, 0x32 }; | ||
254 | |||
255 | mt352_write(fe, mt352_clock_config, sizeof(mt352_clock_config)); | ||
256 | udelay(2000); | ||
257 | mt352_write(fe, mt352_reset, sizeof(mt352_reset)); | ||
258 | mt352_write(fe, mt352_adc_ctl_1_cfg, sizeof(mt352_adc_ctl_1_cfg)); | ||
259 | |||
260 | mt352_write(fe, mt352_agc_cfg, sizeof(mt352_agc_cfg)); | ||
261 | mt352_write(fe, mt352_capt_range_cfg, sizeof(mt352_capt_range_cfg)); | ||
262 | |||
263 | return 0; | ||
264 | } | ||
265 | |||
266 | static int samsung_tdtc9251dh0_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params, u8* pllbuf) | ||
267 | { | ||
268 | u32 div; | ||
269 | unsigned char bs = 0; | ||
270 | |||
271 | #define IF_FREQUENCYx6 217 /* 6 * 36.16666666667MHz */ | ||
272 | div = (((params->frequency + 83333) * 3) / 500000) + IF_FREQUENCYx6; | ||
273 | |||
274 | if (params->frequency >= 48000000 && params->frequency <= 154000000) bs = 0x09; | ||
275 | if (params->frequency >= 161000000 && params->frequency <= 439000000) bs = 0x0a; | ||
276 | if (params->frequency >= 447000000 && params->frequency <= 863000000) bs = 0x08; | ||
277 | |||
278 | pllbuf[0] = 0xc2; /* Note: non-linux standard PLL i2c address */ | ||
279 | pllbuf[1] = div >> 8; | ||
280 | pllbuf[2] = div & 0xff; | ||
281 | pllbuf[3] = 0xcc; | ||
282 | pllbuf[4] = bs; | ||
283 | |||
284 | return 0; | ||
285 | } | ||
286 | |||
287 | static struct mt352_config samsung_tdtc9251dh0_config = { | ||
288 | |||
289 | .demod_address = 0x0f, | ||
290 | .demod_init = samsung_tdtc9251dh0_demod_init, | ||
291 | .pll_set = samsung_tdtc9251dh0_pll_set, | ||
292 | }; | ||
293 | |||
294 | static int nxt2002_request_firmware(struct dvb_frontend* fe, const struct firmware **fw, char* name) | ||
295 | { | ||
296 | struct flexcop_device *fc = fe->dvb->priv; | ||
297 | return request_firmware(fw, name, fc->dev); | ||
298 | } | ||
299 | |||
300 | static struct nxt2002_config samsung_tbmv_config = { | ||
301 | .demod_address = 0x0a, | ||
302 | .request_firmware = nxt2002_request_firmware, | ||
303 | }; | ||
304 | |||
305 | static int skystar23_samsung_tbdu18132_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params) | ||
306 | { | ||
307 | u8 buf[4]; | ||
308 | u32 div; | ||
309 | struct i2c_msg msg = { .addr = 0x61, .flags = 0, .buf = buf, .len = sizeof(buf) }; | ||
310 | struct flexcop_device *fc = fe->dvb->priv; | ||
311 | |||
312 | div = (params->frequency + (125/2)) / 125; | ||
313 | |||
314 | buf[0] = (div >> 8) & 0x7f; | ||
315 | buf[1] = (div >> 0) & 0xff; | ||
316 | buf[2] = 0x84 | ((div >> 10) & 0x60); | ||
317 | buf[3] = 0x80; | ||
318 | |||
319 | if (params->frequency < 1550000) | ||
320 | buf[3] |= 0x02; | ||
321 | |||
322 | if (i2c_transfer(&fc->i2c_adap, &msg, 1) != 1) | ||
323 | return -EIO; | ||
324 | return 0; | ||
325 | } | ||
326 | |||
327 | static struct mt312_config skystar23_samsung_tbdu18132_config = { | ||
328 | |||
329 | .demod_address = 0x0e, | ||
330 | .pll_set = skystar23_samsung_tbdu18132_pll_set, | ||
331 | }; | ||
332 | |||
333 | static struct stv0297_config alps_tdee4_stv0297_config = { | ||
334 | .demod_address = 0x1c, | ||
335 | // .invert = 1, | ||
336 | // .pll_set = alps_tdee4_stv0297_pll_set, | ||
337 | }; | ||
338 | |||
339 | /* try to figure out the frontend, each card/box can have on of the following list */ | ||
340 | int flexcop_frontend_init(struct flexcop_device *fc) | ||
341 | { | ||
342 | /* try the sky v2.6 (stv0299/Samsung tbmu24112(sl1935)) */ | ||
343 | if ((fc->fe = stv0299_attach(&samsung_tbmu24112_config, &fc->i2c_adap)) != NULL) { | ||
344 | fc->fe->ops->set_voltage = flexcop_set_voltage; | ||
345 | |||
346 | fc->fe_sleep = fc->fe->ops->sleep; | ||
347 | fc->fe->ops->sleep = flexcop_sleep; | ||
348 | |||
349 | fc->dev_type = FC_SKY; | ||
350 | info("found the stv0299 at i2c address: 0x%02x",samsung_tbmu24112_config.demod_address); | ||
351 | } else | ||
352 | /* try the air dvb-t (mt352/Samsung tdtc9251dh0(??)) */ | ||
353 | if ((fc->fe = mt352_attach(&samsung_tdtc9251dh0_config, &fc->i2c_adap)) != NULL ) { | ||
354 | fc->dev_type = FC_AIR_DVB; | ||
355 | info("found the mt352 at i2c address: 0x%02x",samsung_tdtc9251dh0_config.demod_address); | ||
356 | } else | ||
357 | /* try the air atsc (nxt2002) */ | ||
358 | if ((fc->fe = nxt2002_attach(&samsung_tbmv_config, &fc->i2c_adap)) != NULL) { | ||
359 | fc->dev_type = FC_AIR_ATSC; | ||
360 | info("found the nxt2002 at i2c address: 0x%02x",samsung_tbmv_config.demod_address); | ||
361 | } else | ||
362 | /* try the cable dvb (stv0297) */ | ||
363 | if ((fc->fe = stv0297_attach(&alps_tdee4_stv0297_config, &fc->i2c_adap, 0xf8)) != NULL) { | ||
364 | fc->dev_type = FC_CABLE; | ||
365 | info("found the stv0297 at i2c address: 0x%02x",alps_tdee4_stv0297_config.demod_address); | ||
366 | } else | ||
367 | /* try the sky v2.3 (vp310/Samsung tbdu18132(tsa5059)) */ | ||
368 | if ((fc->fe = vp310_attach(&skystar23_samsung_tbdu18132_config, &fc->i2c_adap)) != NULL) { | ||
369 | fc->fe->ops->diseqc_send_master_cmd = flexcop_diseqc_send_master_cmd; | ||
370 | fc->fe->ops->diseqc_send_burst = flexcop_diseqc_send_burst; | ||
371 | fc->fe->ops->set_tone = flexcop_set_tone; | ||
372 | fc->fe->ops->set_voltage = flexcop_set_voltage; | ||
373 | |||
374 | fc->fe_sleep = fc->fe->ops->sleep; | ||
375 | fc->fe->ops->sleep = flexcop_sleep; | ||
376 | |||
377 | fc->dev_type = FC_SKY_OLD; | ||
378 | info("found the vp310 (aka mt312) at i2c address: 0x%02x",skystar23_samsung_tbdu18132_config.demod_address); | ||
379 | } | ||
380 | |||
381 | if (fc->fe == NULL) { | ||
382 | err("no frontend driver found for this B2C2/FlexCop adapter"); | ||
383 | return -ENODEV; | ||
384 | } else { | ||
385 | if (dvb_register_frontend(&fc->dvb_adapter, fc->fe)) { | ||
386 | err("frontend registration failed!"); | ||
387 | if (fc->fe->ops->release != NULL) | ||
388 | fc->fe->ops->release(fc->fe); | ||
389 | fc->fe = NULL; | ||
390 | return -EINVAL; | ||
391 | } | ||
392 | } | ||
393 | fc->init_state |= FC_STATE_FE_INIT; | ||
394 | return 0; | ||
395 | } | ||
396 | |||
397 | void flexcop_frontend_exit(struct flexcop_device *fc) | ||
398 | { | ||
399 | if (fc->init_state & FC_STATE_FE_INIT) | ||
400 | dvb_unregister_frontend(fc->fe); | ||
401 | |||
402 | fc->init_state &= ~FC_STATE_FE_INIT; | ||
403 | } | ||
diff --git a/drivers/media/dvb/b2c2/flexcop-hw-filter.c b/drivers/media/dvb/b2c2/flexcop-hw-filter.c new file mode 100644 index 000000000000..2baf43d3ce8f --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop-hw-filter.c | |||
@@ -0,0 +1,204 @@ | |||
1 | /* | ||
2 | * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III | ||
3 | * | ||
4 | * flexcop-hw-filter.c - pid and mac address filtering and corresponding control functions. | ||
5 | * | ||
6 | * see flexcop.c for copyright information. | ||
7 | */ | ||
8 | #include "flexcop.h" | ||
9 | |||
10 | static void flexcop_rcv_data_ctrl(struct flexcop_device *fc, int onoff) | ||
11 | { | ||
12 | flexcop_set_ibi_value(ctrl_208,Rcv_Data_sig,onoff); | ||
13 | } | ||
14 | |||
15 | void flexcop_smc_ctrl(struct flexcop_device *fc, int onoff) | ||
16 | { | ||
17 | flexcop_set_ibi_value(ctrl_208,SMC_Enable_sig,onoff); | ||
18 | } | ||
19 | |||
20 | void flexcop_null_filter_ctrl(struct flexcop_device *fc, int onoff) | ||
21 | { | ||
22 | flexcop_set_ibi_value(ctrl_208,Null_filter_sig,onoff); | ||
23 | } | ||
24 | |||
25 | void flexcop_set_mac_filter(struct flexcop_device *fc, u8 mac[6]) | ||
26 | { | ||
27 | flexcop_ibi_value v418,v41c; | ||
28 | v41c = fc->read_ibi_reg(fc,mac_address_41c); | ||
29 | |||
30 | v418.mac_address_418.MAC1 = mac[0]; | ||
31 | v418.mac_address_418.MAC2 = mac[1]; | ||
32 | v418.mac_address_418.MAC3 = mac[2]; | ||
33 | v418.mac_address_418.MAC6 = mac[3]; | ||
34 | v41c.mac_address_41c.MAC7 = mac[4]; | ||
35 | v41c.mac_address_41c.MAC8 = mac[5]; | ||
36 | |||
37 | fc->write_ibi_reg(fc,mac_address_418,v418); | ||
38 | fc->write_ibi_reg(fc,mac_address_41c,v41c); | ||
39 | } | ||
40 | |||
41 | void flexcop_mac_filter_ctrl(struct flexcop_device *fc, int onoff) | ||
42 | { | ||
43 | flexcop_set_ibi_value(ctrl_208,MAC_filter_Mode_sig,onoff); | ||
44 | } | ||
45 | |||
46 | static void flexcop_pid_group_filter(struct flexcop_device *fc, u16 pid, u16 mask) | ||
47 | { | ||
48 | /* index_reg_310.extra_index_reg need to 0 or 7 to work */ | ||
49 | flexcop_ibi_value v30c; | ||
50 | v30c.pid_filter_30c_ext_ind_0_7.Group_PID = pid; | ||
51 | v30c.pid_filter_30c_ext_ind_0_7.Group_mask = mask; | ||
52 | fc->write_ibi_reg(fc,pid_filter_30c,v30c); | ||
53 | } | ||
54 | |||
55 | static void flexcop_pid_group_filter_ctrl(struct flexcop_device *fc, int onoff) | ||
56 | { | ||
57 | flexcop_set_ibi_value(ctrl_208,Mask_filter_sig,onoff); | ||
58 | } | ||
59 | |||
60 | /* this fancy define reduces the code size of the quite similar PID controlling of | ||
61 | * the first 6 PIDs | ||
62 | */ | ||
63 | |||
64 | #define pid_ctrl(vregname,field,enablefield,trans_field,transval) \ | ||
65 | flexcop_ibi_value vpid = fc->read_ibi_reg(fc, vregname), \ | ||
66 | v208 = fc->read_ibi_reg(fc, ctrl_208); \ | ||
67 | \ | ||
68 | vpid.vregname.field = onoff ? pid : 0x1fff; \ | ||
69 | vpid.vregname.trans_field = transval; \ | ||
70 | v208.ctrl_208.enablefield = onoff; \ | ||
71 | \ | ||
72 | fc->write_ibi_reg(fc,vregname,vpid); \ | ||
73 | fc->write_ibi_reg(fc,ctrl_208,v208); | ||
74 | |||
75 | static void flexcop_pid_Stream1_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff) | ||
76 | { | ||
77 | pid_ctrl(pid_filter_300,Stream1_PID,Stream1_filter_sig,Stream1_trans,0); | ||
78 | } | ||
79 | |||
80 | static void flexcop_pid_Stream2_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff) | ||
81 | { | ||
82 | pid_ctrl(pid_filter_300,Stream2_PID,Stream2_filter_sig,Stream2_trans,0); | ||
83 | } | ||
84 | |||
85 | static void flexcop_pid_PCR_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff) | ||
86 | { | ||
87 | pid_ctrl(pid_filter_304,PCR_PID,PCR_filter_sig,PCR_trans,0); | ||
88 | } | ||
89 | |||
90 | static void flexcop_pid_PMT_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff) | ||
91 | { | ||
92 | pid_ctrl(pid_filter_304,PMT_PID,PMT_filter_sig,PMT_trans,0); | ||
93 | } | ||
94 | |||
95 | static void flexcop_pid_EMM_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff) | ||
96 | { | ||
97 | pid_ctrl(pid_filter_308,EMM_PID,EMM_filter_sig,EMM_trans,0); | ||
98 | } | ||
99 | |||
100 | static void flexcop_pid_ECM_PID_ctrl(struct flexcop_device *fc, u16 pid, int onoff) | ||
101 | { | ||
102 | pid_ctrl(pid_filter_308,ECM_PID,ECM_filter_sig,ECM_trans,0); | ||
103 | } | ||
104 | |||
105 | static void flexcop_pid_control(struct flexcop_device *fc, int index, u16 pid,int onoff) | ||
106 | { | ||
107 | if (pid == 0x2000) | ||
108 | return; | ||
109 | |||
110 | deb_ts("setting pid: %5d %04x at index %d '%s'\n",pid,pid,index,onoff ? "on" : "off"); | ||
111 | |||
112 | /* We could use bit magic here to reduce source code size. | ||
113 | * I decided against it, but to use the real register names */ | ||
114 | switch (index) { | ||
115 | case 0: flexcop_pid_Stream1_PID_ctrl(fc,pid,onoff); break; | ||
116 | case 1: flexcop_pid_Stream2_PID_ctrl(fc,pid,onoff); break; | ||
117 | case 2: flexcop_pid_PCR_PID_ctrl(fc,pid,onoff); break; | ||
118 | case 3: flexcop_pid_PMT_PID_ctrl(fc,pid,onoff); break; | ||
119 | case 4: flexcop_pid_EMM_PID_ctrl(fc,pid,onoff); break; | ||
120 | case 5: flexcop_pid_ECM_PID_ctrl(fc,pid,onoff); break; | ||
121 | default: | ||
122 | if (fc->has_32_hw_pid_filter && index < 38) { | ||
123 | flexcop_ibi_value vpid,vid; | ||
124 | |||
125 | /* set the index */ | ||
126 | vid = fc->read_ibi_reg(fc,index_reg_310); | ||
127 | vid.index_reg_310.index_reg = index - 6; | ||
128 | fc->write_ibi_reg(fc,index_reg_310, vid); | ||
129 | |||
130 | vpid = fc->read_ibi_reg(fc,pid_n_reg_314); | ||
131 | vpid.pid_n_reg_314.PID = onoff ? pid : 0x1fff; | ||
132 | vpid.pid_n_reg_314.PID_enable_bit = onoff; | ||
133 | fc->write_ibi_reg(fc,pid_n_reg_314, vpid); | ||
134 | } | ||
135 | break; | ||
136 | } | ||
137 | } | ||
138 | |||
139 | static int flexcop_toggle_fullts_streaming(struct flexcop_device *fc,int onoff) | ||
140 | { | ||
141 | if (fc->fullts_streaming_state != onoff) { | ||
142 | deb_ts("%s full TS transfer\n",onoff ? "enabling" : "disabling"); | ||
143 | flexcop_pid_group_filter(fc, 0, 0x1fe0 * (!onoff)); | ||
144 | flexcop_pid_group_filter_ctrl(fc,onoff); | ||
145 | fc->fullts_streaming_state = onoff; | ||
146 | } | ||
147 | return 0; | ||
148 | } | ||
149 | |||
150 | int flexcop_pid_feed_control(struct flexcop_device *fc, struct dvb_demux_feed *dvbdmxfeed, int onoff) | ||
151 | { | ||
152 | int max_pid_filter = 6 + fc->has_32_hw_pid_filter*32; | ||
153 | |||
154 | fc->feedcount += onoff ? 1 : -1; | ||
155 | if (dvbdmxfeed->index >= max_pid_filter) | ||
156 | fc->extra_feedcount += onoff ? 1 : -1; | ||
157 | |||
158 | /* toggle complete-TS-streaming when: | ||
159 | * - pid_filtering is not enabled and it is the first or last feed requested | ||
160 | * - pid_filtering is enabled, | ||
161 | * - but the number of requested feeds is exceeded | ||
162 | * - or the requested pid is 0x2000 */ | ||
163 | |||
164 | if (!fc->pid_filtering && fc->feedcount == onoff) | ||
165 | flexcop_toggle_fullts_streaming(fc,onoff); | ||
166 | |||
167 | if (fc->pid_filtering) { | ||
168 | flexcop_pid_control(fc,dvbdmxfeed->index,dvbdmxfeed->pid,onoff); | ||
169 | |||
170 | if (fc->extra_feedcount > 0) | ||
171 | flexcop_toggle_fullts_streaming(fc,1); | ||
172 | else if (dvbdmxfeed->pid == 0x2000) | ||
173 | flexcop_toggle_fullts_streaming(fc,onoff); | ||
174 | else | ||
175 | flexcop_toggle_fullts_streaming(fc,0); | ||
176 | } | ||
177 | |||
178 | /* if it was the first or last feed request change the stream-status */ | ||
179 | if (fc->feedcount == onoff) { | ||
180 | flexcop_rcv_data_ctrl(fc,onoff); | ||
181 | if (fc->stream_control) | ||
182 | fc->stream_control(fc,onoff); | ||
183 | } | ||
184 | |||
185 | return 0; | ||
186 | } | ||
187 | |||
188 | void flexcop_hw_filter_init(struct flexcop_device *fc) | ||
189 | { | ||
190 | int i; | ||
191 | flexcop_ibi_value v; | ||
192 | for (i = 0; i < 6 + 32*fc->has_32_hw_pid_filter; i++) | ||
193 | flexcop_pid_control(fc,i,0x1fff,0); | ||
194 | |||
195 | flexcop_pid_group_filter(fc, 0, 0x1fe0); | ||
196 | flexcop_pid_group_filter_ctrl(fc,0); | ||
197 | |||
198 | v = fc->read_ibi_reg(fc,pid_filter_308); | ||
199 | v.pid_filter_308.EMM_filter_4 = 1; | ||
200 | v.pid_filter_308.EMM_filter_6 = 0; | ||
201 | fc->write_ibi_reg(fc,pid_filter_308,v); | ||
202 | |||
203 | flexcop_null_filter_ctrl(fc, 1); | ||
204 | } | ||
diff --git a/drivers/media/dvb/b2c2/flexcop-i2c.c b/drivers/media/dvb/b2c2/flexcop-i2c.c new file mode 100644 index 000000000000..be4266d4ae91 --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop-i2c.c | |||
@@ -0,0 +1,210 @@ | |||
1 | /* | ||
2 | * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III | ||
3 | * | ||
4 | * flexcop-i2c.c - flexcop internal 2Wire bus (I2C) and dvb i2c initialization | ||
5 | * | ||
6 | * see flexcop.c for copyright information. | ||
7 | */ | ||
8 | #include "flexcop.h" | ||
9 | |||
10 | #define FC_MAX_I2C_RETRIES 100000 | ||
11 | |||
12 | static int flexcop_i2c_operation(struct flexcop_device *fc, flexcop_ibi_value *r100) | ||
13 | { | ||
14 | int i; | ||
15 | flexcop_ibi_value r; | ||
16 | |||
17 | r100->tw_sm_c_100.working_start = 1; | ||
18 | deb_i2c("r100 before: %08x\n",r100->raw); | ||
19 | |||
20 | fc->write_ibi_reg(fc, tw_sm_c_100, ibi_zero); | ||
21 | fc->write_ibi_reg(fc, tw_sm_c_100, *r100); /* initiating i2c operation */ | ||
22 | |||
23 | for (i = 0; i < FC_MAX_I2C_RETRIES; i++) { | ||
24 | r = fc->read_ibi_reg(fc, tw_sm_c_100); | ||
25 | |||
26 | if (!r.tw_sm_c_100.no_base_addr_ack_error) { | ||
27 | if (r.tw_sm_c_100.st_done) { /* && !r.tw_sm_c_100.working_start */ | ||
28 | *r100 = r; | ||
29 | deb_i2c("i2c success\n"); | ||
30 | return 0; | ||
31 | } | ||
32 | } else { | ||
33 | deb_i2c("suffering from an i2c ack_error\n"); | ||
34 | return -EREMOTEIO; | ||
35 | } | ||
36 | } | ||
37 | deb_i2c("tried %d times i2c operation, never finished or too many ack errors.\n",i); | ||
38 | return -EREMOTEIO; | ||
39 | } | ||
40 | |||
41 | static int flexcop_i2c_read4(struct flexcop_device *fc, flexcop_ibi_value r100, u8 *buf) | ||
42 | { | ||
43 | flexcop_ibi_value r104; | ||
44 | int len = r100.tw_sm_c_100.total_bytes, /* remember total_bytes is buflen-1 */ | ||
45 | ret; | ||
46 | |||
47 | if ((ret = flexcop_i2c_operation(fc,&r100)) != 0) { | ||
48 | /* The Cablestar needs a different kind of i2c-transfer (does not | ||
49 | * support "Repeat Start"): | ||
50 | * wait for the ACK failure, | ||
51 | * and do a subsequent read with the Bit 30 enabled | ||
52 | */ | ||
53 | r100.tw_sm_c_100.no_base_addr_ack_error = 1; | ||
54 | if ((ret = flexcop_i2c_operation(fc,&r100)) != 0) { | ||
55 | deb_i2c("no_base_addr read failed. %d\n",ret); | ||
56 | return ret; | ||
57 | } | ||
58 | } | ||
59 | |||
60 | buf[0] = r100.tw_sm_c_100.data1_reg; | ||
61 | |||
62 | if (len > 0) { | ||
63 | r104 = fc->read_ibi_reg(fc,tw_sm_c_104); | ||
64 | deb_i2c("read: r100: %08x, r104: %08x\n",r100.raw,r104.raw); | ||
65 | |||
66 | /* there is at least one more byte, otherwise we wouldn't be here */ | ||
67 | buf[1] = r104.tw_sm_c_104.data2_reg; | ||
68 | if (len > 1) buf[2] = r104.tw_sm_c_104.data3_reg; | ||
69 | if (len > 2) buf[3] = r104.tw_sm_c_104.data4_reg; | ||
70 | } | ||
71 | |||
72 | return 0; | ||
73 | } | ||
74 | |||
75 | static int flexcop_i2c_write4(struct flexcop_device *fc, flexcop_ibi_value r100, u8 *buf) | ||
76 | { | ||
77 | flexcop_ibi_value r104; | ||
78 | int len = r100.tw_sm_c_100.total_bytes; /* remember total_bytes is buflen-1 */ | ||
79 | r104.raw = 0; | ||
80 | |||
81 | /* there is at least one byte, otherwise we wouldn't be here */ | ||
82 | r100.tw_sm_c_100.data1_reg = buf[0]; | ||
83 | |||
84 | r104.tw_sm_c_104.data2_reg = len > 0 ? buf[1] : 0; | ||
85 | r104.tw_sm_c_104.data3_reg = len > 1 ? buf[2] : 0; | ||
86 | r104.tw_sm_c_104.data4_reg = len > 2 ? buf[3] : 0; | ||
87 | |||
88 | deb_i2c("write: r100: %08x, r104: %08x\n",r100.raw,r104.raw); | ||
89 | |||
90 | /* write the additional i2c data before doing the actual i2c operation */ | ||
91 | fc->write_ibi_reg(fc,tw_sm_c_104,r104); | ||
92 | return flexcop_i2c_operation(fc,&r100); | ||
93 | } | ||
94 | |||
95 | int flexcop_i2c_request(struct flexcop_device *fc, flexcop_access_op_t op, | ||
96 | flexcop_i2c_port_t port, u8 chipaddr, u8 addr, u8 *buf, u16 len) | ||
97 | { | ||
98 | int ret; | ||
99 | u16 bytes_to_transfer; | ||
100 | flexcop_ibi_value r100; | ||
101 | |||
102 | deb_i2c("op = %d\n",op); | ||
103 | r100.raw = 0; | ||
104 | r100.tw_sm_c_100.chipaddr = chipaddr; | ||
105 | r100.tw_sm_c_100.twoWS_rw = op; | ||
106 | r100.tw_sm_c_100.twoWS_port_reg = port; | ||
107 | |||
108 | while (len != 0) { | ||
109 | bytes_to_transfer = len > 4 ? 4 : len; | ||
110 | |||
111 | r100.tw_sm_c_100.total_bytes = bytes_to_transfer - 1; | ||
112 | r100.tw_sm_c_100.baseaddr = addr; | ||
113 | |||
114 | if (op == FC_READ) | ||
115 | ret = flexcop_i2c_read4(fc, r100, buf); | ||
116 | else | ||
117 | ret = flexcop_i2c_write4(fc,r100, buf); | ||
118 | |||
119 | if (ret < 0) | ||
120 | return ret; | ||
121 | |||
122 | buf += bytes_to_transfer; | ||
123 | addr += bytes_to_transfer; | ||
124 | len -= bytes_to_transfer; | ||
125 | }; | ||
126 | |||
127 | return 0; | ||
128 | } | ||
129 | /* exported for PCI i2c */ | ||
130 | EXPORT_SYMBOL(flexcop_i2c_request); | ||
131 | |||
132 | /* master xfer callback for demodulator */ | ||
133 | static int flexcop_master_xfer(struct i2c_adapter *i2c_adap, struct i2c_msg msgs[], int num) | ||
134 | { | ||
135 | struct flexcop_device *fc = i2c_get_adapdata(i2c_adap); | ||
136 | int i, ret = 0; | ||
137 | |||
138 | if (down_interruptible(&fc->i2c_sem)) | ||
139 | return -ERESTARTSYS; | ||
140 | |||
141 | /* reading */ | ||
142 | if (num == 2 && | ||
143 | msgs[0].flags == 0 && | ||
144 | msgs[1].flags == I2C_M_RD && | ||
145 | msgs[0].buf != NULL && | ||
146 | msgs[1].buf != NULL) { | ||
147 | |||
148 | ret = fc->i2c_request(fc, FC_READ, FC_I2C_PORT_DEMOD, msgs[0].addr, msgs[0].buf[0], msgs[1].buf, msgs[1].len); | ||
149 | |||
150 | } else for (i = 0; i < num; i++) { /* writing command */ | ||
151 | if (msgs[i].flags != 0 || msgs[i].buf == NULL || msgs[i].len < 2) { | ||
152 | ret = -EINVAL; | ||
153 | break; | ||
154 | } | ||
155 | |||
156 | ret = fc->i2c_request(fc, FC_WRITE, FC_I2C_PORT_DEMOD, msgs[i].addr, msgs[i].buf[0], &msgs[i].buf[1], msgs[i].len - 1); | ||
157 | } | ||
158 | |||
159 | if (ret < 0) | ||
160 | err("i2c master_xfer failed"); | ||
161 | else | ||
162 | ret = num; | ||
163 | |||
164 | up(&fc->i2c_sem); | ||
165 | |||
166 | return ret; | ||
167 | } | ||
168 | |||
169 | static u32 flexcop_i2c_func(struct i2c_adapter *adapter) | ||
170 | { | ||
171 | return I2C_FUNC_I2C; | ||
172 | } | ||
173 | |||
174 | static struct i2c_algorithm flexcop_algo = { | ||
175 | .name = "FlexCop I2C algorithm", | ||
176 | .id = I2C_ALGO_BIT, | ||
177 | .master_xfer = flexcop_master_xfer, | ||
178 | .functionality = flexcop_i2c_func, | ||
179 | }; | ||
180 | |||
181 | int flexcop_i2c_init(struct flexcop_device *fc) | ||
182 | { | ||
183 | int ret; | ||
184 | |||
185 | sema_init(&fc->i2c_sem,1); | ||
186 | |||
187 | memset(&fc->i2c_adap, 0, sizeof(struct i2c_adapter)); | ||
188 | strncpy(fc->i2c_adap.name, "B2C2 FlexCop device",I2C_NAME_SIZE); | ||
189 | |||
190 | i2c_set_adapdata(&fc->i2c_adap,fc); | ||
191 | |||
192 | fc->i2c_adap.class = I2C_CLASS_TV_DIGITAL; | ||
193 | fc->i2c_adap.algo = &flexcop_algo; | ||
194 | fc->i2c_adap.algo_data = NULL; | ||
195 | fc->i2c_adap.id = I2C_ALGO_BIT; | ||
196 | |||
197 | if ((ret = i2c_add_adapter(&fc->i2c_adap)) < 0) | ||
198 | return ret; | ||
199 | |||
200 | fc->init_state |= FC_STATE_I2C_INIT; | ||
201 | return 0; | ||
202 | } | ||
203 | |||
204 | void flexcop_i2c_exit(struct flexcop_device *fc) | ||
205 | { | ||
206 | if (fc->init_state & FC_STATE_I2C_INIT) | ||
207 | i2c_del_adapter(&fc->i2c_adap); | ||
208 | |||
209 | fc->init_state &= ~FC_STATE_I2C_INIT; | ||
210 | } | ||
diff --git a/drivers/media/dvb/b2c2/flexcop-misc.c b/drivers/media/dvb/b2c2/flexcop-misc.c new file mode 100644 index 000000000000..19e06da46774 --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop-misc.c | |||
@@ -0,0 +1,66 @@ | |||
1 | /* | ||
2 | * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III | ||
3 | * | ||
4 | * flexcop-misc.c - miscellaneous functions. | ||
5 | * | ||
6 | * see flexcop.c for copyright information. | ||
7 | */ | ||
8 | #include "flexcop.h" | ||
9 | |||
10 | void flexcop_determine_revision(struct flexcop_device *fc) | ||
11 | { | ||
12 | flexcop_ibi_value v = fc->read_ibi_reg(fc,misc_204); | ||
13 | |||
14 | switch (v.misc_204.Rev_N_sig_revision_hi) { | ||
15 | case 0x2: | ||
16 | deb_info("found a FlexCopII.\n"); | ||
17 | fc->rev = FLEXCOP_II; | ||
18 | break; | ||
19 | case 0x3: | ||
20 | deb_info("found a FlexCopIIb.\n"); | ||
21 | fc->rev = FLEXCOP_IIB; | ||
22 | break; | ||
23 | case 0x0: | ||
24 | deb_info("found a FlexCopIII.\n"); | ||
25 | fc->rev = FLEXCOP_III; | ||
26 | break; | ||
27 | default: | ||
28 | err("unkown FlexCop Revision: %x. Please report the linux-dvb@linuxtv.org.",v.misc_204.Rev_N_sig_revision_hi); | ||
29 | break; | ||
30 | } | ||
31 | |||
32 | if ((fc->has_32_hw_pid_filter = v.misc_204.Rev_N_sig_caps)) | ||
33 | deb_info("this FlexCop has the additional 32 hardware pid filter.\n"); | ||
34 | else | ||
35 | deb_info("this FlexCop has only the 6 basic main hardware pid filter.\n"); | ||
36 | /* bus parts have to decide if hw pid filtering is used or not. */ | ||
37 | } | ||
38 | |||
39 | const char *flexcop_revision_names[] = { | ||
40 | "Unkown chip", | ||
41 | "FlexCopII", | ||
42 | "FlexCopIIb", | ||
43 | "FlexCopIII", | ||
44 | }; | ||
45 | |||
46 | const char *flexcop_device_names[] = { | ||
47 | "Unkown device", | ||
48 | "AirStar 2 DVB-T", | ||
49 | "AirStar 2 ATSC", | ||
50 | "SkyStar 2 DVB-S", | ||
51 | "SkyStar 2 DVB-S (old version)", | ||
52 | "CableStar 2 DVB-C", | ||
53 | }; | ||
54 | |||
55 | const char *flexcop_bus_names[] = { | ||
56 | "USB", | ||
57 | "PCI", | ||
58 | }; | ||
59 | |||
60 | void flexcop_device_name(struct flexcop_device *fc,const char *prefix,const | ||
61 | char *suffix) | ||
62 | { | ||
63 | info("%s '%s' at the '%s' bus controlled by a '%s' %s",prefix, | ||
64 | flexcop_device_names[fc->dev_type],flexcop_bus_names[fc->bus_type], | ||
65 | flexcop_revision_names[fc->rev],suffix); | ||
66 | } | ||
diff --git a/drivers/media/dvb/b2c2/flexcop-pci.c b/drivers/media/dvb/b2c2/flexcop-pci.c new file mode 100644 index 000000000000..ed717c0073d5 --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop-pci.c | |||
@@ -0,0 +1,381 @@ | |||
1 | /* | ||
2 | * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III | ||
3 | * | ||
4 | * flexcop-pci.c - covers the PCI part including DMA transfers. | ||
5 | * | ||
6 | * see flexcop.c for copyright information. | ||
7 | */ | ||
8 | |||
9 | #define FC_LOG_PREFIX "flexcop-pci" | ||
10 | #include "flexcop-common.h" | ||
11 | |||
12 | static int enable_pid_filtering = 1; | ||
13 | module_param(enable_pid_filtering, int, 0444); | ||
14 | MODULE_PARM_DESC(enable_pid_filtering, "enable hardware pid filtering: supported values: 0 (fullts), 1"); | ||
15 | |||
16 | #ifdef CONFIG_DVB_B2C2_FLEXCOP_DEBUG | ||
17 | #define dprintk(level,args...) \ | ||
18 | do { if ((debug & level)) printk(args); } while (0) | ||
19 | #define DEBSTATUS "" | ||
20 | #else | ||
21 | #define dprintk(level,args...) | ||
22 | #define DEBSTATUS " (debugging is not enabled)" | ||
23 | #endif | ||
24 | |||
25 | #define deb_info(args...) dprintk(0x01,args) | ||
26 | #define deb_reg(args...) dprintk(0x02,args) | ||
27 | #define deb_ts(args...) dprintk(0x04,args) | ||
28 | #define deb_irq(args...) dprintk(0x08,args) | ||
29 | |||
30 | static int debug = 0; | ||
31 | module_param(debug, int, 0644); | ||
32 | MODULE_PARM_DESC(debug, "set debug level (1=info,2=regs,4=TS,8=irqdma (|-able))." DEBSTATUS); | ||
33 | |||
34 | #define DRIVER_VERSION "0.1" | ||
35 | #define DRIVER_NAME "Technisat/B2C2 FlexCop II/IIb/III Digital TV PCI Driver" | ||
36 | #define DRIVER_AUTHOR "Patrick Boettcher <patrick.boettcher@desy.de>" | ||
37 | |||
38 | struct flexcop_pci { | ||
39 | struct pci_dev *pdev; | ||
40 | |||
41 | #define FC_PCI_INIT 0x01 | ||
42 | #define FC_PCI_DMA_INIT 0x02 | ||
43 | int init_state; | ||
44 | |||
45 | void __iomem *io_mem; | ||
46 | u32 irq; | ||
47 | /* buffersize (at least for DMA1, need to be % 188 == 0, | ||
48 | * this logic is required */ | ||
49 | #define FC_DEFAULT_DMA1_BUFSIZE (1280 * 188) | ||
50 | #define FC_DEFAULT_DMA2_BUFSIZE (10 * 188) | ||
51 | struct flexcop_dma dma[2]; | ||
52 | |||
53 | int active_dma1_addr; /* 0 = addr0 of dma1; 1 = addr1 of dma1 */ | ||
54 | u32 last_dma1_cur_pos; /* position of the pointer last time the timer/packet irq occured */ | ||
55 | int count; | ||
56 | |||
57 | spinlock_t irq_lock; | ||
58 | |||
59 | struct flexcop_device *fc_dev; | ||
60 | }; | ||
61 | |||
62 | static int lastwreg,lastwval,lastrreg,lastrval; | ||
63 | |||
64 | static flexcop_ibi_value flexcop_pci_read_ibi_reg (struct flexcop_device *fc, flexcop_ibi_register r) | ||
65 | { | ||
66 | struct flexcop_pci *fc_pci = fc->bus_specific; | ||
67 | flexcop_ibi_value v; | ||
68 | v.raw = readl(fc_pci->io_mem + r); | ||
69 | |||
70 | if (lastrreg != r || lastrval != v.raw) { | ||
71 | lastrreg = r; lastrval = v.raw; | ||
72 | deb_reg("new rd: %3x: %08x\n",r,v.raw); | ||
73 | } | ||
74 | |||
75 | return v; | ||
76 | } | ||
77 | |||
78 | static int flexcop_pci_write_ibi_reg(struct flexcop_device *fc, flexcop_ibi_register r, flexcop_ibi_value v) | ||
79 | { | ||
80 | struct flexcop_pci *fc_pci = fc->bus_specific; | ||
81 | |||
82 | if (lastwreg != r || lastwval != v.raw) { | ||
83 | lastwreg = r; lastwval = v.raw; | ||
84 | deb_reg("new wr: %3x: %08x\n",r,v.raw); | ||
85 | } | ||
86 | |||
87 | writel(v.raw, fc_pci->io_mem + r); | ||
88 | return 0; | ||
89 | } | ||
90 | |||
91 | /* When PID filtering is turned on, we use the timer IRQ, because small amounts | ||
92 | * of data need to be passed to the user space instantly as well. When PID | ||
93 | * filtering is turned off, we use the page-change-IRQ */ | ||
94 | static irqreturn_t flexcop_pci_irq(int irq, void *dev_id, struct pt_regs *regs) | ||
95 | { | ||
96 | struct flexcop_pci *fc_pci = dev_id; | ||
97 | struct flexcop_device *fc = fc_pci->fc_dev; | ||
98 | flexcop_ibi_value v = fc->read_ibi_reg(fc,irq_20c); | ||
99 | irqreturn_t ret = IRQ_HANDLED; | ||
100 | |||
101 | spin_lock_irq(&fc_pci->irq_lock); | ||
102 | |||
103 | if (v.irq_20c.DMA1_IRQ_Status == 1) { | ||
104 | if (fc_pci->active_dma1_addr == 0) | ||
105 | flexcop_pass_dmx_packets(fc_pci->fc_dev,fc_pci->dma[0].cpu_addr0,fc_pci->dma[0].size / 188); | ||
106 | else | ||
107 | flexcop_pass_dmx_packets(fc_pci->fc_dev,fc_pci->dma[0].cpu_addr1,fc_pci->dma[0].size / 188); | ||
108 | |||
109 | deb_irq("page change to page: %d\n",!fc_pci->active_dma1_addr); | ||
110 | fc_pci->active_dma1_addr = !fc_pci->active_dma1_addr; | ||
111 | } else if (v.irq_20c.DMA1_Timer_Status == 1) { | ||
112 | /* for the timer IRQ we only can use buffer dmx feeding, because we don't have | ||
113 | * complete TS packets when reading from the DMA memory */ | ||
114 | dma_addr_t cur_addr = | ||
115 | fc->read_ibi_reg(fc,dma1_008).dma_0x8.dma_cur_addr << 2; | ||
116 | u32 cur_pos = cur_addr - fc_pci->dma[0].dma_addr0; | ||
117 | |||
118 | deb_irq("irq: %08x cur_addr: %08x: cur_pos: %08x, last_cur_pos: %08x ", | ||
119 | v.raw,cur_addr,cur_pos,fc_pci->last_dma1_cur_pos); | ||
120 | |||
121 | /* buffer end was reached, restarted from the beginning | ||
122 | * pass the data from last_cur_pos to the buffer end to the demux | ||
123 | */ | ||
124 | if (cur_pos < fc_pci->last_dma1_cur_pos) { | ||
125 | deb_irq(" end was reached: passing %d bytes ",(fc_pci->dma[0].size*2 - 1) - fc_pci->last_dma1_cur_pos); | ||
126 | flexcop_pass_dmx_data(fc_pci->fc_dev, | ||
127 | fc_pci->dma[0].cpu_addr0 + fc_pci->last_dma1_cur_pos, | ||
128 | (fc_pci->dma[0].size*2) - fc_pci->last_dma1_cur_pos); | ||
129 | fc_pci->last_dma1_cur_pos = 0; | ||
130 | fc_pci->count = 0; | ||
131 | } | ||
132 | |||
133 | if (cur_pos > fc_pci->last_dma1_cur_pos) { | ||
134 | deb_irq(" passing %d bytes ",cur_pos - fc_pci->last_dma1_cur_pos); | ||
135 | flexcop_pass_dmx_data(fc_pci->fc_dev, | ||
136 | fc_pci->dma[0].cpu_addr0 + fc_pci->last_dma1_cur_pos, | ||
137 | cur_pos - fc_pci->last_dma1_cur_pos); | ||
138 | } | ||
139 | deb_irq("\n"); | ||
140 | |||
141 | fc_pci->last_dma1_cur_pos = cur_pos; | ||
142 | } else | ||
143 | ret = IRQ_NONE; | ||
144 | |||
145 | spin_unlock_irq(&fc_pci->irq_lock); | ||
146 | |||
147 | /* packet count would be ideal for hw filtering, but it isn't working. Either | ||
148 | * the data book is wrong, or I'm unable to read it correctly */ | ||
149 | |||
150 | /* if (v.irq_20c.DMA1_Size_IRQ_Status == 1) { packet counter */ | ||
151 | |||
152 | return ret; | ||
153 | } | ||
154 | |||
155 | static int flexcop_pci_stream_control(struct flexcop_device *fc, int onoff) | ||
156 | { | ||
157 | struct flexcop_pci *fc_pci = fc->bus_specific; | ||
158 | if (onoff) { | ||
159 | flexcop_dma_config(fc,&fc_pci->dma[0],FC_DMA_1,FC_DMA_SUBADDR_0 | FC_DMA_SUBADDR_1); | ||
160 | flexcop_dma_config(fc,&fc_pci->dma[1],FC_DMA_2,FC_DMA_SUBADDR_0 | FC_DMA_SUBADDR_1); | ||
161 | flexcop_dma_config_timer(fc,FC_DMA_1,1); | ||
162 | |||
163 | if (fc_pci->fc_dev->pid_filtering) { | ||
164 | fc_pci->last_dma1_cur_pos = 0; | ||
165 | flexcop_dma_control_timer_irq(fc,FC_DMA_1,1); | ||
166 | } else { | ||
167 | fc_pci->active_dma1_addr = 0; | ||
168 | flexcop_dma_control_size_irq(fc,FC_DMA_1,1); | ||
169 | } | ||
170 | |||
171 | /* flexcop_dma_config_packet_count(fc,FC_DMA_1,0xc0); | ||
172 | flexcop_dma_control_packet_irq(fc,FC_DMA_1,1); */ | ||
173 | |||
174 | deb_irq("irqs enabled\n"); | ||
175 | } else { | ||
176 | if (fc_pci->fc_dev->pid_filtering) | ||
177 | flexcop_dma_control_timer_irq(fc,FC_DMA_1,0); | ||
178 | else | ||
179 | flexcop_dma_control_size_irq(fc,FC_DMA_1,0); | ||
180 | |||
181 | // flexcop_dma_control_packet_irq(fc,FC_DMA_1,0); | ||
182 | deb_irq("irqs disabled\n"); | ||
183 | } | ||
184 | |||
185 | return 0; | ||
186 | } | ||
187 | |||
188 | static int flexcop_pci_dma_init(struct flexcop_pci *fc_pci) | ||
189 | { | ||
190 | int ret; | ||
191 | if ((ret = flexcop_dma_allocate(fc_pci->pdev,&fc_pci->dma[0],FC_DEFAULT_DMA1_BUFSIZE)) != 0) | ||
192 | return ret; | ||
193 | |||
194 | if ((ret = flexcop_dma_allocate(fc_pci->pdev,&fc_pci->dma[1],FC_DEFAULT_DMA2_BUFSIZE)) != 0) | ||
195 | goto dma1_free; | ||
196 | |||
197 | flexcop_sram_set_dest(fc_pci->fc_dev,FC_SRAM_DEST_MEDIA | FC_SRAM_DEST_NET, FC_SRAM_DEST_TARGET_DMA1); | ||
198 | flexcop_sram_set_dest(fc_pci->fc_dev,FC_SRAM_DEST_CAO | FC_SRAM_DEST_CAI, FC_SRAM_DEST_TARGET_DMA2); | ||
199 | |||
200 | fc_pci->init_state |= FC_PCI_DMA_INIT; | ||
201 | goto success; | ||
202 | dma1_free: | ||
203 | flexcop_dma_free(&fc_pci->dma[0]); | ||
204 | |||
205 | success: | ||
206 | return ret; | ||
207 | } | ||
208 | |||
209 | static void flexcop_pci_dma_exit(struct flexcop_pci *fc_pci) | ||
210 | { | ||
211 | if (fc_pci->init_state & FC_PCI_DMA_INIT) { | ||
212 | flexcop_dma_free(&fc_pci->dma[0]); | ||
213 | flexcop_dma_free(&fc_pci->dma[1]); | ||
214 | } | ||
215 | fc_pci->init_state &= ~FC_PCI_DMA_INIT; | ||
216 | } | ||
217 | |||
218 | static int flexcop_pci_init(struct flexcop_pci *fc_pci) | ||
219 | { | ||
220 | int ret; | ||
221 | u8 card_rev; | ||
222 | |||
223 | pci_read_config_byte(fc_pci->pdev, PCI_CLASS_REVISION, &card_rev); | ||
224 | info("card revision %x", card_rev); | ||
225 | |||
226 | if ((ret = pci_enable_device(fc_pci->pdev)) != 0) | ||
227 | return ret; | ||
228 | |||
229 | pci_set_master(fc_pci->pdev); | ||
230 | |||
231 | /* enable interrupts */ | ||
232 | // pci_write_config_dword(pdev, 0x6c, 0x8000); | ||
233 | |||
234 | if ((ret = pci_request_regions(fc_pci->pdev, DRIVER_NAME)) != 0) | ||
235 | goto err_pci_disable_device; | ||
236 | |||
237 | fc_pci->io_mem = pci_iomap(fc_pci->pdev, 0, 0x800); | ||
238 | |||
239 | if (!fc_pci->io_mem) { | ||
240 | err("cannot map io memory\n"); | ||
241 | ret = -EIO; | ||
242 | goto err_pci_release_regions; | ||
243 | } | ||
244 | |||
245 | pci_set_drvdata(fc_pci->pdev, fc_pci); | ||
246 | |||
247 | if ((ret = request_irq(fc_pci->pdev->irq, flexcop_pci_irq, | ||
248 | SA_SHIRQ, DRIVER_NAME, fc_pci)) != 0) | ||
249 | goto err_pci_iounmap; | ||
250 | |||
251 | spin_lock_init(&fc_pci->irq_lock); | ||
252 | |||
253 | fc_pci->init_state |= FC_PCI_INIT; | ||
254 | goto success; | ||
255 | |||
256 | err_pci_iounmap: | ||
257 | pci_iounmap(fc_pci->pdev, fc_pci->io_mem); | ||
258 | pci_set_drvdata(fc_pci->pdev, NULL); | ||
259 | err_pci_release_regions: | ||
260 | pci_release_regions(fc_pci->pdev); | ||
261 | err_pci_disable_device: | ||
262 | pci_disable_device(fc_pci->pdev); | ||
263 | |||
264 | success: | ||
265 | return ret; | ||
266 | } | ||
267 | |||
268 | static void flexcop_pci_exit(struct flexcop_pci *fc_pci) | ||
269 | { | ||
270 | if (fc_pci->init_state & FC_PCI_INIT) { | ||
271 | free_irq(fc_pci->pdev->irq, fc_pci); | ||
272 | pci_iounmap(fc_pci->pdev, fc_pci->io_mem); | ||
273 | pci_set_drvdata(fc_pci->pdev, NULL); | ||
274 | pci_release_regions(fc_pci->pdev); | ||
275 | pci_disable_device(fc_pci->pdev); | ||
276 | } | ||
277 | fc_pci->init_state &= ~FC_PCI_INIT; | ||
278 | } | ||
279 | |||
280 | |||
281 | static int flexcop_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent) | ||
282 | { | ||
283 | struct flexcop_device *fc; | ||
284 | struct flexcop_pci *fc_pci; | ||
285 | int ret = -ENOMEM; | ||
286 | |||
287 | if ((fc = flexcop_device_kmalloc(sizeof(struct flexcop_pci))) == NULL) { | ||
288 | err("out of memory\n"); | ||
289 | return -ENOMEM; | ||
290 | } | ||
291 | |||
292 | /* general flexcop init */ | ||
293 | fc_pci = fc->bus_specific; | ||
294 | fc_pci->fc_dev = fc; | ||
295 | |||
296 | fc->read_ibi_reg = flexcop_pci_read_ibi_reg; | ||
297 | fc->write_ibi_reg = flexcop_pci_write_ibi_reg; | ||
298 | fc->i2c_request = flexcop_i2c_request; | ||
299 | fc->get_mac_addr = flexcop_eeprom_check_mac_addr; | ||
300 | |||
301 | fc->stream_control = flexcop_pci_stream_control; | ||
302 | |||
303 | if (enable_pid_filtering) | ||
304 | info("will use the HW PID filter."); | ||
305 | else | ||
306 | info("will pass the complete TS to the demuxer."); | ||
307 | |||
308 | fc->pid_filtering = enable_pid_filtering; | ||
309 | fc->bus_type = FC_PCI; | ||
310 | |||
311 | fc->dev = &pdev->dev; | ||
312 | fc->owner = THIS_MODULE; | ||
313 | |||
314 | /* bus specific part */ | ||
315 | fc_pci->pdev = pdev; | ||
316 | if ((ret = flexcop_pci_init(fc_pci)) != 0) | ||
317 | goto err_kfree; | ||
318 | |||
319 | /* init flexcop */ | ||
320 | if ((ret = flexcop_device_initialize(fc)) != 0) | ||
321 | goto err_pci_exit; | ||
322 | |||
323 | /* init dma */ | ||
324 | if ((ret = flexcop_pci_dma_init(fc_pci)) != 0) | ||
325 | goto err_fc_exit; | ||
326 | |||
327 | goto success; | ||
328 | err_fc_exit: | ||
329 | flexcop_device_exit(fc); | ||
330 | err_pci_exit: | ||
331 | flexcop_pci_exit(fc_pci); | ||
332 | err_kfree: | ||
333 | flexcop_device_kfree(fc); | ||
334 | success: | ||
335 | return ret; | ||
336 | } | ||
337 | |||
338 | /* in theory every _exit function should be called exactly two times, | ||
339 | * here and in the bail-out-part of the _init-function | ||
340 | */ | ||
341 | static void flexcop_pci_remove(struct pci_dev *pdev) | ||
342 | { | ||
343 | struct flexcop_pci *fc_pci = pci_get_drvdata(pdev); | ||
344 | |||
345 | flexcop_pci_dma_exit(fc_pci); | ||
346 | flexcop_device_exit(fc_pci->fc_dev); | ||
347 | flexcop_pci_exit(fc_pci); | ||
348 | flexcop_device_kfree(fc_pci->fc_dev); | ||
349 | } | ||
350 | |||
351 | static struct pci_device_id flexcop_pci_tbl[] = { | ||
352 | { PCI_DEVICE(0x13d0, 0x2103) }, | ||
353 | /* { PCI_DEVICE(0x13d0, 0x2200) }, PCI FlexCopIII ? */ | ||
354 | { }, | ||
355 | }; | ||
356 | |||
357 | MODULE_DEVICE_TABLE(pci, flexcop_pci_tbl); | ||
358 | |||
359 | static struct pci_driver flexcop_pci_driver = { | ||
360 | .name = "Technisat/B2C2 FlexCop II/IIb/III PCI", | ||
361 | .id_table = flexcop_pci_tbl, | ||
362 | .probe = flexcop_pci_probe, | ||
363 | .remove = flexcop_pci_remove, | ||
364 | }; | ||
365 | |||
366 | static int __init flexcop_pci_module_init(void) | ||
367 | { | ||
368 | return pci_register_driver(&flexcop_pci_driver); | ||
369 | } | ||
370 | |||
371 | static void __exit flexcop_pci_module_exit(void) | ||
372 | { | ||
373 | pci_unregister_driver(&flexcop_pci_driver); | ||
374 | } | ||
375 | |||
376 | module_init(flexcop_pci_module_init); | ||
377 | module_exit(flexcop_pci_module_exit); | ||
378 | |||
379 | MODULE_AUTHOR(DRIVER_AUTHOR); | ||
380 | MODULE_DESCRIPTION(DRIVER_NAME); | ||
381 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/media/dvb/b2c2/flexcop-reg.h b/drivers/media/dvb/b2c2/flexcop-reg.h new file mode 100644 index 000000000000..5e131be55cb3 --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop-reg.h | |||
@@ -0,0 +1,701 @@ | |||
1 | /* | ||
2 | * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III | ||
3 | * | ||
4 | * flexcop-reg.h - register abstraction for FlexCopII, FlexCopIIb and FlexCopIII | ||
5 | * | ||
6 | * see flexcop.c for copyright information. | ||
7 | */ | ||
8 | #ifndef __FLEXCOP_REG_H__ | ||
9 | #define __FLEXCOP_REG_H__ | ||
10 | |||
11 | |||
12 | typedef enum { | ||
13 | FLEXCOP_UNK = 0, | ||
14 | FLEXCOP_II, | ||
15 | FLEXCOP_IIB, | ||
16 | FLEXCOP_III, | ||
17 | } flexcop_revision_t; | ||
18 | |||
19 | extern const char *flexcop_revision_names[]; | ||
20 | |||
21 | typedef enum { | ||
22 | FC_UNK = 0, | ||
23 | FC_AIR_DVB, | ||
24 | FC_AIR_ATSC, | ||
25 | FC_SKY, | ||
26 | FC_SKY_OLD, | ||
27 | FC_CABLE, | ||
28 | } flexcop_device_type_t; | ||
29 | |||
30 | typedef enum { | ||
31 | FC_USB = 0, | ||
32 | FC_PCI, | ||
33 | } flexcop_bus_t; | ||
34 | |||
35 | extern const char *flexcop_device_names[]; | ||
36 | |||
37 | /* FlexCop IBI Registers */ | ||
38 | |||
39 | /* flexcop_ibi_reg - a huge union representing the register structure */ | ||
40 | typedef union { | ||
41 | u32 raw; | ||
42 | |||
43 | /* DMA 0x000 to 0x01c | ||
44 | * DMA1 0x000 to 0x00c | ||
45 | * DMA2 0x010 to 0x01c | ||
46 | */ | ||
47 | struct { | ||
48 | u32 dma_0start : 1; /* set: data will be delivered to dma1_address0 */ | ||
49 | u32 dma_0No_update : 1; /* set: dma1_cur_address will be updated, unset: no update */ | ||
50 | u32 dma_address0 :30; /* physical/virtual host memory address0 DMA */ | ||
51 | } dma_0x0; | ||
52 | |||
53 | struct { | ||
54 | u32 DMA_maxpackets : 8; /* (remapped) PCI DMA1 Packet Count Interrupt. This variable | ||
55 | is able to be read and written while bit(1) of register | ||
56 | 0x00c (remap_enable) is set. This variable represents | ||
57 | the number of packets that will be transmitted to the PCI | ||
58 | host using PCI DMA1 before an interrupt to the PCI is | ||
59 | asserted. This functionality may be enabled using bit(20) | ||
60 | of register 0x208. N=0 disables the IRQ. */ | ||
61 | u32 dma_addr_size :24; /* size of memory buffer in DWORDs (bytesize / 4) for DMA */ | ||
62 | } dma_0x4_remap; | ||
63 | |||
64 | struct { | ||
65 | u32 dma1timer : 7; /* reading PCI DMA1 timer ... when remap_enable is 0 */ | ||
66 | u32 unused : 1; | ||
67 | u32 dma_addr_size :24; | ||
68 | } dma_0x4_read; | ||
69 | |||
70 | struct { | ||
71 | u32 unused : 1; | ||
72 | u32 dmatimer : 7; /* writing PCI DMA1 timer ... when remap_enable is 0 */ | ||
73 | u32 dma_addr_size :24; | ||
74 | } dma_0x4_write; | ||
75 | |||
76 | struct { | ||
77 | u32 unused : 2; | ||
78 | u32 dma_cur_addr :30; /* current physical host memory address pointer for DMA */ | ||
79 | } dma_0x8; | ||
80 | |||
81 | struct { | ||
82 | u32 dma_1start : 1; /* set: data will be delivered to dma_address1, when dma_address0 is full */ | ||
83 | u32 remap_enable : 1; /* remap enable for 0x0x4(7:0) */ | ||
84 | u32 dma_address1 :30; /* Physical/virtual address 1 on DMA */ | ||
85 | } dma_0xc; | ||
86 | |||
87 | /* Two-wire Serial Master and Clock 0x100-0x110 */ | ||
88 | struct { | ||
89 | // u32 slave_transmitter : 1; /* ???*/ | ||
90 | u32 chipaddr : 7; /* two-line serial address of the target slave */ | ||
91 | u32 reserved1 : 1; | ||
92 | u32 baseaddr : 8; /* address of the location of the read/write operation */ | ||
93 | u32 data1_reg : 8; /* first byte in two-line serial read/write operation */ | ||
94 | u32 working_start : 1; /* when doing a write operation this indicator is 0 when ready | ||
95 | * set to 1 when doing a write operation */ | ||
96 | u32 twoWS_rw : 1; /* read/write indicator (1 = read, 0 write) */ | ||
97 | u32 total_bytes : 2; /* number of data bytes in each two-line serial transaction (0 = 1 byte, 11 = 4byte)*/ | ||
98 | u32 twoWS_port_reg : 2; /* port selection: 01 - Front End/Demod, 10 - EEPROM, 11 - Tuner */ | ||
99 | u32 no_base_addr_ack_error : 1; /* writing: write-req: frame is produced w/o baseaddr, read-req: read-cycles w/o | ||
100 | * preceding address assignment write frame | ||
101 | * ACK_ERROR = 1 when no ACK from slave in the last transaction */ | ||
102 | u32 st_done : 1; /* indicator for transaction is done */ | ||
103 | } tw_sm_c_100; | ||
104 | |||
105 | struct { | ||
106 | u32 data2_reg : 8; /* 2nd data byte */ | ||
107 | u32 data3_reg : 8; /* 3rd data byte */ | ||
108 | u32 data4_reg : 8; /* 4th data byte */ | ||
109 | u32 exlicit_stops : 1; /* when set, transactions are produced w/o trailing STOP flag, then send isolated STOP flags */ | ||
110 | u32 force_stop : 1; /* isolated stop flag */ | ||
111 | u32 unused : 6; | ||
112 | } tw_sm_c_104; | ||
113 | |||
114 | /* Clock. The register allows the FCIII to convert an incoming Master clock | ||
115 | * (MCLK) signal into a lower frequency clock through the use of a LowCounter | ||
116 | * (TLO) and a High- Counter (THI). The time counts for THI and TLO are | ||
117 | * measured in MCLK; each count represents 4 MCLK input clock cycles. | ||
118 | * | ||
119 | * The default output for port #1 is set for Front End Demod communication. (0x108) | ||
120 | * The default output for port #2 is set for EEPROM communication. (0x10c) | ||
121 | * The default output for port #3 is set for Tuner communication. (0x110) | ||
122 | */ | ||
123 | struct { | ||
124 | u32 thi1 : 6; /* Thi for port #1 (def: 100110b; 38) */ | ||
125 | u32 reserved1 : 2; | ||
126 | u32 tlo1 : 5; /* Tlo for port #1 (def: 11100b; 28) */ | ||
127 | u32 reserved2 :19; | ||
128 | } tw_sm_c_108; | ||
129 | |||
130 | struct { | ||
131 | u32 thi1 : 6; /* Thi for port #2 (def: 111001b; 57) */ | ||
132 | u32 reserved1 : 2; | ||
133 | u32 tlo1 : 5; /* Tlo for port #2 (def: 11100b; 28) */ | ||
134 | u32 reserved2 :19; | ||
135 | } tw_sm_c_10c; | ||
136 | |||
137 | struct { | ||
138 | u32 thi1 : 6; /* Thi for port #3 (def: 111001b; 57) */ | ||
139 | u32 reserved1 : 2; | ||
140 | u32 tlo1 : 5; /* Tlo for port #3 (def: 11100b; 28) */ | ||
141 | u32 reserved2 :19; | ||
142 | } tw_sm_c_110; | ||
143 | |||
144 | /* LNB Switch Frequency 0x200 | ||
145 | * Clock that creates the LNB switch tone. The default is set to have a fixed | ||
146 | * low output (not oscillating) to the LNB_CTL line. | ||
147 | */ | ||
148 | struct { | ||
149 | u32 LNB_CTLHighCount_sig :15; /* It is the number of pre-scaled clock cycles that will be low. */ | ||
150 | u32 LNB_CTLLowCount_sig :15; /* For example, to obtain a 22KHz output given a 45 Mhz Master | ||
151 | Clock signal (MCLK), set PreScalar=01 and LowCounter value to 0x1ff. */ | ||
152 | u32 LNB_CTLPrescaler_sig : 2; /* pre-scaler divides MCLK: 00 (no division), 01 by 2, 10 by 4, 11 by 12 */ | ||
153 | } lnb_switch_freq_200; | ||
154 | |||
155 | /* ACPI, Peripheral Reset, LNB Polarity | ||
156 | * ACPI power conservation mode, LNB polarity selection (low or high voltage), | ||
157 | * and peripheral reset. | ||
158 | */ | ||
159 | struct { | ||
160 | u32 ACPI1_sig : 1; /* turn of the power of tuner and LNB, not implemented in FCIII */ | ||
161 | u32 ACPI3_sig : 1; /* turn of power of the complete satelite receiver board (except FCIII) */ | ||
162 | u32 LNB_L_H_sig : 1; /* low or high voltage for LNB. (0 = low, 1 = high) */ | ||
163 | u32 Per_reset_sig : 1; /* misc. init reset (default: 1), to reset set to low and back to high */ | ||
164 | u32 reserved :20; | ||
165 | u32 Rev_N_sig_revision_hi : 4;/* 0xc in case of FCIII */ | ||
166 | u32 Rev_N_sig_reserved1 : 2; | ||
167 | u32 Rev_N_sig_caps : 1; /* if 1, FCIII has 32 PID- and MAC-filters and is capable of IP multicast */ | ||
168 | u32 Rev_N_sig_reserved2 : 1; | ||
169 | } misc_204; | ||
170 | |||
171 | /* Control and Status 0x208 to 0x21c */ | ||
172 | /* Gross enable and disable control */ | ||
173 | struct { | ||
174 | u32 Stream1_filter_sig : 1; /* Stream1 PID filtering */ | ||
175 | u32 Stream2_filter_sig : 1; /* Stream2 PID filtering */ | ||
176 | u32 PCR_filter_sig : 1; /* PCR PID filter */ | ||
177 | u32 PMT_filter_sig : 1; /* PMT PID filter */ | ||
178 | |||
179 | u32 EMM_filter_sig : 1; /* EMM PID filter */ | ||
180 | u32 ECM_filter_sig : 1; /* ECM PID filter */ | ||
181 | u32 Null_filter_sig : 1; /* Filters null packets, PID=0x1fff. */ | ||
182 | u32 Mask_filter_sig : 1; /* mask PID filter */ | ||
183 | |||
184 | u32 WAN_Enable_sig : 1; /* WAN output line through V8 memory space is activated. */ | ||
185 | u32 WAN_CA_Enable_sig : 1; /* not in FCIII */ | ||
186 | u32 CA_Enable_sig : 1; /* not in FCIII */ | ||
187 | u32 SMC_Enable_sig : 1; /* CI stream data (CAI) goes directly to the smart card intf (opposed IBI 0x600 or SC-cmd buf). */ | ||
188 | |||
189 | u32 Per_CA_Enable_sig : 1; /* not in FCIII */ | ||
190 | u32 Multi2_Enable_sig : 1; /* ? */ | ||
191 | u32 MAC_filter_Mode_sig : 1; /* (MAC_filter_enable) Globally enables MAC filters for Net PID filteres. */ | ||
192 | u32 Rcv_Data_sig : 1; /* PID filtering module enable. When this bit is a one, the PID filter will | ||
193 | examine and process packets according to all other (individual) PID | ||
194 | filtering controls. If it a zero, no packet processing of any kind will | ||
195 | take place. All data from the tuner will be thrown away. */ | ||
196 | |||
197 | u32 DMA1_IRQ_Enable_sig : 1; /* When set, a DWORD counter is enabled on PCI DMA1 that asserts the PCI | ||
198 | * interrupt after the specified count for filling the buffer. */ | ||
199 | u32 DMA1_Timer_Enable_sig : 1; /* When set, a timer is enabled on PCI DMA1 that asserts the PCI interrupt | ||
200 | after a specified amount of time. */ | ||
201 | u32 DMA2_IRQ_Enable_sig : 1; /* same as DMA1_IRQ_Enable_sig but for DMA2 */ | ||
202 | u32 DMA2_Timer_Enable_sig : 1; /* same as DMA1_Timer_Enable_sig but for DMA2 */ | ||
203 | |||
204 | u32 DMA1_Size_IRQ_Enable_sig : 1; /* When set, a packet count detector is enabled on PCI DMA1 that asserts the PCI interrupt. */ | ||
205 | u32 DMA2_Size_IRQ_Enable_sig : 1; /* When set, a packet count detector is enabled on PCI DMA2 that asserts the PCI interrupt. */ | ||
206 | u32 Mailbox_from_V8_Enable_sig: 1; /* When set, writes to the mailbox register produce an interrupt to the | ||
207 | PCI host to indicate that mailbox data is available. */ | ||
208 | |||
209 | u32 unused : 9; | ||
210 | } ctrl_208; | ||
211 | |||
212 | /* General status. When a PCI interrupt occurs, this register is read to | ||
213 | * discover the reason for the interrupt. | ||
214 | */ | ||
215 | struct { | ||
216 | u32 DMA1_IRQ_Status : 1; /* When set(1) the DMA1 counter had generated an IRQ. Read Only. */ | ||
217 | u32 DMA1_Timer_Status : 1; /* When set(1) the DMA1 timer had generated an IRQ. Read Only. */ | ||
218 | u32 DMA2_IRQ_Status : 1; /* When set(1) the DMA2 counter had generated an IRQ. Read Only. */ | ||
219 | u32 DMA2_Timer_Status : 1; /* When set(1) the DMA2 timer had generated an IRQ. Read Only. */ | ||
220 | u32 DMA1_Size_IRQ_Status : 1; /* (Read only). This register is read after an interrupt to */ | ||
221 | u32 DMA2_Size_IRQ_Status : 1; /* find out why we had an IRQ. Reading this register will clear this bit. Packet count*/ | ||
222 | u32 Mailbox_from_V8_Status_sig: 1; /* Same as above. Reading this register will clear this bit. */ | ||
223 | u32 Data_receiver_error : 1; /* 1 indicate an error in the receiver Front End (Tuner module) */ | ||
224 | u32 Continuity_error_flag : 1; /* 1 indicates a continuity error in the TS stream. */ | ||
225 | u32 LLC_SNAP_FLAG_set : 1; /* 1 indicates that the LCC_SNAP_FLAG was set. */ | ||
226 | u32 Transport_Error : 1; /* When set indicates that an unexpected packet was received. */ | ||
227 | u32 reserved :21; | ||
228 | } irq_20c; | ||
229 | |||
230 | |||
231 | /* Software reset register */ | ||
232 | struct { | ||
233 | u32 reset_blocks : 8; /* Enabled when Block_reset_enable = 0xB2 and 0x208 bits 15:8 = 0x00. | ||
234 | Each bit location represents a 0x100 block of registers. Writing | ||
235 | a one in a bit location resets that block of registers and the logic | ||
236 | that it controls. */ | ||
237 | u32 Block_reset_enable : 8; /* This variable is set to 0xB2 when the register is written. */ | ||
238 | u32 Special_controls :16; /* Asserts Reset_V8 => 0xC258; Turns on pci encryption => 0xC25A; | ||
239 | Turns off pci encryption => 0xC259 Note: pci_encryption default | ||
240 | at power-up is ON. */ | ||
241 | } sw_reset_210; | ||
242 | |||
243 | struct { | ||
244 | u32 vuart_oe_sig : 1; /* When clear, the V8 processor has sole control of the serial UART | ||
245 | (RS-232 Smart Card interface). When set, the IBI interface | ||
246 | defined by register 0x600 controls the serial UART. */ | ||
247 | u32 v2WS_oe_sig : 1; /* When clear, the V8 processor has direct control of the Two-line | ||
248 | Serial Master EEPROM target. When set, the Two-line Serial Master | ||
249 | EEPROM target interface is controlled by IBI register 0x100. */ | ||
250 | u32 halt_V8_sig : 1; /* When set, contiguous wait states are applied to the V8-space | ||
251 | bus masters. Once this signal is cleared, normal V8-space | ||
252 | operations resume. */ | ||
253 | u32 section_pkg_enable_sig: 1; /* When set, this signal enables the front end translation circuitry | ||
254 | to process section packed transport streams. */ | ||
255 | u32 s2p_sel_sig : 1; /* Serial to parallel conversion. When set, polarized transport data | ||
256 | within the FlexCop3 front end circuitry is converted from a serial | ||
257 | stream into parallel data before downstream processing otherwise | ||
258 | interprets the data. */ | ||
259 | u32 unused1 : 3; | ||
260 | u32 polarity_PS_CLK_sig: 1; /* This signal is used to invert the input polarity of the tranport | ||
261 | stream CLOCK signal before any processing occurs on the transport | ||
262 | stream within FlexCop3. */ | ||
263 | u32 polarity_PS_VALID_sig: 1; /* This signal is used to invert the input polarity of the tranport | ||
264 | stream VALID signal before any processing occurs on the transport | ||
265 | stream within FlexCop3. */ | ||
266 | u32 polarity_PS_SYNC_sig: 1; /* This signal is used to invert the input polarity of the tranport | ||
267 | stream SYNC signal before any processing occurs on the transport | ||
268 | stream within FlexCop3. */ | ||
269 | u32 polarity_PS_ERR_sig: 1; /* This signal is used to invert the input polarity of the tranport | ||
270 | stream ERROR signal before any processing occurs on the transport | ||
271 | stream within FlexCop3. */ | ||
272 | u32 unused2 :20; | ||
273 | } misc_214; | ||
274 | |||
275 | /* Mailbox from V8 to host */ | ||
276 | struct { | ||
277 | u32 Mailbox_from_V8 :32; /* When this register is written by either the V8 processor or by an | ||
278 | end host, an interrupt is generated to the PCI host to indicate | ||
279 | that mailbox data is available. Reading register 20c will clear | ||
280 | the IRQ. */ | ||
281 | } mbox_v8_to_host_218; | ||
282 | |||
283 | /* Mailbox from host to v8 Mailbox_to_V8 | ||
284 | * Mailbox_to_V8 mailbox storage register | ||
285 | * used to send messages from PCI to V8. Writing to this register will send an | ||
286 | * IRQ to the V8. Then it can read the data from here. Reading this register | ||
287 | * will clear the IRQ. If the V8 is halted and bit 31 of this register is set, | ||
288 | * then this register is used instead as a direct interface to access the | ||
289 | * V8space memory. | ||
290 | */ | ||
291 | struct { | ||
292 | u32 sysramaccess_data : 8; /* Data byte written or read from the specified address in V8 SysRAM. */ | ||
293 | u32 sysramaccess_addr :15; /* 15 bit address used to access V8 Sys-RAM. */ | ||
294 | u32 unused : 7; | ||
295 | u32 sysramaccess_write: 1; /* Write flag used to latch data into the V8 SysRAM. */ | ||
296 | u32 sysramaccess_busmuster: 1; /* Setting this bit when the V8 is halted at 0x214 Bit(2) allows | ||
297 | this IBI register interface to directly drive the V8-space memory. */ | ||
298 | } mbox_host_to_v8_21c; | ||
299 | |||
300 | |||
301 | /* PIDs, Translation Bit, SMC Filter Select 0x300 to 0x31c */ | ||
302 | struct { | ||
303 | u32 Stream1_PID :13; /* Primary use is receiving Net data, so these 13 bits normally | ||
304 | hold the PID value for the desired network stream. */ | ||
305 | u32 Stream1_trans : 1; /* When set, Net translation will take place for Net data ferried in TS packets. */ | ||
306 | u32 MAC_Multicast_filter : 1; /* When clear, multicast MAC filtering is not allowed for Stream1 and PID_n filters. */ | ||
307 | u32 debug_flag_pid_saved : 1; | ||
308 | u32 Stream2_PID :13; /* 13 bits for Stream 2 PID filter value. General use. */ | ||
309 | u32 Stream2_trans : 1; /* When set Tables/CAI translation will take place for the data ferried in | ||
310 | Stream2_PID TS packets. */ | ||
311 | u32 debug_flag_write_status00 : 1; | ||
312 | u32 debug_fifo_problem : 1; | ||
313 | } pid_filter_300; | ||
314 | |||
315 | struct { | ||
316 | u32 PCR_PID :13; /* PCR stream PID filter value. Primary use is Program Clock Reference stream filtering. */ | ||
317 | u32 PCR_trans : 1; /* When set, Tables/CAI translation will take place for these packets. */ | ||
318 | u32 debug_overrun3 : 1; | ||
319 | u32 debug_overrun2 : 1; | ||
320 | u32 PMT_PID :13; /* stream PID filter value. Primary use is Program Management Table segment filtering. */ | ||
321 | u32 PMT_trans : 1; /* When set, Tables/CAI translation will take place for these packets. */ | ||
322 | u32 reserved : 2; | ||
323 | } pid_filter_304; | ||
324 | |||
325 | struct { | ||
326 | u32 EMM_PID :13; /* EMM PID filter value. Primary use is Entitlement Management Messaging for | ||
327 | conditional access-related data. */ | ||
328 | u32 EMM_trans : 1; /* When set, Tables/CAI translation will take place for these packets. */ | ||
329 | u32 EMM_filter_4 : 1; /* When set will pass only EMM data possessing the same ID code as the | ||
330 | first four bytes (32 bits) of the end-user s 6-byte Smart Card ID number Select */ | ||
331 | u32 EMM_filter_6 : 1; /* When set will pass only EMM data possessing the same 6-byte code as the end-users | ||
332 | complete 6-byte Smart Card ID number. */ | ||
333 | u32 ECM_PID :13; /* ECM PID filter value. Primary use is Entitlement Control Messaging for conditional | ||
334 | access-related data. */ | ||
335 | u32 ECM_trans : 1; /* When set, Tables/CAI translation will take place for these packets. */ | ||
336 | u32 reserved : 2; | ||
337 | } pid_filter_308; | ||
338 | |||
339 | struct { | ||
340 | u32 Group_PID :13; /* PID value for group filtering. */ | ||
341 | u32 Group_trans : 1; /* When set, Tables/CAI translation will take place for these packets. */ | ||
342 | u32 unused1 : 2; | ||
343 | u32 Group_mask :13; /* Mask value used in logical "and" equation that defines group filtering */ | ||
344 | u32 unused2 : 3; | ||
345 | } pid_filter_30c_ext_ind_0_7; | ||
346 | |||
347 | struct { | ||
348 | u32 net_master_read :17; | ||
349 | u32 unused :15; | ||
350 | } pid_filter_30c_ext_ind_1; | ||
351 | |||
352 | struct { | ||
353 | u32 net_master_write :17; | ||
354 | u32 unused :15; | ||
355 | } pid_filter_30c_ext_ind_2; | ||
356 | |||
357 | struct { | ||
358 | u32 next_net_master_write :17; | ||
359 | u32 unused :15; | ||
360 | } pid_filter_30c_ext_ind_3; | ||
361 | |||
362 | struct { | ||
363 | u32 unused1 : 1; | ||
364 | u32 state_write :10; | ||
365 | u32 reserved1 : 6; /* default: 000100 */ | ||
366 | u32 stack_read :10; | ||
367 | u32 reserved2 : 5; /* default: 00100 */ | ||
368 | } pid_filter_30c_ext_ind_4; | ||
369 | |||
370 | struct { | ||
371 | u32 stack_cnt :10; | ||
372 | u32 unused :22; | ||
373 | } pid_filter_30c_ext_ind_5; | ||
374 | |||
375 | struct { | ||
376 | u32 pid_fsm_save_reg0 : 2; | ||
377 | u32 pid_fsm_save_reg1 : 2; | ||
378 | u32 pid_fsm_save_reg2 : 2; | ||
379 | u32 pid_fsm_save_reg3 : 2; | ||
380 | u32 pid_fsm_save_reg4 : 2; | ||
381 | u32 pid_fsm_save_reg300 : 2; | ||
382 | u32 write_status1 : 2; | ||
383 | u32 write_status4 : 2; | ||
384 | u32 data_size_reg :12; | ||
385 | u32 unused : 4; | ||
386 | } pid_filter_30c_ext_ind_6; | ||
387 | |||
388 | struct { | ||
389 | u32 index_reg : 5; /* (Index pointer) Points at an internal PIDn register. A binary code | ||
390 | representing one of 32 internal PIDn registers as well as its | ||
391 | corresponding internal MAC_lown register. */ | ||
392 | u32 extra_index_reg : 3; /* This vector is used to select between sets of debug signals routed to register 0x30c. */ | ||
393 | u32 AB_select : 1; /* Used in conjunction with 0x31c. read/write to the MAC_highA or MAC_highB register | ||
394 | 0=MAC_highB register, 1=MAC_highA */ | ||
395 | u32 pass_alltables : 1; /* 1=Net packets are not filtered against the Network Table ID found in register 0x400. | ||
396 | All types of networks (DVB, ATSC, ISDB) are passed. */ | ||
397 | u32 unused :22; | ||
398 | } index_reg_310; | ||
399 | |||
400 | struct { | ||
401 | u32 PID :13; /* PID value */ | ||
402 | u32 PID_trans : 1; /* translation will take place for packets filtered */ | ||
403 | u32 PID_enable_bit : 1; /* When set this PID filter is enabled */ | ||
404 | u32 reserved :17; | ||
405 | } pid_n_reg_314; | ||
406 | |||
407 | struct { | ||
408 | u32 A4_byte : 8; | ||
409 | u32 A5_byte : 8; | ||
410 | u32 A6_byte : 8; | ||
411 | u32 Enable_bit : 1; /* enabled (1) or disabled (1) */ | ||
412 | u32 HighAB_bit : 1; /* use MAC_highA (1) or MAC_highB (0) as MSB */ | ||
413 | u32 reserved : 6; | ||
414 | } mac_low_reg_318; | ||
415 | |||
416 | struct { | ||
417 | u32 A1_byte : 8; | ||
418 | u32 A2_byte : 8; | ||
419 | u32 A3_byte : 8; | ||
420 | u32 reserved : 8; | ||
421 | } mac_high_reg_31c; | ||
422 | |||
423 | /* Table, SMCID,MACDestination Filters 0x400 to 0x41c */ | ||
424 | struct { | ||
425 | u32 reserved :16; | ||
426 | #define fc_data_Tag_ID_DVB 0x3e | ||
427 | #define fc_data_Tag_ID_ATSC 0x3f | ||
428 | #define fc_data_Tag_ID_IDSB 0x8b | ||
429 | u32 data_Tag_ID :16; | ||
430 | } data_tag_400; | ||
431 | |||
432 | struct { | ||
433 | u32 Card_IDbyte6 : 8; | ||
434 | u32 Card_IDbyte5 : 8; | ||
435 | u32 Card_IDbyte4 : 8; | ||
436 | u32 Card_IDbyte3 : 8; | ||
437 | } card_id_408; | ||
438 | |||
439 | struct { | ||
440 | u32 Card_IDbyte2 : 8; | ||
441 | u32 Card_IDbyte1 : 8; | ||
442 | } card_id_40c; | ||
443 | |||
444 | /* holding the unique mac address of the receiver which houses the FlexCopIII */ | ||
445 | struct { | ||
446 | u32 MAC1 : 8; | ||
447 | u32 MAC2 : 8; | ||
448 | u32 MAC3 : 8; | ||
449 | u32 MAC6 : 8; | ||
450 | } mac_address_418; | ||
451 | |||
452 | struct { | ||
453 | u32 MAC7 : 8; | ||
454 | u32 MAC8 : 8; | ||
455 | u32 reserved : 16; | ||
456 | } mac_address_41c; | ||
457 | |||
458 | struct { | ||
459 | u32 transmitter_data_byte : 8; | ||
460 | u32 ReceiveDataReady : 1; | ||
461 | u32 ReceiveByteFrameError: 1; | ||
462 | u32 txbuffempty : 1; | ||
463 | u32 reserved :21; | ||
464 | } ci_600; | ||
465 | |||
466 | struct { | ||
467 | u32 pi_d : 8; | ||
468 | u32 pi_ha :20; | ||
469 | u32 pi_rw : 1; | ||
470 | u32 pi_component_reg : 3; | ||
471 | } pi_604; | ||
472 | |||
473 | struct { | ||
474 | u32 serialReset : 1; | ||
475 | u32 oncecycle_read : 1; | ||
476 | u32 Timer_Read_req : 1; | ||
477 | u32 Timer_Load_req : 1; | ||
478 | u32 timer_data : 7; | ||
479 | u32 unused : 1; /* ??? not mentioned in data book */ | ||
480 | u32 Timer_addr : 5; | ||
481 | u32 reserved : 3; | ||
482 | u32 pcmcia_a_mod_pwr_n : 1; | ||
483 | u32 pcmcia_b_mod_pwr_n : 1; | ||
484 | u32 config_Done_stat : 1; | ||
485 | u32 config_Init_stat : 1; | ||
486 | u32 config_Prog_n : 1; | ||
487 | u32 config_wr_n : 1; | ||
488 | u32 config_cs_n : 1; | ||
489 | u32 config_cclk : 1; | ||
490 | u32 pi_CiMax_IRQ_n : 1; | ||
491 | u32 pi_timeout_status : 1; | ||
492 | u32 pi_wait_n : 1; | ||
493 | u32 pi_busy_n : 1; | ||
494 | } pi_608; | ||
495 | |||
496 | struct { | ||
497 | u32 PID :13; | ||
498 | u32 key_enable : 1; | ||
499 | #define fc_key_code_default 0x1 | ||
500 | #define fc_key_code_even 0x2 | ||
501 | #define fc_key_code_odd 0x3 | ||
502 | u32 key_code : 2; | ||
503 | u32 key_array_col : 3; | ||
504 | u32 key_array_row : 5; | ||
505 | u32 dvb_en : 1; /* 0=TS bypasses the Descrambler */ | ||
506 | u32 rw_flag : 1; | ||
507 | u32 reserved : 6; | ||
508 | } dvb_reg_60c; | ||
509 | |||
510 | /* SRAM and Output Destination 0x700 to 0x714 */ | ||
511 | struct { | ||
512 | u32 sram_addr :15; | ||
513 | u32 sram_rw : 1; /* 0=write, 1=read */ | ||
514 | u32 sram_data : 8; | ||
515 | u32 sc_xfer_bit : 1; | ||
516 | u32 reserved1 : 3; | ||
517 | u32 oe_pin_reg : 1; | ||
518 | u32 ce_pin_reg : 1; | ||
519 | u32 reserved2 : 1; | ||
520 | u32 start_sram_ibi : 1; | ||
521 | } sram_ctrl_reg_700; | ||
522 | |||
523 | struct { | ||
524 | u32 net_addr_read :16; | ||
525 | u32 net_addr_write :16; | ||
526 | } net_buf_reg_704; | ||
527 | |||
528 | struct { | ||
529 | u32 cai_read :11; | ||
530 | u32 reserved1 : 5; | ||
531 | u32 cai_write :11; | ||
532 | u32 reserved2 : 6; | ||
533 | u32 cai_cnt : 4; | ||
534 | } cai_buf_reg_708; | ||
535 | |||
536 | struct { | ||
537 | u32 cao_read :11; | ||
538 | u32 reserved1 : 5; | ||
539 | u32 cap_write :11; | ||
540 | u32 reserved2 : 6; | ||
541 | u32 cao_cnt : 4; | ||
542 | } cao_buf_reg_70c; | ||
543 | |||
544 | struct { | ||
545 | u32 media_read :11; | ||
546 | u32 reserved1 : 5; | ||
547 | u32 media_write :11; | ||
548 | u32 reserved2 : 6; | ||
549 | u32 media_cnt : 4; | ||
550 | } media_buf_reg_710; | ||
551 | |||
552 | struct { | ||
553 | u32 NET_Dest : 2; | ||
554 | u32 CAI_Dest : 2; | ||
555 | u32 CAO_Dest : 2; | ||
556 | u32 MEDIA_Dest : 2; | ||
557 | u32 net_ovflow_error : 1; | ||
558 | u32 media_ovflow_error : 1; | ||
559 | u32 cai_ovflow_error : 1; | ||
560 | u32 cao_ovflow_error : 1; | ||
561 | u32 ctrl_usb_wan : 1; | ||
562 | u32 ctrl_sramdma : 1; | ||
563 | u32 ctrl_maximumfill : 1; | ||
564 | u32 reserved :17; | ||
565 | } sram_dest_reg_714; | ||
566 | |||
567 | struct { | ||
568 | u32 net_cnt :12; | ||
569 | u32 reserved1 : 4; | ||
570 | u32 net_addr_read : 1; | ||
571 | u32 reserved2 : 3; | ||
572 | u32 net_addr_write : 1; | ||
573 | u32 reserved3 :11; | ||
574 | } net_buf_reg_718; | ||
575 | |||
576 | struct { | ||
577 | u32 wan_speed_sig : 2; | ||
578 | u32 reserved1 : 6; | ||
579 | u32 wan_wait_state : 8; | ||
580 | u32 sram_chip : 2; | ||
581 | u32 sram_memmap : 2; | ||
582 | u32 reserved2 : 4; | ||
583 | u32 wan_pkt_frame : 4; | ||
584 | u32 reserved3 : 4; | ||
585 | } wan_ctrl_reg_71c; | ||
586 | } flexcop_ibi_value; | ||
587 | |||
588 | extern flexcop_ibi_value ibi_zero; | ||
589 | |||
590 | typedef enum { | ||
591 | FC_I2C_PORT_DEMOD = 1, | ||
592 | FC_I2C_PORT_EEPROM = 2, | ||
593 | FC_I2C_PORT_TUNER = 3, | ||
594 | } flexcop_i2c_port_t; | ||
595 | |||
596 | typedef enum { | ||
597 | FC_WRITE = 0, | ||
598 | FC_READ = 1, | ||
599 | } flexcop_access_op_t; | ||
600 | |||
601 | typedef enum { | ||
602 | FC_SRAM_DEST_NET = 1, | ||
603 | FC_SRAM_DEST_CAI = 2, | ||
604 | FC_SRAM_DEST_CAO = 4, | ||
605 | FC_SRAM_DEST_MEDIA = 8 | ||
606 | } flexcop_sram_dest_t; | ||
607 | |||
608 | typedef enum { | ||
609 | FC_SRAM_DEST_TARGET_WAN_USB = 0, | ||
610 | FC_SRAM_DEST_TARGET_DMA1 = 1, | ||
611 | FC_SRAM_DEST_TARGET_DMA2 = 2, | ||
612 | FC_SRAM_DEST_TARGET_FC3_CA = 3 | ||
613 | } flexcop_sram_dest_target_t; | ||
614 | |||
615 | typedef enum { | ||
616 | FC_SRAM_2_32KB = 0, /* 64KB */ | ||
617 | FC_SRAM_1_32KB = 1, /* 32KB - default fow FCII */ | ||
618 | FC_SRAM_1_128KB = 2, /* 128KB */ | ||
619 | FC_SRAM_1_48KB = 3, /* 48KB - default for FCIII */ | ||
620 | } flexcop_sram_type_t; | ||
621 | |||
622 | typedef enum { | ||
623 | FC_WAN_SPEED_4MBITS = 0, | ||
624 | FC_WAN_SPEED_8MBITS = 1, | ||
625 | FC_WAN_SPEED_12MBITS = 2, | ||
626 | FC_WAN_SPEED_16MBITS = 3, | ||
627 | } flexcop_wan_speed_t; | ||
628 | |||
629 | typedef enum { | ||
630 | FC_DMA_1 = 1, | ||
631 | FC_DMA_2 = 2, | ||
632 | } flexcop_dma_index_t; | ||
633 | |||
634 | typedef enum { | ||
635 | FC_DMA_SUBADDR_0 = 1, | ||
636 | FC_DMA_SUBADDR_1 = 2, | ||
637 | } flexcop_dma_addr_index_t; | ||
638 | |||
639 | /* names of the particular registers */ | ||
640 | typedef enum { | ||
641 | dma1_000 = 0x000, | ||
642 | dma1_004 = 0x004, | ||
643 | dma1_008 = 0x008, | ||
644 | dma1_00c = 0x00c, | ||
645 | dma2_010 = 0x010, | ||
646 | dma2_014 = 0x014, | ||
647 | dma2_018 = 0x018, | ||
648 | dma2_01c = 0x01c, | ||
649 | |||
650 | tw_sm_c_100 = 0x100, | ||
651 | tw_sm_c_104 = 0x104, | ||
652 | tw_sm_c_108 = 0x108, | ||
653 | tw_sm_c_10c = 0x10c, | ||
654 | tw_sm_c_110 = 0x110, | ||
655 | |||
656 | lnb_switch_freq_200 = 0x200, | ||
657 | misc_204 = 0x204, | ||
658 | ctrl_208 = 0x208, | ||
659 | irq_20c = 0x20c, | ||
660 | sw_reset_210 = 0x210, | ||
661 | misc_214 = 0x214, | ||
662 | mbox_v8_to_host_218 = 0x218, | ||
663 | mbox_host_to_v8_21c = 0x21c, | ||
664 | |||
665 | pid_filter_300 = 0x300, | ||
666 | pid_filter_304 = 0x304, | ||
667 | pid_filter_308 = 0x308, | ||
668 | pid_filter_30c = 0x30c, | ||
669 | index_reg_310 = 0x310, | ||
670 | pid_n_reg_314 = 0x314, | ||
671 | mac_low_reg_318 = 0x318, | ||
672 | mac_high_reg_31c = 0x31c, | ||
673 | |||
674 | data_tag_400 = 0x400, | ||
675 | card_id_408 = 0x408, | ||
676 | card_id_40c = 0x40c, | ||
677 | mac_address_418 = 0x418, | ||
678 | mac_address_41c = 0x41c, | ||
679 | |||
680 | ci_600 = 0x600, | ||
681 | pi_604 = 0x604, | ||
682 | pi_608 = 0x608, | ||
683 | dvb_reg_60c = 0x60c, | ||
684 | |||
685 | sram_ctrl_reg_700 = 0x700, | ||
686 | net_buf_reg_704 = 0x704, | ||
687 | cai_buf_reg_708 = 0x708, | ||
688 | cao_buf_reg_70c = 0x70c, | ||
689 | media_buf_reg_710 = 0x710, | ||
690 | sram_dest_reg_714 = 0x714, | ||
691 | net_buf_reg_718 = 0x718, | ||
692 | wan_ctrl_reg_71c = 0x71c, | ||
693 | } flexcop_ibi_register; | ||
694 | |||
695 | #define flexcop_set_ibi_value(reg,attr,val) { \ | ||
696 | flexcop_ibi_value v = fc->read_ibi_reg(fc,reg); \ | ||
697 | v.reg.attr = val; \ | ||
698 | fc->write_ibi_reg(fc,reg,v); \ | ||
699 | } | ||
700 | |||
701 | #endif | ||
diff --git a/drivers/media/dvb/b2c2/flexcop-sram.c b/drivers/media/dvb/b2c2/flexcop-sram.c new file mode 100644 index 000000000000..01570ec80962 --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop-sram.c | |||
@@ -0,0 +1,403 @@ | |||
1 | /* | ||
2 | * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III | ||
3 | * | ||
4 | * flexcop-sram.c - functions for controlling the SRAM. | ||
5 | * | ||
6 | * see flexcop.c for copyright information. | ||
7 | */ | ||
8 | #include "flexcop.h" | ||
9 | |||
10 | static void flexcop_sram_set_chip (struct flexcop_device *fc, flexcop_sram_type_t type) | ||
11 | { | ||
12 | flexcop_set_ibi_value(wan_ctrl_reg_71c,sram_chip,type); | ||
13 | } | ||
14 | |||
15 | int flexcop_sram_init(struct flexcop_device *fc) | ||
16 | { | ||
17 | switch (fc->rev) { | ||
18 | case FLEXCOP_II: | ||
19 | case FLEXCOP_IIB: | ||
20 | flexcop_sram_set_chip(fc,FC_SRAM_1_32KB); | ||
21 | break; | ||
22 | case FLEXCOP_III: | ||
23 | flexcop_sram_set_chip(fc,FC_SRAM_1_48KB); | ||
24 | break; | ||
25 | default: | ||
26 | return -EINVAL; | ||
27 | } | ||
28 | return 0; | ||
29 | } | ||
30 | |||
31 | int flexcop_sram_set_dest(struct flexcop_device *fc, flexcop_sram_dest_t dest, flexcop_sram_dest_target_t target) | ||
32 | { | ||
33 | flexcop_ibi_value v; | ||
34 | |||
35 | v = fc->read_ibi_reg(fc,sram_dest_reg_714); | ||
36 | |||
37 | if (fc->rev != FLEXCOP_III && target == FC_SRAM_DEST_TARGET_FC3_CA) { | ||
38 | err("SRAM destination target to available on FlexCopII(b)\n"); | ||
39 | return -EINVAL; | ||
40 | } | ||
41 | |||
42 | deb_sram("sram dest: %x target: %x\n",dest, target); | ||
43 | |||
44 | if (dest & FC_SRAM_DEST_NET) | ||
45 | v.sram_dest_reg_714.NET_Dest = target; | ||
46 | if (dest & FC_SRAM_DEST_CAI) | ||
47 | v.sram_dest_reg_714.CAI_Dest = target; | ||
48 | if (dest & FC_SRAM_DEST_CAO) | ||
49 | v.sram_dest_reg_714.CAO_Dest = target; | ||
50 | if (dest & FC_SRAM_DEST_MEDIA) | ||
51 | v.sram_dest_reg_714.MEDIA_Dest = target; | ||
52 | |||
53 | fc->write_ibi_reg(fc,sram_dest_reg_714,v); | ||
54 | udelay(1000); /* TODO delay really necessary */ | ||
55 | |||
56 | return 0; | ||
57 | } | ||
58 | EXPORT_SYMBOL(flexcop_sram_set_dest); | ||
59 | |||
60 | void flexcop_wan_set_speed(struct flexcop_device *fc, flexcop_wan_speed_t s) | ||
61 | { | ||
62 | flexcop_set_ibi_value(wan_ctrl_reg_71c,wan_speed_sig,s); | ||
63 | } | ||
64 | EXPORT_SYMBOL(flexcop_wan_set_speed); | ||
65 | |||
66 | void flexcop_sram_ctrl(struct flexcop_device *fc, int usb_wan, int sramdma, int maximumfill) | ||
67 | { | ||
68 | flexcop_ibi_value v = fc->read_ibi_reg(fc,sram_dest_reg_714); | ||
69 | v.sram_dest_reg_714.ctrl_usb_wan = usb_wan; | ||
70 | v.sram_dest_reg_714.ctrl_sramdma = sramdma; | ||
71 | v.sram_dest_reg_714.ctrl_maximumfill = maximumfill; | ||
72 | fc->write_ibi_reg(fc,sram_dest_reg_714,v); | ||
73 | } | ||
74 | EXPORT_SYMBOL(flexcop_sram_ctrl); | ||
75 | |||
76 | #if 0 | ||
77 | static void flexcop_sram_write(struct adapter *adapter, u32 bank, u32 addr, u8 *buf, u32 len) | ||
78 | { | ||
79 | int i, retries; | ||
80 | u32 command; | ||
81 | |||
82 | for (i = 0; i < len; i++) { | ||
83 | command = bank | addr | 0x04000000 | (*buf << 0x10); | ||
84 | |||
85 | retries = 2; | ||
86 | |||
87 | while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) { | ||
88 | mdelay(1); | ||
89 | retries--; | ||
90 | }; | ||
91 | |||
92 | if (retries == 0) | ||
93 | printk("%s: SRAM timeout\n", __FUNCTION__); | ||
94 | |||
95 | write_reg_dw(adapter, 0x700, command); | ||
96 | |||
97 | buf++; | ||
98 | addr++; | ||
99 | } | ||
100 | } | ||
101 | |||
102 | static void flex_sram_read(struct adapter *adapter, u32 bank, u32 addr, u8 *buf, u32 len) | ||
103 | { | ||
104 | int i, retries; | ||
105 | u32 command, value; | ||
106 | |||
107 | for (i = 0; i < len; i++) { | ||
108 | command = bank | addr | 0x04008000; | ||
109 | |||
110 | retries = 10000; | ||
111 | |||
112 | while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) { | ||
113 | mdelay(1); | ||
114 | retries--; | ||
115 | }; | ||
116 | |||
117 | if (retries == 0) | ||
118 | printk("%s: SRAM timeout\n", __FUNCTION__); | ||
119 | |||
120 | write_reg_dw(adapter, 0x700, command); | ||
121 | |||
122 | retries = 10000; | ||
123 | |||
124 | while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) { | ||
125 | mdelay(1); | ||
126 | retries--; | ||
127 | }; | ||
128 | |||
129 | if (retries == 0) | ||
130 | printk("%s: SRAM timeout\n", __FUNCTION__); | ||
131 | |||
132 | value = read_reg_dw(adapter, 0x700) >> 0x10; | ||
133 | |||
134 | *buf = (value & 0xff); | ||
135 | |||
136 | addr++; | ||
137 | buf++; | ||
138 | } | ||
139 | } | ||
140 | |||
141 | static void sram_write_chunk(struct adapter *adapter, u32 addr, u8 *buf, u16 len) | ||
142 | { | ||
143 | u32 bank; | ||
144 | |||
145 | bank = 0; | ||
146 | |||
147 | if (adapter->dw_sram_type == 0x20000) { | ||
148 | bank = (addr & 0x18000) << 0x0d; | ||
149 | } | ||
150 | |||
151 | if (adapter->dw_sram_type == 0x00000) { | ||
152 | if ((addr >> 0x0f) == 0) | ||
153 | bank = 0x20000000; | ||
154 | else | ||
155 | bank = 0x10000000; | ||
156 | } | ||
157 | |||
158 | flex_sram_write(adapter, bank, addr & 0x7fff, buf, len); | ||
159 | } | ||
160 | |||
161 | static void sram_read_chunk(struct adapter *adapter, u32 addr, u8 *buf, u16 len) | ||
162 | { | ||
163 | u32 bank; | ||
164 | |||
165 | bank = 0; | ||
166 | |||
167 | if (adapter->dw_sram_type == 0x20000) { | ||
168 | bank = (addr & 0x18000) << 0x0d; | ||
169 | } | ||
170 | |||
171 | if (adapter->dw_sram_type == 0x00000) { | ||
172 | if ((addr >> 0x0f) == 0) | ||
173 | bank = 0x20000000; | ||
174 | else | ||
175 | bank = 0x10000000; | ||
176 | } | ||
177 | |||
178 | flex_sram_read(adapter, bank, addr & 0x7fff, buf, len); | ||
179 | } | ||
180 | |||
181 | static void sram_read(struct adapter *adapter, u32 addr, u8 *buf, u32 len) | ||
182 | { | ||
183 | u32 length; | ||
184 | |||
185 | while (len != 0) { | ||
186 | length = len; | ||
187 | |||
188 | // check if the address range belongs to the same | ||
189 | // 32K memory chip. If not, the data is read from | ||
190 | // one chip at a time. | ||
191 | if ((addr >> 0x0f) != ((addr + len - 1) >> 0x0f)) { | ||
192 | length = (((addr >> 0x0f) + 1) << 0x0f) - addr; | ||
193 | } | ||
194 | |||
195 | sram_read_chunk(adapter, addr, buf, length); | ||
196 | |||
197 | addr = addr + length; | ||
198 | buf = buf + length; | ||
199 | len = len - length; | ||
200 | } | ||
201 | } | ||
202 | |||
203 | static void sram_write(struct adapter *adapter, u32 addr, u8 *buf, u32 len) | ||
204 | { | ||
205 | u32 length; | ||
206 | |||
207 | while (len != 0) { | ||
208 | length = len; | ||
209 | |||
210 | // check if the address range belongs to the same | ||
211 | // 32K memory chip. If not, the data is written to | ||
212 | // one chip at a time. | ||
213 | if ((addr >> 0x0f) != ((addr + len - 1) >> 0x0f)) { | ||
214 | length = (((addr >> 0x0f) + 1) << 0x0f) - addr; | ||
215 | } | ||
216 | |||
217 | sram_write_chunk(adapter, addr, buf, length); | ||
218 | |||
219 | addr = addr + length; | ||
220 | buf = buf + length; | ||
221 | len = len - length; | ||
222 | } | ||
223 | } | ||
224 | |||
225 | static void sram_set_size(struct adapter *adapter, u32 mask) | ||
226 | { | ||
227 | write_reg_dw(adapter, 0x71c, (mask | (~0x30000 & read_reg_dw(adapter, 0x71c)))); | ||
228 | } | ||
229 | |||
230 | static void sram_init(struct adapter *adapter) | ||
231 | { | ||
232 | u32 tmp; | ||
233 | |||
234 | tmp = read_reg_dw(adapter, 0x71c); | ||
235 | |||
236 | write_reg_dw(adapter, 0x71c, 1); | ||
237 | |||
238 | if (read_reg_dw(adapter, 0x71c) != 0) { | ||
239 | write_reg_dw(adapter, 0x71c, tmp); | ||
240 | |||
241 | adapter->dw_sram_type = tmp & 0x30000; | ||
242 | |||
243 | ddprintk("%s: dw_sram_type = %x\n", __FUNCTION__, adapter->dw_sram_type); | ||
244 | |||
245 | } else { | ||
246 | |||
247 | adapter->dw_sram_type = 0x10000; | ||
248 | |||
249 | ddprintk("%s: dw_sram_type = %x\n", __FUNCTION__, adapter->dw_sram_type); | ||
250 | } | ||
251 | |||
252 | /* return value is never used? */ | ||
253 | /* return adapter->dw_sram_type; */ | ||
254 | } | ||
255 | |||
256 | static int sram_test_location(struct adapter *adapter, u32 mask, u32 addr) | ||
257 | { | ||
258 | u8 tmp1, tmp2; | ||
259 | |||
260 | dprintk("%s: mask = %x, addr = %x\n", __FUNCTION__, mask, addr); | ||
261 | |||
262 | sram_set_size(adapter, mask); | ||
263 | sram_init(adapter); | ||
264 | |||
265 | tmp2 = 0xa5; | ||
266 | tmp1 = 0x4f; | ||
267 | |||
268 | sram_write(adapter, addr, &tmp2, 1); | ||
269 | sram_write(adapter, addr + 4, &tmp1, 1); | ||
270 | |||
271 | tmp2 = 0; | ||
272 | |||
273 | mdelay(20); | ||
274 | |||
275 | sram_read(adapter, addr, &tmp2, 1); | ||
276 | sram_read(adapter, addr, &tmp2, 1); | ||
277 | |||
278 | dprintk("%s: wrote 0xa5, read 0x%2x\n", __FUNCTION__, tmp2); | ||
279 | |||
280 | if (tmp2 != 0xa5) | ||
281 | return 0; | ||
282 | |||
283 | tmp2 = 0x5a; | ||
284 | tmp1 = 0xf4; | ||
285 | |||
286 | sram_write(adapter, addr, &tmp2, 1); | ||
287 | sram_write(adapter, addr + 4, &tmp1, 1); | ||
288 | |||
289 | tmp2 = 0; | ||
290 | |||
291 | mdelay(20); | ||
292 | |||
293 | sram_read(adapter, addr, &tmp2, 1); | ||
294 | sram_read(adapter, addr, &tmp2, 1); | ||
295 | |||
296 | dprintk("%s: wrote 0x5a, read 0x%2x\n", __FUNCTION__, tmp2); | ||
297 | |||
298 | if (tmp2 != 0x5a) | ||
299 | return 0; | ||
300 | |||
301 | return 1; | ||
302 | } | ||
303 | |||
304 | static u32 sram_length(struct adapter *adapter) | ||
305 | { | ||
306 | if (adapter->dw_sram_type == 0x10000) | ||
307 | return 32768; // 32K | ||
308 | if (adapter->dw_sram_type == 0x00000) | ||
309 | return 65536; // 64K | ||
310 | if (adapter->dw_sram_type == 0x20000) | ||
311 | return 131072; // 128K | ||
312 | |||
313 | return 32768; // 32K | ||
314 | } | ||
315 | |||
316 | /* FlexcopII can work with 32K, 64K or 128K of external SRAM memory. | ||
317 | - for 128K there are 4x32K chips at bank 0,1,2,3. | ||
318 | - for 64K there are 2x32K chips at bank 1,2. | ||
319 | - for 32K there is one 32K chip at bank 0. | ||
320 | |||
321 | FlexCop works only with one bank at a time. The bank is selected | ||
322 | by bits 28-29 of the 0x700 register. | ||
323 | |||
324 | bank 0 covers addresses 0x00000-0x07fff | ||
325 | bank 1 covers addresses 0x08000-0x0ffff | ||
326 | bank 2 covers addresses 0x10000-0x17fff | ||
327 | bank 3 covers addresses 0x18000-0x1ffff | ||
328 | */ | ||
329 | |||
330 | static int flexcop_sram_detect(struct flexcop_device *fc) | ||
331 | { | ||
332 | flexcop_ibi_value r208,r71c_0,vr71c_1; | ||
333 | |||
334 | r208 = fc->read_ibi_reg(fc, ctrl_208); | ||
335 | fc->write_ibi_reg(fc, ctrl_208, ibi_zero); | ||
336 | |||
337 | r71c_0 = fc->read_ibi_reg(fc, wan_ctrl_reg_71c); | ||
338 | |||
339 | write_reg_dw(adapter, 0x71c, 1); | ||
340 | |||
341 | tmp3 = read_reg_dw(adapter, 0x71c); | ||
342 | |||
343 | dprintk("%s: tmp3 = %x\n", __FUNCTION__, tmp3); | ||
344 | |||
345 | write_reg_dw(adapter, 0x71c, tmp2); | ||
346 | |||
347 | // check for internal SRAM ??? | ||
348 | tmp3--; | ||
349 | if (tmp3 != 0) { | ||
350 | sram_set_size(adapter, 0x10000); | ||
351 | sram_init(adapter); | ||
352 | write_reg_dw(adapter, 0x208, tmp); | ||
353 | |||
354 | dprintk("%s: sram size = 32K\n", __FUNCTION__); | ||
355 | |||
356 | return 32; | ||
357 | } | ||
358 | |||
359 | if (sram_test_location(adapter, 0x20000, 0x18000) != 0) { | ||
360 | sram_set_size(adapter, 0x20000); | ||
361 | sram_init(adapter); | ||
362 | write_reg_dw(adapter, 0x208, tmp); | ||
363 | |||
364 | dprintk("%s: sram size = 128K\n", __FUNCTION__); | ||
365 | |||
366 | return 128; | ||
367 | } | ||
368 | |||
369 | if (sram_test_location(adapter, 0x00000, 0x10000) != 0) { | ||
370 | sram_set_size(adapter, 0x00000); | ||
371 | sram_init(adapter); | ||
372 | write_reg_dw(adapter, 0x208, tmp); | ||
373 | |||
374 | dprintk("%s: sram size = 64K\n", __FUNCTION__); | ||
375 | |||
376 | return 64; | ||
377 | } | ||
378 | |||
379 | if (sram_test_location(adapter, 0x10000, 0x00000) != 0) { | ||
380 | sram_set_size(adapter, 0x10000); | ||
381 | sram_init(adapter); | ||
382 | write_reg_dw(adapter, 0x208, tmp); | ||
383 | |||
384 | dprintk("%s: sram size = 32K\n", __FUNCTION__); | ||
385 | |||
386 | return 32; | ||
387 | } | ||
388 | |||
389 | sram_set_size(adapter, 0x10000); | ||
390 | sram_init(adapter); | ||
391 | write_reg_dw(adapter, 0x208, tmp); | ||
392 | |||
393 | dprintk("%s: SRAM detection failed. Set to 32K \n", __FUNCTION__); | ||
394 | |||
395 | return 0; | ||
396 | } | ||
397 | |||
398 | static void sll_detect_sram_size(struct adapter *adapter) | ||
399 | { | ||
400 | sram_detect_for_flex2(adapter); | ||
401 | } | ||
402 | |||
403 | #endif | ||
diff --git a/drivers/media/dvb/b2c2/flexcop-usb.c b/drivers/media/dvb/b2c2/flexcop-usb.c new file mode 100644 index 000000000000..0113449abd15 --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop-usb.c | |||
@@ -0,0 +1,577 @@ | |||
1 | /* | ||
2 | * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III | ||
3 | * | ||
4 | * flexcop-usb.c - covers the USB part. | ||
5 | * | ||
6 | * see flexcop.c for copyright information. | ||
7 | */ | ||
8 | |||
9 | #define FC_LOG_PREFIX "flexcop_usb" | ||
10 | #include "flexcop-usb.h" | ||
11 | #include "flexcop-common.h" | ||
12 | |||
13 | /* Version information */ | ||
14 | #define DRIVER_VERSION "0.1" | ||
15 | #define DRIVER_NAME "Technisat/B2C2 FlexCop II/IIb/III Digital TV USB Driver" | ||
16 | #define DRIVER_AUTHOR "Patrick Boettcher <patrick.boettcher@desy.de>" | ||
17 | |||
18 | /* debug */ | ||
19 | #ifdef CONFIG_DVB_B2C2_FLEXCOP_DEBUG | ||
20 | #define dprintk(level,args...) \ | ||
21 | do { if ((debug & level)) { printk(args); } } while (0) | ||
22 | #define debug_dump(b,l,method) {\ | ||
23 | int i; \ | ||
24 | for (i = 0; i < l; i++) method("%02x ", b[i]); \ | ||
25 | method("\n");\ | ||
26 | } | ||
27 | |||
28 | #define DEBSTATUS "" | ||
29 | #else | ||
30 | #define dprintk(level,args...) | ||
31 | #define debug_dump(b,l,method) | ||
32 | #define DEBSTATUS " (debugging is not enabled)" | ||
33 | #endif | ||
34 | |||
35 | static int debug; | ||
36 | module_param(debug, int, 0644); | ||
37 | MODULE_PARM_DESC(debug, "set debugging level (1=info,ts=2,ctrl=4,i2c=8,v8mem=16 (or-able))." DEBSTATUS); | ||
38 | #undef DEBSTATUS | ||
39 | |||
40 | #define deb_info(args...) dprintk(0x01,args) | ||
41 | #define deb_ts(args...) dprintk(0x02,args) | ||
42 | #define deb_ctrl(args...) dprintk(0x04,args) | ||
43 | #define deb_i2c(args...) dprintk(0x08,args) | ||
44 | #define deb_v8(args...) dprintk(0x10,args) | ||
45 | |||
46 | /* JLP 111700: we will include the 1 bit gap between the upper and lower 3 bits | ||
47 | * in the IBI address, to make the V8 code simpler. | ||
48 | * PCI ADDRESS FORMAT: 0x71C -> 0000 0111 0001 1100 (these are the six bits used) | ||
49 | * in general: 0000 0HHH 000L LL00 | ||
50 | * IBI ADDRESS FORMAT: RHHH BLLL | ||
51 | * | ||
52 | * where R is the read(1)/write(0) bit, B is the busy bit | ||
53 | * and HHH and LLL are the two sets of three bits from the PCI address. | ||
54 | */ | ||
55 | #define B2C2_FLEX_PCIOFFSET_TO_INTERNALADDR(usPCI) (u8) (((usPCI >> 2) & 0x07) + ((usPCI >> 4) & 0x70)) | ||
56 | #define B2C2_FLEX_INTERNALADDR_TO_PCIOFFSET(ucAddr) (u16) (((ucAddr & 0x07) << 2) + ((ucAddr & 0x70) << 4)) | ||
57 | |||
58 | /* | ||
59 | * DKT 020228 | ||
60 | * - forget about this VENDOR_BUFFER_SIZE, read and write register | ||
61 | * deal with DWORD or 4 bytes, that should be should from now on | ||
62 | * - from now on, we don't support anything older than firm 1.00 | ||
63 | * I eliminated the write register as a 2 trip of writing hi word and lo word | ||
64 | * and force this to write only 4 bytes at a time. | ||
65 | * NOTE: this should work with all the firmware from 1.00 and newer | ||
66 | */ | ||
67 | static int flexcop_usb_readwrite_dw(struct flexcop_device *fc, u16 wRegOffsPCI, u32 *val, u8 read) | ||
68 | { | ||
69 | struct flexcop_usb *fc_usb = fc->bus_specific; | ||
70 | u8 request = read ? B2C2_USB_READ_REG : B2C2_USB_WRITE_REG; | ||
71 | u8 request_type = (read ? USB_DIR_IN : USB_DIR_OUT) | USB_TYPE_VENDOR; | ||
72 | u8 wAddress = B2C2_FLEX_PCIOFFSET_TO_INTERNALADDR(wRegOffsPCI) | (read ? 0x80 : 0); | ||
73 | |||
74 | int len = usb_control_msg(fc_usb->udev, | ||
75 | read ? B2C2_USB_CTRL_PIPE_IN : B2C2_USB_CTRL_PIPE_OUT, | ||
76 | request, | ||
77 | request_type, /* 0xc0 read or 0x40 write*/ | ||
78 | wAddress, | ||
79 | 0, | ||
80 | val, | ||
81 | sizeof(u32), | ||
82 | B2C2_WAIT_FOR_OPERATION_RDW * HZ); | ||
83 | |||
84 | if (len != sizeof(u32)) { | ||
85 | err("error while %s dword from %d (%d).",read ? "reading" : "writing", | ||
86 | wAddress,wRegOffsPCI); | ||
87 | return -EIO; | ||
88 | } | ||
89 | return 0; | ||
90 | } | ||
91 | |||
92 | /* | ||
93 | * DKT 010817 - add support for V8 memory read/write and flash update | ||
94 | */ | ||
95 | static int flexcop_usb_v8_memory_req(struct flexcop_usb *fc_usb, | ||
96 | flexcop_usb_request_t req, u8 page, u16 wAddress, | ||
97 | u8 *pbBuffer,u32 buflen) | ||
98 | { | ||
99 | // u8 dwRequestType; | ||
100 | u8 request_type = USB_TYPE_VENDOR; | ||
101 | u16 wIndex; | ||
102 | int nWaitTime,pipe,len; | ||
103 | |||
104 | wIndex = page << 8; | ||
105 | |||
106 | switch (req) { | ||
107 | case B2C2_USB_READ_V8_MEM: | ||
108 | nWaitTime = B2C2_WAIT_FOR_OPERATION_V8READ; | ||
109 | request_type |= USB_DIR_IN; | ||
110 | // dwRequestType = (u8) RTYPE_READ_V8_MEMORY; | ||
111 | pipe = B2C2_USB_CTRL_PIPE_IN; | ||
112 | break; | ||
113 | case B2C2_USB_WRITE_V8_MEM: | ||
114 | wIndex |= pbBuffer[0]; | ||
115 | request_type |= USB_DIR_OUT; | ||
116 | nWaitTime = B2C2_WAIT_FOR_OPERATION_V8WRITE; | ||
117 | // dwRequestType = (u8) RTYPE_WRITE_V8_MEMORY; | ||
118 | pipe = B2C2_USB_CTRL_PIPE_OUT; | ||
119 | break; | ||
120 | case B2C2_USB_FLASH_BLOCK: | ||
121 | request_type |= USB_DIR_OUT; | ||
122 | nWaitTime = B2C2_WAIT_FOR_OPERATION_V8FLASH; | ||
123 | // dwRequestType = (u8) RTYPE_WRITE_V8_FLASH; | ||
124 | pipe = B2C2_USB_CTRL_PIPE_OUT; | ||
125 | break; | ||
126 | default: | ||
127 | deb_info("unsupported request for v8_mem_req %x.\n",req); | ||
128 | return -EINVAL; | ||
129 | } | ||
130 | deb_v8("v8mem: %02x %02x %04x %04x, len: %d\n",request_type,req, | ||
131 | wAddress,wIndex,buflen); | ||
132 | |||
133 | len = usb_control_msg(fc_usb->udev,pipe, | ||
134 | req, | ||
135 | request_type, | ||
136 | wAddress, | ||
137 | wIndex, | ||
138 | pbBuffer, | ||
139 | buflen, | ||
140 | nWaitTime * HZ); | ||
141 | |||
142 | debug_dump(pbBuffer,len,deb_v8); | ||
143 | |||
144 | return len == buflen ? 0 : -EIO; | ||
145 | } | ||
146 | |||
147 | #define bytes_left_to_read_on_page(paddr,buflen) \ | ||
148 | ((V8_MEMORY_PAGE_SIZE - (paddr & V8_MEMORY_PAGE_MASK)) > buflen \ | ||
149 | ? buflen : (V8_MEMORY_PAGE_SIZE - (paddr & V8_MEMORY_PAGE_MASK))) | ||
150 | |||
151 | static int flexcop_usb_memory_req(struct flexcop_usb *fc_usb,flexcop_usb_request_t req, | ||
152 | flexcop_usb_mem_page_t page_start, u32 addr, int extended, u8 *buf, u32 len) | ||
153 | { | ||
154 | int i,ret = 0; | ||
155 | u16 wMax; | ||
156 | u32 pagechunk = 0; | ||
157 | |||
158 | switch(req) { | ||
159 | case B2C2_USB_READ_V8_MEM: wMax = USB_MEM_READ_MAX; break; | ||
160 | case B2C2_USB_WRITE_V8_MEM: wMax = USB_MEM_WRITE_MAX; break; | ||
161 | case B2C2_USB_FLASH_BLOCK: wMax = USB_FLASH_MAX; break; | ||
162 | default: | ||
163 | return -EINVAL; | ||
164 | break; | ||
165 | } | ||
166 | for (i = 0; i < len;) { | ||
167 | pagechunk = wMax < bytes_left_to_read_on_page(addr,len) ? wMax : bytes_left_to_read_on_page(addr,len); | ||
168 | deb_info("%x\n",(addr & V8_MEMORY_PAGE_MASK) | (V8_MEMORY_EXTENDED*extended)); | ||
169 | if ((ret = flexcop_usb_v8_memory_req(fc_usb,req, | ||
170 | page_start + (addr / V8_MEMORY_PAGE_SIZE), /* actual page */ | ||
171 | (addr & V8_MEMORY_PAGE_MASK) | (V8_MEMORY_EXTENDED*extended), | ||
172 | &buf[i],pagechunk)) < 0) | ||
173 | return ret; | ||
174 | |||
175 | addr += pagechunk; | ||
176 | len -= pagechunk; | ||
177 | } | ||
178 | return 0; | ||
179 | } | ||
180 | |||
181 | static int flexcop_usb_get_mac_addr(struct flexcop_device *fc, int extended) | ||
182 | { | ||
183 | return flexcop_usb_memory_req(fc->bus_specific,B2C2_USB_READ_V8_MEM, | ||
184 | V8_MEMORY_PAGE_FLASH,0x1f010,1,fc->dvb_adapter.proposed_mac,6); | ||
185 | } | ||
186 | |||
187 | #if 0 | ||
188 | static int flexcop_usb_utility_req(struct flexcop_usb *fc_usb, int set, | ||
189 | flexcop_usb_utility_function_t func, u8 extra, u16 wIndex, | ||
190 | u16 buflen, u8 *pvBuffer) | ||
191 | { | ||
192 | u16 wValue; | ||
193 | u8 request_type = (set ? USB_DIR_OUT : USB_DIR_IN) | USB_TYPE_VENDOR; | ||
194 | // u8 dwRequestType = (u8) RTYPE_GENERIC, | ||
195 | int nWaitTime = 2, | ||
196 | pipe = set ? B2C2_USB_CTRL_PIPE_OUT : B2C2_USB_CTRL_PIPE_IN, | ||
197 | len; | ||
198 | |||
199 | wValue = (func << 8) | extra; | ||
200 | |||
201 | len = usb_control_msg(fc_usb->udev,pipe, | ||
202 | B2C2_USB_UTILITY, | ||
203 | request_type, | ||
204 | wValue, | ||
205 | wIndex, | ||
206 | pvBuffer, | ||
207 | buflen, | ||
208 | nWaitTime * HZ); | ||
209 | return len == buflen ? 0 : -EIO; | ||
210 | } | ||
211 | #endif | ||
212 | |||
213 | /* usb i2c stuff */ | ||
214 | static int flexcop_usb_i2c_req(struct flexcop_usb *fc_usb, | ||
215 | flexcop_usb_request_t req, flexcop_usb_i2c_function_t func, | ||
216 | flexcop_i2c_port_t port, u8 chipaddr, u8 addr, u8 *buf, u8 buflen) | ||
217 | { | ||
218 | u16 wValue, wIndex; | ||
219 | int nWaitTime,pipe,len; | ||
220 | // u8 dwRequestType; | ||
221 | u8 request_type = USB_TYPE_VENDOR; | ||
222 | |||
223 | switch (func) { | ||
224 | case USB_FUNC_I2C_WRITE: | ||
225 | case USB_FUNC_I2C_MULTIWRITE: | ||
226 | case USB_FUNC_I2C_REPEATWRITE: | ||
227 | /* DKT 020208 - add this to support special case of DiSEqC */ | ||
228 | case USB_FUNC_I2C_CHECKWRITE: | ||
229 | pipe = B2C2_USB_CTRL_PIPE_OUT; | ||
230 | nWaitTime = 2; | ||
231 | // dwRequestType = (u8) RTYPE_GENERIC; | ||
232 | request_type |= USB_DIR_OUT; | ||
233 | break; | ||
234 | case USB_FUNC_I2C_READ: | ||
235 | case USB_FUNC_I2C_REPEATREAD: | ||
236 | pipe = B2C2_USB_CTRL_PIPE_IN; | ||
237 | nWaitTime = 2; | ||
238 | // dwRequestType = (u8) RTYPE_GENERIC; | ||
239 | request_type |= USB_DIR_IN; | ||
240 | break; | ||
241 | default: | ||
242 | deb_info("unsupported function for i2c_req %x\n",func); | ||
243 | return -EINVAL; | ||
244 | } | ||
245 | wValue = (func << 8 ) | (port << 4); | ||
246 | wIndex = (chipaddr << 8 ) | addr; | ||
247 | |||
248 | deb_i2c("i2c %2d: %02x %02x %02x %02x %02x %02x\n",func,request_type,req, | ||
249 | ((wValue && 0xff) << 8),wValue >> 8,((wIndex && 0xff) << 8),wIndex >> 8); | ||
250 | |||
251 | len = usb_control_msg(fc_usb->udev,pipe, | ||
252 | req, | ||
253 | request_type, | ||
254 | wValue, | ||
255 | wIndex, | ||
256 | buf, | ||
257 | buflen, | ||
258 | nWaitTime * HZ); | ||
259 | |||
260 | return len == buflen ? 0 : -EREMOTEIO; | ||
261 | } | ||
262 | |||
263 | /* actual bus specific access functions, make sure prototype are/will be equal to pci */ | ||
264 | static flexcop_ibi_value flexcop_usb_read_ibi_reg(struct flexcop_device *fc, flexcop_ibi_register reg) | ||
265 | { | ||
266 | flexcop_ibi_value val; | ||
267 | val.raw = 0; | ||
268 | flexcop_usb_readwrite_dw(fc,reg, &val.raw, 1); | ||
269 | return val; | ||
270 | } | ||
271 | |||
272 | static int flexcop_usb_write_ibi_reg(struct flexcop_device *fc, flexcop_ibi_register reg, flexcop_ibi_value val) | ||
273 | { | ||
274 | return flexcop_usb_readwrite_dw(fc,reg, &val.raw, 0); | ||
275 | } | ||
276 | |||
277 | static int flexcop_usb_i2c_request(struct flexcop_device *fc, flexcop_access_op_t op, | ||
278 | flexcop_i2c_port_t port, u8 chipaddr, u8 addr, u8 *buf, u16 len) | ||
279 | { | ||
280 | if (op == FC_READ) | ||
281 | return flexcop_usb_i2c_req(fc->bus_specific,B2C2_USB_I2C_REQUEST,USB_FUNC_I2C_READ,port,chipaddr,addr,buf,len); | ||
282 | else | ||
283 | return flexcop_usb_i2c_req(fc->bus_specific,B2C2_USB_I2C_REQUEST,USB_FUNC_I2C_WRITE,port,chipaddr,addr,buf,len); | ||
284 | } | ||
285 | |||
286 | static void flexcop_usb_process_frame(struct flexcop_usb *fc_usb, u8 *buffer, int buffer_length) | ||
287 | { | ||
288 | u8 *b; | ||
289 | int l; | ||
290 | |||
291 | deb_ts("tmp_buffer_length=%d, buffer_length=%d\n", fc_usb->tmp_buffer_length, buffer_length); | ||
292 | |||
293 | if (fc_usb->tmp_buffer_length > 0) { | ||
294 | memcpy(fc_usb->tmp_buffer+fc_usb->tmp_buffer_length, buffer, buffer_length); | ||
295 | fc_usb->tmp_buffer_length += buffer_length; | ||
296 | b = fc_usb->tmp_buffer; | ||
297 | l = fc_usb->tmp_buffer_length; | ||
298 | } else { | ||
299 | b=buffer; | ||
300 | l=buffer_length; | ||
301 | } | ||
302 | |||
303 | while (l >= 190) { | ||
304 | if (*b == 0xff) | ||
305 | switch (*(b+1) & 0x03) { | ||
306 | case 0x01: /* media packet */ | ||
307 | if ( *(b+2) == 0x47 ) | ||
308 | flexcop_pass_dmx_packets(fc_usb->fc_dev, b+2, 1); | ||
309 | else | ||
310 | deb_ts("not ts packet %02x %02x %02x %02x \n", *(b+2), *(b+3), *(b+4), *(b+5) ); | ||
311 | |||
312 | b += 190; | ||
313 | l -= 190; | ||
314 | break; | ||
315 | default: | ||
316 | deb_ts("wrong packet type\n"); | ||
317 | l = 0; | ||
318 | break; | ||
319 | } | ||
320 | else { | ||
321 | deb_ts("wrong header\n"); | ||
322 | l = 0; | ||
323 | } | ||
324 | } | ||
325 | |||
326 | if (l>0) | ||
327 | memcpy(fc_usb->tmp_buffer, b, l); | ||
328 | fc_usb->tmp_buffer_length = l; | ||
329 | } | ||
330 | |||
331 | static void flexcop_usb_urb_complete(struct urb *urb, struct pt_regs *ptregs) | ||
332 | { | ||
333 | struct flexcop_usb *fc_usb = urb->context; | ||
334 | int i; | ||
335 | |||
336 | if (urb->actual_length > 0) | ||
337 | deb_ts("urb completed, bufsize: %d actlen; %d\n",urb->transfer_buffer_length, urb->actual_length); | ||
338 | |||
339 | for (i = 0; i < urb->number_of_packets; i++) { | ||
340 | if (urb->iso_frame_desc[i].status < 0) { | ||
341 | err("iso frame descriptor %d has an error: %d\n",i,urb->iso_frame_desc[i].status); | ||
342 | } else | ||
343 | if (urb->iso_frame_desc[i].actual_length > 0) { | ||
344 | deb_ts("passed %d bytes to the demux\n",urb->iso_frame_desc[i].actual_length); | ||
345 | |||
346 | flexcop_usb_process_frame(fc_usb, | ||
347 | urb->transfer_buffer + urb->iso_frame_desc[i].offset, | ||
348 | urb->iso_frame_desc[i].actual_length); | ||
349 | } | ||
350 | urb->iso_frame_desc[i].status = 0; | ||
351 | urb->iso_frame_desc[i].actual_length = 0; | ||
352 | } | ||
353 | |||
354 | usb_submit_urb(urb,GFP_ATOMIC); | ||
355 | } | ||
356 | |||
357 | static int flexcop_usb_stream_control(struct flexcop_device *fc, int onoff) | ||
358 | { | ||
359 | /* submit/kill iso packets */ | ||
360 | return 0; | ||
361 | } | ||
362 | |||
363 | static void flexcop_usb_transfer_exit(struct flexcop_usb *fc_usb) | ||
364 | { | ||
365 | int i; | ||
366 | for (i = 0; i < B2C2_USB_NUM_ISO_URB; i++) | ||
367 | if (fc_usb->iso_urb[i] != NULL) { | ||
368 | deb_ts("unlinking/killing urb no. %d\n",i); | ||
369 | usb_kill_urb(fc_usb->iso_urb[i]); | ||
370 | usb_free_urb(fc_usb->iso_urb[i]); | ||
371 | } | ||
372 | |||
373 | if (fc_usb->iso_buffer != NULL) | ||
374 | pci_free_consistent(NULL,fc_usb->buffer_size, fc_usb->iso_buffer, fc_usb->dma_addr); | ||
375 | } | ||
376 | |||
377 | static int flexcop_usb_transfer_init(struct flexcop_usb *fc_usb) | ||
378 | { | ||
379 | u16 frame_size = fc_usb->uintf->cur_altsetting->endpoint[0].desc.wMaxPacketSize; | ||
380 | int bufsize = B2C2_USB_NUM_ISO_URB * B2C2_USB_FRAMES_PER_ISO * frame_size,i,j,ret; | ||
381 | int buffer_offset = 0; | ||
382 | |||
383 | deb_ts("creating %d iso-urbs with %d frames each of %d bytes size = %d.\n", | ||
384 | B2C2_USB_NUM_ISO_URB, B2C2_USB_FRAMES_PER_ISO, frame_size,bufsize); | ||
385 | |||
386 | fc_usb->iso_buffer = pci_alloc_consistent(NULL,bufsize,&fc_usb->dma_addr); | ||
387 | if (fc_usb->iso_buffer == NULL) | ||
388 | return -ENOMEM; | ||
389 | memset(fc_usb->iso_buffer, 0, bufsize); | ||
390 | fc_usb->buffer_size = bufsize; | ||
391 | |||
392 | /* creating iso urbs */ | ||
393 | for (i = 0; i < B2C2_USB_NUM_ISO_URB; i++) | ||
394 | if (!(fc_usb->iso_urb[i] = usb_alloc_urb(B2C2_USB_FRAMES_PER_ISO,GFP_ATOMIC))) { | ||
395 | ret = -ENOMEM; | ||
396 | goto urb_error; | ||
397 | } | ||
398 | /* initialising and submitting iso urbs */ | ||
399 | for (i = 0; i < B2C2_USB_NUM_ISO_URB; i++) { | ||
400 | int frame_offset = 0; | ||
401 | struct urb *urb = fc_usb->iso_urb[i]; | ||
402 | deb_ts("initializing and submitting urb no. %d (buf_offset: %d).\n",i,buffer_offset); | ||
403 | |||
404 | urb->dev = fc_usb->udev; | ||
405 | urb->context = fc_usb; | ||
406 | urb->complete = flexcop_usb_urb_complete; | ||
407 | urb->pipe = B2C2_USB_DATA_PIPE; | ||
408 | urb->transfer_flags = URB_ISO_ASAP; | ||
409 | urb->interval = 1; | ||
410 | urb->number_of_packets = B2C2_USB_FRAMES_PER_ISO; | ||
411 | urb->transfer_buffer_length = frame_size * B2C2_USB_FRAMES_PER_ISO; | ||
412 | urb->transfer_buffer = fc_usb->iso_buffer + buffer_offset; | ||
413 | |||
414 | buffer_offset += frame_size * B2C2_USB_FRAMES_PER_ISO; | ||
415 | for (j = 0; j < B2C2_USB_FRAMES_PER_ISO; j++) { | ||
416 | deb_ts("urb no: %d, frame: %d, frame_offset: %d\n",i,j,frame_offset); | ||
417 | urb->iso_frame_desc[j].offset = frame_offset; | ||
418 | urb->iso_frame_desc[j].length = frame_size; | ||
419 | frame_offset += frame_size; | ||
420 | } | ||
421 | |||
422 | if ((ret = usb_submit_urb(fc_usb->iso_urb[i],GFP_ATOMIC))) { | ||
423 | err("submitting urb %d failed with %d.",i,ret); | ||
424 | goto urb_error; | ||
425 | } | ||
426 | deb_ts("submitted urb no. %d.\n",i); | ||
427 | } | ||
428 | |||
429 | /* SRAM */ | ||
430 | |||
431 | flexcop_sram_set_dest(fc_usb->fc_dev,FC_SRAM_DEST_MEDIA | FC_SRAM_DEST_NET | | ||
432 | FC_SRAM_DEST_CAO | FC_SRAM_DEST_CAI, FC_SRAM_DEST_TARGET_WAN_USB); | ||
433 | flexcop_wan_set_speed(fc_usb->fc_dev,FC_WAN_SPEED_8MBITS); | ||
434 | flexcop_sram_ctrl(fc_usb->fc_dev,1,1,1); | ||
435 | |||
436 | ret = 0; | ||
437 | goto success; | ||
438 | urb_error: | ||
439 | flexcop_usb_transfer_exit(fc_usb); | ||
440 | success: | ||
441 | return ret; | ||
442 | } | ||
443 | |||
444 | static int flexcop_usb_init(struct flexcop_usb *fc_usb) | ||
445 | { | ||
446 | /* use the alternate setting with the larges buffer */ | ||
447 | usb_set_interface(fc_usb->udev,0,1); | ||
448 | switch (fc_usb->udev->speed) { | ||
449 | case USB_SPEED_LOW: | ||
450 | err("cannot handle USB speed because it is to sLOW."); | ||
451 | return -ENODEV; | ||
452 | break; | ||
453 | case USB_SPEED_FULL: | ||
454 | info("running at FULL speed."); | ||
455 | break; | ||
456 | case USB_SPEED_HIGH: | ||
457 | info("running at HIGH speed."); | ||
458 | break; | ||
459 | case USB_SPEED_UNKNOWN: /* fall through */ | ||
460 | default: | ||
461 | err("cannot handle USB speed because it is unkown."); | ||
462 | return -ENODEV; | ||
463 | } | ||
464 | usb_set_intfdata(fc_usb->uintf, fc_usb); | ||
465 | return 0; | ||
466 | } | ||
467 | |||
468 | static void flexcop_usb_exit(struct flexcop_usb *fc_usb) | ||
469 | { | ||
470 | usb_set_intfdata(fc_usb->uintf, NULL); | ||
471 | } | ||
472 | |||
473 | static int flexcop_usb_probe(struct usb_interface *intf, | ||
474 | const struct usb_device_id *id) | ||
475 | { | ||
476 | struct usb_device *udev = interface_to_usbdev(intf); | ||
477 | struct flexcop_usb *fc_usb = NULL; | ||
478 | struct flexcop_device *fc = NULL; | ||
479 | int ret; | ||
480 | |||
481 | if ((fc = flexcop_device_kmalloc(sizeof(struct flexcop_usb))) == NULL) { | ||
482 | err("out of memory\n"); | ||
483 | return -ENOMEM; | ||
484 | } | ||
485 | |||
486 | /* general flexcop init */ | ||
487 | fc_usb = fc->bus_specific; | ||
488 | fc_usb->fc_dev = fc; | ||
489 | |||
490 | fc->read_ibi_reg = flexcop_usb_read_ibi_reg; | ||
491 | fc->write_ibi_reg = flexcop_usb_write_ibi_reg; | ||
492 | fc->i2c_request = flexcop_usb_i2c_request; | ||
493 | fc->get_mac_addr = flexcop_usb_get_mac_addr; | ||
494 | |||
495 | fc->stream_control = flexcop_usb_stream_control; | ||
496 | |||
497 | fc->pid_filtering = 1; | ||
498 | fc->bus_type = FC_USB; | ||
499 | |||
500 | fc->dev = &udev->dev; | ||
501 | fc->owner = THIS_MODULE; | ||
502 | |||
503 | /* bus specific part */ | ||
504 | fc_usb->udev = udev; | ||
505 | fc_usb->uintf = intf; | ||
506 | if ((ret = flexcop_usb_init(fc_usb)) != 0) | ||
507 | goto err_kfree; | ||
508 | |||
509 | /* init flexcop */ | ||
510 | if ((ret = flexcop_device_initialize(fc)) != 0) | ||
511 | goto err_usb_exit; | ||
512 | |||
513 | /* xfer init */ | ||
514 | if ((ret = flexcop_usb_transfer_init(fc_usb)) != 0) | ||
515 | goto err_fc_exit; | ||
516 | |||
517 | info("%s successfully initialized and connected.",DRIVER_NAME); | ||
518 | ret = 0; | ||
519 | goto success; | ||
520 | err_fc_exit: | ||
521 | flexcop_device_exit(fc); | ||
522 | err_usb_exit: | ||
523 | flexcop_usb_exit(fc_usb); | ||
524 | err_kfree: | ||
525 | flexcop_device_kfree(fc); | ||
526 | success: | ||
527 | return ret; | ||
528 | } | ||
529 | |||
530 | static void flexcop_usb_disconnect(struct usb_interface *intf) | ||
531 | { | ||
532 | struct flexcop_usb *fc_usb = usb_get_intfdata(intf); | ||
533 | flexcop_usb_transfer_exit(fc_usb); | ||
534 | flexcop_device_exit(fc_usb->fc_dev); | ||
535 | flexcop_usb_exit(fc_usb); | ||
536 | flexcop_device_kfree(fc_usb->fc_dev); | ||
537 | info("%s successfully deinitialized and disconnected.",DRIVER_NAME); | ||
538 | } | ||
539 | |||
540 | static struct usb_device_id flexcop_usb_table [] = { | ||
541 | { USB_DEVICE(0x0af7, 0x0101) }, | ||
542 | { } | ||
543 | }; | ||
544 | |||
545 | /* usb specific object needed to register this driver with the usb subsystem */ | ||
546 | static struct usb_driver flexcop_usb_driver = { | ||
547 | .owner = THIS_MODULE, | ||
548 | .name = "Technisat/B2C2 FlexCop II/IIb/III USB", | ||
549 | .probe = flexcop_usb_probe, | ||
550 | .disconnect = flexcop_usb_disconnect, | ||
551 | .id_table = flexcop_usb_table, | ||
552 | }; | ||
553 | |||
554 | /* module stuff */ | ||
555 | static int __init flexcop_usb_module_init(void) | ||
556 | { | ||
557 | int result; | ||
558 | if ((result = usb_register(&flexcop_usb_driver))) { | ||
559 | err("usb_register failed. (%d)",result); | ||
560 | return result; | ||
561 | } | ||
562 | |||
563 | return 0; | ||
564 | } | ||
565 | |||
566 | static void __exit flexcop_usb_module_exit(void) | ||
567 | { | ||
568 | /* deregister this driver from the USB subsystem */ | ||
569 | usb_deregister(&flexcop_usb_driver); | ||
570 | } | ||
571 | |||
572 | module_init(flexcop_usb_module_init); | ||
573 | module_exit(flexcop_usb_module_exit); | ||
574 | |||
575 | MODULE_AUTHOR(DRIVER_AUTHOR); | ||
576 | MODULE_DESCRIPTION(DRIVER_NAME); | ||
577 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/media/dvb/b2c2/flexcop-usb.h b/drivers/media/dvb/b2c2/flexcop-usb.h new file mode 100644 index 000000000000..630e647a2caa --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop-usb.h | |||
@@ -0,0 +1,119 @@ | |||
1 | #ifndef __FLEXCOP_USB_H_INCLUDED__ | ||
2 | #define __FLEXCOP_USB_H_INCLUDED__ | ||
3 | |||
4 | #include <linux/usb.h> | ||
5 | |||
6 | /* transfer parameters */ | ||
7 | #define B2C2_USB_FRAMES_PER_ISO 4 | ||
8 | #define B2C2_USB_NUM_ISO_URB 4 | ||
9 | |||
10 | #define B2C2_USB_CTRL_PIPE_IN usb_rcvctrlpipe(fc_usb->udev,0) | ||
11 | #define B2C2_USB_CTRL_PIPE_OUT usb_sndctrlpipe(fc_usb->udev,0) | ||
12 | #define B2C2_USB_DATA_PIPE usb_rcvisocpipe(fc_usb->udev,0x81) | ||
13 | |||
14 | struct flexcop_usb { | ||
15 | struct usb_device *udev; | ||
16 | struct usb_interface *uintf; | ||
17 | |||
18 | u8 *iso_buffer; | ||
19 | int buffer_size; | ||
20 | dma_addr_t dma_addr; | ||
21 | struct urb *iso_urb[B2C2_USB_NUM_ISO_URB]; | ||
22 | |||
23 | struct flexcop_device *fc_dev; | ||
24 | |||
25 | u8 tmp_buffer[1023+190]; | ||
26 | int tmp_buffer_length; | ||
27 | }; | ||
28 | |||
29 | #if 0 | ||
30 | /* request types TODO What is its use?*/ | ||
31 | typedef enum { | ||
32 | |||
33 | /* something is wrong with this part | ||
34 | RTYPE_READ_DW = (1 << 6), | ||
35 | RTYPE_WRITE_DW_1 = (3 << 6), | ||
36 | RTYPE_READ_V8_MEMORY = (6 << 6), | ||
37 | RTYPE_WRITE_V8_MEMORY = (7 << 6), | ||
38 | RTYPE_WRITE_V8_FLASH = (8 << 6), | ||
39 | RTYPE_GENERIC = (9 << 6), | ||
40 | */ | ||
41 | } flexcop_usb_request_type_t; | ||
42 | #endif | ||
43 | |||
44 | /* request */ | ||
45 | typedef enum { | ||
46 | B2C2_USB_WRITE_V8_MEM = 0x04, | ||
47 | B2C2_USB_READ_V8_MEM = 0x05, | ||
48 | B2C2_USB_READ_REG = 0x08, | ||
49 | B2C2_USB_WRITE_REG = 0x0A, | ||
50 | /* B2C2_USB_WRITEREGLO = 0x0A, */ | ||
51 | B2C2_USB_WRITEREGHI = 0x0B, | ||
52 | B2C2_USB_FLASH_BLOCK = 0x10, | ||
53 | B2C2_USB_I2C_REQUEST = 0x11, | ||
54 | B2C2_USB_UTILITY = 0x12, | ||
55 | } flexcop_usb_request_t; | ||
56 | |||
57 | /* function definition for I2C_REQUEST */ | ||
58 | typedef enum { | ||
59 | USB_FUNC_I2C_WRITE = 0x01, | ||
60 | USB_FUNC_I2C_MULTIWRITE = 0x02, | ||
61 | USB_FUNC_I2C_READ = 0x03, | ||
62 | USB_FUNC_I2C_REPEATWRITE = 0x04, | ||
63 | USB_FUNC_GET_DESCRIPTOR = 0x05, | ||
64 | USB_FUNC_I2C_REPEATREAD = 0x06, | ||
65 | /* DKT 020208 - add this to support special case of DiSEqC */ | ||
66 | USB_FUNC_I2C_CHECKWRITE = 0x07, | ||
67 | USB_FUNC_I2C_CHECKRESULT = 0x08, | ||
68 | } flexcop_usb_i2c_function_t; | ||
69 | |||
70 | /* | ||
71 | * function definition for UTILITY request 0x12 | ||
72 | * DKT 020304 - new utility function | ||
73 | */ | ||
74 | typedef enum { | ||
75 | UTILITY_SET_FILTER = 0x01, | ||
76 | UTILITY_DATA_ENABLE = 0x02, | ||
77 | UTILITY_FLEX_MULTIWRITE = 0x03, | ||
78 | UTILITY_SET_BUFFER_SIZE = 0x04, | ||
79 | UTILITY_FLEX_OPERATOR = 0x05, | ||
80 | UTILITY_FLEX_RESET300_START = 0x06, | ||
81 | UTILITY_FLEX_RESET300_STOP = 0x07, | ||
82 | UTILITY_FLEX_RESET300 = 0x08, | ||
83 | UTILITY_SET_ISO_SIZE = 0x09, | ||
84 | UTILITY_DATA_RESET = 0x0A, | ||
85 | UTILITY_GET_DATA_STATUS = 0x10, | ||
86 | UTILITY_GET_V8_REG = 0x11, | ||
87 | /* DKT 020326 - add function for v1.14 */ | ||
88 | UTILITY_SRAM_WRITE = 0x12, | ||
89 | UTILITY_SRAM_READ = 0x13, | ||
90 | UTILITY_SRAM_TESTFILL = 0x14, | ||
91 | UTILITY_SRAM_TESTSET = 0x15, | ||
92 | UTILITY_SRAM_TESTVERIFY = 0x16, | ||
93 | } flexcop_usb_utility_function_t; | ||
94 | |||
95 | #define B2C2_WAIT_FOR_OPERATION_RW 1*HZ /* 1 s */ | ||
96 | #define B2C2_WAIT_FOR_OPERATION_RDW 3*HZ /* 3 s */ | ||
97 | #define B2C2_WAIT_FOR_OPERATION_WDW 1*HZ /* 1 s */ | ||
98 | |||
99 | #define B2C2_WAIT_FOR_OPERATION_V8READ 3*HZ /* 3 s */ | ||
100 | #define B2C2_WAIT_FOR_OPERATION_V8WRITE 3*HZ /* 3 s */ | ||
101 | #define B2C2_WAIT_FOR_OPERATION_V8FLASH 3*HZ /* 3 s */ | ||
102 | |||
103 | typedef enum { | ||
104 | V8_MEMORY_PAGE_DVB_CI = 0x20, | ||
105 | V8_MEMORY_PAGE_DVB_DS = 0x40, | ||
106 | V8_MEMORY_PAGE_MULTI2 = 0x60, | ||
107 | V8_MEMORY_PAGE_FLASH = 0x80 | ||
108 | } flexcop_usb_mem_page_t; | ||
109 | |||
110 | #define V8_MEMORY_EXTENDED (1 << 15) | ||
111 | |||
112 | #define USB_MEM_READ_MAX 32 | ||
113 | #define USB_MEM_WRITE_MAX 1 | ||
114 | #define USB_FLASH_MAX 8 | ||
115 | |||
116 | #define V8_MEMORY_PAGE_SIZE 0x8000 // 32K | ||
117 | #define V8_MEMORY_PAGE_MASK 0x7FFF | ||
118 | |||
119 | #endif | ||
diff --git a/drivers/media/dvb/b2c2/flexcop.c b/drivers/media/dvb/b2c2/flexcop.c new file mode 100644 index 000000000000..8b5d14dd36e3 --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop.c | |||
@@ -0,0 +1,286 @@ | |||
1 | /* | ||
2 | * flexcop.c - driver for digital TV devices equipped with B2C2 FlexcopII(b)/III | ||
3 | * | ||
4 | * Copyright (C) 2004-5 Patrick Boettcher <patrick.boettcher@desy.de> | ||
5 | * | ||
6 | * based on the skystar2-driver | ||
7 | * Copyright (C) 2003 Vadim Catana, skystar@moldova.cc | ||
8 | * | ||
9 | * Acknowledgements: | ||
10 | * John Jurrius from BBTI, Inc. for extensive support with | ||
11 | * code examples and data books | ||
12 | * | ||
13 | * Bjarne Steinsbo, bjarne at steinsbo.com (some ideas for rewriting) | ||
14 | * | ||
15 | * Contributions to the skystar2-driver have been done by | ||
16 | * Vincenzo Di Massa, hawk.it at tiscalinet.it (several DiSEqC fixes) | ||
17 | * Roberto Ragusa, r.ragusa at libero.it (polishing, restyling the code) | ||
18 | * Niklas Peinecke, peinecke at gdv.uni-hannover.de (hardware pid/mac filtering) | ||
19 | * | ||
20 | * | ||
21 | * This program is free software; you can redistribute it and/or | ||
22 | * modify it under the terms of the GNU Lesser General Public License | ||
23 | * as published by the Free Software Foundation; either version 2.1 | ||
24 | * of the License, or (at your option) any later version. | ||
25 | * | ||
26 | * This program is distributed in the hope that it will be useful, | ||
27 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
28 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
29 | * GNU General Public License for more details. | ||
30 | * | ||
31 | * You should have received a copy of the GNU Lesser General Public License | ||
32 | * along with this program; if not, write to the Free Software | ||
33 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | ||
34 | */ | ||
35 | |||
36 | #include "flexcop.h" | ||
37 | |||
38 | #define DRIVER_NAME "B2C2 FlexcopII/II(b)/III digital TV receiver chip" | ||
39 | #define DRIVER_AUTHOR "Patrick Boettcher <patrick.boettcher@desy.de" | ||
40 | |||
41 | #ifdef CONFIG_DVB_B2C2_FLEXCOP_DEBUG | ||
42 | #define DEBSTATUS "" | ||
43 | #else | ||
44 | #define DEBSTATUS " (debugging is not enabled)" | ||
45 | #endif | ||
46 | |||
47 | int b2c2_flexcop_debug; | ||
48 | module_param_named(debug, b2c2_flexcop_debug, int, 0644); | ||
49 | MODULE_PARM_DESC(debug, "set debug level (1=info,2=tuner,4=i2c,8=ts,16=sram (|-able))." DEBSTATUS); | ||
50 | #undef DEBSTATUS | ||
51 | |||
52 | /* global zero for ibi values */ | ||
53 | flexcop_ibi_value ibi_zero; | ||
54 | |||
55 | static int flexcop_dvb_start_feed(struct dvb_demux_feed *dvbdmxfeed) | ||
56 | { | ||
57 | struct flexcop_device *fc = dvbdmxfeed->demux->priv; | ||
58 | return flexcop_pid_feed_control(fc,dvbdmxfeed,1); | ||
59 | } | ||
60 | |||
61 | static int flexcop_dvb_stop_feed(struct dvb_demux_feed *dvbdmxfeed) | ||
62 | { | ||
63 | struct flexcop_device *fc = dvbdmxfeed->demux->priv; | ||
64 | return flexcop_pid_feed_control(fc,dvbdmxfeed,0); | ||
65 | } | ||
66 | |||
67 | static int flexcop_dvb_init(struct flexcop_device *fc) | ||
68 | { | ||
69 | int ret; | ||
70 | if ((ret = dvb_register_adapter(&fc->dvb_adapter,"FlexCop Digital TV device",fc->owner)) < 0) { | ||
71 | err("error registering DVB adapter"); | ||
72 | return ret; | ||
73 | } | ||
74 | fc->dvb_adapter.priv = fc; | ||
75 | |||
76 | fc->demux.dmx.capabilities = (DMX_TS_FILTERING | DMX_SECTION_FILTERING | DMX_MEMORY_BASED_FILTERING); | ||
77 | fc->demux.priv = fc; | ||
78 | |||
79 | fc->demux.filternum = fc->demux.feednum = FC_MAX_FEED; | ||
80 | |||
81 | fc->demux.start_feed = flexcop_dvb_start_feed; | ||
82 | fc->demux.stop_feed = flexcop_dvb_stop_feed; | ||
83 | fc->demux.write_to_decoder = NULL; | ||
84 | |||
85 | if ((ret = dvb_dmx_init(&fc->demux)) < 0) { | ||
86 | err("dvb_dmx failed: error %d",ret); | ||
87 | goto err_dmx; | ||
88 | } | ||
89 | |||
90 | fc->hw_frontend.source = DMX_FRONTEND_0; | ||
91 | |||
92 | fc->dmxdev.filternum = fc->demux.feednum; | ||
93 | fc->dmxdev.demux = &fc->demux.dmx; | ||
94 | fc->dmxdev.capabilities = 0; | ||
95 | if ((ret = dvb_dmxdev_init(&fc->dmxdev, &fc->dvb_adapter)) < 0) { | ||
96 | err("dvb_dmxdev_init failed: error %d",ret); | ||
97 | goto err_dmx_dev; | ||
98 | } | ||
99 | |||
100 | if ((ret = fc->demux.dmx.add_frontend(&fc->demux.dmx, &fc->hw_frontend)) < 0) { | ||
101 | err("adding hw_frontend to dmx failed: error %d",ret); | ||
102 | goto err_dmx_add_hw_frontend; | ||
103 | } | ||
104 | |||
105 | fc->mem_frontend.source = DMX_MEMORY_FE; | ||
106 | if ((ret = fc->demux.dmx.add_frontend(&fc->demux.dmx, &fc->mem_frontend)) < 0) { | ||
107 | err("adding mem_frontend to dmx failed: error %d",ret); | ||
108 | goto err_dmx_add_mem_frontend; | ||
109 | } | ||
110 | |||
111 | if ((ret = fc->demux.dmx.connect_frontend(&fc->demux.dmx, &fc->hw_frontend)) < 0) { | ||
112 | err("connect frontend failed: error %d",ret); | ||
113 | goto err_connect_frontend; | ||
114 | } | ||
115 | |||
116 | dvb_net_init(&fc->dvb_adapter, &fc->dvbnet, &fc->demux.dmx); | ||
117 | |||
118 | fc->init_state |= FC_STATE_DVB_INIT; | ||
119 | goto success; | ||
120 | |||
121 | err_connect_frontend: | ||
122 | fc->demux.dmx.remove_frontend(&fc->demux.dmx,&fc->mem_frontend); | ||
123 | err_dmx_add_mem_frontend: | ||
124 | fc->demux.dmx.remove_frontend(&fc->demux.dmx,&fc->hw_frontend); | ||
125 | err_dmx_add_hw_frontend: | ||
126 | dvb_dmxdev_release(&fc->dmxdev); | ||
127 | err_dmx_dev: | ||
128 | dvb_dmx_release(&fc->demux); | ||
129 | err_dmx: | ||
130 | dvb_unregister_adapter(&fc->dvb_adapter); | ||
131 | return ret; | ||
132 | |||
133 | success: | ||
134 | return 0; | ||
135 | } | ||
136 | |||
137 | static void flexcop_dvb_exit(struct flexcop_device *fc) | ||
138 | { | ||
139 | if (fc->init_state & FC_STATE_DVB_INIT) { | ||
140 | dvb_net_release(&fc->dvbnet); | ||
141 | |||
142 | fc->demux.dmx.close(&fc->demux.dmx); | ||
143 | fc->demux.dmx.remove_frontend(&fc->demux.dmx,&fc->mem_frontend); | ||
144 | fc->demux.dmx.remove_frontend(&fc->demux.dmx,&fc->hw_frontend); | ||
145 | dvb_dmxdev_release(&fc->dmxdev); | ||
146 | dvb_dmx_release(&fc->demux); | ||
147 | dvb_unregister_adapter(&fc->dvb_adapter); | ||
148 | |||
149 | deb_info("deinitialized dvb stuff\n"); | ||
150 | } | ||
151 | fc->init_state &= ~FC_STATE_DVB_INIT; | ||
152 | } | ||
153 | |||
154 | /* these methods are necessary to achieve the long-term-goal of hiding the | ||
155 | * struct flexcop_device from the bus-parts */ | ||
156 | void flexcop_pass_dmx_data(struct flexcop_device *fc, u8 *buf, u32 len) | ||
157 | { | ||
158 | dvb_dmx_swfilter(&fc->demux, buf, len); | ||
159 | } | ||
160 | EXPORT_SYMBOL(flexcop_pass_dmx_data); | ||
161 | |||
162 | void flexcop_pass_dmx_packets(struct flexcop_device *fc, u8 *buf, u32 no) | ||
163 | { | ||
164 | dvb_dmx_swfilter_packets(&fc->demux, buf, no); | ||
165 | } | ||
166 | EXPORT_SYMBOL(flexcop_pass_dmx_packets); | ||
167 | |||
168 | static void flexcop_reset(struct flexcop_device *fc) | ||
169 | { | ||
170 | flexcop_ibi_value v210,v204; | ||
171 | |||
172 | /* reset the flexcop itself */ | ||
173 | fc->write_ibi_reg(fc,ctrl_208,ibi_zero); | ||
174 | |||
175 | v210.raw = 0; | ||
176 | v210.sw_reset_210.reset_blocks = 0xff; | ||
177 | v210.sw_reset_210.Block_reset_enable = 0xb2; | ||
178 | fc->write_ibi_reg(fc,sw_reset_210,v210); | ||
179 | |||
180 | /* reset the periphical devices */ | ||
181 | |||
182 | v204 = fc->read_ibi_reg(fc,misc_204); | ||
183 | v204.misc_204.Per_reset_sig = 0; | ||
184 | fc->write_ibi_reg(fc,misc_204,v204); | ||
185 | v204.misc_204.Per_reset_sig = 1; | ||
186 | fc->write_ibi_reg(fc,misc_204,v204); | ||
187 | } | ||
188 | |||
189 | struct flexcop_device *flexcop_device_kmalloc(size_t bus_specific_len) | ||
190 | { | ||
191 | void *bus; | ||
192 | struct flexcop_device *fc = kmalloc(sizeof(struct flexcop_device), GFP_KERNEL); | ||
193 | if (!fc) { | ||
194 | err("no memory"); | ||
195 | return NULL; | ||
196 | } | ||
197 | memset(fc, 0, sizeof(struct flexcop_device)); | ||
198 | |||
199 | bus = kmalloc(bus_specific_len, GFP_KERNEL); | ||
200 | if (!bus) { | ||
201 | err("no memory"); | ||
202 | kfree(fc); | ||
203 | return NULL; | ||
204 | } | ||
205 | memset(bus, 0, bus_specific_len); | ||
206 | |||
207 | fc->bus_specific = bus; | ||
208 | |||
209 | return fc; | ||
210 | } | ||
211 | EXPORT_SYMBOL(flexcop_device_kmalloc); | ||
212 | |||
213 | void flexcop_device_kfree(struct flexcop_device *fc) | ||
214 | { | ||
215 | kfree(fc->bus_specific); | ||
216 | kfree(fc); | ||
217 | } | ||
218 | EXPORT_SYMBOL(flexcop_device_kfree); | ||
219 | |||
220 | int flexcop_device_initialize(struct flexcop_device *fc) | ||
221 | { | ||
222 | int ret; | ||
223 | ibi_zero.raw = 0; | ||
224 | |||
225 | flexcop_reset(fc); | ||
226 | flexcop_determine_revision(fc); | ||
227 | flexcop_sram_init(fc); | ||
228 | flexcop_hw_filter_init(fc); | ||
229 | |||
230 | flexcop_smc_ctrl(fc, 0); | ||
231 | |||
232 | if ((ret = flexcop_dvb_init(fc))) | ||
233 | goto error; | ||
234 | |||
235 | /* do the MAC address reading after initializing the dvb_adapter */ | ||
236 | if (fc->get_mac_addr(fc, 0) == 0) { | ||
237 | u8 *b = fc->dvb_adapter.proposed_mac; | ||
238 | info("MAC address = %02x:%02x:%02x:%02x:%02x:%02x", b[0],b[1],b[2],b[3],b[4],b[5]); | ||
239 | flexcop_set_mac_filter(fc,b); | ||
240 | flexcop_mac_filter_ctrl(fc,1); | ||
241 | } else | ||
242 | warn("reading of MAC address failed.\n"); | ||
243 | |||
244 | |||
245 | if ((ret = flexcop_i2c_init(fc))) | ||
246 | goto error; | ||
247 | |||
248 | if ((ret = flexcop_frontend_init(fc))) | ||
249 | goto error; | ||
250 | |||
251 | flexcop_device_name(fc,"initialization of","complete"); | ||
252 | |||
253 | ret = 0; | ||
254 | goto success; | ||
255 | error: | ||
256 | flexcop_device_exit(fc); | ||
257 | success: | ||
258 | return ret; | ||
259 | } | ||
260 | EXPORT_SYMBOL(flexcop_device_initialize); | ||
261 | |||
262 | void flexcop_device_exit(struct flexcop_device *fc) | ||
263 | { | ||
264 | flexcop_frontend_exit(fc); | ||
265 | flexcop_i2c_exit(fc); | ||
266 | flexcop_dvb_exit(fc); | ||
267 | } | ||
268 | EXPORT_SYMBOL(flexcop_device_exit); | ||
269 | |||
270 | static int flexcop_module_init(void) | ||
271 | { | ||
272 | info(DRIVER_NAME " loaded successfully"); | ||
273 | return 0; | ||
274 | } | ||
275 | |||
276 | static void flexcop_module_cleanup(void) | ||
277 | { | ||
278 | info(DRIVER_NAME " unloaded successfully"); | ||
279 | } | ||
280 | |||
281 | module_init(flexcop_module_init); | ||
282 | module_exit(flexcop_module_cleanup); | ||
283 | |||
284 | MODULE_AUTHOR(DRIVER_AUTHOR); | ||
285 | MODULE_DESCRIPTION(DRIVER_NAME); | ||
286 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/media/dvb/b2c2/flexcop.h b/drivers/media/dvb/b2c2/flexcop.h new file mode 100644 index 000000000000..caa343a97bdc --- /dev/null +++ b/drivers/media/dvb/b2c2/flexcop.h | |||
@@ -0,0 +1,30 @@ | |||
1 | /* | ||
2 | * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III | ||
3 | * | ||
4 | * flexcop.h - private header file for all flexcop-chip-source files. | ||
5 | * | ||
6 | * see flexcop.c for copyright information. | ||
7 | */ | ||
8 | #ifndef __FLEXCOP_H__ | ||
9 | #define __FLEXCOP_H___ | ||
10 | |||
11 | #define FC_LOG_PREFIX "b2c2-flexcop" | ||
12 | #include "flexcop-common.h" | ||
13 | |||
14 | extern int b2c2_flexcop_debug; | ||
15 | |||
16 | /* debug */ | ||
17 | #ifdef CONFIG_DVB_B2C2_FLEXCOP_DEBUG | ||
18 | #define dprintk(level,args...) \ | ||
19 | do { if ((b2c2_flexcop_debug & level)) printk(args); } while (0) | ||
20 | #else | ||
21 | #define dprintk(level,args...) | ||
22 | #endif | ||
23 | |||
24 | #define deb_info(args...) dprintk(0x01,args) | ||
25 | #define deb_tuner(args...) dprintk(0x02,args) | ||
26 | #define deb_i2c(args...) dprintk(0x04,args) | ||
27 | #define deb_ts(args...) dprintk(0x08,args) | ||
28 | #define deb_sram(args...) dprintk(0x10,args) | ||
29 | |||
30 | #endif | ||
diff --git a/drivers/media/dvb/b2c2/skystar2.c b/drivers/media/dvb/b2c2/skystar2.c index 336c178fcd5f..acbc4c34f72a 100644 --- a/drivers/media/dvb/b2c2/skystar2.c +++ b/drivers/media/dvb/b2c2/skystar2.c | |||
@@ -97,7 +97,7 @@ struct adapter { | |||
97 | u8 mac_addr[8]; | 97 | u8 mac_addr[8]; |
98 | u32 dw_sram_type; | 98 | u32 dw_sram_type; |
99 | 99 | ||
100 | struct dvb_adapter *dvb_adapter; | 100 | struct dvb_adapter dvb_adapter; |
101 | struct dvb_demux demux; | 101 | struct dvb_demux demux; |
102 | struct dmxdev dmxdev; | 102 | struct dmxdev dmxdev; |
103 | struct dmx_frontend hw_frontend; | 103 | struct dmx_frontend hw_frontend; |
@@ -2461,7 +2461,7 @@ static void frontend_init(struct adapter *skystar2) | |||
2461 | skystar2->pdev->subsystem_vendor, | 2461 | skystar2->pdev->subsystem_vendor, |
2462 | skystar2->pdev->subsystem_device); | 2462 | skystar2->pdev->subsystem_device); |
2463 | } else { | 2463 | } else { |
2464 | if (dvb_register_frontend(skystar2->dvb_adapter, skystar2->fe)) { | 2464 | if (dvb_register_frontend(&skystar2->dvb_adapter, skystar2->fe)) { |
2465 | printk("skystar2: Frontend registration failed!\n"); | 2465 | printk("skystar2: Frontend registration failed!\n"); |
2466 | if (skystar2->fe->ops->release) | 2466 | if (skystar2->fe->ops->release) |
2467 | skystar2->fe->ops->release(skystar2->fe); | 2467 | skystar2->fe->ops->release(skystar2->fe); |
@@ -2486,17 +2486,17 @@ static int skystar2_probe(struct pci_dev *pdev, const struct pci_device_id *ent) | |||
2486 | if (ret < 0) | 2486 | if (ret < 0) |
2487 | goto out; | 2487 | goto out; |
2488 | 2488 | ||
2489 | ret = dvb_register_adapter(&dvb_adapter, skystar2_pci_driver.name, | 2489 | adapter = pci_get_drvdata(pdev); |
2490 | dvb_adapter = &adapter->dvb_adapter; | ||
2491 | |||
2492 | ret = dvb_register_adapter(dvb_adapter, skystar2_pci_driver.name, | ||
2490 | THIS_MODULE); | 2493 | THIS_MODULE); |
2491 | if (ret < 0) { | 2494 | if (ret < 0) { |
2492 | printk("%s: Error registering DVB adapter\n", __FUNCTION__); | 2495 | printk("%s: Error registering DVB adapter\n", __FUNCTION__); |
2493 | goto err_halt; | 2496 | goto err_halt; |
2494 | } | 2497 | } |
2495 | 2498 | ||
2496 | adapter = pci_get_drvdata(pdev); | ||
2497 | |||
2498 | dvb_adapter->priv = adapter; | 2499 | dvb_adapter->priv = adapter; |
2499 | adapter->dvb_adapter = dvb_adapter; | ||
2500 | 2500 | ||
2501 | 2501 | ||
2502 | init_MUTEX(&adapter->i2c_sem); | 2502 | init_MUTEX(&adapter->i2c_sem); |
@@ -2541,7 +2541,7 @@ static int skystar2_probe(struct pci_dev *pdev, const struct pci_device_id *ent) | |||
2541 | adapter->dmxdev.demux = dmx; | 2541 | adapter->dmxdev.demux = dmx; |
2542 | adapter->dmxdev.capabilities = 0; | 2542 | adapter->dmxdev.capabilities = 0; |
2543 | 2543 | ||
2544 | ret = dvb_dmxdev_init(&adapter->dmxdev, adapter->dvb_adapter); | 2544 | ret = dvb_dmxdev_init(&adapter->dmxdev, &adapter->dvb_adapter); |
2545 | if (ret < 0) | 2545 | if (ret < 0) |
2546 | goto err_dmx_release; | 2546 | goto err_dmx_release; |
2547 | 2547 | ||
@@ -2559,7 +2559,7 @@ static int skystar2_probe(struct pci_dev *pdev, const struct pci_device_id *ent) | |||
2559 | if (ret < 0) | 2559 | if (ret < 0) |
2560 | goto err_remove_mem_frontend; | 2560 | goto err_remove_mem_frontend; |
2561 | 2561 | ||
2562 | dvb_net_init(adapter->dvb_adapter, &adapter->dvbnet, &dvbdemux->dmx); | 2562 | dvb_net_init(&adapter->dvb_adapter, &adapter->dvbnet, &dvbdemux->dmx); |
2563 | 2563 | ||
2564 | frontend_init(adapter); | 2564 | frontend_init(adapter); |
2565 | out: | 2565 | out: |
@@ -2576,7 +2576,7 @@ err_dmx_release: | |||
2576 | err_i2c_del: | 2576 | err_i2c_del: |
2577 | i2c_del_adapter(&adapter->i2c_adap); | 2577 | i2c_del_adapter(&adapter->i2c_adap); |
2578 | err_dvb_unregister: | 2578 | err_dvb_unregister: |
2579 | dvb_unregister_adapter(adapter->dvb_adapter); | 2579 | dvb_unregister_adapter(&adapter->dvb_adapter); |
2580 | err_halt: | 2580 | err_halt: |
2581 | driver_halt(pdev); | 2581 | driver_halt(pdev); |
2582 | goto out; | 2582 | goto out; |
@@ -2605,7 +2605,7 @@ static void skystar2_remove(struct pci_dev *pdev) | |||
2605 | if (adapter->fe != NULL) | 2605 | if (adapter->fe != NULL) |
2606 | dvb_unregister_frontend(adapter->fe); | 2606 | dvb_unregister_frontend(adapter->fe); |
2607 | 2607 | ||
2608 | dvb_unregister_adapter(adapter->dvb_adapter); | 2608 | dvb_unregister_adapter(&adapter->dvb_adapter); |
2609 | 2609 | ||
2610 | i2c_del_adapter(&adapter->i2c_adap); | 2610 | i2c_del_adapter(&adapter->i2c_adap); |
2611 | 2611 | ||
diff --git a/drivers/media/dvb/bt8xx/Kconfig b/drivers/media/dvb/bt8xx/Kconfig index e7d11e0667a8..b12545f093f8 100644 --- a/drivers/media/dvb/bt8xx/Kconfig +++ b/drivers/media/dvb/bt8xx/Kconfig | |||
@@ -11,9 +11,8 @@ config DVB_BT8XX | |||
11 | the Nebula cards, the Pinnacle PCTV cards, the Twinhan DST cards and | 11 | the Nebula cards, the Pinnacle PCTV cards, the Twinhan DST cards and |
12 | pcHDTV HD2000 cards. | 12 | pcHDTV HD2000 cards. |
13 | 13 | ||
14 | Since these cards have no MPEG decoder onboard, they transmit | 14 | Since these cards have no MPEG decoder onboard, they transmit |
15 | only compressed MPEG data over the PCI bus, so you need | 15 | only compressed MPEG data over the PCI bus, so you need |
16 | an external software decoder to watch TV on your computer. | 16 | an external software decoder to watch TV on your computer. |
17 | 17 | ||
18 | Say Y if you own such a device and want to use it. | 18 | Say Y if you own such a device and want to use it. |
19 | |||
diff --git a/drivers/media/dvb/bt8xx/Makefile b/drivers/media/dvb/bt8xx/Makefile index 9da8604b9e18..d188e4c670b5 100644 --- a/drivers/media/dvb/bt8xx/Makefile +++ b/drivers/media/dvb/bt8xx/Makefile | |||
@@ -1,5 +1,3 @@ | |||
1 | 1 | obj-$(CONFIG_DVB_BT8XX) += bt878.o dvb-bt8xx.o dst.o dst_ca.o | |
2 | obj-$(CONFIG_DVB_BT8XX) += bt878.o dvb-bt8xx.o dst.o | ||
3 | 2 | ||
4 | EXTRA_CFLAGS = -Idrivers/media/dvb/dvb-core/ -Idrivers/media/video -Idrivers/media/dvb/frontends | 3 | EXTRA_CFLAGS = -Idrivers/media/dvb/dvb-core/ -Idrivers/media/video -Idrivers/media/dvb/frontends |
5 | |||
diff --git a/drivers/media/dvb/bt8xx/bt878.c b/drivers/media/dvb/bt8xx/bt878.c index 213ff7902024..3c5a8e273c4a 100644 --- a/drivers/media/dvb/bt8xx/bt878.c +++ b/drivers/media/dvb/bt8xx/bt878.c | |||
@@ -4,27 +4,27 @@ | |||
4 | * Copyright (C) 2002 Peter Hettkamp <peter.hettkamp@t-online.de> | 4 | * Copyright (C) 2002 Peter Hettkamp <peter.hettkamp@t-online.de> |
5 | * | 5 | * |
6 | * large parts based on the bttv driver | 6 | * large parts based on the bttv driver |
7 | * Copyright (C) 1996,97,98 Ralph Metzler (rjkm@thp.uni-koeln.de) | 7 | * Copyright (C) 1996,97,98 Ralph Metzler (rjkm@metzlerbros.de) |
8 | * & Marcus Metzler (mocm@thp.uni-koeln.de) | 8 | * & Marcus Metzler (mocm@metzlerbros.de) |
9 | * (c) 1999,2000 Gerd Knorr <kraxel@goldbach.in-berlin.de> | 9 | * (c) 1999,2000 Gerd Knorr <kraxel@goldbach.in-berlin.de> |
10 | * | 10 | * |
11 | * This program is free software; you can redistribute it and/or | 11 | * This program is free software; you can redistribute it and/or |
12 | * modify it under the terms of the GNU General Public License | 12 | * modify it under the terms of the GNU General Public License |
13 | * as published by the Free Software Foundation; either version 2 | 13 | * as published by the Free Software Foundation; either version 2 |
14 | * of the License, or (at your option) any later version. | 14 | * of the License, or (at your option) any later version. |
15 | * | 15 | * |
16 | 16 | ||
17 | * This program is distributed in the hope that it will be useful, | 17 | * This program is distributed in the hope that it will be useful, |
18 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | 18 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
19 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | 19 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
20 | * GNU General Public License for more details. | 20 | * GNU General Public License for more details. |
21 | * | 21 | * |
22 | 22 | ||
23 | * You should have received a copy of the GNU General Public License | 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 | 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. | 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 | 26 | * Or, point your browser to http://www.gnu.org/copyleft/gpl.html |
27 | * | 27 | * |
28 | */ | 28 | */ |
29 | 29 | ||
30 | #include <linux/module.h> | 30 | #include <linux/module.h> |
@@ -58,7 +58,7 @@ module_param_named(verbose, bt878_verbose, int, 0444); | |||
58 | MODULE_PARM_DESC(verbose, | 58 | MODULE_PARM_DESC(verbose, |
59 | "verbose startup messages, default is 1 (yes)"); | 59 | "verbose startup messages, default is 1 (yes)"); |
60 | module_param_named(debug, bt878_debug, int, 0644); | 60 | module_param_named(debug, bt878_debug, int, 0644); |
61 | MODULE_PARM_DESC(debug, "Turn on/off debugging (default:off)."); | 61 | MODULE_PARM_DESC(debug, "Turn on/off debugging, default is 0 (off)."); |
62 | 62 | ||
63 | int bt878_num; | 63 | int bt878_num; |
64 | struct bt878 bt878[BT878_MAX]; | 64 | struct bt878 bt878[BT878_MAX]; |
@@ -128,21 +128,21 @@ static int bt878_mem_alloc(struct bt878 *bt) | |||
128 | } | 128 | } |
129 | 129 | ||
130 | /* RISC instructions */ | 130 | /* RISC instructions */ |
131 | #define RISC_WRITE (0x01 << 28) | 131 | #define RISC_WRITE (0x01 << 28) |
132 | #define RISC_JUMP (0x07 << 28) | 132 | #define RISC_JUMP (0x07 << 28) |
133 | #define RISC_SYNC (0x08 << 28) | 133 | #define RISC_SYNC (0x08 << 28) |
134 | 134 | ||
135 | /* RISC bits */ | 135 | /* RISC bits */ |
136 | #define RISC_WR_SOL (1 << 27) | 136 | #define RISC_WR_SOL (1 << 27) |
137 | #define RISC_WR_EOL (1 << 26) | 137 | #define RISC_WR_EOL (1 << 26) |
138 | #define RISC_IRQ (1 << 24) | 138 | #define RISC_IRQ (1 << 24) |
139 | #define RISC_STATUS(status) ((((~status) & 0x0F) << 20) | ((status & 0x0F) << 16)) | 139 | #define RISC_STATUS(status) ((((~status) & 0x0F) << 20) | ((status & 0x0F) << 16)) |
140 | #define RISC_SYNC_RESYNC (1 << 15) | 140 | #define RISC_SYNC_RESYNC (1 << 15) |
141 | #define RISC_SYNC_FM1 0x06 | 141 | #define RISC_SYNC_FM1 0x06 |
142 | #define RISC_SYNC_VRO 0x0C | 142 | #define RISC_SYNC_VRO 0x0C |
143 | 143 | ||
144 | #define RISC_FLUSH() bt->risc_pos = 0 | 144 | #define RISC_FLUSH() bt->risc_pos = 0 |
145 | #define RISC_INSTR(instr) bt->risc_cpu[bt->risc_pos++] = cpu_to_le32(instr) | 145 | #define RISC_INSTR(instr) bt->risc_cpu[bt->risc_pos++] = cpu_to_le32(instr) |
146 | 146 | ||
147 | static int bt878_make_risc(struct bt878 *bt) | 147 | static int bt878_make_risc(struct bt878 *bt) |
148 | { | 148 | { |
@@ -173,7 +173,7 @@ static void bt878_risc_program(struct bt878 *bt, u32 op_sync_orin) | |||
173 | RISC_INSTR(RISC_SYNC | RISC_SYNC_FM1 | op_sync_orin); | 173 | RISC_INSTR(RISC_SYNC | RISC_SYNC_FM1 | op_sync_orin); |
174 | RISC_INSTR(0); | 174 | RISC_INSTR(0); |
175 | 175 | ||
176 | dprintk("bt878: risc len lines %u, bytes per line %u\n", | 176 | dprintk("bt878: risc len lines %u, bytes per line %u\n", |
177 | bt->line_count, bt->line_bytes); | 177 | bt->line_count, bt->line_bytes); |
178 | for (line = 0; line < bt->line_count; line++) { | 178 | for (line = 0; line < bt->line_count; line++) { |
179 | // At the beginning of every block we issue an IRQ with previous (finished) block number set | 179 | // At the beginning of every block we issue an IRQ with previous (finished) block number set |
@@ -228,14 +228,14 @@ void bt878_start(struct bt878 *bt, u32 controlreg, u32 op_sync_orin, | |||
228 | * Hacked for DST to: | 228 | * Hacked for DST to: |
229 | * SCERR | OCERR | FDSR | FTRGT | FBUS | RISCI | 229 | * SCERR | OCERR | FDSR | FTRGT | FBUS | RISCI |
230 | */ | 230 | */ |
231 | int_mask = BT878_ASCERR | BT878_AOCERR | BT878_APABORT | | 231 | int_mask = BT878_ASCERR | BT878_AOCERR | BT878_APABORT | |
232 | BT878_ARIPERR | BT878_APPERR | BT878_AFDSR | BT878_AFTRGT | | 232 | BT878_ARIPERR | BT878_APPERR | BT878_AFDSR | BT878_AFTRGT | |
233 | BT878_AFBUS | BT878_ARISCI; | 233 | BT878_AFBUS | BT878_ARISCI; |
234 | 234 | ||
235 | 235 | ||
236 | /* ignore pesky bits */ | 236 | /* ignore pesky bits */ |
237 | int_mask &= ~irq_err_ignore; | 237 | int_mask &= ~irq_err_ignore; |
238 | 238 | ||
239 | btwrite(int_mask, BT878_AINT_MASK); | 239 | btwrite(int_mask, BT878_AINT_MASK); |
240 | btwrite(controlreg, BT878_AGPIO_DMA_CTL); | 240 | btwrite(controlreg, BT878_AGPIO_DMA_CTL); |
241 | } | 241 | } |
@@ -461,9 +461,9 @@ static int __devinit bt878_probe(struct pci_dev *dev, | |||
461 | pci_set_drvdata(dev, bt); | 461 | pci_set_drvdata(dev, bt); |
462 | 462 | ||
463 | /* if(init_bt878(btv) < 0) { | 463 | /* if(init_bt878(btv) < 0) { |
464 | bt878_remove(dev); | 464 | bt878_remove(dev); |
465 | return -EIO; | 465 | return -EIO; |
466 | } | 466 | } |
467 | */ | 467 | */ |
468 | 468 | ||
469 | if ((result = bt878_mem_alloc(bt))) { | 469 | if ((result = bt878_mem_alloc(bt))) { |
@@ -536,10 +536,10 @@ static struct pci_device_id bt878_pci_tbl[] __devinitdata = { | |||
536 | MODULE_DEVICE_TABLE(pci, bt878_pci_tbl); | 536 | MODULE_DEVICE_TABLE(pci, bt878_pci_tbl); |
537 | 537 | ||
538 | static struct pci_driver bt878_pci_driver = { | 538 | static struct pci_driver bt878_pci_driver = { |
539 | .name = "bt878", | 539 | .name = "bt878", |
540 | .id_table = bt878_pci_tbl, | 540 | .id_table = bt878_pci_tbl, |
541 | .probe = bt878_probe, | 541 | .probe = bt878_probe, |
542 | .remove = bt878_remove, | 542 | .remove = bt878_remove, |
543 | }; | 543 | }; |
544 | 544 | ||
545 | static int bt878_pci_driver_registered = 0; | 545 | static int bt878_pci_driver_registered = 0; |
@@ -558,7 +558,7 @@ static int bt878_init_module(void) | |||
558 | (BT878_VERSION_CODE >> 8) & 0xff, | 558 | (BT878_VERSION_CODE >> 8) & 0xff, |
559 | BT878_VERSION_CODE & 0xff); | 559 | BT878_VERSION_CODE & 0xff); |
560 | /* | 560 | /* |
561 | bt878_check_chipset(); | 561 | bt878_check_chipset(); |
562 | */ | 562 | */ |
563 | /* later we register inside of bt878_find_audio_dma() | 563 | /* later we register inside of bt878_find_audio_dma() |
564 | * because we may want to ignore certain cards */ | 564 | * because we may want to ignore certain cards */ |
diff --git a/drivers/media/dvb/bt8xx/bt878.h b/drivers/media/dvb/bt8xx/bt878.h index e1b9809d1b08..837623f7fcdf 100644 --- a/drivers/media/dvb/bt8xx/bt878.h +++ b/drivers/media/dvb/bt8xx/bt878.h | |||
@@ -1,4 +1,4 @@ | |||
1 | /* | 1 | /* |
2 | bt878.h - Bt878 audio module (register offsets) | 2 | bt878.h - Bt878 audio module (register offsets) |
3 | 3 | ||
4 | Copyright (C) 2002 Peter Hettkamp <peter.hettkamp@t-online.de> | 4 | Copyright (C) 2002 Peter Hettkamp <peter.hettkamp@t-online.de> |
@@ -120,14 +120,14 @@ struct bt878 { | |||
120 | u32 risc_pos; | 120 | u32 risc_pos; |
121 | 121 | ||
122 | struct tasklet_struct tasklet; | 122 | struct tasklet_struct tasklet; |
123 | int shutdown; | 123 | int shutdown; |
124 | }; | 124 | }; |
125 | 125 | ||
126 | extern struct bt878 bt878[BT878_MAX]; | 126 | extern struct bt878 bt878[BT878_MAX]; |
127 | 127 | ||
128 | void bt878_start(struct bt878 *bt, u32 controlreg, u32 op_sync_orin, | 128 | void bt878_start(struct bt878 *bt, u32 controlreg, u32 op_sync_orin, |
129 | u32 irq_err_ignore); | 129 | u32 irq_err_ignore); |
130 | void bt878_stop(struct bt878 *bt); | 130 | void bt878_stop(struct bt878 *bt); |
131 | 131 | ||
132 | #if defined(__powerpc__) /* big-endian */ | 132 | #if defined(__powerpc__) /* big-endian */ |
133 | extern __inline__ void io_st_le32(volatile unsigned __iomem *addr, unsigned val) | 133 | extern __inline__ void io_st_le32(volatile unsigned __iomem *addr, unsigned val) |
diff --git a/drivers/media/dvb/bt8xx/dst.c b/drivers/media/dvb/bt8xx/dst.c index eac83768dfd0..d047e349d706 100644 --- a/drivers/media/dvb/bt8xx/dst.c +++ b/drivers/media/dvb/bt8xx/dst.c | |||
@@ -1,25 +1,25 @@ | |||
1 | /* | 1 | /* |
2 | Frontend-driver for TwinHan DST Frontend | ||
3 | 2 | ||
4 | Copyright (C) 2003 Jamie Honan | 3 | Frontend/Card driver for TwinHan DST Frontend |
4 | Copyright (C) 2003 Jamie Honan | ||
5 | Copyright (C) 2004, 2005 Manu Abraham (manu@kromtek.com) | ||
5 | 6 | ||
6 | This program is free software; you can redistribute it and/or modify | 7 | This program is free software; you can redistribute it and/or modify |
7 | it under the terms of the GNU General Public License as published by | 8 | it under the terms of the GNU General Public License as published by |
8 | the Free Software Foundation; either version 2 of the License, or | 9 | the Free Software Foundation; either version 2 of the License, or |
9 | (at your option) any later version. | 10 | (at your option) any later version. |
10 | 11 | ||
11 | This program is distributed in the hope that it will be useful, | 12 | This program is distributed in the hope that it will be useful, |
12 | but WITHOUT ANY WARRANTY; without even the implied warranty of | 13 | but WITHOUT ANY WARRANTY; without even the implied warranty of |
13 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | 14 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
14 | 15 | GNU General Public License for more details. | |
15 | GNU General Public License for more details. | ||
16 | |||
17 | You should have received a copy of the GNU General Public License | ||
18 | along with this program; if not, write to the Free Software | ||
19 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
20 | 16 | ||
17 | You should have received a copy of the GNU General Public License | ||
18 | along with this program; if not, write to the Free Software | ||
19 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
21 | */ | 20 | */ |
22 | 21 | ||
22 | |||
23 | #include <linux/kernel.h> | 23 | #include <linux/kernel.h> |
24 | #include <linux/module.h> | 24 | #include <linux/module.h> |
25 | #include <linux/init.h> | 25 | #include <linux/init.h> |
@@ -31,59 +31,22 @@ | |||
31 | 31 | ||
32 | #include "dvb_frontend.h" | 32 | #include "dvb_frontend.h" |
33 | #include "dst_priv.h" | 33 | #include "dst_priv.h" |
34 | #include "dst.h" | 34 | #include "dst_common.h" |
35 | |||
36 | struct dst_state { | ||
37 | |||
38 | struct i2c_adapter* i2c; | ||
39 | |||
40 | struct bt878* bt; | ||
41 | |||
42 | struct dvb_frontend_ops ops; | ||
43 | |||
44 | /* configuration settings */ | ||
45 | const struct dst_config* config; | ||
46 | |||
47 | struct dvb_frontend frontend; | ||
48 | |||
49 | /* private demodulator data */ | ||
50 | u8 tx_tuna[10]; | ||
51 | u8 rx_tuna[10]; | ||
52 | u8 rxbuffer[10]; | ||
53 | u8 diseq_flags; | ||
54 | u8 dst_type; | ||
55 | u32 type_flags; | ||
56 | u32 frequency; /* intermediate frequency in kHz for QPSK */ | ||
57 | fe_spectral_inversion_t inversion; | ||
58 | u32 symbol_rate; /* symbol rate in Symbols per second */ | ||
59 | fe_code_rate_t fec; | ||
60 | fe_sec_voltage_t voltage; | ||
61 | fe_sec_tone_mode_t tone; | ||
62 | u32 decode_freq; | ||
63 | u8 decode_lock; | ||
64 | u16 decode_strength; | ||
65 | u16 decode_snr; | ||
66 | unsigned long cur_jiff; | ||
67 | u8 k22; | ||
68 | fe_bandwidth_t bandwidth; | ||
69 | }; | ||
70 | 35 | ||
71 | static unsigned int dst_verbose = 0; | ||
72 | module_param(dst_verbose, int, 0644); | ||
73 | MODULE_PARM_DESC(dst_verbose, "verbose startup messages, default is 1 (yes)"); | ||
74 | static unsigned int dst_debug = 0; | ||
75 | module_param(dst_debug, int, 0644); | ||
76 | MODULE_PARM_DESC(dst_debug, "debug messages, default is 0 (no)"); | ||
77 | 36 | ||
78 | #define dprintk if (dst_debug) printk | 37 | static unsigned int verbose = 1; |
38 | module_param(verbose, int, 0644); | ||
39 | MODULE_PARM_DESC(verbose, "verbose startup messages, default is 1 (yes)"); | ||
79 | 40 | ||
80 | #define DST_TYPE_IS_SAT 0 | 41 | static unsigned int debug = 1; |
81 | #define DST_TYPE_IS_TERR 1 | 42 | module_param(debug, int, 0644); |
82 | #define DST_TYPE_IS_CABLE 2 | 43 | MODULE_PARM_DESC(debug, "debug messages, default is 0 (yes)"); |
83 | 44 | ||
84 | #define DST_TYPE_HAS_NEWTUNE 1 | 45 | static unsigned int dst_addons; |
85 | #define DST_TYPE_HAS_TS204 2 | 46 | module_param(dst_addons, int, 0644); |
86 | #define DST_TYPE_HAS_SYMDIV 4 | 47 | MODULE_PARM_DESC(dst_addons, "CA daughterboard, default is 0 (No addons)"); |
48 | |||
49 | #define dprintk if (debug) printk | ||
87 | 50 | ||
88 | #define HAS_LOCK 1 | 51 | #define HAS_LOCK 1 |
89 | #define ATTEMPT_TUNE 2 | 52 | #define ATTEMPT_TUNE 2 |
@@ -97,7 +60,7 @@ static void dst_packsize(struct dst_state* state, int psize) | |||
97 | bt878_device_control(state->bt, DST_IG_TS, &bits); | 60 | bt878_device_control(state->bt, DST_IG_TS, &bits); |
98 | } | 61 | } |
99 | 62 | ||
100 | static int dst_gpio_outb(struct dst_state* state, u32 mask, u32 enbb, u32 outhigh) | 63 | int dst_gpio_outb(struct dst_state* state, u32 mask, u32 enbb, u32 outhigh, int delay) |
101 | { | 64 | { |
102 | union dst_gpio_packet enb; | 65 | union dst_gpio_packet enb; |
103 | union dst_gpio_packet bits; | 66 | union dst_gpio_packet bits; |
@@ -105,26 +68,33 @@ static int dst_gpio_outb(struct dst_state* state, u32 mask, u32 enbb, u32 outhig | |||
105 | 68 | ||
106 | enb.enb.mask = mask; | 69 | enb.enb.mask = mask; |
107 | enb.enb.enable = enbb; | 70 | enb.enb.enable = enbb; |
71 | if (verbose > 4) | ||
72 | dprintk("%s: mask=[%04x], enbb=[%04x], outhigh=[%04x]\n", __FUNCTION__, mask, enbb, outhigh); | ||
73 | |||
108 | if ((err = bt878_device_control(state->bt, DST_IG_ENABLE, &enb)) < 0) { | 74 | if ((err = bt878_device_control(state->bt, DST_IG_ENABLE, &enb)) < 0) { |
109 | dprintk("%s: dst_gpio_enb error (err == %i, mask == 0x%02x, enb == 0x%02x)\n", __FUNCTION__, err, mask, enbb); | 75 | dprintk("%s: dst_gpio_enb error (err == %i, mask == %02x, enb == %02x)\n", __FUNCTION__, err, mask, enbb); |
110 | return -EREMOTEIO; | 76 | return -EREMOTEIO; |
111 | } | 77 | } |
112 | 78 | udelay(1000); | |
113 | /* because complete disabling means no output, no need to do output packet */ | 79 | /* because complete disabling means no output, no need to do output packet */ |
114 | if (enbb == 0) | 80 | if (enbb == 0) |
115 | return 0; | 81 | return 0; |
116 | 82 | ||
83 | if (delay) | ||
84 | msleep(10); | ||
85 | |||
117 | bits.outp.mask = enbb; | 86 | bits.outp.mask = enbb; |
118 | bits.outp.highvals = outhigh; | 87 | bits.outp.highvals = outhigh; |
119 | 88 | ||
120 | if ((err = bt878_device_control(state->bt, DST_IG_WRITE, &bits)) < 0) { | 89 | if ((err = bt878_device_control(state->bt, DST_IG_WRITE, &bits)) < 0) { |
121 | dprintk("%s: dst_gpio_outb error (err == %i, enbb == 0x%02x, outhigh == 0x%02x)\n", __FUNCTION__, err, enbb, outhigh); | 90 | dprintk("%s: dst_gpio_outb error (err == %i, enbb == %02x, outhigh == %02x)\n", __FUNCTION__, err, enbb, outhigh); |
122 | return -EREMOTEIO; | 91 | return -EREMOTEIO; |
123 | } | 92 | } |
124 | return 0; | 93 | return 0; |
125 | } | 94 | } |
95 | EXPORT_SYMBOL(dst_gpio_outb); | ||
126 | 96 | ||
127 | static int dst_gpio_inb(struct dst_state *state, u8 * result) | 97 | int dst_gpio_inb(struct dst_state *state, u8 * result) |
128 | { | 98 | { |
129 | union dst_gpio_packet rd_packet; | 99 | union dst_gpio_packet rd_packet; |
130 | int err; | 100 | int err; |
@@ -139,143 +109,225 @@ static int dst_gpio_inb(struct dst_state *state, u8 * result) | |||
139 | *result = (u8) rd_packet.rd.value; | 109 | *result = (u8) rd_packet.rd.value; |
140 | return 0; | 110 | return 0; |
141 | } | 111 | } |
112 | EXPORT_SYMBOL(dst_gpio_inb); | ||
142 | 113 | ||
143 | #define DST_I2C_ENABLE 1 | 114 | int rdc_reset_state(struct dst_state *state) |
144 | #define DST_8820 2 | ||
145 | |||
146 | static int dst_reset8820(struct dst_state *state) | ||
147 | { | 115 | { |
148 | int retval; | 116 | if (verbose > 1) |
149 | /* pull 8820 gpio pin low, wait, high, wait, then low */ | 117 | dprintk("%s: Resetting state machine\n", __FUNCTION__); |
150 | // dprintk ("%s: reset 8820\n", __FUNCTION__); | 118 | |
151 | retval = dst_gpio_outb(state, DST_8820, DST_8820, 0); | 119 | if (dst_gpio_outb(state, RDC_8820_INT, RDC_8820_INT, 0, NO_DELAY) < 0) { |
152 | if (retval < 0) | 120 | dprintk("%s: dst_gpio_outb ERROR !\n", __FUNCTION__); |
153 | return retval; | 121 | return -1; |
122 | } | ||
123 | |||
154 | msleep(10); | 124 | msleep(10); |
155 | retval = dst_gpio_outb(state, DST_8820, DST_8820, DST_8820); | 125 | |
156 | if (retval < 0) | 126 | if (dst_gpio_outb(state, RDC_8820_INT, RDC_8820_INT, RDC_8820_INT, NO_DELAY) < 0) { |
157 | return retval; | 127 | dprintk("%s: dst_gpio_outb ERROR !\n", __FUNCTION__); |
158 | /* wait for more feedback on what works here * | 128 | msleep(10); |
159 | msleep(10); | 129 | return -1; |
160 | retval = dst_gpio_outb(dst, DST_8820, DST_8820, 0); | 130 | } |
161 | if (retval < 0) | 131 | |
162 | return retval; | ||
163 | */ | ||
164 | return 0; | 132 | return 0; |
165 | } | 133 | } |
134 | EXPORT_SYMBOL(rdc_reset_state); | ||
166 | 135 | ||
167 | static int dst_i2c_enable(struct dst_state *state) | 136 | int rdc_8820_reset(struct dst_state *state) |
168 | { | 137 | { |
169 | int retval; | 138 | if (verbose > 1) |
170 | /* pull I2C enable gpio pin low, wait */ | 139 | dprintk("%s: Resetting DST\n", __FUNCTION__); |
171 | // dprintk ("%s: i2c enable\n", __FUNCTION__); | 140 | |
172 | retval = dst_gpio_outb(state, ~0, DST_I2C_ENABLE, 0); | 141 | if (dst_gpio_outb(state, RDC_8820_RESET, RDC_8820_RESET, 0, NO_DELAY) < 0) { |
173 | if (retval < 0) | 142 | dprintk("%s: dst_gpio_outb ERROR !\n", __FUNCTION__); |
174 | return retval; | 143 | return -1; |
175 | // dprintk ("%s: i2c enable delay\n", __FUNCTION__); | 144 | } |
176 | msleep(33); | 145 | udelay(1000); |
146 | if (dst_gpio_outb(state, RDC_8820_RESET, RDC_8820_RESET, RDC_8820_RESET, DELAY) < 0) { | ||
147 | dprintk("%s: dst_gpio_outb ERROR !\n", __FUNCTION__); | ||
148 | return -1; | ||
149 | } | ||
150 | |||
177 | return 0; | 151 | return 0; |
178 | } | 152 | } |
153 | EXPORT_SYMBOL(rdc_8820_reset); | ||
179 | 154 | ||
180 | static int dst_i2c_disable(struct dst_state *state) | 155 | int dst_pio_enable(struct dst_state *state) |
181 | { | 156 | { |
182 | int retval; | 157 | if (dst_gpio_outb(state, ~0, RDC_8820_PIO_0_ENABLE, 0, NO_DELAY) < 0) { |
183 | /* release I2C enable gpio pin, wait */ | 158 | dprintk("%s: dst_gpio_outb ERROR !\n", __FUNCTION__); |
184 | // dprintk ("%s: i2c disable\n", __FUNCTION__); | 159 | return -1; |
185 | retval = dst_gpio_outb(state, ~0, 0, 0); | 160 | } |
186 | if (retval < 0) | 161 | udelay(1000); |
187 | return retval; | 162 | return 0; |
188 | // dprintk ("%s: i2c disable delay\n", __FUNCTION__); | 163 | } |
189 | msleep(33); | 164 | EXPORT_SYMBOL(dst_pio_enable); |
165 | |||
166 | int dst_pio_disable(struct dst_state *state) | ||
167 | { | ||
168 | if (dst_gpio_outb(state, ~0, RDC_8820_PIO_0_DISABLE, RDC_8820_PIO_0_DISABLE, NO_DELAY) < 0) { | ||
169 | dprintk("%s: dst_gpio_outb ERROR !\n", __FUNCTION__); | ||
170 | return -1; | ||
171 | } | ||
172 | if (state->type_flags & DST_TYPE_HAS_FW_1) | ||
173 | udelay(1000); | ||
174 | |||
190 | return 0; | 175 | return 0; |
191 | } | 176 | } |
177 | EXPORT_SYMBOL(dst_pio_disable); | ||
192 | 178 | ||
193 | static int dst_wait_dst_ready(struct dst_state *state) | 179 | int dst_wait_dst_ready(struct dst_state *state, u8 delay_mode) |
194 | { | 180 | { |
195 | u8 reply; | 181 | u8 reply; |
196 | int retval; | ||
197 | int i; | 182 | int i; |
183 | |||
198 | for (i = 0; i < 200; i++) { | 184 | for (i = 0; i < 200; i++) { |
199 | retval = dst_gpio_inb(state, &reply); | 185 | if (dst_gpio_inb(state, &reply) < 0) { |
200 | if (retval < 0) | 186 | dprintk("%s: dst_gpio_inb ERROR !\n", __FUNCTION__); |
201 | return retval; | 187 | return -1; |
202 | if ((reply & DST_I2C_ENABLE) == 0) { | 188 | } |
203 | dprintk("%s: dst wait ready after %d\n", __FUNCTION__, i); | 189 | |
190 | if ((reply & RDC_8820_PIO_0_ENABLE) == 0) { | ||
191 | if (verbose > 4) | ||
192 | dprintk("%s: dst wait ready after %d\n", __FUNCTION__, i); | ||
204 | return 1; | 193 | return 1; |
205 | } | 194 | } |
206 | msleep(10); | 195 | msleep(10); |
207 | } | 196 | } |
208 | dprintk("%s: dst wait NOT ready after %d\n", __FUNCTION__, i); | 197 | if (verbose > 1) |
198 | dprintk("%s: dst wait NOT ready after %d\n", __FUNCTION__, i); | ||
199 | |||
200 | return 0; | ||
201 | } | ||
202 | EXPORT_SYMBOL(dst_wait_dst_ready); | ||
203 | |||
204 | int dst_error_recovery(struct dst_state *state) | ||
205 | { | ||
206 | dprintk("%s: Trying to return from previous errors...\n", __FUNCTION__); | ||
207 | dst_pio_disable(state); | ||
208 | msleep(10); | ||
209 | dst_pio_enable(state); | ||
210 | msleep(10); | ||
211 | |||
212 | return 0; | ||
213 | } | ||
214 | EXPORT_SYMBOL(dst_error_recovery); | ||
215 | |||
216 | int dst_error_bailout(struct dst_state *state) | ||
217 | { | ||
218 | dprintk("%s: Trying to bailout from previous error...\n", __FUNCTION__); | ||
219 | rdc_8820_reset(state); | ||
220 | dst_pio_disable(state); | ||
221 | msleep(10); | ||
222 | |||
223 | return 0; | ||
224 | } | ||
225 | EXPORT_SYMBOL(dst_error_bailout); | ||
226 | |||
227 | |||
228 | int dst_comm_init(struct dst_state* state) | ||
229 | { | ||
230 | if (verbose > 1) | ||
231 | dprintk ("%s: Initializing DST..\n", __FUNCTION__); | ||
232 | if ((dst_pio_enable(state)) < 0) { | ||
233 | dprintk("%s: PIO Enable Failed.\n", __FUNCTION__); | ||
234 | return -1; | ||
235 | } | ||
236 | if ((rdc_reset_state(state)) < 0) { | ||
237 | dprintk("%s: RDC 8820 State RESET Failed.\n", __FUNCTION__); | ||
238 | return -1; | ||
239 | } | ||
240 | if (state->type_flags & DST_TYPE_HAS_FW_1) | ||
241 | msleep(100); | ||
242 | else | ||
243 | msleep(5); | ||
244 | |||
209 | return 0; | 245 | return 0; |
210 | } | 246 | } |
247 | EXPORT_SYMBOL(dst_comm_init); | ||
211 | 248 | ||
212 | static int write_dst(struct dst_state *state, u8 * data, u8 len) | 249 | |
250 | int write_dst(struct dst_state *state, u8 *data, u8 len) | ||
213 | { | 251 | { |
214 | struct i2c_msg msg = { | 252 | struct i2c_msg msg = { |
215 | .addr = state->config->demod_address,.flags = 0,.buf = data,.len = len | 253 | .addr = state->config->demod_address,.flags = 0,.buf = data,.len = len |
216 | }; | 254 | }; |
255 | |||
217 | int err; | 256 | int err; |
218 | int cnt; | 257 | int cnt; |
219 | 258 | if (debug && (verbose > 4)) { | |
220 | if (dst_debug && dst_verbose) { | ||
221 | u8 i; | 259 | u8 i; |
222 | dprintk("%s writing", __FUNCTION__); | 260 | if (verbose > 4) { |
223 | for (i = 0; i < len; i++) { | 261 | dprintk("%s writing", __FUNCTION__); |
224 | dprintk(" 0x%02x", data[i]); | 262 | for (i = 0; i < len; i++) |
263 | dprintk(" %02x", data[i]); | ||
264 | dprintk("\n"); | ||
225 | } | 265 | } |
226 | dprintk("\n"); | ||
227 | } | 266 | } |
228 | msleep(30); | 267 | for (cnt = 0; cnt < 2; cnt++) { |
229 | for (cnt = 0; cnt < 4; cnt++) { | ||
230 | if ((err = i2c_transfer(state->i2c, &msg, 1)) < 0) { | 268 | if ((err = i2c_transfer(state->i2c, &msg, 1)) < 0) { |
231 | dprintk("%s: write_dst error (err == %i, len == 0x%02x, b0 == 0x%02x)\n", __FUNCTION__, err, len, data[0]); | 269 | dprintk("%s: _write_dst error (err == %i, len == 0x%02x, b0 == 0x%02x)\n", __FUNCTION__, err, len, data[0]); |
232 | dst_i2c_disable(state); | 270 | dst_error_recovery(state); |
233 | msleep(500); | ||
234 | dst_i2c_enable(state); | ||
235 | msleep(500); | ||
236 | continue; | 271 | continue; |
237 | } else | 272 | } else |
238 | break; | 273 | break; |
239 | } | 274 | } |
240 | if (cnt >= 4) | 275 | |
241 | return -EREMOTEIO; | 276 | if (cnt >= 2) { |
277 | if (verbose > 1) | ||
278 | printk("%s: RDC 8820 RESET...\n", __FUNCTION__); | ||
279 | dst_error_bailout(state); | ||
280 | |||
281 | return -1; | ||
282 | } | ||
283 | |||
242 | return 0; | 284 | return 0; |
243 | } | 285 | } |
286 | EXPORT_SYMBOL(write_dst); | ||
244 | 287 | ||
245 | static int read_dst(struct dst_state *state, u8 * ret, u8 len) | 288 | int read_dst(struct dst_state *state, u8 * ret, u8 len) |
246 | { | 289 | { |
247 | struct i2c_msg msg = {.addr = state->config->demod_address,.flags = I2C_M_RD,.buf = ret,.len = len }; | 290 | struct i2c_msg msg = {.addr = state->config->demod_address,.flags = I2C_M_RD,.buf = ret,.len = len }; |
248 | int err; | 291 | int err; |
249 | int cnt; | 292 | int cnt; |
250 | 293 | ||
251 | for (cnt = 0; cnt < 4; cnt++) { | 294 | for (cnt = 0; cnt < 2; cnt++) { |
252 | if ((err = i2c_transfer(state->i2c, &msg, 1)) < 0) { | 295 | if ((err = i2c_transfer(state->i2c, &msg, 1)) < 0) { |
296 | |||
253 | dprintk("%s: read_dst error (err == %i, len == 0x%02x, b0 == 0x%02x)\n", __FUNCTION__, err, len, ret[0]); | 297 | dprintk("%s: read_dst error (err == %i, len == 0x%02x, b0 == 0x%02x)\n", __FUNCTION__, err, len, ret[0]); |
254 | dst_i2c_disable(state); | 298 | dst_error_recovery(state); |
255 | dst_i2c_enable(state); | 299 | |
256 | continue; | 300 | continue; |
257 | } else | 301 | } else |
258 | break; | 302 | break; |
259 | } | 303 | } |
260 | if (cnt >= 4) | 304 | if (cnt >= 2) { |
261 | return -EREMOTEIO; | 305 | if (verbose > 1) |
262 | dprintk("%s reply is 0x%x\n", __FUNCTION__, ret[0]); | 306 | printk("%s: RDC 8820 RESET...\n", __FUNCTION__); |
263 | if (dst_debug && dst_verbose) { | 307 | dst_error_bailout(state); |
308 | |||
309 | return -1; | ||
310 | } | ||
311 | if (debug && (verbose > 4)) { | ||
312 | dprintk("%s reply is 0x%x\n", __FUNCTION__, ret[0]); | ||
264 | for (err = 1; err < len; err++) | 313 | for (err = 1; err < len; err++) |
265 | dprintk(" 0x%x", ret[err]); | 314 | dprintk(" 0x%x", ret[err]); |
266 | if (err > 1) | 315 | if (err > 1) |
267 | dprintk("\n"); | 316 | dprintk("\n"); |
268 | } | 317 | } |
318 | |||
269 | return 0; | 319 | return 0; |
270 | } | 320 | } |
321 | EXPORT_SYMBOL(read_dst); | ||
271 | 322 | ||
272 | static int dst_set_freq(struct dst_state *state, u32 freq) | 323 | static int dst_set_freq(struct dst_state *state, u32 freq) |
273 | { | 324 | { |
274 | u8 *val; | 325 | u8 *val; |
275 | 326 | ||
276 | state->frequency = freq; | 327 | state->frequency = freq; |
328 | if (debug > 4) | ||
329 | dprintk("%s: set Frequency %u\n", __FUNCTION__, freq); | ||
277 | 330 | ||
278 | // dprintk("%s: set frequency %u\n", __FUNCTION__, freq); | ||
279 | if (state->dst_type == DST_TYPE_IS_SAT) { | 331 | if (state->dst_type == DST_TYPE_IS_SAT) { |
280 | freq = freq / 1000; | 332 | freq = freq / 1000; |
281 | if (freq < 950 || freq > 2150) | 333 | if (freq < 950 || freq > 2150) |
@@ -398,7 +450,8 @@ static int dst_set_symbolrate(struct dst_state* state, u32 srate) | |||
398 | if (state->dst_type == DST_TYPE_IS_TERR) { | 450 | if (state->dst_type == DST_TYPE_IS_TERR) { |
399 | return 0; | 451 | return 0; |
400 | } | 452 | } |
401 | // dprintk("%s: set srate %u\n", __FUNCTION__, srate); | 453 | if (debug > 4) |
454 | dprintk("%s: set symrate %u\n", __FUNCTION__, srate); | ||
402 | srate /= 1000; | 455 | srate /= 1000; |
403 | val = &state->tx_tuna[0]; | 456 | val = &state->tx_tuna[0]; |
404 | 457 | ||
@@ -407,7 +460,10 @@ static int dst_set_symbolrate(struct dst_state* state, u32 srate) | |||
407 | sval <<= 20; | 460 | sval <<= 20; |
408 | do_div(sval, 88000); | 461 | do_div(sval, 88000); |
409 | symcalc = (u32) sval; | 462 | symcalc = (u32) sval; |
410 | // dprintk("%s: set symcalc %u\n", __FUNCTION__, symcalc); | 463 | |
464 | if (debug > 4) | ||
465 | dprintk("%s: set symcalc %u\n", __FUNCTION__, symcalc); | ||
466 | |||
411 | val[5] = (u8) (symcalc >> 12); | 467 | val[5] = (u8) (symcalc >> 12); |
412 | val[6] = (u8) (symcalc >> 4); | 468 | val[6] = (u8) (symcalc >> 4); |
413 | val[7] = (u8) (symcalc << 4); | 469 | val[7] = (u8) (symcalc << 4); |
@@ -422,7 +478,7 @@ static int dst_set_symbolrate(struct dst_state* state, u32 srate) | |||
422 | return 0; | 478 | return 0; |
423 | } | 479 | } |
424 | 480 | ||
425 | static u8 dst_check_sum(u8 * buf, u32 len) | 481 | u8 dst_check_sum(u8 * buf, u32 len) |
426 | { | 482 | { |
427 | u32 i; | 483 | u32 i; |
428 | u8 val = 0; | 484 | u8 val = 0; |
@@ -433,28 +489,7 @@ static u8 dst_check_sum(u8 * buf, u32 len) | |||
433 | } | 489 | } |
434 | return ((~val) + 1); | 490 | return ((~val) + 1); |
435 | } | 491 | } |
436 | 492 | EXPORT_SYMBOL(dst_check_sum); | |
437 | struct dst_types { | ||
438 | char *mstr; | ||
439 | int offs; | ||
440 | u8 dst_type; | ||
441 | u32 type_flags; | ||
442 | }; | ||
443 | |||
444 | static struct dst_types dst_tlist[] = { | ||
445 | {"DST-020", 0, DST_TYPE_IS_SAT, DST_TYPE_HAS_SYMDIV}, | ||
446 | {"DST-030", 0, DST_TYPE_IS_SAT, DST_TYPE_HAS_TS204 | DST_TYPE_HAS_NEWTUNE}, | ||
447 | {"DST-03T", 0, DST_TYPE_IS_SAT, DST_TYPE_HAS_SYMDIV | DST_TYPE_HAS_TS204}, | ||
448 | {"DST-MOT", 0, DST_TYPE_IS_SAT, DST_TYPE_HAS_SYMDIV}, | ||
449 | {"DST-CI", 1, DST_TYPE_IS_SAT, DST_TYPE_HAS_TS204 | DST_TYPE_HAS_NEWTUNE}, | ||
450 | {"DSTMCI", 1, DST_TYPE_IS_SAT, DST_TYPE_HAS_NEWTUNE}, | ||
451 | {"DSTFCI", 1, DST_TYPE_IS_SAT, DST_TYPE_HAS_NEWTUNE}, | ||
452 | {"DCTNEW", 1, DST_TYPE_IS_CABLE, DST_TYPE_HAS_NEWTUNE}, | ||
453 | {"DCT-CI", 1, DST_TYPE_IS_CABLE, DST_TYPE_HAS_NEWTUNE | DST_TYPE_HAS_TS204}, | ||
454 | {"DTTDIG", 1, DST_TYPE_IS_TERR, 0} | ||
455 | }; | ||
456 | |||
457 | /* DCTNEW and DCT-CI are guesses */ | ||
458 | 493 | ||
459 | static void dst_type_flags_print(u32 type_flags) | 494 | static void dst_type_flags_print(u32 type_flags) |
460 | { | 495 | { |
@@ -465,93 +500,270 @@ static void dst_type_flags_print(u32 type_flags) | |||
465 | printk(" 0x%x ts204", DST_TYPE_HAS_TS204); | 500 | printk(" 0x%x ts204", DST_TYPE_HAS_TS204); |
466 | if (type_flags & DST_TYPE_HAS_SYMDIV) | 501 | if (type_flags & DST_TYPE_HAS_SYMDIV) |
467 | printk(" 0x%x symdiv", DST_TYPE_HAS_SYMDIV); | 502 | printk(" 0x%x symdiv", DST_TYPE_HAS_SYMDIV); |
503 | if (type_flags & DST_TYPE_HAS_FW_1) | ||
504 | printk(" 0x%x firmware version = 1", DST_TYPE_HAS_FW_1); | ||
505 | if (type_flags & DST_TYPE_HAS_FW_2) | ||
506 | printk(" 0x%x firmware version = 2", DST_TYPE_HAS_FW_2); | ||
507 | if (type_flags & DST_TYPE_HAS_FW_3) | ||
508 | printk(" 0x%x firmware version = 3", DST_TYPE_HAS_FW_3); | ||
509 | // if ((type_flags & DST_TYPE_HAS_FW_BUILD) && new_fw) | ||
510 | |||
468 | printk("\n"); | 511 | printk("\n"); |
469 | } | 512 | } |
470 | 513 | ||
471 | static int dst_type_print(u8 type) | 514 | |
515 | static int dst_type_print (u8 type) | ||
472 | { | 516 | { |
473 | char *otype; | 517 | char *otype; |
474 | switch (type) { | 518 | switch (type) { |
475 | case DST_TYPE_IS_SAT: | 519 | case DST_TYPE_IS_SAT: |
476 | otype = "satellite"; | 520 | otype = "satellite"; |
477 | break; | 521 | break; |
522 | |||
478 | case DST_TYPE_IS_TERR: | 523 | case DST_TYPE_IS_TERR: |
479 | otype = "terrestrial"; | 524 | otype = "terrestrial"; |
480 | break; | 525 | break; |
526 | |||
481 | case DST_TYPE_IS_CABLE: | 527 | case DST_TYPE_IS_CABLE: |
482 | otype = "cable"; | 528 | otype = "cable"; |
483 | break; | 529 | break; |
530 | |||
484 | default: | 531 | default: |
485 | printk("%s: invalid dst type %d\n", __FUNCTION__, type); | 532 | printk("%s: invalid dst type %d\n", __FUNCTION__, type); |
486 | return -EINVAL; | 533 | return -EINVAL; |
487 | } | 534 | } |
488 | printk("DST type : %s\n", otype); | 535 | printk("DST type : %s\n", otype); |
536 | |||
489 | return 0; | 537 | return 0; |
490 | } | 538 | } |
491 | 539 | ||
492 | static int dst_check_ci(struct dst_state *state) | 540 | /* |
541 | Known cards list | ||
542 | Satellite | ||
543 | ------------------- | ||
544 | 200103A | ||
545 | VP-1020 DST-MOT LG(old), TS=188 | ||
546 | |||
547 | VP-1020 DST-03T LG(new), TS=204 | ||
548 | VP-1022 DST-03T LG(new), TS=204 | ||
549 | VP-1025 DST-03T LG(new), TS=204 | ||
550 | |||
551 | VP-1030 DSTMCI, LG(new), TS=188 | ||
552 | VP-1032 DSTMCI, LG(new), TS=188 | ||
553 | |||
554 | Cable | ||
555 | ------------------- | ||
556 | VP-2030 DCT-CI, Samsung, TS=204 | ||
557 | VP-2021 DCT-CI, Unknown, TS=204 | ||
558 | VP-2031 DCT-CI, Philips, TS=188 | ||
559 | VP-2040 DCT-CI, Philips, TS=188, with CA daughter board | ||
560 | VP-2040 DCT-CI, Philips, TS=204, without CA daughter board | ||
561 | |||
562 | Terrestrial | ||
563 | ------------------- | ||
564 | VP-3050 DTTNXT TS=188 | ||
565 | VP-3040 DTT-CI, Philips, TS=188 | ||
566 | VP-3040 DTT-CI, Philips, TS=204 | ||
567 | |||
568 | ATSC | ||
569 | ------------------- | ||
570 | VP-3220 ATSCDI, TS=188 | ||
571 | VP-3250 ATSCAD, TS=188 | ||
572 | |||
573 | */ | ||
574 | |||
575 | struct dst_types dst_tlist[] = { | ||
576 | { | ||
577 | .device_id = "200103A", | ||
578 | .offset = 0, | ||
579 | .dst_type = DST_TYPE_IS_SAT, | ||
580 | .type_flags = DST_TYPE_HAS_SYMDIV | DST_TYPE_HAS_FW_1, | ||
581 | .dst_feature = 0 | ||
582 | }, /* obsolete */ | ||
583 | |||
584 | { | ||
585 | .device_id = "DST-020", | ||
586 | .offset = 0, | ||
587 | .dst_type = DST_TYPE_IS_SAT, | ||
588 | .type_flags = DST_TYPE_HAS_SYMDIV | DST_TYPE_HAS_FW_1, | ||
589 | .dst_feature = 0 | ||
590 | }, /* obsolete */ | ||
591 | |||
592 | { | ||
593 | .device_id = "DST-030", | ||
594 | .offset = 0, | ||
595 | .dst_type = DST_TYPE_IS_SAT, | ||
596 | .type_flags = DST_TYPE_HAS_TS204 | DST_TYPE_HAS_NEWTUNE | DST_TYPE_HAS_FW_1, | ||
597 | .dst_feature = 0 | ||
598 | }, /* obsolete */ | ||
599 | |||
600 | { | ||
601 | .device_id = "DST-03T", | ||
602 | .offset = 0, | ||
603 | .dst_type = DST_TYPE_IS_SAT, | ||
604 | .type_flags = DST_TYPE_HAS_SYMDIV | DST_TYPE_HAS_TS204 | DST_TYPE_HAS_FW_2, | ||
605 | .dst_feature = DST_TYPE_HAS_DISEQC3 | DST_TYPE_HAS_DISEQC4 | DST_TYPE_HAS_DISEQC5 | ||
606 | | DST_TYPE_HAS_MAC | DST_TYPE_HAS_MOTO | ||
607 | }, | ||
608 | |||
609 | { | ||
610 | .device_id = "DST-MOT", | ||
611 | .offset = 0, | ||
612 | .dst_type = DST_TYPE_IS_SAT, | ||
613 | .type_flags = DST_TYPE_HAS_SYMDIV | DST_TYPE_HAS_FW_1, | ||
614 | .dst_feature = 0 | ||
615 | }, /* obsolete */ | ||
616 | |||
617 | { | ||
618 | .device_id = "DST-CI", | ||
619 | .offset = 1, | ||
620 | .dst_type = DST_TYPE_IS_SAT, | ||
621 | .type_flags = DST_TYPE_HAS_TS204 | DST_TYPE_HAS_NEWTUNE | DST_TYPE_HAS_FW_1, | ||
622 | .dst_feature = DST_TYPE_HAS_CA | ||
623 | }, /* An OEM board */ | ||
624 | |||
625 | { | ||
626 | .device_id = "DSTMCI", | ||
627 | .offset = 1, | ||
628 | .dst_type = DST_TYPE_IS_SAT, | ||
629 | .type_flags = DST_TYPE_HAS_NEWTUNE | DST_TYPE_HAS_FW_2 | DST_TYPE_HAS_FW_BUILD, | ||
630 | .dst_feature = DST_TYPE_HAS_CA | DST_TYPE_HAS_DISEQC3 | DST_TYPE_HAS_DISEQC4 | ||
631 | | DST_TYPE_HAS_MOTO | DST_TYPE_HAS_MAC | ||
632 | }, | ||
633 | |||
634 | { | ||
635 | .device_id = "DSTFCI", | ||
636 | .offset = 1, | ||
637 | .dst_type = DST_TYPE_IS_SAT, | ||
638 | .type_flags = DST_TYPE_HAS_NEWTUNE | DST_TYPE_HAS_FW_1, | ||
639 | .dst_feature = 0 | ||
640 | }, /* unknown to vendor */ | ||
641 | |||
642 | { | ||
643 | .device_id = "DCT-CI", | ||
644 | .offset = 1, | ||
645 | .dst_type = DST_TYPE_IS_CABLE, | ||
646 | .type_flags = DST_TYPE_HAS_TS204 | DST_TYPE_HAS_NEWTUNE | DST_TYPE_HAS_FW_1 | ||
647 | | DST_TYPE_HAS_FW_2 | DST_TYPE_HAS_FW_BUILD, | ||
648 | .dst_feature = DST_TYPE_HAS_CA | ||
649 | }, | ||
650 | |||
651 | { | ||
652 | .device_id = "DCTNEW", | ||
653 | .offset = 1, | ||
654 | .dst_type = DST_TYPE_IS_CABLE, | ||
655 | .type_flags = DST_TYPE_HAS_NEWTUNE | DST_TYPE_HAS_FW_3, | ||
656 | .dst_feature = 0 | ||
657 | }, | ||
658 | |||
659 | { | ||
660 | .device_id = "DTT-CI", | ||
661 | .offset = 1, | ||
662 | .dst_type = DST_TYPE_IS_TERR, | ||
663 | .type_flags = DST_TYPE_HAS_TS204 | DST_TYPE_HAS_FW_2 | DST_TYPE_HAS_FW_BUILD, | ||
664 | .dst_feature = 0 | ||
665 | }, | ||
666 | |||
667 | { | ||
668 | .device_id = "DTTDIG", | ||
669 | .offset = 1, | ||
670 | .dst_type = DST_TYPE_IS_TERR, | ||
671 | .type_flags = DST_TYPE_HAS_FW_2, | ||
672 | .dst_feature = 0 | ||
673 | }, | ||
674 | |||
675 | { | ||
676 | .device_id = "DTTNXT", | ||
677 | .offset = 1, | ||
678 | .dst_type = DST_TYPE_IS_TERR, | ||
679 | .type_flags = DST_TYPE_HAS_FW_2, | ||
680 | .dst_feature = DST_TYPE_HAS_ANALOG | ||
681 | }, | ||
682 | |||
683 | { | ||
684 | .device_id = "ATSCDI", | ||
685 | .offset = 1, | ||
686 | .dst_type = DST_TYPE_IS_ATSC, | ||
687 | .type_flags = DST_TYPE_HAS_FW_2, | ||
688 | .dst_feature = 0 | ||
689 | }, | ||
690 | |||
691 | { | ||
692 | .device_id = "ATSCAD", | ||
693 | .offset = 1, | ||
694 | .dst_type = DST_TYPE_IS_ATSC, | ||
695 | .type_flags = DST_TYPE_HAS_FW_2, | ||
696 | .dst_feature = 0 | ||
697 | }, | ||
698 | |||
699 | { } | ||
700 | |||
701 | }; | ||
702 | |||
703 | |||
704 | static int dst_get_device_id(struct dst_state *state) | ||
493 | { | 705 | { |
494 | u8 txbuf[8]; | 706 | u8 reply; |
495 | u8 rxbuf[8]; | 707 | |
496 | int retval; | ||
497 | int i; | 708 | int i; |
498 | struct dst_types *dsp; | 709 | struct dst_types *p_dst_type; |
499 | u8 use_dst_type; | 710 | u8 use_dst_type = 0; |
500 | u32 use_type_flags; | 711 | u32 use_type_flags = 0; |
501 | 712 | ||
502 | memset(txbuf, 0, sizeof(txbuf)); | 713 | static u8 device_type[8] = {0x00, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff}; |
503 | txbuf[1] = 6; | ||
504 | txbuf[7] = dst_check_sum(txbuf, 7); | ||
505 | 714 | ||
506 | dst_i2c_enable(state); | 715 | device_type[7] = dst_check_sum(device_type, 7); |
507 | dst_reset8820(state); | 716 | |
508 | retval = write_dst(state, txbuf, 8); | 717 | if (write_dst(state, device_type, FIXED_COMM)) |
509 | if (retval < 0) { | 718 | return -1; /* Write failed */ |
510 | dst_i2c_disable(state); | 719 | |
511 | dprintk("%s: write not successful, maybe no card?\n", __FUNCTION__); | 720 | if ((dst_pio_disable(state)) < 0) |
512 | return retval; | 721 | return -1; |
513 | } | 722 | |
514 | msleep(3); | 723 | if (read_dst(state, &reply, GET_ACK)) |
515 | retval = read_dst(state, rxbuf, 1); | 724 | return -1; /* Read failure */ |
516 | dst_i2c_disable(state); | 725 | |
517 | if (retval < 0) { | 726 | if (reply != ACK) { |
518 | dprintk("%s: read not successful, maybe no card?\n", __FUNCTION__); | 727 | dprintk("%s: Write not Acknowledged! [Reply=0x%02x]\n", __FUNCTION__, reply); |
519 | return retval; | 728 | return -1; /* Unack'd write */ |
520 | } | ||
521 | if (rxbuf[0] != 0xff) { | ||
522 | dprintk("%s: write reply not 0xff, not ci (%02x)\n", __FUNCTION__, rxbuf[0]); | ||
523 | return retval; | ||
524 | } | ||
525 | if (!dst_wait_dst_ready(state)) | ||
526 | return 0; | ||
527 | // dst_i2c_enable(i2c); Dimitri | ||
528 | retval = read_dst(state, rxbuf, 8); | ||
529 | dst_i2c_disable(state); | ||
530 | if (retval < 0) { | ||
531 | dprintk("%s: read not successful\n", __FUNCTION__); | ||
532 | return retval; | ||
533 | } | 729 | } |
534 | if (rxbuf[7] != dst_check_sum(rxbuf, 7)) { | 730 | |
535 | dprintk("%s: checksum failure\n", __FUNCTION__); | 731 | if (!dst_wait_dst_ready(state, DEVICE_INIT)) |
536 | return retval; | 732 | return -1; /* DST not ready yet */ |
733 | |||
734 | if (read_dst(state, state->rxbuffer, FIXED_COMM)) | ||
735 | return -1; | ||
736 | |||
737 | dst_pio_disable(state); | ||
738 | |||
739 | if (state->rxbuffer[7] != dst_check_sum(state->rxbuffer, 7)) { | ||
740 | dprintk("%s: Checksum failure! \n", __FUNCTION__); | ||
741 | return -1; /* Checksum failure */ | ||
537 | } | 742 | } |
538 | rxbuf[7] = '\0'; | 743 | |
539 | for (i = 0, dsp = &dst_tlist[0]; i < sizeof(dst_tlist) / sizeof(dst_tlist[0]); i++, dsp++) { | 744 | state->rxbuffer[7] = '\0'; |
540 | if (!strncmp(&rxbuf[dsp->offs], dsp->mstr, strlen(dsp->mstr))) { | 745 | |
541 | use_type_flags = dsp->type_flags; | 746 | for (i = 0, p_dst_type = dst_tlist; i < ARRAY_SIZE (dst_tlist); i++, p_dst_type++) { |
542 | use_dst_type = dsp->dst_type; | 747 | if (!strncmp (&state->rxbuffer[p_dst_type->offset], p_dst_type->device_id, strlen (p_dst_type->device_id))) { |
543 | printk("%s: recognize %s\n", __FUNCTION__, dsp->mstr); | 748 | use_type_flags = p_dst_type->type_flags; |
749 | use_dst_type = p_dst_type->dst_type; | ||
750 | |||
751 | /* Card capabilities */ | ||
752 | state->dst_hw_cap = p_dst_type->dst_feature; | ||
753 | printk ("%s: Recognise [%s]\n", __FUNCTION__, p_dst_type->device_id); | ||
754 | |||
544 | break; | 755 | break; |
545 | } | 756 | } |
546 | } | 757 | } |
547 | if (i >= sizeof(dst_tlist) / sizeof(dst_tlist[0])) { | 758 | |
548 | printk("%s: unable to recognize %s or %s\n", __FUNCTION__, &rxbuf[0], &rxbuf[1]); | 759 | if (i >= sizeof (dst_tlist) / sizeof (dst_tlist [0])) { |
549 | printk("%s please email linux-dvb@linuxtv.org with this type in\n", __FUNCTION__); | 760 | printk("%s: Unable to recognize %s or %s\n", __FUNCTION__, &state->rxbuffer[0], &state->rxbuffer[1]); |
761 | printk("%s: please email linux-dvb@linuxtv.org with this type in\n", __FUNCTION__); | ||
550 | use_dst_type = DST_TYPE_IS_SAT; | 762 | use_dst_type = DST_TYPE_IS_SAT; |
551 | use_type_flags = DST_TYPE_HAS_SYMDIV; | 763 | use_type_flags = DST_TYPE_HAS_SYMDIV; |
552 | } | 764 | } |
553 | dst_type_print(use_dst_type); | ||
554 | 765 | ||
766 | dst_type_print(use_dst_type); | ||
555 | state->type_flags = use_type_flags; | 767 | state->type_flags = use_type_flags; |
556 | state->dst_type = use_dst_type; | 768 | state->dst_type = use_dst_type; |
557 | dst_type_flags_print(state->type_flags); | 769 | dst_type_flags_print(state->type_flags); |
@@ -559,50 +771,102 @@ static int dst_check_ci(struct dst_state *state) | |||
559 | if (state->type_flags & DST_TYPE_HAS_TS204) { | 771 | if (state->type_flags & DST_TYPE_HAS_TS204) { |
560 | dst_packsize(state, 204); | 772 | dst_packsize(state, 204); |
561 | } | 773 | } |
774 | |||
562 | return 0; | 775 | return 0; |
563 | } | 776 | } |
564 | 777 | ||
565 | static int dst_command(struct dst_state* state, u8 * data, u8 len) | 778 | static int dst_probe(struct dst_state *state) |
779 | { | ||
780 | if ((rdc_8820_reset(state)) < 0) { | ||
781 | dprintk("%s: RDC 8820 RESET Failed.\n", __FUNCTION__); | ||
782 | return -1; | ||
783 | } | ||
784 | if (dst_addons & DST_TYPE_HAS_CA) | ||
785 | msleep(4000); | ||
786 | else | ||
787 | msleep(100); | ||
788 | |||
789 | if ((dst_comm_init(state)) < 0) { | ||
790 | dprintk("%s: DST Initialization Failed.\n", __FUNCTION__); | ||
791 | return -1; | ||
792 | } | ||
793 | msleep(100); | ||
794 | if (dst_get_device_id(state) < 0) { | ||
795 | dprintk("%s: unknown device.\n", __FUNCTION__); | ||
796 | return -1; | ||
797 | } | ||
798 | |||
799 | return 0; | ||
800 | } | ||
801 | |||
802 | int dst_command(struct dst_state* state, u8 * data, u8 len) | ||
566 | { | 803 | { |
567 | int retval; | ||
568 | u8 reply; | 804 | u8 reply; |
805 | if ((dst_comm_init(state)) < 0) { | ||
806 | dprintk("%s: DST Communication Initialization Failed.\n", __FUNCTION__); | ||
807 | return -1; | ||
808 | } | ||
569 | 809 | ||
570 | dst_i2c_enable(state); | 810 | if (write_dst(state, data, len)) { |
571 | dst_reset8820(state); | 811 | if (verbose > 1) |
572 | retval = write_dst(state, data, len); | 812 | dprintk("%s: Tring to recover.. \n", __FUNCTION__); |
573 | if (retval < 0) { | 813 | if ((dst_error_recovery(state)) < 0) { |
574 | dst_i2c_disable(state); | 814 | dprintk("%s: Recovery Failed.\n", __FUNCTION__); |
575 | dprintk("%s: write not successful\n", __FUNCTION__); | 815 | return -1; |
576 | return retval; | 816 | } |
817 | return -1; | ||
577 | } | 818 | } |
578 | msleep(33); | 819 | if ((dst_pio_disable(state)) < 0) { |
579 | retval = read_dst(state, &reply, 1); | 820 | dprintk("%s: PIO Disable Failed.\n", __FUNCTION__); |
580 | dst_i2c_disable(state); | 821 | return -1; |
581 | if (retval < 0) { | ||
582 | dprintk("%s: read verify not successful\n", __FUNCTION__); | ||
583 | return retval; | ||
584 | } | 822 | } |
585 | if (reply != 0xff) { | 823 | if (state->type_flags & DST_TYPE_HAS_FW_1) |
586 | dprintk("%s: write reply not 0xff 0x%02x \n", __FUNCTION__, reply); | 824 | udelay(3000); |
587 | return 0; | 825 | |
826 | if (read_dst(state, &reply, GET_ACK)) { | ||
827 | if (verbose > 1) | ||
828 | dprintk("%s: Trying to recover.. \n", __FUNCTION__); | ||
829 | if ((dst_error_recovery(state)) < 0) { | ||
830 | dprintk("%s: Recovery Failed.\n", __FUNCTION__); | ||
831 | return -1; | ||
832 | } | ||
833 | return -1; | ||
834 | } | ||
835 | |||
836 | if (reply != ACK) { | ||
837 | dprintk("%s: write not acknowledged 0x%02x \n", __FUNCTION__, reply); | ||
838 | return -1; | ||
588 | } | 839 | } |
589 | if (len >= 2 && data[0] == 0 && (data[1] == 1 || data[1] == 3)) | 840 | if (len >= 2 && data[0] == 0 && (data[1] == 1 || data[1] == 3)) |
590 | return 0; | 841 | return 0; |
591 | if (!dst_wait_dst_ready(state)) | 842 | |
592 | return 0; | 843 | // udelay(3000); |
593 | // dst_i2c_enable(i2c); Per dimitri | 844 | if (state->type_flags & DST_TYPE_HAS_FW_1) |
594 | retval = read_dst(state, state->rxbuffer, 8); | 845 | udelay(3000); |
595 | dst_i2c_disable(state); | 846 | else |
596 | if (retval < 0) { | 847 | udelay(2000); |
597 | dprintk("%s: read not successful\n", __FUNCTION__); | 848 | |
598 | return 0; | 849 | if (!dst_wait_dst_ready(state, NO_DELAY)) |
850 | return -1; | ||
851 | |||
852 | if (read_dst(state, state->rxbuffer, FIXED_COMM)) { | ||
853 | if (verbose > 1) | ||
854 | dprintk("%s: Trying to recover.. \n", __FUNCTION__); | ||
855 | if ((dst_error_recovery(state)) < 0) { | ||
856 | dprintk("%s: Recovery failed.\n", __FUNCTION__); | ||
857 | return -1; | ||
858 | } | ||
859 | return -1; | ||
599 | } | 860 | } |
861 | |||
600 | if (state->rxbuffer[7] != dst_check_sum(state->rxbuffer, 7)) { | 862 | if (state->rxbuffer[7] != dst_check_sum(state->rxbuffer, 7)) { |
601 | dprintk("%s: checksum failure\n", __FUNCTION__); | 863 | dprintk("%s: checksum failure\n", __FUNCTION__); |
602 | return 0; | 864 | return -1; |
603 | } | 865 | } |
866 | |||
604 | return 0; | 867 | return 0; |
605 | } | 868 | } |
869 | EXPORT_SYMBOL(dst_command); | ||
606 | 870 | ||
607 | static int dst_get_signal(struct dst_state* state) | 871 | static int dst_get_signal(struct dst_state* state) |
608 | { | 872 | { |
@@ -646,11 +910,17 @@ static int dst_tone_power_cmd(struct dst_state* state) | |||
646 | paket[4] = 0; | 910 | paket[4] = 0; |
647 | else | 911 | else |
648 | paket[4] = 1; | 912 | paket[4] = 1; |
913 | |||
649 | if (state->tone == SEC_TONE_ON) | 914 | if (state->tone == SEC_TONE_ON) |
650 | paket[2] = state->k22; | 915 | paket[2] = 0x02; |
651 | else | 916 | else |
652 | paket[2] = 0; | 917 | paket[2] = 0; |
653 | paket[7] = dst_check_sum(&paket[0], 7); | 918 | if (state->minicmd == SEC_MINI_A) |
919 | paket[3] = 0x02; | ||
920 | else | ||
921 | paket[3] = 0; | ||
922 | |||
923 | paket[7] = dst_check_sum (paket, 7); | ||
654 | dst_command(state, paket, 8); | 924 | dst_command(state, paket, 8); |
655 | return 0; | 925 | return 0; |
656 | } | 926 | } |
@@ -658,21 +928,26 @@ static int dst_tone_power_cmd(struct dst_state* state) | |||
658 | static int dst_get_tuna(struct dst_state* state) | 928 | static int dst_get_tuna(struct dst_state* state) |
659 | { | 929 | { |
660 | int retval; | 930 | int retval; |
931 | |||
661 | if ((state->diseq_flags & ATTEMPT_TUNE) == 0) | 932 | if ((state->diseq_flags & ATTEMPT_TUNE) == 0) |
662 | return 0; | 933 | return 0; |
934 | |||
663 | state->diseq_flags &= ~(HAS_LOCK); | 935 | state->diseq_flags &= ~(HAS_LOCK); |
664 | if (!dst_wait_dst_ready(state)) | 936 | if (!dst_wait_dst_ready(state, NO_DELAY)) |
665 | return 0; | 937 | return 0; |
938 | |||
666 | if (state->type_flags & DST_TYPE_HAS_NEWTUNE) { | 939 | if (state->type_flags & DST_TYPE_HAS_NEWTUNE) { |
667 | /* how to get variable length reply ???? */ | 940 | /* how to get variable length reply ???? */ |
668 | retval = read_dst(state, state->rx_tuna, 10); | 941 | retval = read_dst(state, state->rx_tuna, 10); |
669 | } else { | 942 | } else { |
670 | retval = read_dst(state, &state->rx_tuna[2], 8); | 943 | retval = read_dst(state, &state->rx_tuna[2], FIXED_COMM); |
671 | } | 944 | } |
945 | |||
672 | if (retval < 0) { | 946 | if (retval < 0) { |
673 | dprintk("%s: read not successful\n", __FUNCTION__); | 947 | dprintk("%s: read not successful\n", __FUNCTION__); |
674 | return 0; | 948 | return 0; |
675 | } | 949 | } |
950 | |||
676 | if (state->type_flags & DST_TYPE_HAS_NEWTUNE) { | 951 | if (state->type_flags & DST_TYPE_HAS_NEWTUNE) { |
677 | if (state->rx_tuna[9] != dst_check_sum(&state->rx_tuna[0], 9)) { | 952 | if (state->rx_tuna[9] != dst_check_sum(&state->rx_tuna[0], 9)) { |
678 | dprintk("%s: checksum failure?\n", __FUNCTION__); | 953 | dprintk("%s: checksum failure?\n", __FUNCTION__); |
@@ -709,7 +984,9 @@ static int dst_write_tuna(struct dvb_frontend* fe) | |||
709 | int retval; | 984 | int retval; |
710 | u8 reply; | 985 | u8 reply; |
711 | 986 | ||
712 | dprintk("%s: type_flags 0x%x \n", __FUNCTION__, state->type_flags); | 987 | if (debug > 4) |
988 | dprintk("%s: type_flags 0x%x \n", __FUNCTION__, state->type_flags); | ||
989 | |||
713 | state->decode_freq = 0; | 990 | state->decode_freq = 0; |
714 | state->decode_lock = state->decode_strength = state->decode_snr = 0; | 991 | state->decode_lock = state->decode_strength = state->decode_snr = 0; |
715 | if (state->dst_type == DST_TYPE_IS_SAT) { | 992 | if (state->dst_type == DST_TYPE_IS_SAT) { |
@@ -717,32 +994,41 @@ static int dst_write_tuna(struct dvb_frontend* fe) | |||
717 | dst_set_voltage(fe, SEC_VOLTAGE_13); | 994 | dst_set_voltage(fe, SEC_VOLTAGE_13); |
718 | } | 995 | } |
719 | state->diseq_flags &= ~(HAS_LOCK | ATTEMPT_TUNE); | 996 | state->diseq_flags &= ~(HAS_LOCK | ATTEMPT_TUNE); |
720 | dst_i2c_enable(state); | 997 | |
998 | if ((dst_comm_init(state)) < 0) { | ||
999 | dprintk("%s: DST Communication initialization failed.\n", __FUNCTION__); | ||
1000 | return -1; | ||
1001 | } | ||
1002 | |||
721 | if (state->type_flags & DST_TYPE_HAS_NEWTUNE) { | 1003 | if (state->type_flags & DST_TYPE_HAS_NEWTUNE) { |
722 | dst_reset8820(state); | ||
723 | state->tx_tuna[9] = dst_check_sum(&state->tx_tuna[0], 9); | 1004 | state->tx_tuna[9] = dst_check_sum(&state->tx_tuna[0], 9); |
724 | retval = write_dst(state, &state->tx_tuna[0], 10); | 1005 | retval = write_dst(state, &state->tx_tuna[0], 10); |
1006 | |||
725 | } else { | 1007 | } else { |
726 | state->tx_tuna[9] = dst_check_sum(&state->tx_tuna[2], 7); | 1008 | state->tx_tuna[9] = dst_check_sum(&state->tx_tuna[2], 7); |
727 | retval = write_dst(state, &state->tx_tuna[2], 8); | 1009 | retval = write_dst(state, &state->tx_tuna[2], FIXED_COMM); |
728 | } | 1010 | } |
729 | if (retval < 0) { | 1011 | if (retval < 0) { |
730 | dst_i2c_disable(state); | 1012 | dst_pio_disable(state); |
731 | dprintk("%s: write not successful\n", __FUNCTION__); | 1013 | dprintk("%s: write not successful\n", __FUNCTION__); |
732 | return retval; | 1014 | return retval; |
733 | } | 1015 | } |
734 | msleep(3); | 1016 | |
735 | retval = read_dst(state, &reply, 1); | 1017 | if ((dst_pio_disable(state)) < 0) { |
736 | dst_i2c_disable(state); | 1018 | dprintk("%s: DST PIO disable failed !\n", __FUNCTION__); |
737 | if (retval < 0) { | 1019 | return -1; |
738 | dprintk("%s: read verify not successful\n", __FUNCTION__); | 1020 | } |
739 | return retval; | 1021 | |
1022 | if ((read_dst(state, &reply, GET_ACK) < 0)) { | ||
1023 | dprintk("%s: read verify not successful.\n", __FUNCTION__); | ||
1024 | return -1; | ||
740 | } | 1025 | } |
741 | if (reply != 0xff) { | 1026 | if (reply != ACK) { |
742 | dprintk("%s: write reply not 0xff 0x%02x \n", __FUNCTION__, reply); | 1027 | dprintk("%s: write not acknowledged 0x%02x \n", __FUNCTION__, reply); |
743 | return 0; | 1028 | return 0; |
744 | } | 1029 | } |
745 | state->diseq_flags |= ATTEMPT_TUNE; | 1030 | state->diseq_flags |= ATTEMPT_TUNE; |
1031 | |||
746 | return dst_get_tuna(state); | 1032 | return dst_get_tuna(state); |
747 | } | 1033 | } |
748 | 1034 | ||
@@ -796,22 +1082,25 @@ static int dst_set_voltage(struct dvb_frontend* fe, fe_sec_voltage_t voltage) | |||
796 | need_cmd = 1; | 1082 | need_cmd = 1; |
797 | state->diseq_flags |= HAS_POWER; | 1083 | state->diseq_flags |= HAS_POWER; |
798 | break; | 1084 | break; |
1085 | |||
799 | case SEC_VOLTAGE_18: | 1086 | case SEC_VOLTAGE_18: |
800 | if ((state->diseq_flags & HAS_POWER) == 0) | 1087 | if ((state->diseq_flags & HAS_POWER) == 0) |
801 | need_cmd = 1; | 1088 | need_cmd = 1; |
802 | state->diseq_flags |= HAS_POWER; | 1089 | state->diseq_flags |= HAS_POWER; |
803 | val[8] |= 0x40; | 1090 | val[8] |= 0x40; |
804 | break; | 1091 | break; |
1092 | |||
805 | case SEC_VOLTAGE_OFF: | 1093 | case SEC_VOLTAGE_OFF: |
806 | need_cmd = 1; | 1094 | need_cmd = 1; |
807 | state->diseq_flags &= ~(HAS_POWER | HAS_LOCK | ATTEMPT_TUNE); | 1095 | state->diseq_flags &= ~(HAS_POWER | HAS_LOCK | ATTEMPT_TUNE); |
808 | break; | 1096 | break; |
1097 | |||
809 | default: | 1098 | default: |
810 | return -EINVAL; | 1099 | return -EINVAL; |
811 | } | 1100 | } |
812 | if (need_cmd) { | 1101 | if (need_cmd) |
813 | dst_tone_power_cmd(state); | 1102 | dst_tone_power_cmd(state); |
814 | } | 1103 | |
815 | return 0; | 1104 | return 0; |
816 | } | 1105 | } |
817 | 1106 | ||
@@ -832,13 +1121,16 @@ static int dst_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone) | |||
832 | switch (tone) { | 1121 | switch (tone) { |
833 | case SEC_TONE_OFF: | 1122 | case SEC_TONE_OFF: |
834 | break; | 1123 | break; |
1124 | |||
835 | case SEC_TONE_ON: | 1125 | case SEC_TONE_ON: |
836 | val[8] |= 1; | 1126 | val[8] |= 1; |
837 | break; | 1127 | break; |
1128 | |||
838 | default: | 1129 | default: |
839 | return -EINVAL; | 1130 | return -EINVAL; |
840 | } | 1131 | } |
841 | dst_tone_power_cmd(state); | 1132 | dst_tone_power_cmd(state); |
1133 | |||
842 | return 0; | 1134 | return 0; |
843 | } | 1135 | } |
844 | 1136 | ||
@@ -913,10 +1205,16 @@ static int dst_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_paramet | |||
913 | struct dst_state* state = (struct dst_state*) fe->demodulator_priv; | 1205 | struct dst_state* state = (struct dst_state*) fe->demodulator_priv; |
914 | 1206 | ||
915 | dst_set_freq(state, p->frequency); | 1207 | dst_set_freq(state, p->frequency); |
1208 | if (verbose > 4) | ||
1209 | dprintk("Set Frequency = [%d]\n", p->frequency); | ||
1210 | |||
916 | dst_set_inversion(state, p->inversion); | 1211 | dst_set_inversion(state, p->inversion); |
917 | if (state->dst_type == DST_TYPE_IS_SAT) { | 1212 | if (state->dst_type == DST_TYPE_IS_SAT) { |
918 | dst_set_fec(state, p->u.qpsk.fec_inner); | 1213 | dst_set_fec(state, p->u.qpsk.fec_inner); |
919 | dst_set_symbolrate(state, p->u.qpsk.symbol_rate); | 1214 | dst_set_symbolrate(state, p->u.qpsk.symbol_rate); |
1215 | if (verbose > 4) | ||
1216 | dprintk("Set Symbolrate = [%d]\n", p->u.qpsk.symbol_rate); | ||
1217 | |||
920 | } else if (state->dst_type == DST_TYPE_IS_TERR) { | 1218 | } else if (state->dst_type == DST_TYPE_IS_TERR) { |
921 | dst_set_bandwidth(state, p->u.ofdm.bandwidth); | 1219 | dst_set_bandwidth(state, p->u.ofdm.bandwidth); |
922 | } else if (state->dst_type == DST_TYPE_IS_CABLE) { | 1220 | } else if (state->dst_type == DST_TYPE_IS_CABLE) { |
@@ -958,50 +1256,47 @@ static struct dvb_frontend_ops dst_dvbt_ops; | |||
958 | static struct dvb_frontend_ops dst_dvbs_ops; | 1256 | static struct dvb_frontend_ops dst_dvbs_ops; |
959 | static struct dvb_frontend_ops dst_dvbc_ops; | 1257 | static struct dvb_frontend_ops dst_dvbc_ops; |
960 | 1258 | ||
961 | struct dvb_frontend* dst_attach(const struct dst_config* config, | 1259 | struct dst_state* dst_attach(struct dst_state *state, struct dvb_adapter *dvb_adapter) |
962 | struct i2c_adapter* i2c, | ||
963 | struct bt878 *bt) | ||
964 | { | 1260 | { |
965 | struct dst_state* state = NULL; | ||
966 | |||
967 | /* allocate memory for the internal state */ | ||
968 | state = (struct dst_state*) kmalloc(sizeof(struct dst_state), GFP_KERNEL); | ||
969 | if (state == NULL) goto error; | ||
970 | 1261 | ||
971 | /* setup the state */ | 1262 | /* check if the ASIC is there */ |
972 | state->config = config; | 1263 | if (dst_probe(state) < 0) { |
973 | state->i2c = i2c; | 1264 | if (state) |
974 | state->bt = bt; | 1265 | kfree(state); |
975 | |||
976 | /* check if the demod is there */ | ||
977 | if (dst_check_ci(state) < 0) goto error; | ||
978 | 1266 | ||
1267 | return NULL; | ||
1268 | } | ||
979 | /* determine settings based on type */ | 1269 | /* determine settings based on type */ |
980 | switch (state->dst_type) { | 1270 | switch (state->dst_type) { |
981 | case DST_TYPE_IS_TERR: | 1271 | case DST_TYPE_IS_TERR: |
982 | memcpy(&state->ops, &dst_dvbt_ops, sizeof(struct dvb_frontend_ops)); | 1272 | memcpy(&state->ops, &dst_dvbt_ops, sizeof(struct dvb_frontend_ops)); |
983 | break; | 1273 | break; |
1274 | |||
984 | case DST_TYPE_IS_CABLE: | 1275 | case DST_TYPE_IS_CABLE: |
985 | memcpy(&state->ops, &dst_dvbc_ops, sizeof(struct dvb_frontend_ops)); | 1276 | memcpy(&state->ops, &dst_dvbc_ops, sizeof(struct dvb_frontend_ops)); |
986 | break; | 1277 | break; |
1278 | |||
987 | case DST_TYPE_IS_SAT: | 1279 | case DST_TYPE_IS_SAT: |
988 | memcpy(&state->ops, &dst_dvbs_ops, sizeof(struct dvb_frontend_ops)); | 1280 | memcpy(&state->ops, &dst_dvbs_ops, sizeof(struct dvb_frontend_ops)); |
989 | break; | 1281 | break; |
1282 | |||
990 | default: | 1283 | default: |
991 | printk("dst: unknown frontend type. please report to the LinuxTV.org DVB mailinglist.\n"); | 1284 | printk("%s: unknown DST type. please report to the LinuxTV.org DVB mailinglist.\n", __FUNCTION__); |
992 | goto error; | 1285 | if (state) |
1286 | kfree(state); | ||
1287 | |||
1288 | return NULL; | ||
993 | } | 1289 | } |
994 | 1290 | ||
995 | /* create dvb_frontend */ | 1291 | /* create dvb_frontend */ |
996 | state->frontend.ops = &state->ops; | 1292 | state->frontend.ops = &state->ops; |
997 | state->frontend.demodulator_priv = state; | 1293 | state->frontend.demodulator_priv = state; |
998 | return &state->frontend; | ||
999 | 1294 | ||
1000 | error: | 1295 | return state; /* Manu (DST is a card not a frontend) */ |
1001 | kfree(state); | ||
1002 | return NULL; | ||
1003 | } | 1296 | } |
1004 | 1297 | ||
1298 | EXPORT_SYMBOL(dst_attach); | ||
1299 | |||
1005 | static struct dvb_frontend_ops dst_dvbt_ops = { | 1300 | static struct dvb_frontend_ops dst_dvbt_ops = { |
1006 | 1301 | ||
1007 | .info = { | 1302 | .info = { |
@@ -1051,6 +1346,7 @@ static struct dvb_frontend_ops dst_dvbs_ops = { | |||
1051 | .read_signal_strength = dst_read_signal_strength, | 1346 | .read_signal_strength = dst_read_signal_strength, |
1052 | .read_snr = dst_read_snr, | 1347 | .read_snr = dst_read_snr, |
1053 | 1348 | ||
1349 | .diseqc_send_burst = dst_set_tone, | ||
1054 | .diseqc_send_master_cmd = dst_set_diseqc, | 1350 | .diseqc_send_master_cmd = dst_set_diseqc, |
1055 | .set_voltage = dst_set_voltage, | 1351 | .set_voltage = dst_set_voltage, |
1056 | .set_tone = dst_set_tone, | 1352 | .set_tone = dst_set_tone, |
@@ -1082,8 +1378,7 @@ static struct dvb_frontend_ops dst_dvbc_ops = { | |||
1082 | .read_snr = dst_read_snr, | 1378 | .read_snr = dst_read_snr, |
1083 | }; | 1379 | }; |
1084 | 1380 | ||
1381 | |||
1085 | MODULE_DESCRIPTION("DST DVB-S/T/C Combo Frontend driver"); | 1382 | MODULE_DESCRIPTION("DST DVB-S/T/C Combo Frontend driver"); |
1086 | MODULE_AUTHOR("Jamie Honan"); | 1383 | MODULE_AUTHOR("Jamie Honan, Manu Abraham"); |
1087 | MODULE_LICENSE("GPL"); | 1384 | MODULE_LICENSE("GPL"); |
1088 | |||
1089 | EXPORT_SYMBOL(dst_attach); | ||
diff --git a/drivers/media/dvb/bt8xx/dst.h b/drivers/media/dvb/bt8xx/dst.h deleted file mode 100644 index bcb418c5c121..000000000000 --- a/drivers/media/dvb/bt8xx/dst.h +++ /dev/null | |||
@@ -1,40 +0,0 @@ | |||
1 | /* | ||
2 | Frontend-driver for TwinHan DST Frontend | ||
3 | |||
4 | Copyright (C) 2003 Jamie Honan | ||
5 | |||
6 | This program is free software; you can redistribute it and/or modify | ||
7 | it under the terms of the GNU General Public License as published by | ||
8 | the Free Software Foundation; either version 2 of the License, or | ||
9 | (at your option) any later version. | ||
10 | |||
11 | This program is distributed in the hope that it will be useful, | ||
12 | but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
13 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
14 | |||
15 | GNU General Public License for more details. | ||
16 | |||
17 | You should have received a copy of the GNU General Public License | ||
18 | along with this program; if not, write to the Free Software | ||
19 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
20 | |||
21 | */ | ||
22 | |||
23 | #ifndef DST_H | ||
24 | #define DST_H | ||
25 | |||
26 | #include <linux/dvb/frontend.h> | ||
27 | #include <linux/device.h> | ||
28 | #include "bt878.h" | ||
29 | |||
30 | struct dst_config | ||
31 | { | ||
32 | /* the demodulator's i2c address */ | ||
33 | u8 demod_address; | ||
34 | }; | ||
35 | |||
36 | extern struct dvb_frontend* dst_attach(const struct dst_config* config, | ||
37 | struct i2c_adapter* i2c, | ||
38 | struct bt878 *bt); | ||
39 | |||
40 | #endif // DST_H | ||
diff --git a/drivers/media/dvb/bt8xx/dst_ca.c b/drivers/media/dvb/bt8xx/dst_ca.c new file mode 100644 index 000000000000..d781504cc2fa --- /dev/null +++ b/drivers/media/dvb/bt8xx/dst_ca.c | |||
@@ -0,0 +1,861 @@ | |||
1 | /* | ||
2 | CA-driver for TwinHan DST Frontend/Card | ||
3 | |||
4 | Copyright (C) 2004, 2005 Manu Abraham (manu@kromtek.com) | ||
5 | |||
6 | This program is free software; you can redistribute it and/or modify | ||
7 | it under the terms of the GNU General Public License as published by | ||
8 | the Free Software Foundation; either version 2 of the License, or | ||
9 | (at your option) any later version. | ||
10 | |||
11 | This program is distributed in the hope that it will be useful, | ||
12 | but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
13 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
14 | GNU General Public License for more details. | ||
15 | |||
16 | You should have received a copy of the GNU General Public License | ||
17 | along with this program; if not, write to the Free Software | ||
18 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
19 | */ | ||
20 | |||
21 | |||
22 | |||
23 | #include <linux/kernel.h> | ||
24 | #include <linux/module.h> | ||
25 | #include <linux/init.h> | ||
26 | #include <linux/string.h> | ||
27 | |||
28 | #include <linux/dvb/ca.h> | ||
29 | #include "dvbdev.h" | ||
30 | #include "dvb_frontend.h" | ||
31 | |||
32 | #include "dst_ca.h" | ||
33 | #include "dst_common.h" | ||
34 | |||
35 | static unsigned int verbose = 1; | ||
36 | module_param(verbose, int, 0644); | ||
37 | MODULE_PARM_DESC(verbose, "verbose startup messages, default is 1 (yes)"); | ||
38 | |||
39 | static unsigned int debug = 1; | ||
40 | module_param(debug, int, 0644); | ||
41 | MODULE_PARM_DESC(debug, "debug messages, default is 1 (yes)"); | ||
42 | |||
43 | #define dprintk if (debug) printk | ||
44 | |||
45 | /* Need some more work */ | ||
46 | static int ca_set_slot_descr(void) | ||
47 | { | ||
48 | /* We could make this more graceful ? */ | ||
49 | return -EOPNOTSUPP; | ||
50 | } | ||
51 | |||
52 | /* Need some more work */ | ||
53 | static int ca_set_pid(void) | ||
54 | { | ||
55 | /* We could make this more graceful ? */ | ||
56 | return -EOPNOTSUPP; | ||
57 | } | ||
58 | |||
59 | |||
60 | static int put_checksum(u8 *check_string, int length) | ||
61 | { | ||
62 | u8 i = 0, checksum = 0; | ||
63 | |||
64 | if (verbose > 3) { | ||
65 | dprintk("%s: ========================= Checksum calculation ===========================\n", __FUNCTION__); | ||
66 | dprintk("%s: String Length=[0x%02x]\n", __FUNCTION__, length); | ||
67 | |||
68 | dprintk("%s: String=[", __FUNCTION__); | ||
69 | } | ||
70 | while (i < length) { | ||
71 | if (verbose > 3) | ||
72 | dprintk(" %02x", check_string[i]); | ||
73 | checksum += check_string[i]; | ||
74 | i++; | ||
75 | } | ||
76 | if (verbose > 3) { | ||
77 | dprintk(" ]\n"); | ||
78 | dprintk("%s: Sum=[%02x]\n", __FUNCTION__, checksum); | ||
79 | } | ||
80 | check_string[length] = ~checksum + 1; | ||
81 | if (verbose > 3) { | ||
82 | dprintk("%s: Checksum=[%02x]\n", __FUNCTION__, check_string[length]); | ||
83 | dprintk("%s: ==========================================================================\n", __FUNCTION__); | ||
84 | } | ||
85 | |||
86 | return 0; | ||
87 | } | ||
88 | |||
89 | static int dst_ci_command(struct dst_state* state, u8 * data, u8 *ca_string, u8 len, int read) | ||
90 | { | ||
91 | u8 reply; | ||
92 | |||
93 | dst_comm_init(state); | ||
94 | msleep(65); | ||
95 | |||
96 | if (write_dst(state, data, len)) { | ||
97 | dprintk("%s: Write not successful, trying to recover\n", __FUNCTION__); | ||
98 | dst_error_recovery(state); | ||
99 | return -1; | ||
100 | } | ||
101 | |||
102 | if ((dst_pio_disable(state)) < 0) { | ||
103 | dprintk("%s: DST PIO disable failed.\n", __FUNCTION__); | ||
104 | return -1; | ||
105 | } | ||
106 | |||
107 | if (read_dst(state, &reply, GET_ACK) < 0) { | ||
108 | dprintk("%s: Read not successful, trying to recover\n", __FUNCTION__); | ||
109 | dst_error_recovery(state); | ||
110 | return -1; | ||
111 | } | ||
112 | |||
113 | if (read) { | ||
114 | if (! dst_wait_dst_ready(state, LONG_DELAY)) { | ||
115 | dprintk("%s: 8820 not ready\n", __FUNCTION__); | ||
116 | return -1; | ||
117 | } | ||
118 | |||
119 | if (read_dst(state, ca_string, 128) < 0) { /* Try to make this dynamic */ | ||
120 | dprintk("%s: Read not successful, trying to recover\n", __FUNCTION__); | ||
121 | dst_error_recovery(state); | ||
122 | return -1; | ||
123 | } | ||
124 | } | ||
125 | |||
126 | return 0; | ||
127 | } | ||
128 | |||
129 | |||
130 | static int dst_put_ci(struct dst_state *state, u8 *data, int len, u8 *ca_string, int read) | ||
131 | { | ||
132 | u8 dst_ca_comm_err = 0; | ||
133 | |||
134 | while (dst_ca_comm_err < RETRIES) { | ||
135 | dst_comm_init(state); | ||
136 | if (verbose > 2) | ||
137 | dprintk("%s: Put Command\n", __FUNCTION__); | ||
138 | if (dst_ci_command(state, data, ca_string, len, read)) { // If error | ||
139 | dst_error_recovery(state); | ||
140 | dst_ca_comm_err++; // work required here. | ||
141 | } | ||
142 | break; | ||
143 | } | ||
144 | |||
145 | return 0; | ||
146 | } | ||
147 | |||
148 | |||
149 | |||
150 | static int ca_get_app_info(struct dst_state *state) | ||
151 | { | ||
152 | static u8 command[8] = {0x07, 0x40, 0x01, 0x00, 0x01, 0x00, 0x00, 0xff}; | ||
153 | |||
154 | put_checksum(&command[0], command[0]); | ||
155 | if ((dst_put_ci(state, command, sizeof(command), state->messages, GET_REPLY)) < 0) { | ||
156 | dprintk("%s: -->dst_put_ci FAILED !\n", __FUNCTION__); | ||
157 | return -1; | ||
158 | } | ||
159 | if (verbose > 1) { | ||
160 | dprintk("%s: -->dst_put_ci SUCCESS !\n", __FUNCTION__); | ||
161 | |||
162 | dprintk("%s: ================================ CI Module Application Info ======================================\n", __FUNCTION__); | ||
163 | dprintk("%s: Application Type=[%d], Application Vendor=[%d], Vendor Code=[%d]\n%s: Application info=[%s]\n", | ||
164 | __FUNCTION__, state->messages[7], (state->messages[8] << 8) | state->messages[9], | ||
165 | (state->messages[10] << 8) | state->messages[11], __FUNCTION__, (char *)(&state->messages[12])); | ||
166 | dprintk("%s: ==================================================================================================\n", __FUNCTION__); | ||
167 | } | ||
168 | |||
169 | return 0; | ||
170 | } | ||
171 | |||
172 | static int ca_get_slot_caps(struct dst_state *state, struct ca_caps *p_ca_caps, void *arg) | ||
173 | { | ||
174 | int i; | ||
175 | u8 slot_cap[256]; | ||
176 | static u8 slot_command[8] = {0x07, 0x40, 0x02, 0x00, 0x02, 0x00, 0x00, 0xff}; | ||
177 | |||
178 | put_checksum(&slot_command[0], slot_command[0]); | ||
179 | if ((dst_put_ci(state, slot_command, sizeof (slot_command), slot_cap, GET_REPLY)) < 0) { | ||
180 | dprintk("%s: -->dst_put_ci FAILED !\n", __FUNCTION__); | ||
181 | return -1; | ||
182 | } | ||
183 | if (verbose > 1) | ||
184 | dprintk("%s: -->dst_put_ci SUCCESS !\n", __FUNCTION__); | ||
185 | |||
186 | /* Will implement the rest soon */ | ||
187 | |||
188 | if (verbose > 1) { | ||
189 | dprintk("%s: Slot cap = [%d]\n", __FUNCTION__, slot_cap[7]); | ||
190 | dprintk("===================================\n"); | ||
191 | for (i = 0; i < 8; i++) | ||
192 | dprintk(" %d", slot_cap[i]); | ||
193 | dprintk("\n"); | ||
194 | } | ||
195 | |||
196 | p_ca_caps->slot_num = 1; | ||
197 | p_ca_caps->slot_type = 1; | ||
198 | p_ca_caps->descr_num = slot_cap[7]; | ||
199 | p_ca_caps->descr_type = 1; | ||
200 | |||
201 | |||
202 | if (copy_to_user((struct ca_caps *)arg, p_ca_caps, sizeof (struct ca_caps))) { | ||
203 | return -EFAULT; | ||
204 | } | ||
205 | |||
206 | return 0; | ||
207 | } | ||
208 | |||
209 | /* Need some more work */ | ||
210 | static int ca_get_slot_descr(struct dst_state *state, struct ca_msg *p_ca_message, void *arg) | ||
211 | { | ||
212 | return -EOPNOTSUPP; | ||
213 | } | ||
214 | |||
215 | |||
216 | static int ca_get_slot_info(struct dst_state *state, struct ca_slot_info *p_ca_slot_info, void *arg) | ||
217 | { | ||
218 | int i; | ||
219 | static u8 slot_command[8] = {0x00, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff}; | ||
220 | |||
221 | u8 *slot_info = state->rxbuffer; | ||
222 | |||
223 | put_checksum(&slot_command[0], 7); | ||
224 | if ((dst_put_ci(state, slot_command, sizeof (slot_command), slot_info, GET_REPLY)) < 0) { | ||
225 | dprintk("%s: -->dst_put_ci FAILED !\n", __FUNCTION__); | ||
226 | return -1; | ||
227 | } | ||
228 | if (verbose > 1) | ||
229 | dprintk("%s: -->dst_put_ci SUCCESS !\n", __FUNCTION__); | ||
230 | |||
231 | /* Will implement the rest soon */ | ||
232 | |||
233 | if (verbose > 1) { | ||
234 | dprintk("%s: Slot info = [%d]\n", __FUNCTION__, slot_info[3]); | ||
235 | dprintk("===================================\n"); | ||
236 | for (i = 0; i < 8; i++) | ||
237 | dprintk(" %d", slot_info[i]); | ||
238 | dprintk("\n"); | ||
239 | } | ||
240 | |||
241 | if (slot_info[4] & 0x80) { | ||
242 | p_ca_slot_info->flags = CA_CI_MODULE_PRESENT; | ||
243 | p_ca_slot_info->num = 1; | ||
244 | p_ca_slot_info->type = CA_CI; | ||
245 | } | ||
246 | else if (slot_info[4] & 0x40) { | ||
247 | p_ca_slot_info->flags = CA_CI_MODULE_READY; | ||
248 | p_ca_slot_info->num = 1; | ||
249 | p_ca_slot_info->type = CA_CI; | ||
250 | } | ||
251 | else { | ||
252 | p_ca_slot_info->flags = 0; | ||
253 | } | ||
254 | |||
255 | if (copy_to_user((struct ca_slot_info *)arg, p_ca_slot_info, sizeof (struct ca_slot_info))) { | ||
256 | return -EFAULT; | ||
257 | } | ||
258 | |||
259 | return 0; | ||
260 | } | ||
261 | |||
262 | |||
263 | |||
264 | |||
265 | static int ca_get_message(struct dst_state *state, struct ca_msg *p_ca_message, void *arg) | ||
266 | { | ||
267 | u8 i = 0; | ||
268 | u32 command = 0; | ||
269 | |||
270 | if (copy_from_user(p_ca_message, (void *)arg, sizeof (struct ca_msg))) | ||
271 | return -EFAULT; | ||
272 | |||
273 | |||
274 | if (p_ca_message->msg) { | ||
275 | if (verbose > 3) | ||
276 | dprintk("Message = [%02x %02x %02x]\n", p_ca_message->msg[0], p_ca_message->msg[1], p_ca_message->msg[2]); | ||
277 | |||
278 | for (i = 0; i < 3; i++) { | ||
279 | command = command | p_ca_message->msg[i]; | ||
280 | if (i < 2) | ||
281 | command = command << 8; | ||
282 | } | ||
283 | if (verbose > 3) | ||
284 | dprintk("%s:Command=[0x%x]\n", __FUNCTION__, command); | ||
285 | |||
286 | switch (command) { | ||
287 | case CA_APP_INFO: | ||
288 | memcpy(p_ca_message->msg, state->messages, 128); | ||
289 | if (copy_to_user((void *)arg, p_ca_message, sizeof (struct ca_msg)) ) | ||
290 | return -EFAULT; | ||
291 | break; | ||
292 | } | ||
293 | } | ||
294 | |||
295 | return 0; | ||
296 | } | ||
297 | |||
298 | static int handle_en50221_tag(struct dst_state *state, struct ca_msg *p_ca_message, struct ca_msg *hw_buffer) | ||
299 | { | ||
300 | if (state->dst_hw_cap & DST_TYPE_HAS_SESSION) { | ||
301 | hw_buffer->msg[2] = p_ca_message->msg[1]; /* MSB */ | ||
302 | hw_buffer->msg[3] = p_ca_message->msg[2]; /* LSB */ | ||
303 | } | ||
304 | else { | ||
305 | hw_buffer->msg[2] = 0x03; | ||
306 | hw_buffer->msg[3] = 0x00; | ||
307 | } | ||
308 | return 0; | ||
309 | } | ||
310 | |||
311 | static int debug_8820_buffer(struct ca_msg *hw_buffer) | ||
312 | { | ||
313 | unsigned int i; | ||
314 | |||
315 | dprintk("%s:Debug=[", __FUNCTION__); | ||
316 | for (i = 0; i < (hw_buffer->msg[0] + 1); i++) | ||
317 | dprintk(" %02x", hw_buffer->msg[i]); | ||
318 | dprintk("]\n"); | ||
319 | |||
320 | return 0; | ||
321 | } | ||
322 | |||
323 | static int write_to_8820(struct dst_state *state, struct ca_msg *hw_buffer, u8 reply) | ||
324 | { | ||
325 | if ((dst_put_ci(state, hw_buffer->msg, (hw_buffer->length + 1), hw_buffer->msg, reply)) < 0) { | ||
326 | dprintk("%s: DST-CI Command failed.\n", __FUNCTION__); | ||
327 | dprintk("%s: Resetting DST.\n", __FUNCTION__); | ||
328 | rdc_reset_state(state); | ||
329 | return -1; | ||
330 | } | ||
331 | if (verbose > 2) | ||
332 | dprintk("%s: DST-CI Command succes.\n", __FUNCTION__); | ||
333 | |||
334 | return 0; | ||
335 | } | ||
336 | |||
337 | |||
338 | static int ca_set_pmt(struct dst_state *state, struct ca_msg *p_ca_message, struct ca_msg *hw_buffer, u8 reply, u8 query) | ||
339 | { | ||
340 | u32 hw_offset, buf_offset, i, k; | ||
341 | u32 program_info_length = 0, es_info_length = 0, length = 0, words = 0; | ||
342 | u8 found_prog_ca_desc = 0, found_stream_ca_desc = 0, error_condition = 0, hw_buffer_length = 0; | ||
343 | |||
344 | if (verbose > 3) | ||
345 | dprintk("%s, p_ca_message length %d (0x%x)\n", __FUNCTION__,p_ca_message->length,p_ca_message->length ); | ||
346 | |||
347 | handle_en50221_tag(state, p_ca_message, hw_buffer); /* EN50221 tag */ | ||
348 | |||
349 | /* Handle the length field (variable) */ | ||
350 | if (!(p_ca_message->msg[3] & 0x80)) { /* Length = 1 */ | ||
351 | length = p_ca_message->msg[3] & 0x7f; | ||
352 | words = 0; /* domi's suggestion */ | ||
353 | } | ||
354 | else { /* Length = words */ | ||
355 | words = p_ca_message->msg[3] & 0x7f; | ||
356 | for (i = 0; i < words; i++) { | ||
357 | length = length << 8; | ||
358 | length = length | p_ca_message->msg[4 + i]; | ||
359 | } | ||
360 | } | ||
361 | if (verbose > 4) { | ||
362 | dprintk("%s:Length=[%d (0x%x)], Words=[%d]\n", __FUNCTION__, length,length, words); | ||
363 | |||
364 | /* Debug Input string */ | ||
365 | for (i = 0; i < length; i++) | ||
366 | dprintk(" %02x", p_ca_message->msg[i]); | ||
367 | dprintk("]\n"); | ||
368 | } | ||
369 | |||
370 | hw_offset = 7; | ||
371 | buf_offset = words + 4; | ||
372 | |||
373 | /* Program Header */ | ||
374 | if (verbose > 4) | ||
375 | dprintk("\n%s:Program Header=[", __FUNCTION__); | ||
376 | for (i = 0; i < 6; i++) { | ||
377 | hw_buffer->msg[hw_offset] = p_ca_message->msg[buf_offset]; | ||
378 | if (verbose > 4) | ||
379 | dprintk(" %02x", p_ca_message->msg[buf_offset]); | ||
380 | hw_offset++, buf_offset++, hw_buffer_length++; | ||
381 | } | ||
382 | if (verbose > 4) | ||
383 | dprintk("]\n"); | ||
384 | |||
385 | program_info_length = 0; | ||
386 | program_info_length = (((program_info_length | p_ca_message->msg[words + 8]) & 0x0f) << 8) | p_ca_message->msg[words + 9]; | ||
387 | if (verbose > 4) | ||
388 | dprintk("%s:Program info Length=[%d][%02x], hw_offset=[%d], buf_offset=[%d] \n", | ||
389 | __FUNCTION__, program_info_length, program_info_length, hw_offset, buf_offset); | ||
390 | |||
391 | if (program_info_length && (program_info_length < 256)) { /* If program_info_length */ | ||
392 | hw_buffer->msg[11] = hw_buffer->msg[11] & 0x0f; /* req only 4 bits */ | ||
393 | hw_buffer->msg[12] = hw_buffer->msg[12] + 1; /* increment! ASIC bug! */ | ||
394 | |||
395 | if (p_ca_message->msg[buf_offset + 1] == 0x09) { /* Check CA descriptor */ | ||
396 | found_prog_ca_desc = 1; | ||
397 | if (verbose > 4) | ||
398 | dprintk("%s: Found CA descriptor @ Program level\n", __FUNCTION__); | ||
399 | } | ||
400 | |||
401 | if (found_prog_ca_desc) { /* Command only if CA descriptor */ | ||
402 | hw_buffer->msg[13] = p_ca_message->msg[buf_offset]; /* CA PMT command ID */ | ||
403 | hw_offset++, buf_offset++, hw_buffer_length++; | ||
404 | } | ||
405 | |||
406 | /* Program descriptors */ | ||
407 | if (verbose > 4) { | ||
408 | dprintk("%s:**********>buf_offset=[%d], hw_offset=[%d]\n", __FUNCTION__, buf_offset, hw_offset); | ||
409 | dprintk("%s:Program descriptors=[", __FUNCTION__); | ||
410 | } | ||
411 | while (program_info_length && !error_condition) { /* Copy prog descriptors */ | ||
412 | if (program_info_length > p_ca_message->length) { /* Error situation */ | ||
413 | dprintk ("%s:\"WARNING\" Length error, line=[%d], prog_info_length=[%d]\n", | ||
414 | __FUNCTION__, __LINE__, program_info_length); | ||
415 | dprintk("%s:\"WARNING\" Bailing out of possible loop\n", __FUNCTION__); | ||
416 | error_condition = 1; | ||
417 | break; | ||
418 | } | ||
419 | |||
420 | hw_buffer->msg[hw_offset] = p_ca_message->msg[buf_offset]; | ||
421 | dprintk(" %02x", p_ca_message->msg[buf_offset]); | ||
422 | hw_offset++, buf_offset++, hw_buffer_length++, program_info_length--; | ||
423 | } | ||
424 | if (verbose > 4) { | ||
425 | dprintk("]\n"); | ||
426 | dprintk("%s:**********>buf_offset=[%d], hw_offset=[%d]\n", __FUNCTION__, buf_offset, hw_offset); | ||
427 | } | ||
428 | if (found_prog_ca_desc) { | ||
429 | if (!reply) { | ||
430 | hw_buffer->msg[13] = 0x01; /* OK descrambling */ | ||
431 | if (verbose > 1) | ||
432 | dprintk("CA PMT Command = OK Descrambling\n"); | ||
433 | } | ||
434 | else { | ||
435 | hw_buffer->msg[13] = 0x02; /* Ok MMI */ | ||
436 | if (verbose > 1) | ||
437 | dprintk("CA PMT Command = Ok MMI\n"); | ||
438 | } | ||
439 | if (query) { | ||
440 | hw_buffer->msg[13] = 0x03; /* Query */ | ||
441 | if (verbose > 1) | ||
442 | dprintk("CA PMT Command = CA PMT query\n"); | ||
443 | } | ||
444 | } | ||
445 | } | ||
446 | else { | ||
447 | hw_buffer->msg[11] = hw_buffer->msg[11] & 0xf0; /* Don't write to ASIC */ | ||
448 | hw_buffer->msg[12] = hw_buffer->msg[12] = 0x00; | ||
449 | } | ||
450 | if (verbose > 4) | ||
451 | dprintk("%s:**********>p_ca_message->length=[%d], buf_offset=[%d], hw_offset=[%d]\n", | ||
452 | __FUNCTION__, p_ca_message->length, buf_offset, hw_offset); | ||
453 | |||
454 | while ((buf_offset < p_ca_message->length) && !error_condition) { | ||
455 | /* Bail out in case of an indefinite loop */ | ||
456 | if ((es_info_length > p_ca_message->length) || (buf_offset > p_ca_message->length)) { | ||
457 | dprintk("%s:\"WARNING\" Length error, line=[%d], prog_info_length=[%d], buf_offset=[%d]\n", | ||
458 | __FUNCTION__, __LINE__, program_info_length, buf_offset); | ||
459 | |||
460 | dprintk("%s:\"WARNING\" Bailing out of possible loop\n", __FUNCTION__); | ||
461 | error_condition = 1; | ||
462 | break; | ||
463 | } | ||
464 | |||
465 | /* Stream Header */ | ||
466 | |||
467 | for (k = 0; k < 5; k++) { | ||
468 | hw_buffer->msg[hw_offset + k] = p_ca_message->msg[buf_offset + k]; | ||
469 | } | ||
470 | |||
471 | es_info_length = 0; | ||
472 | es_info_length = (es_info_length | (p_ca_message->msg[buf_offset + 3] & 0x0f)) << 8 | p_ca_message->msg[buf_offset + 4]; | ||
473 | |||
474 | if (verbose > 4) { | ||
475 | dprintk("\n%s:----->Stream header=[%02x %02x %02x %02x %02x]\n", __FUNCTION__, | ||
476 | p_ca_message->msg[buf_offset + 0], p_ca_message->msg[buf_offset + 1], | ||
477 | p_ca_message->msg[buf_offset + 2], p_ca_message->msg[buf_offset + 3], | ||
478 | p_ca_message->msg[buf_offset + 4]); | ||
479 | |||
480 | dprintk("%s:----->Stream type=[%02x], es length=[%d (0x%x)], Chars=[%02x] [%02x], buf_offset=[%d]\n", __FUNCTION__, | ||
481 | p_ca_message->msg[buf_offset + 0], es_info_length, es_info_length, | ||
482 | p_ca_message->msg[buf_offset + 3], p_ca_message->msg[buf_offset + 4], buf_offset); | ||
483 | } | ||
484 | |||
485 | hw_buffer->msg[hw_offset + 3] &= 0x0f; /* req only 4 bits */ | ||
486 | |||
487 | if (found_prog_ca_desc) { | ||
488 | hw_buffer->msg[hw_offset + 3] = 0x00; | ||
489 | hw_buffer->msg[hw_offset + 4] = 0x00; | ||
490 | } | ||
491 | |||
492 | hw_offset += 5, buf_offset += 5, hw_buffer_length += 5; | ||
493 | |||
494 | /* Check for CA descriptor */ | ||
495 | if (p_ca_message->msg[buf_offset + 1] == 0x09) { | ||
496 | if (verbose > 4) | ||
497 | dprintk("%s:Found CA descriptor @ Stream level\n", __FUNCTION__); | ||
498 | found_stream_ca_desc = 1; | ||
499 | } | ||
500 | |||
501 | /* ES descriptors */ | ||
502 | |||
503 | if (es_info_length && !error_condition && !found_prog_ca_desc && found_stream_ca_desc) { | ||
504 | // if (!ca_pmt_done) { | ||
505 | hw_buffer->msg[hw_offset] = p_ca_message->msg[buf_offset]; /* CA PMT cmd(es) */ | ||
506 | if (verbose > 4) | ||
507 | printk("%s:----->CA PMT Command ID=[%02x]\n", __FUNCTION__, p_ca_message->msg[buf_offset]); | ||
508 | // hw_offset++, buf_offset++, hw_buffer_length++, es_info_length--, ca_pmt_done = 1; | ||
509 | hw_offset++, buf_offset++, hw_buffer_length++, es_info_length--; | ||
510 | // } | ||
511 | if (verbose > 4) | ||
512 | dprintk("%s:----->ES descriptors=[", __FUNCTION__); | ||
513 | |||
514 | while (es_info_length && !error_condition) { /* ES descriptors */ | ||
515 | if ((es_info_length > p_ca_message->length) || (buf_offset > p_ca_message->length)) { | ||
516 | if (verbose > 4) { | ||
517 | dprintk("%s:\"WARNING\" ES Length error, line=[%d], es_info_length=[%d], buf_offset=[%d]\n", | ||
518 | __FUNCTION__, __LINE__, es_info_length, buf_offset); | ||
519 | |||
520 | dprintk("%s:\"WARNING\" Bailing out of possible loop\n", __FUNCTION__); | ||
521 | } | ||
522 | error_condition = 1; | ||
523 | break; | ||
524 | } | ||
525 | |||
526 | hw_buffer->msg[hw_offset] = p_ca_message->msg[buf_offset]; | ||
527 | if (verbose > 3) | ||
528 | dprintk("%02x ", hw_buffer->msg[hw_offset]); | ||
529 | hw_offset++, buf_offset++, hw_buffer_length++, es_info_length--; | ||
530 | } | ||
531 | found_stream_ca_desc = 0; /* unset for new streams */ | ||
532 | dprintk("]\n"); | ||
533 | } | ||
534 | } | ||
535 | |||
536 | /* MCU Magic words */ | ||
537 | |||
538 | hw_buffer_length += 7; | ||
539 | hw_buffer->msg[0] = hw_buffer_length; | ||
540 | hw_buffer->msg[1] = 64; | ||
541 | hw_buffer->msg[4] = 3; | ||
542 | hw_buffer->msg[5] = hw_buffer->msg[0] - 7; | ||
543 | hw_buffer->msg[6] = 0; | ||
544 | |||
545 | |||
546 | /* Fix length */ | ||
547 | hw_buffer->length = hw_buffer->msg[0]; | ||
548 | |||
549 | put_checksum(&hw_buffer->msg[0], hw_buffer->msg[0]); | ||
550 | /* Do the actual write */ | ||
551 | if (verbose > 4) { | ||
552 | dprintk("%s:======================DEBUGGING================================\n", __FUNCTION__); | ||
553 | dprintk("%s: Actual Length=[%d]\n", __FUNCTION__, hw_buffer_length); | ||
554 | } | ||
555 | /* Only for debugging! */ | ||
556 | if (verbose > 2) | ||
557 | debug_8820_buffer(hw_buffer); | ||
558 | if (verbose > 3) | ||
559 | dprintk("%s: Reply = [%d]\n", __FUNCTION__, reply); | ||
560 | write_to_8820(state, hw_buffer, reply); | ||
561 | |||
562 | return 0; | ||
563 | } | ||
564 | |||
565 | /* Board supports CA PMT reply ? */ | ||
566 | static int dst_check_ca_pmt(struct dst_state *state, struct ca_msg *p_ca_message, struct ca_msg *hw_buffer) | ||
567 | { | ||
568 | int ca_pmt_reply_test = 0; | ||
569 | |||
570 | /* Do test board */ | ||
571 | /* Not there yet but soon */ | ||
572 | |||
573 | |||
574 | /* CA PMT Reply capable */ | ||
575 | if (ca_pmt_reply_test) { | ||
576 | if ((ca_set_pmt(state, p_ca_message, hw_buffer, 1, GET_REPLY)) < 0) { | ||
577 | dprintk("%s: ca_set_pmt.. failed !\n", __FUNCTION__); | ||
578 | return -1; | ||
579 | } | ||
580 | |||
581 | /* Process CA PMT Reply */ | ||
582 | /* will implement soon */ | ||
583 | dprintk("%s: Not there yet\n", __FUNCTION__); | ||
584 | } | ||
585 | /* CA PMT Reply not capable */ | ||
586 | if (!ca_pmt_reply_test) { | ||
587 | if ((ca_set_pmt(state, p_ca_message, hw_buffer, 0, NO_REPLY)) < 0) { | ||
588 | dprintk("%s: ca_set_pmt.. failed !\n", __FUNCTION__); | ||
589 | return -1; | ||
590 | } | ||
591 | if (verbose > 3) | ||
592 | dprintk("%s: ca_set_pmt.. success !\n", __FUNCTION__); | ||
593 | /* put a dummy message */ | ||
594 | |||
595 | } | ||
596 | return 0; | ||
597 | } | ||
598 | |||
599 | static int ca_send_message(struct dst_state *state, struct ca_msg *p_ca_message, void *arg) | ||
600 | { | ||
601 | int i = 0; | ||
602 | unsigned int ca_message_header_len; | ||
603 | |||
604 | u32 command = 0; | ||
605 | struct ca_msg *hw_buffer; | ||
606 | |||
607 | if ((hw_buffer = (struct ca_msg *) kmalloc(sizeof (struct ca_msg), GFP_KERNEL)) == NULL) { | ||
608 | printk("%s: Memory allocation failure\n", __FUNCTION__); | ||
609 | return -ENOMEM; | ||
610 | } | ||
611 | if (verbose > 3) | ||
612 | dprintk("%s\n", __FUNCTION__); | ||
613 | |||
614 | if (copy_from_user(p_ca_message, (void *)arg, sizeof (struct ca_msg))) | ||
615 | return -EFAULT; | ||
616 | |||
617 | if (p_ca_message->msg) { | ||
618 | ca_message_header_len = p_ca_message->length; /* Restore it back when you are done */ | ||
619 | /* EN50221 tag */ | ||
620 | command = 0; | ||
621 | |||
622 | for (i = 0; i < 3; i++) { | ||
623 | command = command | p_ca_message->msg[i]; | ||
624 | if (i < 2) | ||
625 | command = command << 8; | ||
626 | } | ||
627 | if (verbose > 3) | ||
628 | dprintk("%s:Command=[0x%x]\n", __FUNCTION__, command); | ||
629 | |||
630 | switch (command) { | ||
631 | case CA_PMT: | ||
632 | if (verbose > 3) | ||
633 | dprintk("Command = SEND_CA_PMT\n"); | ||
634 | if ((ca_set_pmt(state, p_ca_message, hw_buffer, 0, 0)) < 0) { | ||
635 | dprintk("%s: -->CA_PMT Failed !\n", __FUNCTION__); | ||
636 | return -1; | ||
637 | } | ||
638 | if (verbose > 3) | ||
639 | dprintk("%s: -->CA_PMT Success !\n", __FUNCTION__); | ||
640 | // retval = dummy_set_pmt(state, p_ca_message, hw_buffer, 0, 0); | ||
641 | |||
642 | break; | ||
643 | |||
644 | case CA_PMT_REPLY: | ||
645 | if (verbose > 3) | ||
646 | dprintk("Command = CA_PMT_REPLY\n"); | ||
647 | /* Have to handle the 2 basic types of cards here */ | ||
648 | if ((dst_check_ca_pmt(state, p_ca_message, hw_buffer)) < 0) { | ||
649 | dprintk("%s: -->CA_PMT_REPLY Failed !\n", __FUNCTION__); | ||
650 | return -1; | ||
651 | } | ||
652 | if (verbose > 3) | ||
653 | dprintk("%s: -->CA_PMT_REPLY Success !\n", __FUNCTION__); | ||
654 | |||
655 | /* Certain boards do behave different ? */ | ||
656 | // retval = ca_set_pmt(state, p_ca_message, hw_buffer, 1, 1); | ||
657 | |||
658 | case CA_APP_INFO_ENQUIRY: // only for debugging | ||
659 | if (verbose > 3) | ||
660 | dprintk("%s: Getting Cam Application information\n", __FUNCTION__); | ||
661 | |||
662 | if ((ca_get_app_info(state)) < 0) { | ||
663 | dprintk("%s: -->CA_APP_INFO_ENQUIRY Failed !\n", __FUNCTION__); | ||
664 | return -1; | ||
665 | } | ||
666 | if (verbose > 3) | ||
667 | printk("%s: -->CA_APP_INFO_ENQUIRY Success !\n", __FUNCTION__); | ||
668 | |||
669 | break; | ||
670 | } | ||
671 | } | ||
672 | return 0; | ||
673 | } | ||
674 | |||
675 | static int dst_ca_ioctl(struct inode *inode, struct file *file, unsigned int cmd, void *arg) | ||
676 | { | ||
677 | struct dvb_device* dvbdev = (struct dvb_device*) file->private_data; | ||
678 | struct dst_state* state = (struct dst_state*) dvbdev->priv; | ||
679 | struct ca_slot_info *p_ca_slot_info; | ||
680 | struct ca_caps *p_ca_caps; | ||
681 | struct ca_msg *p_ca_message; | ||
682 | |||
683 | if ((p_ca_message = (struct ca_msg *) kmalloc(sizeof (struct ca_msg), GFP_KERNEL)) == NULL) { | ||
684 | printk("%s: Memory allocation failure\n", __FUNCTION__); | ||
685 | return -ENOMEM; | ||
686 | } | ||
687 | |||
688 | if ((p_ca_slot_info = (struct ca_slot_info *) kmalloc(sizeof (struct ca_slot_info), GFP_KERNEL)) == NULL) { | ||
689 | printk("%s: Memory allocation failure\n", __FUNCTION__); | ||
690 | return -ENOMEM; | ||
691 | } | ||
692 | |||
693 | if ((p_ca_caps = (struct ca_caps *) kmalloc(sizeof (struct ca_caps), GFP_KERNEL)) == NULL) { | ||
694 | printk("%s: Memory allocation failure\n", __FUNCTION__); | ||
695 | return -ENOMEM; | ||
696 | } | ||
697 | |||
698 | /* We have now only the standard ioctl's, the driver is upposed to handle internals. */ | ||
699 | switch (cmd) { | ||
700 | case CA_SEND_MSG: | ||
701 | if (verbose > 1) | ||
702 | dprintk("%s: Sending message\n", __FUNCTION__); | ||
703 | if ((ca_send_message(state, p_ca_message, arg)) < 0) { | ||
704 | dprintk("%s: -->CA_SEND_MSG Failed !\n", __FUNCTION__); | ||
705 | return -1; | ||
706 | } | ||
707 | |||
708 | break; | ||
709 | |||
710 | case CA_GET_MSG: | ||
711 | if (verbose > 1) | ||
712 | dprintk("%s: Getting message\n", __FUNCTION__); | ||
713 | if ((ca_get_message(state, p_ca_message, arg)) < 0) { | ||
714 | dprintk("%s: -->CA_GET_MSG Failed !\n", __FUNCTION__); | ||
715 | return -1; | ||
716 | } | ||
717 | if (verbose > 1) | ||
718 | dprintk("%s: -->CA_GET_MSG Success !\n", __FUNCTION__); | ||
719 | |||
720 | break; | ||
721 | |||
722 | case CA_RESET: | ||
723 | if (verbose > 1) | ||
724 | dprintk("%s: Resetting DST\n", __FUNCTION__); | ||
725 | dst_error_bailout(state); | ||
726 | msleep(4000); | ||
727 | |||
728 | break; | ||
729 | |||
730 | case CA_GET_SLOT_INFO: | ||
731 | if (verbose > 1) | ||
732 | dprintk("%s: Getting Slot info\n", __FUNCTION__); | ||
733 | if ((ca_get_slot_info(state, p_ca_slot_info, arg)) < 0) { | ||
734 | dprintk("%s: -->CA_GET_SLOT_INFO Failed !\n", __FUNCTION__); | ||
735 | return -1; | ||
736 | } | ||
737 | if (verbose > 1) | ||
738 | dprintk("%s: -->CA_GET_SLOT_INFO Success !\n", __FUNCTION__); | ||
739 | |||
740 | break; | ||
741 | |||
742 | case CA_GET_CAP: | ||
743 | if (verbose > 1) | ||
744 | dprintk("%s: Getting Slot capabilities\n", __FUNCTION__); | ||
745 | if ((ca_get_slot_caps(state, p_ca_caps, arg)) < 0) { | ||
746 | dprintk("%s: -->CA_GET_CAP Failed !\n", __FUNCTION__); | ||
747 | return -1; | ||
748 | } | ||
749 | if (verbose > 1) | ||
750 | dprintk("%s: -->CA_GET_CAP Success !\n", __FUNCTION__); | ||
751 | |||
752 | break; | ||
753 | |||
754 | case CA_GET_DESCR_INFO: | ||
755 | if (verbose > 1) | ||
756 | dprintk("%s: Getting descrambler description\n", __FUNCTION__); | ||
757 | if ((ca_get_slot_descr(state, p_ca_message, arg)) < 0) { | ||
758 | dprintk("%s: -->CA_GET_DESCR_INFO Failed !\n", __FUNCTION__); | ||
759 | return -1; | ||
760 | } | ||
761 | if (verbose > 1) | ||
762 | dprintk("%s: -->CA_GET_DESCR_INFO Success !\n", __FUNCTION__); | ||
763 | |||
764 | break; | ||
765 | |||
766 | case CA_SET_DESCR: | ||
767 | if (verbose > 1) | ||
768 | dprintk("%s: Setting descrambler\n", __FUNCTION__); | ||
769 | if ((ca_set_slot_descr()) < 0) { | ||
770 | dprintk("%s: -->CA_SET_DESCR Failed !\n", __FUNCTION__); | ||
771 | return -1; | ||
772 | } | ||
773 | if (verbose > 1) | ||
774 | dprintk("%s: -->CA_SET_DESCR Success !\n", __FUNCTION__); | ||
775 | |||
776 | break; | ||
777 | |||
778 | case CA_SET_PID: | ||
779 | if (verbose > 1) | ||
780 | dprintk("%s: Setting PID\n", __FUNCTION__); | ||
781 | if ((ca_set_pid()) < 0) { | ||
782 | dprintk("%s: -->CA_SET_PID Failed !\n", __FUNCTION__); | ||
783 | return -1; | ||
784 | } | ||
785 | if (verbose > 1) | ||
786 | dprintk("%s: -->CA_SET_PID Success !\n", __FUNCTION__); | ||
787 | |||
788 | default: | ||
789 | return -EOPNOTSUPP; | ||
790 | }; | ||
791 | |||
792 | return 0; | ||
793 | } | ||
794 | |||
795 | static int dst_ca_open(struct inode *inode, struct file *file) | ||
796 | { | ||
797 | if (verbose > 4) | ||
798 | dprintk("%s:Device opened [%p]\n", __FUNCTION__, file); | ||
799 | try_module_get(THIS_MODULE); | ||
800 | |||
801 | return 0; | ||
802 | } | ||
803 | |||
804 | static int dst_ca_release(struct inode *inode, struct file *file) | ||
805 | { | ||
806 | if (verbose > 4) | ||
807 | dprintk("%s:Device closed.\n", __FUNCTION__); | ||
808 | module_put(THIS_MODULE); | ||
809 | |||
810 | return 0; | ||
811 | } | ||
812 | |||
813 | static int dst_ca_read(struct file *file, char __user * buffer, size_t length, loff_t * offset) | ||
814 | { | ||
815 | int bytes_read = 0; | ||
816 | |||
817 | if (verbose > 4) | ||
818 | dprintk("%s:Device read.\n", __FUNCTION__); | ||
819 | |||
820 | return bytes_read; | ||
821 | } | ||
822 | |||
823 | static int dst_ca_write(struct file *file, const char __user * buffer, size_t length, loff_t * offset) | ||
824 | { | ||
825 | if (verbose > 4) | ||
826 | dprintk("%s:Device write.\n", __FUNCTION__); | ||
827 | |||
828 | return 0; | ||
829 | } | ||
830 | |||
831 | static struct file_operations dst_ca_fops = { | ||
832 | .owner = THIS_MODULE, | ||
833 | .ioctl = (void *)dst_ca_ioctl, | ||
834 | .open = dst_ca_open, | ||
835 | .release = dst_ca_release, | ||
836 | .read = dst_ca_read, | ||
837 | .write = dst_ca_write | ||
838 | }; | ||
839 | |||
840 | static struct dvb_device dvbdev_ca = { | ||
841 | .priv = NULL, | ||
842 | .users = 1, | ||
843 | .readers = 1, | ||
844 | .writers = 1, | ||
845 | .fops = &dst_ca_fops | ||
846 | }; | ||
847 | |||
848 | int dst_ca_attach(struct dst_state *dst, struct dvb_adapter *dvb_adapter) | ||
849 | { | ||
850 | struct dvb_device *dvbdev; | ||
851 | if (verbose > 4) | ||
852 | dprintk("%s:registering DST-CA device\n", __FUNCTION__); | ||
853 | dvb_register_device(dvb_adapter, &dvbdev, &dvbdev_ca, dst, DVB_DEVICE_CA); | ||
854 | return 0; | ||
855 | } | ||
856 | |||
857 | EXPORT_SYMBOL(dst_ca_attach); | ||
858 | |||
859 | MODULE_DESCRIPTION("DST DVB-S/T/C Combo CA driver"); | ||
860 | MODULE_AUTHOR("Manu Abraham"); | ||
861 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/media/dvb/bt8xx/dst_ca.h b/drivers/media/dvb/bt8xx/dst_ca.h new file mode 100644 index 000000000000..59cd0ddd6d8e --- /dev/null +++ b/drivers/media/dvb/bt8xx/dst_ca.h | |||
@@ -0,0 +1,58 @@ | |||
1 | /* | ||
2 | CA-driver for TwinHan DST Frontend/Card | ||
3 | |||
4 | Copyright (C) 2004, 2005 Manu Abraham (manu@kromtek.com) | ||
5 | |||
6 | This program is free software; you can redistribute it and/or modify | ||
7 | it under the terms of the GNU General Public License as published by | ||
8 | the Free Software Foundation; either version 2 of the License, or | ||
9 | (at your option) any later version. | ||
10 | |||
11 | This program is distributed in the hope that it will be useful, | ||
12 | but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
13 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
14 | GNU General Public License for more details. | ||
15 | |||
16 | You should have received a copy of the GNU General Public License | ||
17 | along with this program; if not, write to the Free Software | ||
18 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
19 | */ | ||
20 | |||
21 | #ifndef _DST_CA_H_ | ||
22 | #define _DST_CA_H_ | ||
23 | |||
24 | #define RETRIES 5 | ||
25 | |||
26 | |||
27 | #define CA_APP_INFO_ENQUIRY 0x9f8020 | ||
28 | #define CA_APP_INFO 0x9f8021 | ||
29 | #define CA_ENTER_MENU 0x9f8022 | ||
30 | #define CA_INFO_ENQUIRY 0x9f8030 | ||
31 | #define CA_INFO 0x9f8031 | ||
32 | #define CA_PMT 0x9f8032 | ||
33 | #define CA_PMT_REPLY 0x9f8033 | ||
34 | |||
35 | #define CA_CLOSE_MMI 0x9f8800 | ||
36 | #define CA_DISPLAY_CONTROL 0x9f8801 | ||
37 | #define CA_DISPLAY_REPLY 0x9f8802 | ||
38 | #define CA_TEXT_LAST 0x9f8803 | ||
39 | #define CA_TEXT_MORE 0x9f8804 | ||
40 | #define CA_KEYPAD_CONTROL 0x9f8805 | ||
41 | #define CA_KEYPRESS 0x9f8806 | ||
42 | |||
43 | #define CA_ENQUIRY 0x9f8807 | ||
44 | #define CA_ANSWER 0x9f8808 | ||
45 | #define CA_MENU_LAST 0x9f8809 | ||
46 | #define CA_MENU_MORE 0x9f880a | ||
47 | #define CA_MENU_ANSWER 0x9f880b | ||
48 | #define CA_LIST_LAST 0x9f880c | ||
49 | #define CA_LIST_MORE 0x9f880d | ||
50 | |||
51 | |||
52 | struct dst_ca_private { | ||
53 | struct dst_state *dst; | ||
54 | struct dvb_device *dvbdev; | ||
55 | }; | ||
56 | |||
57 | |||
58 | #endif | ||
diff --git a/drivers/media/dvb/bt8xx/dst_common.h b/drivers/media/dvb/bt8xx/dst_common.h new file mode 100644 index 000000000000..0b3da29245fb --- /dev/null +++ b/drivers/media/dvb/bt8xx/dst_common.h | |||
@@ -0,0 +1,153 @@ | |||
1 | /* | ||
2 | Frontend-driver for TwinHan DST Frontend | ||
3 | |||
4 | Copyright (C) 2003 Jamie Honan | ||
5 | Copyright (C) 2004, 2005 Manu Abraham (manu@kromtek.com) | ||
6 | |||
7 | This program is free software; you can redistribute it and/or modify | ||
8 | it under the terms of the GNU General Public License as published by | ||
9 | the Free Software Foundation; either version 2 of the License, or | ||
10 | (at your option) any later version. | ||
11 | |||
12 | This program is distributed in the hope that it will be useful, | ||
13 | but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
14 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
15 | GNU General Public License for more details. | ||
16 | |||
17 | You should have received a copy of the GNU General Public License | ||
18 | along with this program; if not, write to the Free Software | ||
19 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
20 | */ | ||
21 | |||
22 | #ifndef DST_COMMON_H | ||
23 | #define DST_COMMON_H | ||
24 | |||
25 | #include <linux/dvb/frontend.h> | ||
26 | #include <linux/device.h> | ||
27 | #include "bt878.h" | ||
28 | |||
29 | #include "dst_ca.h" | ||
30 | |||
31 | |||
32 | #define NO_DELAY 0 | ||
33 | #define LONG_DELAY 1 | ||
34 | #define DEVICE_INIT 2 | ||
35 | |||
36 | #define DELAY 1 | ||
37 | |||
38 | #define DST_TYPE_IS_SAT 0 | ||
39 | #define DST_TYPE_IS_TERR 1 | ||
40 | #define DST_TYPE_IS_CABLE 2 | ||
41 | #define DST_TYPE_IS_ATSC 3 | ||
42 | |||
43 | #define DST_TYPE_HAS_NEWTUNE 1 | ||
44 | #define DST_TYPE_HAS_TS204 2 | ||
45 | #define DST_TYPE_HAS_SYMDIV 4 | ||
46 | #define DST_TYPE_HAS_FW_1 8 | ||
47 | #define DST_TYPE_HAS_FW_2 16 | ||
48 | #define DST_TYPE_HAS_FW_3 32 | ||
49 | #define DST_TYPE_HAS_FW_BUILD 64 | ||
50 | |||
51 | /* Card capability list */ | ||
52 | |||
53 | #define DST_TYPE_HAS_MAC 1 | ||
54 | #define DST_TYPE_HAS_DISEQC3 2 | ||
55 | #define DST_TYPE_HAS_DISEQC4 4 | ||
56 | #define DST_TYPE_HAS_DISEQC5 8 | ||
57 | #define DST_TYPE_HAS_MOTO 16 | ||
58 | #define DST_TYPE_HAS_CA 32 | ||
59 | #define DST_TYPE_HAS_ANALOG 64 /* Analog inputs */ | ||
60 | #define DST_TYPE_HAS_SESSION 128 | ||
61 | |||
62 | |||
63 | #define RDC_8820_PIO_0_DISABLE 0 | ||
64 | #define RDC_8820_PIO_0_ENABLE 1 | ||
65 | #define RDC_8820_INT 2 | ||
66 | #define RDC_8820_RESET 4 | ||
67 | |||
68 | /* DST Communication */ | ||
69 | #define GET_REPLY 1 | ||
70 | #define NO_REPLY 0 | ||
71 | |||
72 | #define GET_ACK 1 | ||
73 | #define FIXED_COMM 8 | ||
74 | |||
75 | #define ACK 0xff | ||
76 | |||
77 | struct dst_state { | ||
78 | |||
79 | struct i2c_adapter* i2c; | ||
80 | |||
81 | struct bt878* bt; | ||
82 | |||
83 | struct dvb_frontend_ops ops; | ||
84 | |||
85 | /* configuration settings */ | ||
86 | const struct dst_config* config; | ||
87 | |||
88 | struct dvb_frontend frontend; | ||
89 | |||
90 | /* private ASIC data */ | ||
91 | u8 tx_tuna[10]; | ||
92 | u8 rx_tuna[10]; | ||
93 | u8 rxbuffer[10]; | ||
94 | u8 diseq_flags; | ||
95 | u8 dst_type; | ||
96 | u32 type_flags; | ||
97 | u32 frequency; /* intermediate frequency in kHz for QPSK */ | ||
98 | fe_spectral_inversion_t inversion; | ||
99 | u32 symbol_rate; /* symbol rate in Symbols per second */ | ||
100 | fe_code_rate_t fec; | ||
101 | fe_sec_voltage_t voltage; | ||
102 | fe_sec_tone_mode_t tone; | ||
103 | u32 decode_freq; | ||
104 | u8 decode_lock; | ||
105 | u16 decode_strength; | ||
106 | u16 decode_snr; | ||
107 | unsigned long cur_jiff; | ||
108 | u8 k22; | ||
109 | fe_bandwidth_t bandwidth; | ||
110 | u32 dst_hw_cap; | ||
111 | u8 dst_fw_version; | ||
112 | fe_sec_mini_cmd_t minicmd; | ||
113 | u8 messages[256]; | ||
114 | }; | ||
115 | |||
116 | struct dst_types { | ||
117 | char *device_id; | ||
118 | int offset; | ||
119 | u8 dst_type; | ||
120 | u32 type_flags; | ||
121 | u32 dst_feature; | ||
122 | }; | ||
123 | |||
124 | |||
125 | |||
126 | struct dst_config | ||
127 | { | ||
128 | /* the ASIC i2c address */ | ||
129 | u8 demod_address; | ||
130 | }; | ||
131 | |||
132 | |||
133 | int rdc_reset_state(struct dst_state *state); | ||
134 | int rdc_8820_reset(struct dst_state *state); | ||
135 | |||
136 | int dst_wait_dst_ready(struct dst_state *state, u8 delay_mode); | ||
137 | int dst_pio_enable(struct dst_state *state); | ||
138 | int dst_pio_disable(struct dst_state *state); | ||
139 | int dst_error_recovery(struct dst_state* state); | ||
140 | int dst_error_bailout(struct dst_state *state); | ||
141 | int dst_comm_init(struct dst_state* state); | ||
142 | |||
143 | int write_dst(struct dst_state *state, u8 * data, u8 len); | ||
144 | int read_dst(struct dst_state *state, u8 * ret, u8 len); | ||
145 | u8 dst_check_sum(u8 * buf, u32 len); | ||
146 | struct dst_state* dst_attach(struct dst_state* state, struct dvb_adapter *dvb_adapter); | ||
147 | int dst_ca_attach(struct dst_state *state, struct dvb_adapter *dvb_adapter); | ||
148 | int dst_gpio_outb(struct dst_state* state, u32 mask, u32 enbb, u32 outhigh, int delay); | ||
149 | |||
150 | int dst_command(struct dst_state* state, u8 * data, u8 len); | ||
151 | |||
152 | |||
153 | #endif // DST_COMMON_H | ||
diff --git a/drivers/media/dvb/bt8xx/dst_priv.h b/drivers/media/dvb/bt8xx/dst_priv.h index 80488aa628b4..3974a4c6ebe7 100644 --- a/drivers/media/dvb/bt8xx/dst_priv.h +++ b/drivers/media/dvb/bt8xx/dst_priv.h | |||
@@ -33,4 +33,3 @@ union dst_gpio_packet { | |||
33 | struct bt878; | 33 | struct bt878; |
34 | 34 | ||
35 | int bt878_device_control(struct bt878 *bt, unsigned int cmd, union dst_gpio_packet *mp); | 35 | int bt878_device_control(struct bt878 *bt, unsigned int cmd, union dst_gpio_packet *mp); |
36 | |||
diff --git a/drivers/media/dvb/bt8xx/dvb-bt8xx.c b/drivers/media/dvb/bt8xx/dvb-bt8xx.c index b735397f59aa..6f857c6091f3 100644 --- a/drivers/media/dvb/bt8xx/dvb-bt8xx.c +++ b/drivers/media/dvb/bt8xx/dvb-bt8xx.c | |||
@@ -142,7 +142,7 @@ static int thomson_dtt7579_demod_init(struct dvb_frontend* fe) | |||
142 | mt352_write(fe, mt352_adc_ctl_1_cfg, sizeof(mt352_adc_ctl_1_cfg)); | 142 | mt352_write(fe, mt352_adc_ctl_1_cfg, sizeof(mt352_adc_ctl_1_cfg)); |
143 | 143 | ||
144 | mt352_write(fe, mt352_agc_cfg, sizeof(mt352_agc_cfg)); | 144 | mt352_write(fe, mt352_agc_cfg, sizeof(mt352_agc_cfg)); |
145 | mt352_write(fe, mt352_gpp_ctl_cfg, sizeof(mt352_gpp_ctl_cfg)); | 145 | mt352_write(fe, mt352_gpp_ctl_cfg, sizeof(mt352_gpp_ctl_cfg)); |
146 | mt352_write(fe, mt352_capt_range_cfg, sizeof(mt352_capt_range_cfg)); | 146 | mt352_write(fe, mt352_capt_range_cfg, sizeof(mt352_capt_range_cfg)); |
147 | 147 | ||
148 | return 0; | 148 | return 0; |
@@ -161,7 +161,7 @@ static int thomson_dtt7579_pll_set(struct dvb_frontend* fe, struct dvb_frontend_ | |||
161 | else if (params->frequency < 771000000) cp = 0xbc; | 161 | else if (params->frequency < 771000000) cp = 0xbc; |
162 | else cp = 0xf4; | 162 | else cp = 0xf4; |
163 | 163 | ||
164 | if (params->frequency == 0) bs = 0x03; | 164 | if (params->frequency == 0) bs = 0x03; |
165 | else if (params->frequency < 443250000) bs = 0x02; | 165 | else if (params->frequency < 443250000) bs = 0x02; |
166 | else bs = 0x08; | 166 | else bs = 0x08; |
167 | 167 | ||
@@ -190,44 +190,44 @@ static int cx24108_pll_set(struct dvb_frontend* fe, struct dvb_frontend_paramete | |||
190 | 190 | ||
191 | 191 | ||
192 | u32 osci[]={950000,1019000,1075000,1178000,1296000,1432000, | 192 | u32 osci[]={950000,1019000,1075000,1178000,1296000,1432000, |
193 | 1576000,1718000,1856000,2036000,2150000}; | 193 | 1576000,1718000,1856000,2036000,2150000}; |
194 | u32 bandsel[]={0,0x00020000,0x00040000,0x00100800,0x00101000, | 194 | u32 bandsel[]={0,0x00020000,0x00040000,0x00100800,0x00101000, |
195 | 0x00102000,0x00104000,0x00108000,0x00110000, | 195 | 0x00102000,0x00104000,0x00108000,0x00110000, |
196 | 0x00120000,0x00140000}; | 196 | 0x00120000,0x00140000}; |
197 | 197 | ||
198 | #define XTAL 1011100 /* Hz, really 1.0111 MHz and a /10 prescaler */ | 198 | #define XTAL 1011100 /* Hz, really 1.0111 MHz and a /10 prescaler */ |
199 | printk("cx24108 debug: entering SetTunerFreq, freq=%d\n",freq); | 199 | printk("cx24108 debug: entering SetTunerFreq, freq=%d\n",freq); |
200 | 200 | ||
201 | /* This is really the bit driving the tuner chip cx24108 */ | 201 | /* This is really the bit driving the tuner chip cx24108 */ |
202 | 202 | ||
203 | if(freq<950000) freq=950000; /* kHz */ | 203 | if(freq<950000) freq=950000; /* kHz */ |
204 | if(freq>2150000) freq=2150000; /* satellite IF is 950..2150MHz */ | 204 | if(freq>2150000) freq=2150000; /* satellite IF is 950..2150MHz */ |
205 | 205 | ||
206 | /* decide which VCO to use for the input frequency */ | 206 | /* decide which VCO to use for the input frequency */ |
207 | for(i=1;(i<sizeof(osci)/sizeof(osci[0]))&&(osci[i]<freq);i++); | 207 | for(i=1;(i<sizeof(osci)/sizeof(osci[0]))&&(osci[i]<freq);i++); |
208 | printk("cx24108 debug: select vco #%d (f=%d)\n",i,freq); | 208 | printk("cx24108 debug: select vco #%d (f=%d)\n",i,freq); |
209 | band=bandsel[i]; | 209 | band=bandsel[i]; |
210 | /* the gain values must be set by SetSymbolrate */ | 210 | /* the gain values must be set by SetSymbolrate */ |
211 | /* compute the pll divider needed, from Conexant data sheet, | 211 | /* compute the pll divider needed, from Conexant data sheet, |
212 | resolved for (n*32+a), remember f(vco) is f(receive) *2 or *4, | 212 | resolved for (n*32+a), remember f(vco) is f(receive) *2 or *4, |
213 | depending on the divider bit. It is set to /4 on the 2 lowest | 213 | depending on the divider bit. It is set to /4 on the 2 lowest |
214 | bands */ | 214 | bands */ |
215 | n=((i<=2?2:1)*freq*10L)/(XTAL/100); | 215 | n=((i<=2?2:1)*freq*10L)/(XTAL/100); |
216 | a=n%32; n/=32; if(a==0) n--; | 216 | a=n%32; n/=32; if(a==0) n--; |
217 | pump=(freq<(osci[i-1]+osci[i])/2); | 217 | pump=(freq<(osci[i-1]+osci[i])/2); |
218 | pll=0xf8000000| | 218 | pll=0xf8000000| |
219 | ((pump?1:2)<<(14+11))| | 219 | ((pump?1:2)<<(14+11))| |
220 | ((n&0x1ff)<<(5+11))| | 220 | ((n&0x1ff)<<(5+11))| |
221 | ((a&0x1f)<<11); | 221 | ((a&0x1f)<<11); |
222 | /* everything is shifted left 11 bits to left-align the bits in the | 222 | /* everything is shifted left 11 bits to left-align the bits in the |
223 | 32bit word. Output to the tuner goes MSB-aligned, after all */ | 223 | 32bit word. Output to the tuner goes MSB-aligned, after all */ |
224 | printk("cx24108 debug: pump=%d, n=%d, a=%d\n",pump,n,a); | 224 | printk("cx24108 debug: pump=%d, n=%d, a=%d\n",pump,n,a); |
225 | cx24110_pll_write(fe,band); | 225 | cx24110_pll_write(fe,band); |
226 | /* set vga and vca to their widest-band settings, as a precaution. | 226 | /* set vga and vca to their widest-band settings, as a precaution. |
227 | SetSymbolrate might not be called to set this up */ | 227 | SetSymbolrate might not be called to set this up */ |
228 | cx24110_pll_write(fe,0x500c0000); | 228 | cx24110_pll_write(fe,0x500c0000); |
229 | cx24110_pll_write(fe,0x83f1f800); | 229 | cx24110_pll_write(fe,0x83f1f800); |
230 | cx24110_pll_write(fe,pll); | 230 | cx24110_pll_write(fe,pll); |
231 | /* writereg(client,0x56,0x7f);*/ | 231 | /* writereg(client,0x56,0x7f);*/ |
232 | 232 | ||
233 | return 0; | 233 | return 0; |
@@ -299,7 +299,7 @@ static int advbt771_samsung_tdtc9251dh0_demod_init(struct dvb_frontend* fe) | |||
299 | static u8 mt352_reset [] = { 0x50, 0x80 }; | 299 | static u8 mt352_reset [] = { 0x50, 0x80 }; |
300 | static u8 mt352_adc_ctl_1_cfg [] = { 0x8E, 0x40 }; | 300 | static u8 mt352_adc_ctl_1_cfg [] = { 0x8E, 0x40 }; |
301 | static u8 mt352_agc_cfg [] = { 0x67, 0x10, 0x23, 0x00, 0xFF, 0xFF, | 301 | static u8 mt352_agc_cfg [] = { 0x67, 0x10, 0x23, 0x00, 0xFF, 0xFF, |
302 | 0x00, 0xFF, 0x00, 0x40, 0x40 }; | 302 | 0x00, 0xFF, 0x00, 0x40, 0x40 }; |
303 | static u8 mt352_av771_extra[] = { 0xB5, 0x7A }; | 303 | static u8 mt352_av771_extra[] = { 0xB5, 0x7A }; |
304 | static u8 mt352_capt_range_cfg[] = { 0x75, 0x32 }; | 304 | static u8 mt352_capt_range_cfg[] = { 0x75, 0x32 }; |
305 | 305 | ||
@@ -463,6 +463,9 @@ static struct nxt6000_config vp3021_alps_tded4_config = { | |||
463 | 463 | ||
464 | static void frontend_init(struct dvb_bt8xx_card *card, u32 type) | 464 | static void frontend_init(struct dvb_bt8xx_card *card, u32 type) |
465 | { | 465 | { |
466 | int ret; | ||
467 | struct dst_state* state = NULL; | ||
468 | |||
466 | switch(type) { | 469 | switch(type) { |
467 | #ifdef BTTV_DVICO_DVBT_LITE | 470 | #ifdef BTTV_DVICO_DVBT_LITE |
468 | case BTTV_DVICO_DVBT_LITE: | 471 | case BTTV_DVICO_DVBT_LITE: |
@@ -503,7 +506,25 @@ static void frontend_init(struct dvb_bt8xx_card *card, u32 type) | |||
503 | break; | 506 | break; |
504 | 507 | ||
505 | case BTTV_TWINHAN_DST: | 508 | case BTTV_TWINHAN_DST: |
506 | card->fe = dst_attach(&dst_config, card->i2c_adapter, card->bt); | 509 | /* DST is not a frontend driver !!! */ |
510 | state = (struct dst_state *) kmalloc(sizeof (struct dst_state), GFP_KERNEL); | ||
511 | /* Setup the Card */ | ||
512 | state->config = &dst_config; | ||
513 | state->i2c = card->i2c_adapter; | ||
514 | state->bt = card->bt; | ||
515 | |||
516 | /* DST is not a frontend, attaching the ASIC */ | ||
517 | if ((dst_attach(state, &card->dvb_adapter)) == NULL) { | ||
518 | printk("%s: Could not find a Twinhan DST.\n", __FUNCTION__); | ||
519 | break; | ||
520 | } | ||
521 | card->fe = &state->frontend; | ||
522 | |||
523 | /* Attach other DST peripherals if any */ | ||
524 | /* Conditional Access device */ | ||
525 | if (state->dst_hw_cap & DST_TYPE_HAS_CA) { | ||
526 | ret = dst_ca_attach(state, &card->dvb_adapter); | ||
527 | } | ||
507 | if (card->fe != NULL) { | 528 | if (card->fe != NULL) { |
508 | break; | 529 | break; |
509 | } | 530 | } |
@@ -531,7 +552,7 @@ static void frontend_init(struct dvb_bt8xx_card *card, u32 type) | |||
531 | card->bt->dev->subsystem_vendor, | 552 | card->bt->dev->subsystem_vendor, |
532 | card->bt->dev->subsystem_device); | 553 | card->bt->dev->subsystem_device); |
533 | } else { | 554 | } else { |
534 | if (dvb_register_frontend(card->dvb_adapter, card->fe)) { | 555 | if (dvb_register_frontend(&card->dvb_adapter, card->fe)) { |
535 | printk("dvb-bt8xx: Frontend registration failed!\n"); | 556 | printk("dvb-bt8xx: Frontend registration failed!\n"); |
536 | if (card->fe->ops->release) | 557 | if (card->fe->ops->release) |
537 | card->fe->ops->release(card->fe); | 558 | card->fe->ops->release(card->fe); |
@@ -550,7 +571,7 @@ static int __init dvb_bt8xx_load_card(struct dvb_bt8xx_card *card, u32 type) | |||
550 | return result; | 571 | return result; |
551 | 572 | ||
552 | } | 573 | } |
553 | card->dvb_adapter->priv = card; | 574 | card->dvb_adapter.priv = card; |
554 | 575 | ||
555 | card->bt->adapter = card->i2c_adapter; | 576 | card->bt->adapter = card->i2c_adapter; |
556 | 577 | ||
@@ -568,7 +589,7 @@ static int __init dvb_bt8xx_load_card(struct dvb_bt8xx_card *card, u32 type) | |||
568 | if ((result = dvb_dmx_init(&card->demux)) < 0) { | 589 | if ((result = dvb_dmx_init(&card->demux)) < 0) { |
569 | printk("dvb_bt8xx: dvb_dmx_init failed (errno = %d)\n", result); | 590 | printk("dvb_bt8xx: dvb_dmx_init failed (errno = %d)\n", result); |
570 | 591 | ||
571 | dvb_unregister_adapter(card->dvb_adapter); | 592 | dvb_unregister_adapter(&card->dvb_adapter); |
572 | return result; | 593 | return result; |
573 | } | 594 | } |
574 | 595 | ||
@@ -576,11 +597,11 @@ static int __init dvb_bt8xx_load_card(struct dvb_bt8xx_card *card, u32 type) | |||
576 | card->dmxdev.demux = &card->demux.dmx; | 597 | card->dmxdev.demux = &card->demux.dmx; |
577 | card->dmxdev.capabilities = 0; | 598 | card->dmxdev.capabilities = 0; |
578 | 599 | ||
579 | if ((result = dvb_dmxdev_init(&card->dmxdev, card->dvb_adapter)) < 0) { | 600 | if ((result = dvb_dmxdev_init(&card->dmxdev, &card->dvb_adapter)) < 0) { |
580 | printk("dvb_bt8xx: dvb_dmxdev_init failed (errno = %d)\n", result); | 601 | printk("dvb_bt8xx: dvb_dmxdev_init failed (errno = %d)\n", result); |
581 | 602 | ||
582 | dvb_dmx_release(&card->demux); | 603 | dvb_dmx_release(&card->demux); |
583 | dvb_unregister_adapter(card->dvb_adapter); | 604 | dvb_unregister_adapter(&card->dvb_adapter); |
584 | return result; | 605 | return result; |
585 | } | 606 | } |
586 | 607 | ||
@@ -591,7 +612,7 @@ static int __init dvb_bt8xx_load_card(struct dvb_bt8xx_card *card, u32 type) | |||
591 | 612 | ||
592 | dvb_dmxdev_release(&card->dmxdev); | 613 | dvb_dmxdev_release(&card->dmxdev); |
593 | dvb_dmx_release(&card->demux); | 614 | dvb_dmx_release(&card->demux); |
594 | dvb_unregister_adapter(card->dvb_adapter); | 615 | dvb_unregister_adapter(&card->dvb_adapter); |
595 | return result; | 616 | return result; |
596 | } | 617 | } |
597 | 618 | ||
@@ -603,7 +624,7 @@ static int __init dvb_bt8xx_load_card(struct dvb_bt8xx_card *card, u32 type) | |||
603 | card->demux.dmx.remove_frontend(&card->demux.dmx, &card->fe_hw); | 624 | card->demux.dmx.remove_frontend(&card->demux.dmx, &card->fe_hw); |
604 | dvb_dmxdev_release(&card->dmxdev); | 625 | dvb_dmxdev_release(&card->dmxdev); |
605 | dvb_dmx_release(&card->demux); | 626 | dvb_dmx_release(&card->demux); |
606 | dvb_unregister_adapter(card->dvb_adapter); | 627 | dvb_unregister_adapter(&card->dvb_adapter); |
607 | return result; | 628 | return result; |
608 | } | 629 | } |
609 | 630 | ||
@@ -614,11 +635,11 @@ static int __init dvb_bt8xx_load_card(struct dvb_bt8xx_card *card, u32 type) | |||
614 | card->demux.dmx.remove_frontend(&card->demux.dmx, &card->fe_hw); | 635 | card->demux.dmx.remove_frontend(&card->demux.dmx, &card->fe_hw); |
615 | dvb_dmxdev_release(&card->dmxdev); | 636 | dvb_dmxdev_release(&card->dmxdev); |
616 | dvb_dmx_release(&card->demux); | 637 | dvb_dmx_release(&card->demux); |
617 | dvb_unregister_adapter(card->dvb_adapter); | 638 | dvb_unregister_adapter(&card->dvb_adapter); |
618 | return result; | 639 | return result; |
619 | } | 640 | } |
620 | 641 | ||
621 | dvb_net_init(card->dvb_adapter, &card->dvbnet, &card->demux.dmx); | 642 | dvb_net_init(&card->dvb_adapter, &card->dvbnet, &card->demux.dmx); |
622 | 643 | ||
623 | tasklet_init(&card->bt->tasklet, dvb_bt8xx_task, (unsigned long) card); | 644 | tasklet_init(&card->bt->tasklet, dvb_bt8xx_task, (unsigned long) card); |
624 | 645 | ||
@@ -648,7 +669,7 @@ static int dvb_bt8xx_probe(struct device *dev) | |||
648 | case BTTV_PINNACLESAT: | 669 | case BTTV_PINNACLESAT: |
649 | card->gpio_mode = 0x0400c060; | 670 | card->gpio_mode = 0x0400c060; |
650 | /* should be: BT878_A_GAIN=0,BT878_A_PWRDN,BT878_DA_DPM,BT878_DA_SBR, | 671 | /* should be: BT878_A_GAIN=0,BT878_A_PWRDN,BT878_DA_DPM,BT878_DA_SBR, |
651 | BT878_DA_IOM=1,BT878_DA_APP to enable serial highspeed mode. */ | 672 | BT878_DA_IOM=1,BT878_DA_APP to enable serial highspeed mode. */ |
652 | card->op_sync_orin = 0; | 673 | card->op_sync_orin = 0; |
653 | card->irq_err_ignore = 0; | 674 | card->irq_err_ignore = 0; |
654 | break; | 675 | break; |
@@ -759,7 +780,7 @@ static int dvb_bt8xx_remove(struct device *dev) | |||
759 | dvb_dmxdev_release(&card->dmxdev); | 780 | dvb_dmxdev_release(&card->dmxdev); |
760 | dvb_dmx_release(&card->demux); | 781 | dvb_dmx_release(&card->demux); |
761 | if (card->fe) dvb_unregister_frontend(card->fe); | 782 | if (card->fe) dvb_unregister_frontend(card->fe); |
762 | dvb_unregister_adapter(card->dvb_adapter); | 783 | dvb_unregister_adapter(&card->dvb_adapter); |
763 | 784 | ||
764 | kfree(card); | 785 | kfree(card); |
765 | 786 | ||
diff --git a/drivers/media/dvb/bt8xx/dvb-bt8xx.h b/drivers/media/dvb/bt8xx/dvb-bt8xx.h index 80ef189f930f..2923b3b0dd3c 100644 --- a/drivers/media/dvb/bt8xx/dvb-bt8xx.h +++ b/drivers/media/dvb/bt8xx/dvb-bt8xx.h | |||
@@ -31,7 +31,7 @@ | |||
31 | #include "bttv.h" | 31 | #include "bttv.h" |
32 | #include "mt352.h" | 32 | #include "mt352.h" |
33 | #include "sp887x.h" | 33 | #include "sp887x.h" |
34 | #include "dst.h" | 34 | #include "dst_common.h" |
35 | #include "nxt6000.h" | 35 | #include "nxt6000.h" |
36 | #include "cx24110.h" | 36 | #include "cx24110.h" |
37 | #include "or51211.h" | 37 | #include "or51211.h" |
@@ -40,7 +40,7 @@ struct dvb_bt8xx_card { | |||
40 | struct semaphore lock; | 40 | struct semaphore lock; |
41 | int nfeeds; | 41 | int nfeeds; |
42 | char card_name[32]; | 42 | char card_name[32]; |
43 | struct dvb_adapter *dvb_adapter; | 43 | struct dvb_adapter dvb_adapter; |
44 | struct bt878 *bt; | 44 | struct bt878 *bt; |
45 | unsigned int bttv_nr; | 45 | unsigned int bttv_nr; |
46 | struct dvb_demux demux; | 46 | struct dvb_demux demux; |
diff --git a/drivers/media/dvb/cinergyT2/cinergyT2.c b/drivers/media/dvb/cinergyT2/cinergyT2.c index 28d4d926de3e..96c57fde95a0 100644 --- a/drivers/media/dvb/cinergyT2/cinergyT2.c +++ b/drivers/media/dvb/cinergyT2/cinergyT2.c | |||
@@ -119,7 +119,7 @@ struct cinergyt2 { | |||
119 | struct dvb_demux demux; | 119 | struct dvb_demux demux; |
120 | struct usb_device *udev; | 120 | struct usb_device *udev; |
121 | struct semaphore sem; | 121 | struct semaphore sem; |
122 | struct dvb_adapter *adapter; | 122 | struct dvb_adapter adapter; |
123 | struct dvb_device *fedev; | 123 | struct dvb_device *fedev; |
124 | struct dmxdev dmxdev; | 124 | struct dmxdev dmxdev; |
125 | struct dvb_net dvbnet; | 125 | struct dvb_net dvbnet; |
@@ -813,15 +813,15 @@ static int cinergyt2_probe (struct usb_interface *intf, | |||
813 | cinergyt2->dmxdev.demux = &cinergyt2->demux.dmx; | 813 | cinergyt2->dmxdev.demux = &cinergyt2->demux.dmx; |
814 | cinergyt2->dmxdev.capabilities = 0; | 814 | cinergyt2->dmxdev.capabilities = 0; |
815 | 815 | ||
816 | if ((err = dvb_dmxdev_init(&cinergyt2->dmxdev, cinergyt2->adapter)) < 0) { | 816 | if ((err = dvb_dmxdev_init(&cinergyt2->dmxdev, &cinergyt2->adapter)) < 0) { |
817 | dprintk(1, "dvb_dmxdev_init() failed (err = %d)\n", err); | 817 | dprintk(1, "dvb_dmxdev_init() failed (err = %d)\n", err); |
818 | goto bailout; | 818 | goto bailout; |
819 | } | 819 | } |
820 | 820 | ||
821 | if (dvb_net_init(cinergyt2->adapter, &cinergyt2->dvbnet, &cinergyt2->demux.dmx)) | 821 | if (dvb_net_init(&cinergyt2->adapter, &cinergyt2->dvbnet, &cinergyt2->demux.dmx)) |
822 | dprintk(1, "dvb_net_init() failed!\n"); | 822 | dprintk(1, "dvb_net_init() failed!\n"); |
823 | 823 | ||
824 | dvb_register_device(cinergyt2->adapter, &cinergyt2->fedev, | 824 | dvb_register_device(&cinergyt2->adapter, &cinergyt2->fedev, |
825 | &cinergyt2_fe_template, cinergyt2, | 825 | &cinergyt2_fe_template, cinergyt2, |
826 | DVB_DEVICE_FRONTEND); | 826 | DVB_DEVICE_FRONTEND); |
827 | 827 | ||
@@ -848,7 +848,7 @@ static int cinergyt2_probe (struct usb_interface *intf, | |||
848 | bailout: | 848 | bailout: |
849 | dvb_dmxdev_release(&cinergyt2->dmxdev); | 849 | dvb_dmxdev_release(&cinergyt2->dmxdev); |
850 | dvb_dmx_release(&cinergyt2->demux); | 850 | dvb_dmx_release(&cinergyt2->demux); |
851 | dvb_unregister_adapter (cinergyt2->adapter); | 851 | dvb_unregister_adapter (&cinergyt2->adapter); |
852 | cinergyt2_free_stream_urbs (cinergyt2); | 852 | cinergyt2_free_stream_urbs (cinergyt2); |
853 | kfree(cinergyt2); | 853 | kfree(cinergyt2); |
854 | return -ENOMEM; | 854 | return -ENOMEM; |
@@ -872,7 +872,7 @@ static void cinergyt2_disconnect (struct usb_interface *intf) | |||
872 | dvb_dmxdev_release(&cinergyt2->dmxdev); | 872 | dvb_dmxdev_release(&cinergyt2->dmxdev); |
873 | dvb_dmx_release(&cinergyt2->demux); | 873 | dvb_dmx_release(&cinergyt2->demux); |
874 | dvb_unregister_device(cinergyt2->fedev); | 874 | dvb_unregister_device(cinergyt2->fedev); |
875 | dvb_unregister_adapter(cinergyt2->adapter); | 875 | dvb_unregister_adapter(&cinergyt2->adapter); |
876 | 876 | ||
877 | cinergyt2_free_stream_urbs(cinergyt2); | 877 | cinergyt2_free_stream_urbs(cinergyt2); |
878 | up(&cinergyt2->sem); | 878 | up(&cinergyt2->sem); |
diff --git a/drivers/media/dvb/dibusb/dvb-dibusb-dvb.c b/drivers/media/dvb/dibusb/dvb-dibusb-dvb.c index 04e54ec093f0..400b439e804e 100644 --- a/drivers/media/dvb/dibusb/dvb-dibusb-dvb.c +++ b/drivers/media/dvb/dibusb/dvb-dibusb-dvb.c | |||
@@ -131,7 +131,7 @@ int dibusb_dvb_init(struct usb_dibusb *dib) | |||
131 | deb_info("dvb_register_adapter failed: error %d", ret); | 131 | deb_info("dvb_register_adapter failed: error %d", ret); |
132 | goto err; | 132 | goto err; |
133 | } | 133 | } |
134 | dib->adapter->priv = dib; | 134 | dib->adapter.priv = dib; |
135 | 135 | ||
136 | /* i2c is done in dibusb_i2c_init */ | 136 | /* i2c is done in dibusb_i2c_init */ |
137 | 137 | ||
@@ -151,18 +151,18 @@ int dibusb_dvb_init(struct usb_dibusb *dib) | |||
151 | dib->dmxdev.filternum = dib->demux.filternum; | 151 | dib->dmxdev.filternum = dib->demux.filternum; |
152 | dib->dmxdev.demux = &dib->demux.dmx; | 152 | dib->dmxdev.demux = &dib->demux.dmx; |
153 | dib->dmxdev.capabilities = 0; | 153 | dib->dmxdev.capabilities = 0; |
154 | if ((ret = dvb_dmxdev_init(&dib->dmxdev, dib->adapter)) < 0) { | 154 | if ((ret = dvb_dmxdev_init(&dib->dmxdev, &dib->adapter)) < 0) { |
155 | err("dvb_dmxdev_init failed: error %d",ret); | 155 | err("dvb_dmxdev_init failed: error %d",ret); |
156 | goto err_dmx_dev; | 156 | goto err_dmx_dev; |
157 | } | 157 | } |
158 | 158 | ||
159 | dvb_net_init(dib->adapter, &dib->dvb_net, &dib->demux.dmx); | 159 | dvb_net_init(&dib->adapter, &dib->dvb_net, &dib->demux.dmx); |
160 | 160 | ||
161 | goto success; | 161 | goto success; |
162 | err_dmx_dev: | 162 | err_dmx_dev: |
163 | dvb_dmx_release(&dib->demux); | 163 | dvb_dmx_release(&dib->demux); |
164 | err_dmx: | 164 | err_dmx: |
165 | dvb_unregister_adapter(dib->adapter); | 165 | dvb_unregister_adapter(&dib->adapter); |
166 | err: | 166 | err: |
167 | return ret; | 167 | return ret; |
168 | success: | 168 | success: |
@@ -179,7 +179,7 @@ int dibusb_dvb_exit(struct usb_dibusb *dib) | |||
179 | dib->demux.dmx.close(&dib->demux.dmx); | 179 | dib->demux.dmx.close(&dib->demux.dmx); |
180 | dvb_dmxdev_release(&dib->dmxdev); | 180 | dvb_dmxdev_release(&dib->dmxdev); |
181 | dvb_dmx_release(&dib->demux); | 181 | dvb_dmx_release(&dib->demux); |
182 | dvb_unregister_adapter(dib->adapter); | 182 | dvb_unregister_adapter(&dib->adapter); |
183 | } | 183 | } |
184 | return 0; | 184 | return 0; |
185 | } | 185 | } |
diff --git a/drivers/media/dvb/dibusb/dvb-dibusb-fe-i2c.c b/drivers/media/dvb/dibusb/dvb-dibusb-fe-i2c.c index 2ed89488c7c4..5a71b88797d9 100644 --- a/drivers/media/dvb/dibusb/dvb-dibusb-fe-i2c.c +++ b/drivers/media/dvb/dibusb/dvb-dibusb-fe-i2c.c | |||
@@ -183,7 +183,7 @@ int dibusb_fe_init(struct usb_dibusb* dib) | |||
183 | dib->dibdev->name); | 183 | dib->dibdev->name); |
184 | return -ENODEV; | 184 | return -ENODEV; |
185 | } else { | 185 | } else { |
186 | if (dvb_register_frontend(dib->adapter, dib->fe)) { | 186 | if (dvb_register_frontend(&dib->adapter, dib->fe)) { |
187 | err("Frontend registration failed."); | 187 | err("Frontend registration failed."); |
188 | if (dib->fe->ops->release) | 188 | if (dib->fe->ops->release) |
189 | dib->fe->ops->release(dib->fe); | 189 | dib->fe->ops->release(dib->fe); |
@@ -206,7 +206,7 @@ int dibusb_i2c_init(struct usb_dibusb *dib) | |||
206 | { | 206 | { |
207 | int ret = 0; | 207 | int ret = 0; |
208 | 208 | ||
209 | dib->adapter->priv = dib; | 209 | dib->adapter.priv = dib; |
210 | 210 | ||
211 | strncpy(dib->i2c_adap.name,dib->dibdev->name,I2C_NAME_SIZE); | 211 | strncpy(dib->i2c_adap.name,dib->dibdev->name,I2C_NAME_SIZE); |
212 | #ifdef I2C_ADAP_CLASS_TV_DIGITAL | 212 | #ifdef I2C_ADAP_CLASS_TV_DIGITAL |
diff --git a/drivers/media/dvb/dibusb/dvb-dibusb.h b/drivers/media/dvb/dibusb/dvb-dibusb.h index 52cd35dd9d83..c965b64fb1ab 100644 --- a/drivers/media/dvb/dibusb/dvb-dibusb.h +++ b/drivers/media/dvb/dibusb/dvb-dibusb.h | |||
@@ -181,7 +181,7 @@ struct usb_dibusb { | |||
181 | struct semaphore i2c_sem; | 181 | struct semaphore i2c_sem; |
182 | 182 | ||
183 | /* dvb */ | 183 | /* dvb */ |
184 | struct dvb_adapter *adapter; | 184 | struct dvb_adapter adapter; |
185 | struct dmxdev dmxdev; | 185 | struct dmxdev dmxdev; |
186 | struct dvb_demux demux; | 186 | struct dvb_demux demux; |
187 | struct dvb_net dvb_net; | 187 | struct dvb_net dvb_net; |
diff --git a/drivers/media/dvb/dvb-core/dmxdev.c b/drivers/media/dvb/dvb-core/dmxdev.c index 1863f1dfb00c..c225de7ffd82 100644 --- a/drivers/media/dvb/dvb-core/dmxdev.c +++ b/drivers/media/dvb/dvb-core/dmxdev.c | |||
@@ -175,8 +175,8 @@ static inline void dvb_dmxdev_dvr_state_set(struct dmxdev_dvr *dmxdevdvr, int st | |||
175 | 175 | ||
176 | static int dvb_dvr_open(struct inode *inode, struct file *file) | 176 | static int dvb_dvr_open(struct inode *inode, struct file *file) |
177 | { | 177 | { |
178 | struct dvb_device *dvbdev=(struct dvb_device *) file->private_data; | 178 | struct dvb_device *dvbdev = file->private_data; |
179 | struct dmxdev *dmxdev=(struct dmxdev *) dvbdev->priv; | 179 | struct dmxdev *dmxdev = dvbdev->priv; |
180 | struct dmx_frontend *front; | 180 | struct dmx_frontend *front; |
181 | 181 | ||
182 | dprintk ("function : %s\n", __FUNCTION__); | 182 | dprintk ("function : %s\n", __FUNCTION__); |
@@ -224,8 +224,8 @@ static int dvb_dvr_open(struct inode *inode, struct file *file) | |||
224 | 224 | ||
225 | static int dvb_dvr_release(struct inode *inode, struct file *file) | 225 | static int dvb_dvr_release(struct inode *inode, struct file *file) |
226 | { | 226 | { |
227 | struct dvb_device *dvbdev=(struct dvb_device *) file->private_data; | 227 | struct dvb_device *dvbdev = file->private_data; |
228 | struct dmxdev *dmxdev=(struct dmxdev *) dvbdev->priv; | 228 | struct dmxdev *dmxdev = dvbdev->priv; |
229 | 229 | ||
230 | if (down_interruptible (&dmxdev->mutex)) | 230 | if (down_interruptible (&dmxdev->mutex)) |
231 | return -ERESTARTSYS; | 231 | return -ERESTARTSYS; |
@@ -252,8 +252,8 @@ static int dvb_dvr_release(struct inode *inode, struct file *file) | |||
252 | static ssize_t dvb_dvr_write(struct file *file, const char __user *buf, | 252 | static ssize_t dvb_dvr_write(struct file *file, const char __user *buf, |
253 | size_t count, loff_t *ppos) | 253 | size_t count, loff_t *ppos) |
254 | { | 254 | { |
255 | struct dvb_device *dvbdev=(struct dvb_device *) file->private_data; | 255 | struct dvb_device *dvbdev = file->private_data; |
256 | struct dmxdev *dmxdev=(struct dmxdev *) dvbdev->priv; | 256 | struct dmxdev *dmxdev = dvbdev->priv; |
257 | int ret; | 257 | int ret; |
258 | 258 | ||
259 | if (!dmxdev->demux->write) | 259 | if (!dmxdev->demux->write) |
@@ -270,8 +270,8 @@ static ssize_t dvb_dvr_write(struct file *file, const char __user *buf, | |||
270 | static ssize_t dvb_dvr_read(struct file *file, char __user *buf, size_t count, | 270 | static ssize_t dvb_dvr_read(struct file *file, char __user *buf, size_t count, |
271 | loff_t *ppos) | 271 | loff_t *ppos) |
272 | { | 272 | { |
273 | struct dvb_device *dvbdev=(struct dvb_device *) file->private_data; | 273 | struct dvb_device *dvbdev = file->private_data; |
274 | struct dmxdev *dmxdev=(struct dmxdev *) dvbdev->priv; | 274 | struct dmxdev *dmxdev = dvbdev->priv; |
275 | int ret; | 275 | int ret; |
276 | 276 | ||
277 | //down(&dmxdev->mutex); | 277 | //down(&dmxdev->mutex); |
@@ -345,7 +345,7 @@ static int dvb_dmxdev_section_callback(const u8 *buffer1, size_t buffer1_len, | |||
345 | const u8 *buffer2, size_t buffer2_len, | 345 | const u8 *buffer2, size_t buffer2_len, |
346 | struct dmx_section_filter *filter, enum dmx_success success) | 346 | struct dmx_section_filter *filter, enum dmx_success success) |
347 | { | 347 | { |
348 | struct dmxdev_filter *dmxdevfilter=(struct dmxdev_filter *) filter->priv; | 348 | struct dmxdev_filter *dmxdevfilter = filter->priv; |
349 | int ret; | 349 | int ret; |
350 | 350 | ||
351 | if (dmxdevfilter->buffer.error) { | 351 | if (dmxdevfilter->buffer.error) { |
@@ -381,7 +381,7 @@ static int dvb_dmxdev_ts_callback(const u8 *buffer1, size_t buffer1_len, | |||
381 | const u8 *buffer2, size_t buffer2_len, | 381 | const u8 *buffer2, size_t buffer2_len, |
382 | struct dmx_ts_feed *feed, enum dmx_success success) | 382 | struct dmx_ts_feed *feed, enum dmx_success success) |
383 | { | 383 | { |
384 | struct dmxdev_filter *dmxdevfilter=(struct dmxdev_filter *) feed->priv; | 384 | struct dmxdev_filter *dmxdevfilter = feed->priv; |
385 | struct dmxdev_buffer *buffer; | 385 | struct dmxdev_buffer *buffer; |
386 | int ret; | 386 | int ret; |
387 | 387 | ||
@@ -684,8 +684,8 @@ static int dvb_dmxdev_filter_start(struct dmxdev_filter *filter) | |||
684 | 684 | ||
685 | static int dvb_demux_open(struct inode *inode, struct file *file) | 685 | static int dvb_demux_open(struct inode *inode, struct file *file) |
686 | { | 686 | { |
687 | struct dvb_device *dvbdev=(struct dvb_device *) file->private_data; | 687 | struct dvb_device *dvbdev = file->private_data; |
688 | struct dmxdev *dmxdev=(struct dmxdev *) dvbdev->priv; | 688 | struct dmxdev *dmxdev = dvbdev->priv; |
689 | int i; | 689 | int i; |
690 | struct dmxdev_filter *dmxdevfilter; | 690 | struct dmxdev_filter *dmxdevfilter; |
691 | 691 | ||
@@ -1013,8 +1013,8 @@ static struct dvb_device dvbdev_demux = { | |||
1013 | static int dvb_dvr_do_ioctl(struct inode *inode, struct file *file, | 1013 | static int dvb_dvr_do_ioctl(struct inode *inode, struct file *file, |
1014 | unsigned int cmd, void *parg) | 1014 | unsigned int cmd, void *parg) |
1015 | { | 1015 | { |
1016 | struct dvb_device *dvbdev=(struct dvb_device *) file->private_data; | 1016 | struct dvb_device *dvbdev = file->private_data; |
1017 | struct dmxdev *dmxdev=(struct dmxdev *) dvbdev->priv; | 1017 | struct dmxdev *dmxdev = dvbdev->priv; |
1018 | 1018 | ||
1019 | int ret=0; | 1019 | int ret=0; |
1020 | 1020 | ||
@@ -1044,8 +1044,8 @@ static int dvb_dvr_ioctl(struct inode *inode, struct file *file, | |||
1044 | 1044 | ||
1045 | static unsigned int dvb_dvr_poll (struct file *file, poll_table *wait) | 1045 | static unsigned int dvb_dvr_poll (struct file *file, poll_table *wait) |
1046 | { | 1046 | { |
1047 | struct dvb_device *dvbdev = (struct dvb_device *) file->private_data; | 1047 | struct dvb_device *dvbdev = file->private_data; |
1048 | struct dmxdev *dmxdev = (struct dmxdev *) dvbdev->priv; | 1048 | struct dmxdev *dmxdev = dvbdev->priv; |
1049 | unsigned int mask = 0; | 1049 | unsigned int mask = 0; |
1050 | 1050 | ||
1051 | dprintk ("function : %s\n", __FUNCTION__); | 1051 | dprintk ("function : %s\n", __FUNCTION__); |
diff --git a/drivers/media/dvb/dvb-core/dvb_ca_en50221.c b/drivers/media/dvb/dvb-core/dvb_ca_en50221.c index c1ea89f2880c..0eb9aa711fb0 100644 --- a/drivers/media/dvb/dvb-core/dvb_ca_en50221.c +++ b/drivers/media/dvb/dvb-core/dvb_ca_en50221.c | |||
@@ -829,7 +829,7 @@ EXPORT_SYMBOL(dvb_ca_en50221_camready_irq); | |||
829 | */ | 829 | */ |
830 | void dvb_ca_en50221_camchange_irq(struct dvb_ca_en50221 *pubca, int slot, int change_type) | 830 | void dvb_ca_en50221_camchange_irq(struct dvb_ca_en50221 *pubca, int slot, int change_type) |
831 | { | 831 | { |
832 | struct dvb_ca_private *ca = (struct dvb_ca_private *) pubca->private; | 832 | struct dvb_ca_private *ca = pubca->private; |
833 | 833 | ||
834 | dprintk("CAMCHANGE IRQ slot:%i change_type:%i\n", slot, change_type); | 834 | dprintk("CAMCHANGE IRQ slot:%i change_type:%i\n", slot, change_type); |
835 | 835 | ||
@@ -857,7 +857,7 @@ EXPORT_SYMBOL(dvb_ca_en50221_frda_irq); | |||
857 | */ | 857 | */ |
858 | void dvb_ca_en50221_camready_irq(struct dvb_ca_en50221 *pubca, int slot) | 858 | void dvb_ca_en50221_camready_irq(struct dvb_ca_en50221 *pubca, int slot) |
859 | { | 859 | { |
860 | struct dvb_ca_private *ca = (struct dvb_ca_private *) pubca->private; | 860 | struct dvb_ca_private *ca = pubca->private; |
861 | 861 | ||
862 | dprintk("CAMREADY IRQ slot:%i\n", slot); | 862 | dprintk("CAMREADY IRQ slot:%i\n", slot); |
863 | 863 | ||
@@ -876,7 +876,7 @@ void dvb_ca_en50221_camready_irq(struct dvb_ca_en50221 *pubca, int slot) | |||
876 | */ | 876 | */ |
877 | void dvb_ca_en50221_frda_irq(struct dvb_ca_en50221 *pubca, int slot) | 877 | void dvb_ca_en50221_frda_irq(struct dvb_ca_en50221 *pubca, int slot) |
878 | { | 878 | { |
879 | struct dvb_ca_private *ca = (struct dvb_ca_private *) pubca->private; | 879 | struct dvb_ca_private *ca = pubca->private; |
880 | int flags; | 880 | int flags; |
881 | 881 | ||
882 | dprintk("FR/DA IRQ slot:%i\n", slot); | 882 | dprintk("FR/DA IRQ slot:%i\n", slot); |
@@ -993,7 +993,7 @@ static void dvb_ca_en50221_thread_update_delay(struct dvb_ca_private *ca) | |||
993 | */ | 993 | */ |
994 | static int dvb_ca_en50221_thread(void *data) | 994 | static int dvb_ca_en50221_thread(void *data) |
995 | { | 995 | { |
996 | struct dvb_ca_private *ca = (struct dvb_ca_private *) data; | 996 | struct dvb_ca_private *ca = data; |
997 | char name[15]; | 997 | char name[15]; |
998 | int slot; | 998 | int slot; |
999 | int flags; | 999 | int flags; |
@@ -1202,8 +1202,8 @@ static int dvb_ca_en50221_thread(void *data) | |||
1202 | static int dvb_ca_en50221_io_do_ioctl(struct inode *inode, struct file *file, | 1202 | static int dvb_ca_en50221_io_do_ioctl(struct inode *inode, struct file *file, |
1203 | unsigned int cmd, void *parg) | 1203 | unsigned int cmd, void *parg) |
1204 | { | 1204 | { |
1205 | struct dvb_device *dvbdev = (struct dvb_device *) file->private_data; | 1205 | struct dvb_device *dvbdev = file->private_data; |
1206 | struct dvb_ca_private *ca = (struct dvb_ca_private *) dvbdev->priv; | 1206 | struct dvb_ca_private *ca = dvbdev->priv; |
1207 | int err = 0; | 1207 | int err = 0; |
1208 | int slot; | 1208 | int slot; |
1209 | 1209 | ||
@@ -1225,7 +1225,7 @@ static int dvb_ca_en50221_io_do_ioctl(struct inode *inode, struct file *file, | |||
1225 | break; | 1225 | break; |
1226 | 1226 | ||
1227 | case CA_GET_CAP: { | 1227 | case CA_GET_CAP: { |
1228 | struct ca_caps *caps = (struct ca_caps *) parg; | 1228 | struct ca_caps *caps = parg; |
1229 | 1229 | ||
1230 | caps->slot_num = ca->slot_count; | 1230 | caps->slot_num = ca->slot_count; |
1231 | caps->slot_type = CA_CI_LINK; | 1231 | caps->slot_type = CA_CI_LINK; |
@@ -1235,7 +1235,7 @@ static int dvb_ca_en50221_io_do_ioctl(struct inode *inode, struct file *file, | |||
1235 | } | 1235 | } |
1236 | 1236 | ||
1237 | case CA_GET_SLOT_INFO: { | 1237 | case CA_GET_SLOT_INFO: { |
1238 | struct ca_slot_info *info = (struct ca_slot_info *) parg; | 1238 | struct ca_slot_info *info = parg; |
1239 | 1239 | ||
1240 | if ((info->num > ca->slot_count) || (info->num < 0)) | 1240 | if ((info->num > ca->slot_count) || (info->num < 0)) |
1241 | return -EINVAL; | 1241 | return -EINVAL; |
@@ -1291,8 +1291,8 @@ static int dvb_ca_en50221_io_ioctl(struct inode *inode, struct file *file, | |||
1291 | static ssize_t dvb_ca_en50221_io_write(struct file *file, | 1291 | static ssize_t dvb_ca_en50221_io_write(struct file *file, |
1292 | const char __user * buf, size_t count, loff_t * ppos) | 1292 | const char __user * buf, size_t count, loff_t * ppos) |
1293 | { | 1293 | { |
1294 | struct dvb_device *dvbdev = (struct dvb_device *) file->private_data; | 1294 | struct dvb_device *dvbdev = file->private_data; |
1295 | struct dvb_ca_private *ca = (struct dvb_ca_private *) dvbdev->priv; | 1295 | struct dvb_ca_private *ca = dvbdev->priv; |
1296 | u8 slot, connection_id; | 1296 | u8 slot, connection_id; |
1297 | int status; | 1297 | int status; |
1298 | char fragbuf[HOST_LINK_BUF_SIZE]; | 1298 | char fragbuf[HOST_LINK_BUF_SIZE]; |
@@ -1428,8 +1428,8 @@ static int dvb_ca_en50221_io_read_condition(struct dvb_ca_private *ca, int *resu | |||
1428 | static ssize_t dvb_ca_en50221_io_read(struct file *file, char __user * buf, | 1428 | static ssize_t dvb_ca_en50221_io_read(struct file *file, char __user * buf, |
1429 | size_t count, loff_t * ppos) | 1429 | size_t count, loff_t * ppos) |
1430 | { | 1430 | { |
1431 | struct dvb_device *dvbdev = (struct dvb_device *) file->private_data; | 1431 | struct dvb_device *dvbdev = file->private_data; |
1432 | struct dvb_ca_private *ca = (struct dvb_ca_private *) dvbdev->priv; | 1432 | struct dvb_ca_private *ca = dvbdev->priv; |
1433 | int status; | 1433 | int status; |
1434 | int result = 0; | 1434 | int result = 0; |
1435 | u8 hdr[2]; | 1435 | u8 hdr[2]; |
@@ -1526,8 +1526,8 @@ static ssize_t dvb_ca_en50221_io_read(struct file *file, char __user * buf, | |||
1526 | */ | 1526 | */ |
1527 | static int dvb_ca_en50221_io_open(struct inode *inode, struct file *file) | 1527 | static int dvb_ca_en50221_io_open(struct inode *inode, struct file *file) |
1528 | { | 1528 | { |
1529 | struct dvb_device *dvbdev = (struct dvb_device *) file->private_data; | 1529 | struct dvb_device *dvbdev = file->private_data; |
1530 | struct dvb_ca_private *ca = (struct dvb_ca_private *) dvbdev->priv; | 1530 | struct dvb_ca_private *ca = dvbdev->priv; |
1531 | int err; | 1531 | int err; |
1532 | int i; | 1532 | int i; |
1533 | 1533 | ||
@@ -1569,8 +1569,8 @@ static int dvb_ca_en50221_io_open(struct inode *inode, struct file *file) | |||
1569 | */ | 1569 | */ |
1570 | static int dvb_ca_en50221_io_release(struct inode *inode, struct file *file) | 1570 | static int dvb_ca_en50221_io_release(struct inode *inode, struct file *file) |
1571 | { | 1571 | { |
1572 | struct dvb_device *dvbdev = (struct dvb_device *) file->private_data; | 1572 | struct dvb_device *dvbdev = file->private_data; |
1573 | struct dvb_ca_private *ca = (struct dvb_ca_private *) dvbdev->priv; | 1573 | struct dvb_ca_private *ca = dvbdev->priv; |
1574 | int err = 0; | 1574 | int err = 0; |
1575 | 1575 | ||
1576 | dprintk("%s\n", __FUNCTION__); | 1576 | dprintk("%s\n", __FUNCTION__); |
@@ -1597,8 +1597,8 @@ static int dvb_ca_en50221_io_release(struct inode *inode, struct file *file) | |||
1597 | */ | 1597 | */ |
1598 | static unsigned int dvb_ca_en50221_io_poll(struct file *file, poll_table * wait) | 1598 | static unsigned int dvb_ca_en50221_io_poll(struct file *file, poll_table * wait) |
1599 | { | 1599 | { |
1600 | struct dvb_device *dvbdev = (struct dvb_device *) file->private_data; | 1600 | struct dvb_device *dvbdev = file->private_data; |
1601 | struct dvb_ca_private *ca = (struct dvb_ca_private *) dvbdev->priv; | 1601 | struct dvb_ca_private *ca = dvbdev->priv; |
1602 | unsigned int mask = 0; | 1602 | unsigned int mask = 0; |
1603 | int slot; | 1603 | int slot; |
1604 | int result = 0; | 1604 | int result = 0; |
@@ -1750,7 +1750,7 @@ EXPORT_SYMBOL(dvb_ca_en50221_release); | |||
1750 | */ | 1750 | */ |
1751 | void dvb_ca_en50221_release(struct dvb_ca_en50221 *pubca) | 1751 | void dvb_ca_en50221_release(struct dvb_ca_en50221 *pubca) |
1752 | { | 1752 | { |
1753 | struct dvb_ca_private *ca = (struct dvb_ca_private *) pubca->private; | 1753 | struct dvb_ca_private *ca = pubca->private; |
1754 | int i; | 1754 | int i; |
1755 | 1755 | ||
1756 | dprintk("%s\n", __FUNCTION__); | 1756 | dprintk("%s\n", __FUNCTION__); |
diff --git a/drivers/media/dvb/dvb-core/dvb_frontend.c b/drivers/media/dvb/dvb-core/dvb_frontend.c index 59a9adfae1eb..d19301d90a09 100644 --- a/drivers/media/dvb/dvb-core/dvb_frontend.c +++ b/drivers/media/dvb/dvb-core/dvb_frontend.c | |||
@@ -48,7 +48,7 @@ static int dvb_override_tune_delay; | |||
48 | static int dvb_powerdown_on_sleep = 1; | 48 | static int dvb_powerdown_on_sleep = 1; |
49 | 49 | ||
50 | module_param_named(frontend_debug, dvb_frontend_debug, int, 0644); | 50 | module_param_named(frontend_debug, dvb_frontend_debug, int, 0644); |
51 | MODULE_PARM_DESC(dvb_frontend_debug, "Turn on/off frontend core debugging (default:off)."); | 51 | MODULE_PARM_DESC(frontend_debug, "Turn on/off frontend core debugging (default:off)."); |
52 | module_param(dvb_shutdown_timeout, int, 0444); | 52 | module_param(dvb_shutdown_timeout, int, 0444); |
53 | MODULE_PARM_DESC(dvb_shutdown_timeout, "wait <shutdown_timeout> seconds after close() before suspending hardware"); | 53 | MODULE_PARM_DESC(dvb_shutdown_timeout, "wait <shutdown_timeout> seconds after close() before suspending hardware"); |
54 | module_param(dvb_force_auto_inversion, int, 0444); | 54 | module_param(dvb_force_auto_inversion, int, 0444); |
@@ -117,7 +117,7 @@ struct dvb_frontend_private { | |||
117 | 117 | ||
118 | static void dvb_frontend_add_event(struct dvb_frontend *fe, fe_status_t status) | 118 | static void dvb_frontend_add_event(struct dvb_frontend *fe, fe_status_t status) |
119 | { | 119 | { |
120 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 120 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
121 | struct dvb_fe_events *events = &fepriv->events; | 121 | struct dvb_fe_events *events = &fepriv->events; |
122 | struct dvb_frontend_event *e; | 122 | struct dvb_frontend_event *e; |
123 | int wp; | 123 | int wp; |
@@ -155,7 +155,7 @@ static void dvb_frontend_add_event(struct dvb_frontend *fe, fe_status_t status) | |||
155 | static int dvb_frontend_get_event(struct dvb_frontend *fe, | 155 | static int dvb_frontend_get_event(struct dvb_frontend *fe, |
156 | struct dvb_frontend_event *event, int flags) | 156 | struct dvb_frontend_event *event, int flags) |
157 | { | 157 | { |
158 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 158 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
159 | struct dvb_fe_events *events = &fepriv->events; | 159 | struct dvb_fe_events *events = &fepriv->events; |
160 | 160 | ||
161 | dprintk ("%s\n", __FUNCTION__); | 161 | dprintk ("%s\n", __FUNCTION__); |
@@ -234,7 +234,7 @@ static int dvb_frontend_autotune(struct dvb_frontend *fe, int check_wrapped) | |||
234 | { | 234 | { |
235 | int autoinversion; | 235 | int autoinversion; |
236 | int ready = 0; | 236 | int ready = 0; |
237 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 237 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
238 | int original_inversion = fepriv->parameters.inversion; | 238 | int original_inversion = fepriv->parameters.inversion; |
239 | u32 original_frequency = fepriv->parameters.frequency; | 239 | u32 original_frequency = fepriv->parameters.frequency; |
240 | 240 | ||
@@ -321,7 +321,7 @@ static int dvb_frontend_autotune(struct dvb_frontend *fe, int check_wrapped) | |||
321 | 321 | ||
322 | static int dvb_frontend_is_exiting(struct dvb_frontend *fe) | 322 | static int dvb_frontend_is_exiting(struct dvb_frontend *fe) |
323 | { | 323 | { |
324 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 324 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
325 | 325 | ||
326 | if (fepriv->exit) | 326 | if (fepriv->exit) |
327 | return 1; | 327 | return 1; |
@@ -335,7 +335,7 @@ static int dvb_frontend_is_exiting(struct dvb_frontend *fe) | |||
335 | 335 | ||
336 | static int dvb_frontend_should_wakeup(struct dvb_frontend *fe) | 336 | static int dvb_frontend_should_wakeup(struct dvb_frontend *fe) |
337 | { | 337 | { |
338 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 338 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
339 | 339 | ||
340 | if (fepriv->wakeup) { | 340 | if (fepriv->wakeup) { |
341 | fepriv->wakeup = 0; | 341 | fepriv->wakeup = 0; |
@@ -346,7 +346,7 @@ static int dvb_frontend_should_wakeup(struct dvb_frontend *fe) | |||
346 | 346 | ||
347 | static void dvb_frontend_wakeup(struct dvb_frontend *fe) | 347 | static void dvb_frontend_wakeup(struct dvb_frontend *fe) |
348 | { | 348 | { |
349 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 349 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
350 | 350 | ||
351 | fepriv->wakeup = 1; | 351 | fepriv->wakeup = 1; |
352 | wake_up_interruptible(&fepriv->wait_queue); | 352 | wake_up_interruptible(&fepriv->wait_queue); |
@@ -357,8 +357,8 @@ static void dvb_frontend_wakeup(struct dvb_frontend *fe) | |||
357 | */ | 357 | */ |
358 | static int dvb_frontend_thread(void *data) | 358 | static int dvb_frontend_thread(void *data) |
359 | { | 359 | { |
360 | struct dvb_frontend *fe = (struct dvb_frontend *) data; | 360 | struct dvb_frontend *fe = data; |
361 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 361 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
362 | unsigned long timeout; | 362 | unsigned long timeout; |
363 | char name [15]; | 363 | char name [15]; |
364 | int quality = 0, delay = 3*HZ; | 364 | int quality = 0, delay = 3*HZ; |
@@ -520,7 +520,7 @@ static int dvb_frontend_thread(void *data) | |||
520 | static void dvb_frontend_stop(struct dvb_frontend *fe) | 520 | static void dvb_frontend_stop(struct dvb_frontend *fe) |
521 | { | 521 | { |
522 | unsigned long ret; | 522 | unsigned long ret; |
523 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 523 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
524 | 524 | ||
525 | dprintk ("%s\n", __FUNCTION__); | 525 | dprintk ("%s\n", __FUNCTION__); |
526 | 526 | ||
@@ -559,7 +559,7 @@ static void dvb_frontend_stop(struct dvb_frontend *fe) | |||
559 | static int dvb_frontend_start(struct dvb_frontend *fe) | 559 | static int dvb_frontend_start(struct dvb_frontend *fe) |
560 | { | 560 | { |
561 | int ret; | 561 | int ret; |
562 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 562 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
563 | 563 | ||
564 | dprintk ("%s\n", __FUNCTION__); | 564 | dprintk ("%s\n", __FUNCTION__); |
565 | 565 | ||
@@ -597,7 +597,7 @@ static int dvb_frontend_ioctl(struct inode *inode, struct file *file, | |||
597 | { | 597 | { |
598 | struct dvb_device *dvbdev = file->private_data; | 598 | struct dvb_device *dvbdev = file->private_data; |
599 | struct dvb_frontend *fe = dvbdev->priv; | 599 | struct dvb_frontend *fe = dvbdev->priv; |
600 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 600 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
601 | int err = -EOPNOTSUPP; | 601 | int err = -EOPNOTSUPP; |
602 | 602 | ||
603 | dprintk ("%s\n", __FUNCTION__); | 603 | dprintk ("%s\n", __FUNCTION__); |
@@ -615,7 +615,7 @@ static int dvb_frontend_ioctl(struct inode *inode, struct file *file, | |||
615 | 615 | ||
616 | switch (cmd) { | 616 | switch (cmd) { |
617 | case FE_GET_INFO: { | 617 | case FE_GET_INFO: { |
618 | struct dvb_frontend_info* info = (struct dvb_frontend_info*) parg; | 618 | struct dvb_frontend_info* info = parg; |
619 | memcpy(info, &fe->ops->info, sizeof(struct dvb_frontend_info)); | 619 | memcpy(info, &fe->ops->info, sizeof(struct dvb_frontend_info)); |
620 | 620 | ||
621 | /* Force the CAN_INVERSION_AUTO bit on. If the frontend doesn't | 621 | /* Force the CAN_INVERSION_AUTO bit on. If the frontend doesn't |
@@ -793,7 +793,7 @@ static unsigned int dvb_frontend_poll(struct file *file, struct poll_table_struc | |||
793 | { | 793 | { |
794 | struct dvb_device *dvbdev = file->private_data; | 794 | struct dvb_device *dvbdev = file->private_data; |
795 | struct dvb_frontend *fe = dvbdev->priv; | 795 | struct dvb_frontend *fe = dvbdev->priv; |
796 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 796 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
797 | 797 | ||
798 | dprintk ("%s\n", __FUNCTION__); | 798 | dprintk ("%s\n", __FUNCTION__); |
799 | 799 | ||
@@ -809,7 +809,7 @@ static int dvb_frontend_open(struct inode *inode, struct file *file) | |||
809 | { | 809 | { |
810 | struct dvb_device *dvbdev = file->private_data; | 810 | struct dvb_device *dvbdev = file->private_data; |
811 | struct dvb_frontend *fe = dvbdev->priv; | 811 | struct dvb_frontend *fe = dvbdev->priv; |
812 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 812 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
813 | int ret; | 813 | int ret; |
814 | 814 | ||
815 | dprintk ("%s\n", __FUNCTION__); | 815 | dprintk ("%s\n", __FUNCTION__); |
@@ -833,7 +833,7 @@ static int dvb_frontend_release(struct inode *inode, struct file *file) | |||
833 | { | 833 | { |
834 | struct dvb_device *dvbdev = file->private_data; | 834 | struct dvb_device *dvbdev = file->private_data; |
835 | struct dvb_frontend *fe = dvbdev->priv; | 835 | struct dvb_frontend *fe = dvbdev->priv; |
836 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 836 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
837 | 837 | ||
838 | dprintk ("%s\n", __FUNCTION__); | 838 | dprintk ("%s\n", __FUNCTION__); |
839 | 839 | ||
@@ -873,7 +873,7 @@ int dvb_register_frontend(struct dvb_adapter* dvb, | |||
873 | up(&frontend_mutex); | 873 | up(&frontend_mutex); |
874 | return -ENOMEM; | 874 | return -ENOMEM; |
875 | } | 875 | } |
876 | fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 876 | fepriv = fe->frontend_priv; |
877 | memset(fe->frontend_priv, 0, sizeof(struct dvb_frontend_private)); | 877 | memset(fe->frontend_priv, 0, sizeof(struct dvb_frontend_private)); |
878 | 878 | ||
879 | init_MUTEX (&fepriv->sem); | 879 | init_MUTEX (&fepriv->sem); |
@@ -897,7 +897,7 @@ EXPORT_SYMBOL(dvb_register_frontend); | |||
897 | 897 | ||
898 | int dvb_unregister_frontend(struct dvb_frontend* fe) | 898 | int dvb_unregister_frontend(struct dvb_frontend* fe) |
899 | { | 899 | { |
900 | struct dvb_frontend_private *fepriv = (struct dvb_frontend_private*) fe->frontend_priv; | 900 | struct dvb_frontend_private *fepriv = fe->frontend_priv; |
901 | dprintk ("%s\n", __FUNCTION__); | 901 | dprintk ("%s\n", __FUNCTION__); |
902 | 902 | ||
903 | down (&frontend_mutex); | 903 | down (&frontend_mutex); |
diff --git a/drivers/media/dvb/dvb-core/dvb_net.c b/drivers/media/dvb/dvb-core/dvb_net.c index 44892e7abd3d..6a968c346a36 100644 --- a/drivers/media/dvb/dvb-core/dvb_net.c +++ b/drivers/media/dvb/dvb-core/dvb_net.c | |||
@@ -315,7 +315,7 @@ static inline void reset_ule( struct dvb_net_priv *p ) | |||
315 | */ | 315 | */ |
316 | static void dvb_net_ule( struct net_device *dev, const u8 *buf, size_t buf_len ) | 316 | static void dvb_net_ule( struct net_device *dev, const u8 *buf, size_t buf_len ) |
317 | { | 317 | { |
318 | struct dvb_net_priv *priv = (struct dvb_net_priv *)dev->priv; | 318 | struct dvb_net_priv *priv = dev->priv; |
319 | unsigned long skipped = 0L; | 319 | unsigned long skipped = 0L; |
320 | u8 *ts, *ts_end, *from_where = NULL, ts_remain = 0, how_much = 0, new_ts = 1; | 320 | u8 *ts, *ts_end, *from_where = NULL, ts_remain = 0, how_much = 0, new_ts = 1; |
321 | struct ethhdr *ethh = NULL; | 321 | struct ethhdr *ethh = NULL; |
@@ -709,7 +709,7 @@ static int dvb_net_ts_callback(const u8 *buffer1, size_t buffer1_len, | |||
709 | const u8 *buffer2, size_t buffer2_len, | 709 | const u8 *buffer2, size_t buffer2_len, |
710 | struct dmx_ts_feed *feed, enum dmx_success success) | 710 | struct dmx_ts_feed *feed, enum dmx_success success) |
711 | { | 711 | { |
712 | struct net_device *dev = (struct net_device *)feed->priv; | 712 | struct net_device *dev = feed->priv; |
713 | 713 | ||
714 | if (buffer2 != 0) | 714 | if (buffer2 != 0) |
715 | printk(KERN_WARNING "buffer2 not 0: %p.\n", buffer2); | 715 | printk(KERN_WARNING "buffer2 not 0: %p.\n", buffer2); |
@@ -727,6 +727,7 @@ static void dvb_net_sec(struct net_device *dev, u8 *pkt, int pkt_len) | |||
727 | u8 *eth; | 727 | u8 *eth; |
728 | struct sk_buff *skb; | 728 | struct sk_buff *skb; |
729 | struct net_device_stats *stats = &(((struct dvb_net_priv *) dev->priv)->stats); | 729 | struct net_device_stats *stats = &(((struct dvb_net_priv *) dev->priv)->stats); |
730 | int snap = 0; | ||
730 | 731 | ||
731 | /* note: pkt_len includes a 32bit checksum */ | 732 | /* note: pkt_len includes a 32bit checksum */ |
732 | if (pkt_len < 16) { | 733 | if (pkt_len < 16) { |
@@ -750,9 +751,12 @@ static void dvb_net_sec(struct net_device *dev, u8 *pkt, int pkt_len) | |||
750 | return; | 751 | return; |
751 | } | 752 | } |
752 | if (pkt[5] & 0x02) { | 753 | if (pkt[5] & 0x02) { |
753 | //FIXME: handle LLC/SNAP | 754 | /* handle LLC/SNAP, see rfc-1042 */ |
754 | stats->rx_dropped++; | 755 | if (pkt_len < 24 || memcmp(&pkt[12], "\xaa\xaa\x03\0\0\0", 6)) { |
755 | return; | 756 | stats->rx_dropped++; |
757 | return; | ||
758 | } | ||
759 | snap = 8; | ||
756 | } | 760 | } |
757 | if (pkt[7]) { | 761 | if (pkt[7]) { |
758 | /* FIXME: assemble datagram from multiple sections */ | 762 | /* FIXME: assemble datagram from multiple sections */ |
@@ -762,9 +766,9 @@ static void dvb_net_sec(struct net_device *dev, u8 *pkt, int pkt_len) | |||
762 | } | 766 | } |
763 | 767 | ||
764 | /* we have 14 byte ethernet header (ip header follows); | 768 | /* we have 14 byte ethernet header (ip header follows); |
765 | * 12 byte MPE header; 4 byte checksum; + 2 byte alignment | 769 | * 12 byte MPE header; 4 byte checksum; + 2 byte alignment, 8 byte LLC/SNAP |
766 | */ | 770 | */ |
767 | if (!(skb = dev_alloc_skb(pkt_len - 4 - 12 + 14 + 2))) { | 771 | if (!(skb = dev_alloc_skb(pkt_len - 4 - 12 + 14 + 2 - snap))) { |
768 | //printk(KERN_NOTICE "%s: Memory squeeze, dropping packet.\n", dev->name); | 772 | //printk(KERN_NOTICE "%s: Memory squeeze, dropping packet.\n", dev->name); |
769 | stats->rx_dropped++; | 773 | stats->rx_dropped++; |
770 | return; | 774 | return; |
@@ -773,8 +777,8 @@ static void dvb_net_sec(struct net_device *dev, u8 *pkt, int pkt_len) | |||
773 | skb->dev = dev; | 777 | skb->dev = dev; |
774 | 778 | ||
775 | /* copy L3 payload */ | 779 | /* copy L3 payload */ |
776 | eth = (u8 *) skb_put(skb, pkt_len - 12 - 4 + 14); | 780 | eth = (u8 *) skb_put(skb, pkt_len - 12 - 4 + 14 - snap); |
777 | memcpy(eth + 14, pkt + 12, pkt_len - 12 - 4); | 781 | memcpy(eth + 14, pkt + 12 + snap, pkt_len - 12 - 4 - snap); |
778 | 782 | ||
779 | /* create ethernet header: */ | 783 | /* create ethernet header: */ |
780 | eth[0]=pkt[0x0b]; | 784 | eth[0]=pkt[0x0b]; |
@@ -786,8 +790,21 @@ static void dvb_net_sec(struct net_device *dev, u8 *pkt, int pkt_len) | |||
786 | 790 | ||
787 | eth[6]=eth[7]=eth[8]=eth[9]=eth[10]=eth[11]=0; | 791 | eth[6]=eth[7]=eth[8]=eth[9]=eth[10]=eth[11]=0; |
788 | 792 | ||
789 | eth[12] = 0x08; /* ETH_P_IP */ | 793 | if (snap) { |
790 | eth[13] = 0x00; | 794 | eth[12] = pkt[18]; |
795 | eth[13] = pkt[19]; | ||
796 | } else { | ||
797 | /* protocol numbers are from rfc-1700 or | ||
798 | * http://www.iana.org/assignments/ethernet-numbers | ||
799 | */ | ||
800 | if (pkt[12] >> 4 == 6) { /* version field from IP header */ | ||
801 | eth[12] = 0x86; /* IPv6 */ | ||
802 | eth[13] = 0xdd; | ||
803 | } else { | ||
804 | eth[12] = 0x08; /* IPv4 */ | ||
805 | eth[13] = 0x00; | ||
806 | } | ||
807 | } | ||
791 | 808 | ||
792 | skb->protocol = dvb_net_eth_type_trans(skb, dev); | 809 | skb->protocol = dvb_net_eth_type_trans(skb, dev); |
793 | 810 | ||
@@ -801,7 +818,7 @@ static int dvb_net_sec_callback(const u8 *buffer1, size_t buffer1_len, | |||
801 | struct dmx_section_filter *filter, | 818 | struct dmx_section_filter *filter, |
802 | enum dmx_success success) | 819 | enum dmx_success success) |
803 | { | 820 | { |
804 | struct net_device *dev=(struct net_device *) filter->priv; | 821 | struct net_device *dev = filter->priv; |
805 | 822 | ||
806 | /** | 823 | /** |
807 | * we rely on the DVB API definition where exactly one complete | 824 | * we rely on the DVB API definition where exactly one complete |
@@ -826,7 +843,7 @@ static int dvb_net_filter_sec_set(struct net_device *dev, | |||
826 | struct dmx_section_filter **secfilter, | 843 | struct dmx_section_filter **secfilter, |
827 | u8 *mac, u8 *mac_mask) | 844 | u8 *mac, u8 *mac_mask) |
828 | { | 845 | { |
829 | struct dvb_net_priv *priv = (struct dvb_net_priv*) dev->priv; | 846 | struct dvb_net_priv *priv = dev->priv; |
830 | int ret; | 847 | int ret; |
831 | 848 | ||
832 | *secfilter=NULL; | 849 | *secfilter=NULL; |
@@ -870,7 +887,7 @@ static int dvb_net_filter_sec_set(struct net_device *dev, | |||
870 | static int dvb_net_feed_start(struct net_device *dev) | 887 | static int dvb_net_feed_start(struct net_device *dev) |
871 | { | 888 | { |
872 | int ret, i; | 889 | int ret, i; |
873 | struct dvb_net_priv *priv = (struct dvb_net_priv*) dev->priv; | 890 | struct dvb_net_priv *priv = dev->priv; |
874 | struct dmx_demux *demux = priv->demux; | 891 | struct dmx_demux *demux = priv->demux; |
875 | unsigned char *mac = (unsigned char *) dev->dev_addr; | 892 | unsigned char *mac = (unsigned char *) dev->dev_addr; |
876 | 893 | ||
@@ -965,7 +982,7 @@ static int dvb_net_feed_start(struct net_device *dev) | |||
965 | 982 | ||
966 | static int dvb_net_feed_stop(struct net_device *dev) | 983 | static int dvb_net_feed_stop(struct net_device *dev) |
967 | { | 984 | { |
968 | struct dvb_net_priv *priv = (struct dvb_net_priv*) dev->priv; | 985 | struct dvb_net_priv *priv = dev->priv; |
969 | int i; | 986 | int i; |
970 | 987 | ||
971 | dprintk("%s\n", __FUNCTION__); | 988 | dprintk("%s\n", __FUNCTION__); |
@@ -1016,7 +1033,7 @@ static int dvb_net_feed_stop(struct net_device *dev) | |||
1016 | 1033 | ||
1017 | static int dvb_set_mc_filter (struct net_device *dev, struct dev_mc_list *mc) | 1034 | static int dvb_set_mc_filter (struct net_device *dev, struct dev_mc_list *mc) |
1018 | { | 1035 | { |
1019 | struct dvb_net_priv *priv = (struct dvb_net_priv*) dev->priv; | 1036 | struct dvb_net_priv *priv = dev->priv; |
1020 | 1037 | ||
1021 | if (priv->multi_num == DVB_NET_MULTICAST_MAX) | 1038 | if (priv->multi_num == DVB_NET_MULTICAST_MAX) |
1022 | return -ENOMEM; | 1039 | return -ENOMEM; |
@@ -1031,7 +1048,7 @@ static int dvb_set_mc_filter (struct net_device *dev, struct dev_mc_list *mc) | |||
1031 | static void wq_set_multicast_list (void *data) | 1048 | static void wq_set_multicast_list (void *data) |
1032 | { | 1049 | { |
1033 | struct net_device *dev = data; | 1050 | struct net_device *dev = data; |
1034 | struct dvb_net_priv *priv = (struct dvb_net_priv*) dev->priv; | 1051 | struct dvb_net_priv *priv = dev->priv; |
1035 | 1052 | ||
1036 | dvb_net_feed_stop(dev); | 1053 | dvb_net_feed_stop(dev); |
1037 | 1054 | ||
@@ -1066,7 +1083,7 @@ static void wq_set_multicast_list (void *data) | |||
1066 | 1083 | ||
1067 | static void dvb_net_set_multicast_list (struct net_device *dev) | 1084 | static void dvb_net_set_multicast_list (struct net_device *dev) |
1068 | { | 1085 | { |
1069 | struct dvb_net_priv *priv = (struct dvb_net_priv*) dev->priv; | 1086 | struct dvb_net_priv *priv = dev->priv; |
1070 | schedule_work(&priv->set_multicast_list_wq); | 1087 | schedule_work(&priv->set_multicast_list_wq); |
1071 | } | 1088 | } |
1072 | 1089 | ||
@@ -1084,7 +1101,7 @@ static void wq_restart_net_feed (void *data) | |||
1084 | 1101 | ||
1085 | static int dvb_net_set_mac (struct net_device *dev, void *p) | 1102 | static int dvb_net_set_mac (struct net_device *dev, void *p) |
1086 | { | 1103 | { |
1087 | struct dvb_net_priv *priv = (struct dvb_net_priv*) dev->priv; | 1104 | struct dvb_net_priv *priv = dev->priv; |
1088 | struct sockaddr *addr=p; | 1105 | struct sockaddr *addr=p; |
1089 | 1106 | ||
1090 | memcpy(dev->dev_addr, addr->sa_data, dev->addr_len); | 1107 | memcpy(dev->dev_addr, addr->sa_data, dev->addr_len); |
@@ -1098,7 +1115,7 @@ static int dvb_net_set_mac (struct net_device *dev, void *p) | |||
1098 | 1115 | ||
1099 | static int dvb_net_open(struct net_device *dev) | 1116 | static int dvb_net_open(struct net_device *dev) |
1100 | { | 1117 | { |
1101 | struct dvb_net_priv *priv = (struct dvb_net_priv*) dev->priv; | 1118 | struct dvb_net_priv *priv = dev->priv; |
1102 | 1119 | ||
1103 | priv->in_use++; | 1120 | priv->in_use++; |
1104 | dvb_net_feed_start(dev); | 1121 | dvb_net_feed_start(dev); |
@@ -1108,7 +1125,7 @@ static int dvb_net_open(struct net_device *dev) | |||
1108 | 1125 | ||
1109 | static int dvb_net_stop(struct net_device *dev) | 1126 | static int dvb_net_stop(struct net_device *dev) |
1110 | { | 1127 | { |
1111 | struct dvb_net_priv *priv = (struct dvb_net_priv*) dev->priv; | 1128 | struct dvb_net_priv *priv = dev->priv; |
1112 | 1129 | ||
1113 | priv->in_use--; | 1130 | priv->in_use--; |
1114 | return dvb_net_feed_stop(dev); | 1131 | return dvb_net_feed_stop(dev); |
@@ -1228,8 +1245,8 @@ static int dvb_net_remove_if(struct dvb_net *dvbnet, unsigned int num) | |||
1228 | static int dvb_net_do_ioctl(struct inode *inode, struct file *file, | 1245 | static int dvb_net_do_ioctl(struct inode *inode, struct file *file, |
1229 | unsigned int cmd, void *parg) | 1246 | unsigned int cmd, void *parg) |
1230 | { | 1247 | { |
1231 | struct dvb_device *dvbdev = (struct dvb_device *) file->private_data; | 1248 | struct dvb_device *dvbdev = file->private_data; |
1232 | struct dvb_net *dvbnet = (struct dvb_net *) dvbdev->priv; | 1249 | struct dvb_net *dvbnet = dvbdev->priv; |
1233 | 1250 | ||
1234 | if (((file->f_flags&O_ACCMODE)==O_RDONLY)) | 1251 | if (((file->f_flags&O_ACCMODE)==O_RDONLY)) |
1235 | return -EPERM; | 1252 | return -EPERM; |
@@ -1237,7 +1254,7 @@ static int dvb_net_do_ioctl(struct inode *inode, struct file *file, | |||
1237 | switch (cmd) { | 1254 | switch (cmd) { |
1238 | case NET_ADD_IF: | 1255 | case NET_ADD_IF: |
1239 | { | 1256 | { |
1240 | struct dvb_net_if *dvbnetif=(struct dvb_net_if *)parg; | 1257 | struct dvb_net_if *dvbnetif = parg; |
1241 | int result; | 1258 | int result; |
1242 | 1259 | ||
1243 | if (!capable(CAP_SYS_ADMIN)) | 1260 | if (!capable(CAP_SYS_ADMIN)) |
@@ -1258,7 +1275,7 @@ static int dvb_net_do_ioctl(struct inode *inode, struct file *file, | |||
1258 | { | 1275 | { |
1259 | struct net_device *netdev; | 1276 | struct net_device *netdev; |
1260 | struct dvb_net_priv *priv_data; | 1277 | struct dvb_net_priv *priv_data; |
1261 | struct dvb_net_if *dvbnetif=(struct dvb_net_if *)parg; | 1278 | struct dvb_net_if *dvbnetif = parg; |
1262 | 1279 | ||
1263 | if (dvbnetif->if_num >= DVB_NET_DEVICES_MAX || | 1280 | if (dvbnetif->if_num >= DVB_NET_DEVICES_MAX || |
1264 | !dvbnet->state[dvbnetif->if_num]) | 1281 | !dvbnet->state[dvbnetif->if_num]) |
@@ -1266,7 +1283,7 @@ static int dvb_net_do_ioctl(struct inode *inode, struct file *file, | |||
1266 | 1283 | ||
1267 | netdev = dvbnet->device[dvbnetif->if_num]; | 1284 | netdev = dvbnet->device[dvbnetif->if_num]; |
1268 | 1285 | ||
1269 | priv_data=(struct dvb_net_priv*)netdev->priv; | 1286 | priv_data = netdev->priv; |
1270 | dvbnetif->pid=priv_data->pid; | 1287 | dvbnetif->pid=priv_data->pid; |
1271 | dvbnetif->feedtype=priv_data->feedtype; | 1288 | dvbnetif->feedtype=priv_data->feedtype; |
1272 | break; | 1289 | break; |
@@ -1288,7 +1305,7 @@ static int dvb_net_do_ioctl(struct inode *inode, struct file *file, | |||
1288 | /* binary compatiblity cruft */ | 1305 | /* binary compatiblity cruft */ |
1289 | case __NET_ADD_IF_OLD: | 1306 | case __NET_ADD_IF_OLD: |
1290 | { | 1307 | { |
1291 | struct __dvb_net_if_old *dvbnetif=(struct __dvb_net_if_old *)parg; | 1308 | struct __dvb_net_if_old *dvbnetif = parg; |
1292 | int result; | 1309 | int result; |
1293 | 1310 | ||
1294 | if (!capable(CAP_SYS_ADMIN)) | 1311 | if (!capable(CAP_SYS_ADMIN)) |
@@ -1309,7 +1326,7 @@ static int dvb_net_do_ioctl(struct inode *inode, struct file *file, | |||
1309 | { | 1326 | { |
1310 | struct net_device *netdev; | 1327 | struct net_device *netdev; |
1311 | struct dvb_net_priv *priv_data; | 1328 | struct dvb_net_priv *priv_data; |
1312 | struct __dvb_net_if_old *dvbnetif=(struct __dvb_net_if_old *)parg; | 1329 | struct __dvb_net_if_old *dvbnetif = parg; |
1313 | 1330 | ||
1314 | if (dvbnetif->if_num >= DVB_NET_DEVICES_MAX || | 1331 | if (dvbnetif->if_num >= DVB_NET_DEVICES_MAX || |
1315 | !dvbnet->state[dvbnetif->if_num]) | 1332 | !dvbnet->state[dvbnetif->if_num]) |
@@ -1317,7 +1334,7 @@ static int dvb_net_do_ioctl(struct inode *inode, struct file *file, | |||
1317 | 1334 | ||
1318 | netdev = dvbnet->device[dvbnetif->if_num]; | 1335 | netdev = dvbnet->device[dvbnetif->if_num]; |
1319 | 1336 | ||
1320 | priv_data=(struct dvb_net_priv*)netdev->priv; | 1337 | priv_data = netdev->priv; |
1321 | dvbnetif->pid=priv_data->pid; | 1338 | dvbnetif->pid=priv_data->pid; |
1322 | break; | 1339 | break; |
1323 | } | 1340 | } |
diff --git a/drivers/media/dvb/dvb-core/dvbdev.c b/drivers/media/dvb/dvb-core/dvbdev.c index cf4ffe38fda3..9d9662f4b8e6 100644 --- a/drivers/media/dvb/dvb-core/dvbdev.c +++ b/drivers/media/dvb/dvb-core/dvbdev.c | |||
@@ -286,9 +286,8 @@ skip: | |||
286 | } | 286 | } |
287 | 287 | ||
288 | 288 | ||
289 | int dvb_register_adapter(struct dvb_adapter **padap, const char *name, struct module *module) | 289 | int dvb_register_adapter(struct dvb_adapter *adap, const char *name, struct module *module) |
290 | { | 290 | { |
291 | struct dvb_adapter *adap; | ||
292 | int num; | 291 | int num; |
293 | 292 | ||
294 | if (down_interruptible (&dvbdev_register_lock)) | 293 | if (down_interruptible (&dvbdev_register_lock)) |
@@ -299,11 +298,6 @@ int dvb_register_adapter(struct dvb_adapter **padap, const char *name, struct mo | |||
299 | return -ENFILE; | 298 | return -ENFILE; |
300 | } | 299 | } |
301 | 300 | ||
302 | if (!(*padap = adap = kmalloc(sizeof(struct dvb_adapter), GFP_KERNEL))) { | ||
303 | up(&dvbdev_register_lock); | ||
304 | return -ENOMEM; | ||
305 | } | ||
306 | |||
307 | memset (adap, 0, sizeof(struct dvb_adapter)); | 301 | memset (adap, 0, sizeof(struct dvb_adapter)); |
308 | INIT_LIST_HEAD (&adap->device_list); | 302 | INIT_LIST_HEAD (&adap->device_list); |
309 | 303 | ||
@@ -331,7 +325,6 @@ int dvb_unregister_adapter(struct dvb_adapter *adap) | |||
331 | return -ERESTARTSYS; | 325 | return -ERESTARTSYS; |
332 | list_del (&adap->list_head); | 326 | list_del (&adap->list_head); |
333 | up (&dvbdev_register_lock); | 327 | up (&dvbdev_register_lock); |
334 | kfree (adap); | ||
335 | return 0; | 328 | return 0; |
336 | } | 329 | } |
337 | EXPORT_SYMBOL(dvb_unregister_adapter); | 330 | EXPORT_SYMBOL(dvb_unregister_adapter); |
diff --git a/drivers/media/dvb/dvb-core/dvbdev.h b/drivers/media/dvb/dvb-core/dvbdev.h index 184edba3caa7..a251867f30f1 100644 --- a/drivers/media/dvb/dvb-core/dvbdev.h +++ b/drivers/media/dvb/dvb-core/dvbdev.h | |||
@@ -76,7 +76,7 @@ struct dvb_device { | |||
76 | }; | 76 | }; |
77 | 77 | ||
78 | 78 | ||
79 | extern int dvb_register_adapter (struct dvb_adapter **padap, const char *name, struct module *module); | 79 | extern int dvb_register_adapter (struct dvb_adapter *adap, const char *name, struct module *module); |
80 | extern int dvb_unregister_adapter (struct dvb_adapter *adap); | 80 | extern int dvb_unregister_adapter (struct dvb_adapter *adap); |
81 | 81 | ||
82 | extern int dvb_register_device (struct dvb_adapter *adap, | 82 | extern int dvb_register_device (struct dvb_adapter *adap, |
diff --git a/drivers/media/dvb/frontends/Kconfig b/drivers/media/dvb/frontends/Kconfig index 0bfd4df17d08..75fb556ec01f 100644 --- a/drivers/media/dvb/frontends/Kconfig +++ b/drivers/media/dvb/frontends/Kconfig | |||
@@ -12,10 +12,10 @@ config DVB_STV0299 | |||
12 | 12 | ||
13 | config DVB_CX24110 | 13 | config DVB_CX24110 |
14 | tristate "Conexant CX24110 based" | 14 | tristate "Conexant CX24110 based" |
15 | depends on DVB_CORE | 15 | depends on DVB_CORE |
16 | help | 16 | help |
17 | A DVB-S tuner module. Say Y when you want to support this frontend. | 17 | A DVB-S tuner module. Say Y when you want to support this frontend. |
18 | 18 | ||
19 | config DVB_TDA8083 | 19 | config DVB_TDA8083 |
20 | tristate "Philips TDA8083 based" | 20 | tristate "Philips TDA8083 based" |
21 | depends on DVB_CORE | 21 | depends on DVB_CORE |
@@ -127,8 +127,8 @@ comment "DVB-C (cable) frontends" | |||
127 | config DVB_ATMEL_AT76C651 | 127 | config DVB_ATMEL_AT76C651 |
128 | tristate "Atmel AT76C651 based" | 128 | tristate "Atmel AT76C651 based" |
129 | depends on DVB_CORE | 129 | depends on DVB_CORE |
130 | help | 130 | help |
131 | A DVB-C tuner module. Say Y when you want to support this frontend. | 131 | A DVB-C tuner module. Say Y when you want to support this frontend. |
132 | 132 | ||
133 | config DVB_VES1820 | 133 | config DVB_VES1820 |
134 | tristate "VLSI VES1820 based" | 134 | tristate "VLSI VES1820 based" |
@@ -158,10 +158,6 @@ config DVB_NXT2002 | |||
158 | help | 158 | help |
159 | An ATSC 8VSB tuner module. Say Y when you want to support this frontend. | 159 | An ATSC 8VSB tuner module. Say Y when you want to support this frontend. |
160 | 160 | ||
161 | config DVB_OR51132 | ||
162 | tristate "OR51132 based (pcHDTV)" | ||
163 | depends on DVB_CORE | ||
164 | |||
165 | config DVB_OR51211 | 161 | config DVB_OR51211 |
166 | tristate "or51211 based (pcHDTV HD2000 card)" | 162 | tristate "or51211 based (pcHDTV HD2000 card)" |
167 | depends on DVB_CORE | 163 | depends on DVB_CORE |
@@ -169,4 +165,12 @@ config DVB_OR51211 | |||
169 | help | 165 | help |
170 | An ATSC 8VSB tuner module. Say Y when you want to support this frontend. | 166 | An ATSC 8VSB tuner module. Say Y when you want to support this frontend. |
171 | 167 | ||
168 | config DVB_OR51132 | ||
169 | tristate "OR51132 based (pcHDTV HD3000 card)" | ||
170 | depends on DVB_CORE | ||
171 | select FW_LOADER | ||
172 | help | ||
173 | An ATSC 8VSB and QAM64/256 tuner module. Say Y when you want | ||
174 | to support this frontend. | ||
175 | |||
172 | endmenu | 176 | endmenu |
diff --git a/drivers/media/dvb/frontends/at76c651.c b/drivers/media/dvb/frontends/at76c651.c index ce2eaa1640e8..72a2b5455b0b 100644 --- a/drivers/media/dvb/frontends/at76c651.c +++ b/drivers/media/dvb/frontends/at76c651.c | |||
@@ -259,7 +259,7 @@ static int at76c651_set_parameters(struct dvb_frontend* fe, | |||
259 | struct dvb_frontend_parameters *p) | 259 | struct dvb_frontend_parameters *p) |
260 | { | 260 | { |
261 | int ret; | 261 | int ret; |
262 | struct at76c651_state* state = (struct at76c651_state*) fe->demodulator_priv; | 262 | struct at76c651_state* state = fe->demodulator_priv; |
263 | 263 | ||
264 | at76c651_writereg(state, 0x0c, 0xc3); | 264 | at76c651_writereg(state, 0x0c, 0xc3); |
265 | state->config->pll_set(fe, p); | 265 | state->config->pll_set(fe, p); |
@@ -276,7 +276,7 @@ static int at76c651_set_parameters(struct dvb_frontend* fe, | |||
276 | 276 | ||
277 | static int at76c651_set_defaults(struct dvb_frontend* fe) | 277 | static int at76c651_set_defaults(struct dvb_frontend* fe) |
278 | { | 278 | { |
279 | struct at76c651_state* state = (struct at76c651_state*) fe->demodulator_priv; | 279 | struct at76c651_state* state = fe->demodulator_priv; |
280 | 280 | ||
281 | at76c651_set_symbol_rate(state, 6900000); | 281 | at76c651_set_symbol_rate(state, 6900000); |
282 | at76c651_set_qam(state, QAM_64); | 282 | at76c651_set_qam(state, QAM_64); |
@@ -294,7 +294,7 @@ static int at76c651_set_defaults(struct dvb_frontend* fe) | |||
294 | 294 | ||
295 | static int at76c651_read_status(struct dvb_frontend* fe, fe_status_t* status) | 295 | static int at76c651_read_status(struct dvb_frontend* fe, fe_status_t* status) |
296 | { | 296 | { |
297 | struct at76c651_state* state = (struct at76c651_state*) fe->demodulator_priv; | 297 | struct at76c651_state* state = fe->demodulator_priv; |
298 | u8 sync; | 298 | u8 sync; |
299 | 299 | ||
300 | /* | 300 | /* |
@@ -319,7 +319,7 @@ static int at76c651_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
319 | 319 | ||
320 | static int at76c651_read_ber(struct dvb_frontend* fe, u32* ber) | 320 | static int at76c651_read_ber(struct dvb_frontend* fe, u32* ber) |
321 | { | 321 | { |
322 | struct at76c651_state* state = (struct at76c651_state*) fe->demodulator_priv; | 322 | struct at76c651_state* state = fe->demodulator_priv; |
323 | 323 | ||
324 | *ber = (at76c651_readreg(state, 0x81) & 0x0F) << 16; | 324 | *ber = (at76c651_readreg(state, 0x81) & 0x0F) << 16; |
325 | *ber |= at76c651_readreg(state, 0x82) << 8; | 325 | *ber |= at76c651_readreg(state, 0x82) << 8; |
@@ -331,7 +331,7 @@ static int at76c651_read_ber(struct dvb_frontend* fe, u32* ber) | |||
331 | 331 | ||
332 | static int at76c651_read_signal_strength(struct dvb_frontend* fe, u16* strength) | 332 | static int at76c651_read_signal_strength(struct dvb_frontend* fe, u16* strength) |
333 | { | 333 | { |
334 | struct at76c651_state* state = (struct at76c651_state*) fe->demodulator_priv; | 334 | struct at76c651_state* state = fe->demodulator_priv; |
335 | 335 | ||
336 | u8 gain = ~at76c651_readreg(state, 0x91); | 336 | u8 gain = ~at76c651_readreg(state, 0x91); |
337 | *strength = (gain << 8) | gain; | 337 | *strength = (gain << 8) | gain; |
@@ -341,7 +341,7 @@ static int at76c651_read_signal_strength(struct dvb_frontend* fe, u16* strength) | |||
341 | 341 | ||
342 | static int at76c651_read_snr(struct dvb_frontend* fe, u16* snr) | 342 | static int at76c651_read_snr(struct dvb_frontend* fe, u16* snr) |
343 | { | 343 | { |
344 | struct at76c651_state* state = (struct at76c651_state*) fe->demodulator_priv; | 344 | struct at76c651_state* state = fe->demodulator_priv; |
345 | 345 | ||
346 | *snr = 0xFFFF - | 346 | *snr = 0xFFFF - |
347 | ((at76c651_readreg(state, 0x8F) << 8) | | 347 | ((at76c651_readreg(state, 0x8F) << 8) | |
@@ -352,7 +352,7 @@ static int at76c651_read_snr(struct dvb_frontend* fe, u16* snr) | |||
352 | 352 | ||
353 | static int at76c651_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | 353 | static int at76c651_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) |
354 | { | 354 | { |
355 | struct at76c651_state* state = (struct at76c651_state*) fe->demodulator_priv; | 355 | struct at76c651_state* state = fe->demodulator_priv; |
356 | 356 | ||
357 | *ucblocks = at76c651_readreg(state, 0x82); | 357 | *ucblocks = at76c651_readreg(state, 0x82); |
358 | 358 | ||
@@ -369,7 +369,7 @@ static int at76c651_get_tune_settings(struct dvb_frontend* fe, struct dvb_fronte | |||
369 | 369 | ||
370 | static void at76c651_release(struct dvb_frontend* fe) | 370 | static void at76c651_release(struct dvb_frontend* fe) |
371 | { | 371 | { |
372 | struct at76c651_state* state = (struct at76c651_state*) fe->demodulator_priv; | 372 | struct at76c651_state* state = fe->demodulator_priv; |
373 | kfree(state); | 373 | kfree(state); |
374 | } | 374 | } |
375 | 375 | ||
@@ -381,7 +381,7 @@ struct dvb_frontend* at76c651_attach(const struct at76c651_config* config, | |||
381 | struct at76c651_state* state = NULL; | 381 | struct at76c651_state* state = NULL; |
382 | 382 | ||
383 | /* allocate memory for the internal state */ | 383 | /* allocate memory for the internal state */ |
384 | state = (struct at76c651_state*) kmalloc(sizeof(struct at76c651_state), GFP_KERNEL); | 384 | state = kmalloc(sizeof(struct at76c651_state), GFP_KERNEL); |
385 | if (state == NULL) goto error; | 385 | if (state == NULL) goto error; |
386 | 386 | ||
387 | /* setup the state */ | 387 | /* setup the state */ |
diff --git a/drivers/media/dvb/frontends/cx22700.c b/drivers/media/dvb/frontends/cx22700.c index a212279042b8..0c2ed4438618 100644 --- a/drivers/media/dvb/frontends/cx22700.c +++ b/drivers/media/dvb/frontends/cx22700.c | |||
@@ -232,7 +232,7 @@ static int cx22700_get_tps (struct cx22700_state* state, struct dvb_ofdm_paramet | |||
232 | 232 | ||
233 | static int cx22700_init (struct dvb_frontend* fe) | 233 | static int cx22700_init (struct dvb_frontend* fe) |
234 | 234 | ||
235 | { struct cx22700_state* state = (struct cx22700_state*) fe->demodulator_priv; | 235 | { struct cx22700_state* state = fe->demodulator_priv; |
236 | int i; | 236 | int i; |
237 | 237 | ||
238 | dprintk("cx22700_init: init chip\n"); | 238 | dprintk("cx22700_init: init chip\n"); |
@@ -258,7 +258,7 @@ static int cx22700_init (struct dvb_frontend* fe) | |||
258 | 258 | ||
259 | static int cx22700_read_status(struct dvb_frontend* fe, fe_status_t* status) | 259 | static int cx22700_read_status(struct dvb_frontend* fe, fe_status_t* status) |
260 | { | 260 | { |
261 | struct cx22700_state* state = (struct cx22700_state*) fe->demodulator_priv; | 261 | struct cx22700_state* state = fe->demodulator_priv; |
262 | 262 | ||
263 | u16 rs_ber = (cx22700_readreg (state, 0x0d) << 9) | 263 | u16 rs_ber = (cx22700_readreg (state, 0x0d) << 9) |
264 | | (cx22700_readreg (state, 0x0e) << 1); | 264 | | (cx22700_readreg (state, 0x0e) << 1); |
@@ -286,7 +286,7 @@ static int cx22700_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
286 | 286 | ||
287 | static int cx22700_read_ber(struct dvb_frontend* fe, u32* ber) | 287 | static int cx22700_read_ber(struct dvb_frontend* fe, u32* ber) |
288 | { | 288 | { |
289 | struct cx22700_state* state = (struct cx22700_state*) fe->demodulator_priv; | 289 | struct cx22700_state* state = fe->demodulator_priv; |
290 | 290 | ||
291 | *ber = cx22700_readreg (state, 0x0c) & 0x7f; | 291 | *ber = cx22700_readreg (state, 0x0c) & 0x7f; |
292 | cx22700_writereg (state, 0x0c, 0x00); | 292 | cx22700_writereg (state, 0x0c, 0x00); |
@@ -296,7 +296,7 @@ static int cx22700_read_ber(struct dvb_frontend* fe, u32* ber) | |||
296 | 296 | ||
297 | static int cx22700_read_signal_strength(struct dvb_frontend* fe, u16* signal_strength) | 297 | static int cx22700_read_signal_strength(struct dvb_frontend* fe, u16* signal_strength) |
298 | { | 298 | { |
299 | struct cx22700_state* state = (struct cx22700_state*) fe->demodulator_priv; | 299 | struct cx22700_state* state = fe->demodulator_priv; |
300 | 300 | ||
301 | u16 rs_ber = (cx22700_readreg (state, 0x0d) << 9) | 301 | u16 rs_ber = (cx22700_readreg (state, 0x0d) << 9) |
302 | | (cx22700_readreg (state, 0x0e) << 1); | 302 | | (cx22700_readreg (state, 0x0e) << 1); |
@@ -307,7 +307,7 @@ static int cx22700_read_signal_strength(struct dvb_frontend* fe, u16* signal_str | |||
307 | 307 | ||
308 | static int cx22700_read_snr(struct dvb_frontend* fe, u16* snr) | 308 | static int cx22700_read_snr(struct dvb_frontend* fe, u16* snr) |
309 | { | 309 | { |
310 | struct cx22700_state* state = (struct cx22700_state*) fe->demodulator_priv; | 310 | struct cx22700_state* state = fe->demodulator_priv; |
311 | 311 | ||
312 | u16 rs_ber = (cx22700_readreg (state, 0x0d) << 9) | 312 | u16 rs_ber = (cx22700_readreg (state, 0x0d) << 9) |
313 | | (cx22700_readreg (state, 0x0e) << 1); | 313 | | (cx22700_readreg (state, 0x0e) << 1); |
@@ -318,7 +318,7 @@ static int cx22700_read_snr(struct dvb_frontend* fe, u16* snr) | |||
318 | 318 | ||
319 | static int cx22700_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | 319 | static int cx22700_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) |
320 | { | 320 | { |
321 | struct cx22700_state* state = (struct cx22700_state*) fe->demodulator_priv; | 321 | struct cx22700_state* state = fe->demodulator_priv; |
322 | 322 | ||
323 | *ucblocks = cx22700_readreg (state, 0x0f); | 323 | *ucblocks = cx22700_readreg (state, 0x0f); |
324 | cx22700_writereg (state, 0x0f, 0x00); | 324 | cx22700_writereg (state, 0x0f, 0x00); |
@@ -328,7 +328,7 @@ static int cx22700_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | |||
328 | 328 | ||
329 | static int cx22700_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 329 | static int cx22700_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
330 | { | 330 | { |
331 | struct cx22700_state* state = (struct cx22700_state*) fe->demodulator_priv; | 331 | struct cx22700_state* state = fe->demodulator_priv; |
332 | 332 | ||
333 | cx22700_writereg (state, 0x00, 0x02); /* XXX CHECKME: soft reset*/ | 333 | cx22700_writereg (state, 0x00, 0x02); /* XXX CHECKME: soft reset*/ |
334 | cx22700_writereg (state, 0x00, 0x00); | 334 | cx22700_writereg (state, 0x00, 0x00); |
@@ -346,7 +346,7 @@ static int cx22700_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
346 | 346 | ||
347 | static int cx22700_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 347 | static int cx22700_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
348 | { | 348 | { |
349 | struct cx22700_state* state = (struct cx22700_state*) fe->demodulator_priv; | 349 | struct cx22700_state* state = fe->demodulator_priv; |
350 | u8 reg09 = cx22700_readreg (state, 0x09); | 350 | u8 reg09 = cx22700_readreg (state, 0x09); |
351 | 351 | ||
352 | p->inversion = reg09 & 0x1 ? INVERSION_ON : INVERSION_OFF; | 352 | p->inversion = reg09 & 0x1 ? INVERSION_ON : INVERSION_OFF; |
@@ -363,7 +363,7 @@ static int cx22700_get_tune_settings(struct dvb_frontend* fe, struct dvb_fronten | |||
363 | 363 | ||
364 | static void cx22700_release(struct dvb_frontend* fe) | 364 | static void cx22700_release(struct dvb_frontend* fe) |
365 | { | 365 | { |
366 | struct cx22700_state* state = (struct cx22700_state*) fe->demodulator_priv; | 366 | struct cx22700_state* state = fe->demodulator_priv; |
367 | kfree(state); | 367 | kfree(state); |
368 | } | 368 | } |
369 | 369 | ||
@@ -375,7 +375,7 @@ struct dvb_frontend* cx22700_attach(const struct cx22700_config* config, | |||
375 | struct cx22700_state* state = NULL; | 375 | struct cx22700_state* state = NULL; |
376 | 376 | ||
377 | /* allocate memory for the internal state */ | 377 | /* allocate memory for the internal state */ |
378 | state = (struct cx22700_state*) kmalloc(sizeof(struct cx22700_state), GFP_KERNEL); | 378 | state = kmalloc(sizeof(struct cx22700_state), GFP_KERNEL); |
379 | if (state == NULL) goto error; | 379 | if (state == NULL) goto error; |
380 | 380 | ||
381 | /* setup the state */ | 381 | /* setup the state */ |
diff --git a/drivers/media/dvb/frontends/cx22702.c b/drivers/media/dvb/frontends/cx22702.c index 011860ce36cc..f4aa44136c7c 100644 --- a/drivers/media/dvb/frontends/cx22702.c +++ b/drivers/media/dvb/frontends/cx22702.c | |||
@@ -200,7 +200,7 @@ static int cx22702_get_tps (struct cx22702_state *state, struct dvb_ofdm_paramet | |||
200 | static int cx22702_set_tps (struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 200 | static int cx22702_set_tps (struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
201 | { | 201 | { |
202 | u8 val; | 202 | u8 val; |
203 | struct cx22702_state* state = (struct cx22702_state*) fe->demodulator_priv; | 203 | struct cx22702_state* state = fe->demodulator_priv; |
204 | 204 | ||
205 | /* set PLL */ | 205 | /* set PLL */ |
206 | cx22702_writereg (state, 0x0D, cx22702_readreg(state,0x0D) &0xfe); | 206 | cx22702_writereg (state, 0x0D, cx22702_readreg(state,0x0D) &0xfe); |
@@ -338,7 +338,7 @@ static int cx22702_set_tps (struct dvb_frontend* fe, struct dvb_frontend_paramet | |||
338 | static int cx22702_init (struct dvb_frontend* fe) | 338 | static int cx22702_init (struct dvb_frontend* fe) |
339 | { | 339 | { |
340 | int i; | 340 | int i; |
341 | struct cx22702_state* state = (struct cx22702_state*) fe->demodulator_priv; | 341 | struct cx22702_state* state = fe->demodulator_priv; |
342 | 342 | ||
343 | cx22702_writereg (state, 0x00, 0x02); | 343 | cx22702_writereg (state, 0x00, 0x02); |
344 | 344 | ||
@@ -360,7 +360,7 @@ static int cx22702_init (struct dvb_frontend* fe) | |||
360 | 360 | ||
361 | static int cx22702_read_status(struct dvb_frontend* fe, fe_status_t* status) | 361 | static int cx22702_read_status(struct dvb_frontend* fe, fe_status_t* status) |
362 | { | 362 | { |
363 | struct cx22702_state* state = (struct cx22702_state*) fe->demodulator_priv; | 363 | struct cx22702_state* state = fe->demodulator_priv; |
364 | u8 reg0A; | 364 | u8 reg0A; |
365 | u8 reg23; | 365 | u8 reg23; |
366 | 366 | ||
@@ -389,7 +389,7 @@ static int cx22702_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
389 | 389 | ||
390 | static int cx22702_read_ber(struct dvb_frontend* fe, u32* ber) | 390 | static int cx22702_read_ber(struct dvb_frontend* fe, u32* ber) |
391 | { | 391 | { |
392 | struct cx22702_state* state = (struct cx22702_state*) fe->demodulator_priv; | 392 | struct cx22702_state* state = fe->demodulator_priv; |
393 | 393 | ||
394 | if(cx22702_readreg (state, 0xE4) & 0x02) { | 394 | if(cx22702_readreg (state, 0xE4) & 0x02) { |
395 | /* Realtime statistics */ | 395 | /* Realtime statistics */ |
@@ -406,7 +406,7 @@ static int cx22702_read_ber(struct dvb_frontend* fe, u32* ber) | |||
406 | 406 | ||
407 | static int cx22702_read_signal_strength(struct dvb_frontend* fe, u16* signal_strength) | 407 | static int cx22702_read_signal_strength(struct dvb_frontend* fe, u16* signal_strength) |
408 | { | 408 | { |
409 | struct cx22702_state* state = (struct cx22702_state*) fe->demodulator_priv; | 409 | struct cx22702_state* state = fe->demodulator_priv; |
410 | 410 | ||
411 | *signal_strength = cx22702_readreg (state, 0x23); | 411 | *signal_strength = cx22702_readreg (state, 0x23); |
412 | 412 | ||
@@ -415,7 +415,7 @@ static int cx22702_read_signal_strength(struct dvb_frontend* fe, u16* signal_str | |||
415 | 415 | ||
416 | static int cx22702_read_snr(struct dvb_frontend* fe, u16* snr) | 416 | static int cx22702_read_snr(struct dvb_frontend* fe, u16* snr) |
417 | { | 417 | { |
418 | struct cx22702_state* state = (struct cx22702_state*) fe->demodulator_priv; | 418 | struct cx22702_state* state = fe->demodulator_priv; |
419 | 419 | ||
420 | u16 rs_ber=0; | 420 | u16 rs_ber=0; |
421 | if(cx22702_readreg (state, 0xE4) & 0x02) { | 421 | if(cx22702_readreg (state, 0xE4) & 0x02) { |
@@ -434,7 +434,7 @@ static int cx22702_read_snr(struct dvb_frontend* fe, u16* snr) | |||
434 | 434 | ||
435 | static int cx22702_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | 435 | static int cx22702_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) |
436 | { | 436 | { |
437 | struct cx22702_state* state = (struct cx22702_state*) fe->demodulator_priv; | 437 | struct cx22702_state* state = fe->demodulator_priv; |
438 | 438 | ||
439 | u8 _ucblocks; | 439 | u8 _ucblocks; |
440 | 440 | ||
@@ -449,7 +449,7 @@ static int cx22702_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | |||
449 | 449 | ||
450 | static int cx22702_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 450 | static int cx22702_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
451 | { | 451 | { |
452 | struct cx22702_state* state = (struct cx22702_state*) fe->demodulator_priv; | 452 | struct cx22702_state* state = fe->demodulator_priv; |
453 | 453 | ||
454 | u8 reg0C = cx22702_readreg (state, 0x0C); | 454 | u8 reg0C = cx22702_readreg (state, 0x0C); |
455 | 455 | ||
@@ -459,7 +459,7 @@ static int cx22702_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
459 | 459 | ||
460 | static void cx22702_release(struct dvb_frontend* fe) | 460 | static void cx22702_release(struct dvb_frontend* fe) |
461 | { | 461 | { |
462 | struct cx22702_state* state = (struct cx22702_state*) fe->demodulator_priv; | 462 | struct cx22702_state* state = fe->demodulator_priv; |
463 | kfree(state); | 463 | kfree(state); |
464 | } | 464 | } |
465 | 465 | ||
@@ -471,7 +471,7 @@ struct dvb_frontend* cx22702_attach(const struct cx22702_config* config, | |||
471 | struct cx22702_state* state = NULL; | 471 | struct cx22702_state* state = NULL; |
472 | 472 | ||
473 | /* allocate memory for the internal state */ | 473 | /* allocate memory for the internal state */ |
474 | state = (struct cx22702_state*) kmalloc(sizeof(struct cx22702_state), GFP_KERNEL); | 474 | state = kmalloc(sizeof(struct cx22702_state), GFP_KERNEL); |
475 | if (state == NULL) goto error; | 475 | if (state == NULL) goto error; |
476 | 476 | ||
477 | /* setup the state */ | 477 | /* setup the state */ |
diff --git a/drivers/media/dvb/frontends/cx24110.c b/drivers/media/dvb/frontends/cx24110.c index ae16112a0653..8222b88cb486 100644 --- a/drivers/media/dvb/frontends/cx24110.c +++ b/drivers/media/dvb/frontends/cx24110.c | |||
@@ -315,7 +315,7 @@ dprintk("cx24110 debug: entering %s(%d)\n",__FUNCTION__,srate); | |||
315 | 315 | ||
316 | int cx24110_pll_write (struct dvb_frontend* fe, u32 data) | 316 | int cx24110_pll_write (struct dvb_frontend* fe, u32 data) |
317 | { | 317 | { |
318 | struct cx24110_state *state = (struct cx24110_state*) fe->demodulator_priv; | 318 | struct cx24110_state *state = fe->demodulator_priv; |
319 | 319 | ||
320 | /* tuner data is 21 bits long, must be left-aligned in data */ | 320 | /* tuner data is 21 bits long, must be left-aligned in data */ |
321 | /* tuner cx24108 is written through a dedicated 3wire interface on the demod chip */ | 321 | /* tuner cx24108 is written through a dedicated 3wire interface on the demod chip */ |
@@ -356,7 +356,7 @@ int cx24110_pll_write (struct dvb_frontend* fe, u32 data) | |||
356 | 356 | ||
357 | static int cx24110_initfe(struct dvb_frontend* fe) | 357 | static int cx24110_initfe(struct dvb_frontend* fe) |
358 | { | 358 | { |
359 | struct cx24110_state *state = (struct cx24110_state*) fe->demodulator_priv; | 359 | struct cx24110_state *state = fe->demodulator_priv; |
360 | /* fixme (low): error handling */ | 360 | /* fixme (low): error handling */ |
361 | int i; | 361 | int i; |
362 | 362 | ||
@@ -373,7 +373,7 @@ static int cx24110_initfe(struct dvb_frontend* fe) | |||
373 | 373 | ||
374 | static int cx24110_set_voltage (struct dvb_frontend* fe, fe_sec_voltage_t voltage) | 374 | static int cx24110_set_voltage (struct dvb_frontend* fe, fe_sec_voltage_t voltage) |
375 | { | 375 | { |
376 | struct cx24110_state *state = (struct cx24110_state*) fe->demodulator_priv; | 376 | struct cx24110_state *state = fe->demodulator_priv; |
377 | 377 | ||
378 | switch (voltage) { | 378 | switch (voltage) { |
379 | case SEC_VOLTAGE_13: | 379 | case SEC_VOLTAGE_13: |
@@ -385,8 +385,7 @@ static int cx24110_set_voltage (struct dvb_frontend* fe, fe_sec_voltage_t voltag | |||
385 | }; | 385 | }; |
386 | } | 386 | } |
387 | 387 | ||
388 | static int cx24110_diseqc_send_burst(struct dvb_frontend* fe, | 388 | static int cx24110_diseqc_send_burst(struct dvb_frontend* fe, fe_sec_mini_cmd_t burst) |
389 | fe_sec_mini_cmd_t burst) | ||
390 | { | 389 | { |
391 | int rv, bit, i; | 390 | int rv, bit, i; |
392 | struct cx24110_state *state = fe->demodulator_priv; | 391 | struct cx24110_state *state = fe->demodulator_priv; |
@@ -413,7 +412,7 @@ static int cx24110_send_diseqc_msg(struct dvb_frontend* fe, | |||
413 | struct dvb_diseqc_master_cmd *cmd) | 412 | struct dvb_diseqc_master_cmd *cmd) |
414 | { | 413 | { |
415 | int i, rv; | 414 | int i, rv; |
416 | struct cx24110_state *state = (struct cx24110_state*) fe->demodulator_priv; | 415 | struct cx24110_state *state = fe->demodulator_priv; |
417 | 416 | ||
418 | for (i = 0; i < cmd->msg_len; i++) | 417 | for (i = 0; i < cmd->msg_len; i++) |
419 | cx24110_writereg(state, 0x79 + i, cmd->msg[i]); | 418 | cx24110_writereg(state, 0x79 + i, cmd->msg[i]); |
@@ -432,7 +431,7 @@ static int cx24110_send_diseqc_msg(struct dvb_frontend* fe, | |||
432 | 431 | ||
433 | static int cx24110_read_status(struct dvb_frontend* fe, fe_status_t* status) | 432 | static int cx24110_read_status(struct dvb_frontend* fe, fe_status_t* status) |
434 | { | 433 | { |
435 | struct cx24110_state *state = (struct cx24110_state*) fe->demodulator_priv; | 434 | struct cx24110_state *state = fe->demodulator_priv; |
436 | 435 | ||
437 | int sync = cx24110_readreg (state, 0x55); | 436 | int sync = cx24110_readreg (state, 0x55); |
438 | 437 | ||
@@ -460,7 +459,7 @@ static int cx24110_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
460 | 459 | ||
461 | static int cx24110_read_ber(struct dvb_frontend* fe, u32* ber) | 460 | static int cx24110_read_ber(struct dvb_frontend* fe, u32* ber) |
462 | { | 461 | { |
463 | struct cx24110_state *state = (struct cx24110_state*) fe->demodulator_priv; | 462 | struct cx24110_state *state = fe->demodulator_priv; |
464 | 463 | ||
465 | /* fixme (maybe): value range is 16 bit. Scale? */ | 464 | /* fixme (maybe): value range is 16 bit. Scale? */ |
466 | if(cx24110_readreg(state,0x24)&0x10) { | 465 | if(cx24110_readreg(state,0x24)&0x10) { |
@@ -478,7 +477,7 @@ static int cx24110_read_ber(struct dvb_frontend* fe, u32* ber) | |||
478 | 477 | ||
479 | static int cx24110_read_signal_strength(struct dvb_frontend* fe, u16* signal_strength) | 478 | static int cx24110_read_signal_strength(struct dvb_frontend* fe, u16* signal_strength) |
480 | { | 479 | { |
481 | struct cx24110_state *state = (struct cx24110_state*) fe->demodulator_priv; | 480 | struct cx24110_state *state = fe->demodulator_priv; |
482 | 481 | ||
483 | /* no provision in hardware. Read the frontend AGC accumulator. No idea how to scale this, but I know it is 2s complement */ | 482 | /* no provision in hardware. Read the frontend AGC accumulator. No idea how to scale this, but I know it is 2s complement */ |
484 | u8 signal = cx24110_readreg (state, 0x27)+128; | 483 | u8 signal = cx24110_readreg (state, 0x27)+128; |
@@ -489,7 +488,7 @@ static int cx24110_read_signal_strength(struct dvb_frontend* fe, u16* signal_str | |||
489 | 488 | ||
490 | static int cx24110_read_snr(struct dvb_frontend* fe, u16* snr) | 489 | static int cx24110_read_snr(struct dvb_frontend* fe, u16* snr) |
491 | { | 490 | { |
492 | struct cx24110_state *state = (struct cx24110_state*) fe->demodulator_priv; | 491 | struct cx24110_state *state = fe->demodulator_priv; |
493 | 492 | ||
494 | /* no provision in hardware. Can be computed from the Es/N0 estimator, but I don't know how. */ | 493 | /* no provision in hardware. Can be computed from the Es/N0 estimator, but I don't know how. */ |
495 | if(cx24110_readreg(state,0x6a)&0x80) { | 494 | if(cx24110_readreg(state,0x6a)&0x80) { |
@@ -505,7 +504,7 @@ static int cx24110_read_snr(struct dvb_frontend* fe, u16* snr) | |||
505 | 504 | ||
506 | static int cx24110_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | 505 | static int cx24110_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) |
507 | { | 506 | { |
508 | struct cx24110_state *state = (struct cx24110_state*) fe->demodulator_priv; | 507 | struct cx24110_state *state = fe->demodulator_priv; |
509 | u32 lastbyer; | 508 | u32 lastbyer; |
510 | 509 | ||
511 | if(cx24110_readreg(state,0x10)&0x40) { | 510 | if(cx24110_readreg(state,0x10)&0x40) { |
@@ -527,7 +526,7 @@ static int cx24110_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | |||
527 | 526 | ||
528 | static int cx24110_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 527 | static int cx24110_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
529 | { | 528 | { |
530 | struct cx24110_state *state = (struct cx24110_state*) fe->demodulator_priv; | 529 | struct cx24110_state *state = fe->demodulator_priv; |
531 | 530 | ||
532 | state->config->pll_set(fe, p); | 531 | state->config->pll_set(fe, p); |
533 | cx24110_set_inversion (state, p->inversion); | 532 | cx24110_set_inversion (state, p->inversion); |
@@ -540,7 +539,7 @@ static int cx24110_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
540 | 539 | ||
541 | static int cx24110_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 540 | static int cx24110_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
542 | { | 541 | { |
543 | struct cx24110_state *state = (struct cx24110_state*) fe->demodulator_priv; | 542 | struct cx24110_state *state = fe->demodulator_priv; |
544 | s32 afc; unsigned sclk; | 543 | s32 afc; unsigned sclk; |
545 | 544 | ||
546 | /* cannot read back tuner settings (freq). Need to have some private storage */ | 545 | /* cannot read back tuner settings (freq). Need to have some private storage */ |
@@ -567,14 +566,14 @@ static int cx24110_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
567 | 566 | ||
568 | static int cx24110_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone) | 567 | static int cx24110_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone) |
569 | { | 568 | { |
570 | struct cx24110_state *state = (struct cx24110_state*) fe->demodulator_priv; | 569 | struct cx24110_state *state = fe->demodulator_priv; |
571 | 570 | ||
572 | return cx24110_writereg(state,0x76,(cx24110_readreg(state,0x76)&~0x10)|(((tone==SEC_TONE_ON))?0x10:0)); | 571 | return cx24110_writereg(state,0x76,(cx24110_readreg(state,0x76)&~0x10)|(((tone==SEC_TONE_ON))?0x10:0)); |
573 | } | 572 | } |
574 | 573 | ||
575 | static void cx24110_release(struct dvb_frontend* fe) | 574 | static void cx24110_release(struct dvb_frontend* fe) |
576 | { | 575 | { |
577 | struct cx24110_state* state = (struct cx24110_state*) fe->demodulator_priv; | 576 | struct cx24110_state* state = fe->demodulator_priv; |
578 | kfree(state); | 577 | kfree(state); |
579 | } | 578 | } |
580 | 579 | ||
@@ -587,7 +586,7 @@ struct dvb_frontend* cx24110_attach(const struct cx24110_config* config, | |||
587 | int ret; | 586 | int ret; |
588 | 587 | ||
589 | /* allocate memory for the internal state */ | 588 | /* allocate memory for the internal state */ |
590 | state = (struct cx24110_state*) kmalloc(sizeof(struct cx24110_state), GFP_KERNEL); | 589 | state = kmalloc(sizeof(struct cx24110_state), GFP_KERNEL); |
591 | if (state == NULL) goto error; | 590 | if (state == NULL) goto error; |
592 | 591 | ||
593 | /* setup the state */ | 592 | /* setup the state */ |
diff --git a/drivers/media/dvb/frontends/dib3000mb.c b/drivers/media/dvb/frontends/dib3000mb.c index a853d12a26f1..6f52d649e97e 100644 --- a/drivers/media/dvb/frontends/dib3000mb.c +++ b/drivers/media/dvb/frontends/dib3000mb.c | |||
@@ -56,12 +56,12 @@ static int dib3000mb_get_frontend(struct dvb_frontend* fe, | |||
56 | static int dib3000mb_set_frontend(struct dvb_frontend* fe, | 56 | static int dib3000mb_set_frontend(struct dvb_frontend* fe, |
57 | struct dvb_frontend_parameters *fep, int tuner) | 57 | struct dvb_frontend_parameters *fep, int tuner) |
58 | { | 58 | { |
59 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 59 | struct dib3000_state* state = fe->demodulator_priv; |
60 | struct dvb_ofdm_parameters *ofdm = &fep->u.ofdm; | 60 | struct dvb_ofdm_parameters *ofdm = &fep->u.ofdm; |
61 | fe_code_rate_t fe_cr = FEC_NONE; | 61 | fe_code_rate_t fe_cr = FEC_NONE; |
62 | int search_state, seq; | 62 | int search_state, seq; |
63 | 63 | ||
64 | if (tuner) { | 64 | if (tuner && state->config.pll_addr && state->config.pll_set) { |
65 | dib3000mb_tuner_pass_ctrl(fe,1,state->config.pll_addr(fe)); | 65 | dib3000mb_tuner_pass_ctrl(fe,1,state->config.pll_addr(fe)); |
66 | state->config.pll_set(fe, fep, NULL); | 66 | state->config.pll_set(fe, fep, NULL); |
67 | dib3000mb_tuner_pass_ctrl(fe,0,state->config.pll_addr(fe)); | 67 | dib3000mb_tuner_pass_ctrl(fe,0,state->config.pll_addr(fe)); |
@@ -317,7 +317,7 @@ static int dib3000mb_set_frontend(struct dvb_frontend* fe, | |||
317 | 317 | ||
318 | static int dib3000mb_fe_init(struct dvb_frontend* fe, int mobile_mode) | 318 | static int dib3000mb_fe_init(struct dvb_frontend* fe, int mobile_mode) |
319 | { | 319 | { |
320 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 320 | struct dib3000_state* state = fe->demodulator_priv; |
321 | 321 | ||
322 | deb_info("dib3000mb is getting up.\n"); | 322 | deb_info("dib3000mb is getting up.\n"); |
323 | wr(DIB3000MB_REG_POWER_CONTROL, DIB3000MB_POWER_UP); | 323 | wr(DIB3000MB_REG_POWER_CONTROL, DIB3000MB_POWER_UP); |
@@ -401,7 +401,7 @@ static int dib3000mb_fe_init(struct dvb_frontend* fe, int mobile_mode) | |||
401 | static int dib3000mb_get_frontend(struct dvb_frontend* fe, | 401 | static int dib3000mb_get_frontend(struct dvb_frontend* fe, |
402 | struct dvb_frontend_parameters *fep) | 402 | struct dvb_frontend_parameters *fep) |
403 | { | 403 | { |
404 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 404 | struct dib3000_state* state = fe->demodulator_priv; |
405 | struct dvb_ofdm_parameters *ofdm = &fep->u.ofdm; | 405 | struct dvb_ofdm_parameters *ofdm = &fep->u.ofdm; |
406 | fe_code_rate_t *cr; | 406 | fe_code_rate_t *cr; |
407 | u16 tps_val; | 407 | u16 tps_val; |
@@ -562,7 +562,7 @@ static int dib3000mb_get_frontend(struct dvb_frontend* fe, | |||
562 | 562 | ||
563 | static int dib3000mb_read_status(struct dvb_frontend* fe, fe_status_t *stat) | 563 | static int dib3000mb_read_status(struct dvb_frontend* fe, fe_status_t *stat) |
564 | { | 564 | { |
565 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 565 | struct dib3000_state* state = fe->demodulator_priv; |
566 | 566 | ||
567 | *stat = 0; | 567 | *stat = 0; |
568 | 568 | ||
@@ -594,7 +594,7 @@ static int dib3000mb_read_status(struct dvb_frontend* fe, fe_status_t *stat) | |||
594 | 594 | ||
595 | static int dib3000mb_read_ber(struct dvb_frontend* fe, u32 *ber) | 595 | static int dib3000mb_read_ber(struct dvb_frontend* fe, u32 *ber) |
596 | { | 596 | { |
597 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 597 | struct dib3000_state* state = fe->demodulator_priv; |
598 | 598 | ||
599 | *ber = ((rd(DIB3000MB_REG_BER_MSB) << 16) | rd(DIB3000MB_REG_BER_LSB)); | 599 | *ber = ((rd(DIB3000MB_REG_BER_MSB) << 16) | rd(DIB3000MB_REG_BER_LSB)); |
600 | return 0; | 600 | return 0; |
@@ -603,7 +603,7 @@ static int dib3000mb_read_ber(struct dvb_frontend* fe, u32 *ber) | |||
603 | /* see dib3000-watch dvb-apps for exact calcuations of signal_strength and snr */ | 603 | /* see dib3000-watch dvb-apps for exact calcuations of signal_strength and snr */ |
604 | static int dib3000mb_read_signal_strength(struct dvb_frontend* fe, u16 *strength) | 604 | static int dib3000mb_read_signal_strength(struct dvb_frontend* fe, u16 *strength) |
605 | { | 605 | { |
606 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 606 | struct dib3000_state* state = fe->demodulator_priv; |
607 | 607 | ||
608 | *strength = rd(DIB3000MB_REG_SIGNAL_POWER) * 0xffff / 0x170; | 608 | *strength = rd(DIB3000MB_REG_SIGNAL_POWER) * 0xffff / 0x170; |
609 | return 0; | 609 | return 0; |
@@ -611,7 +611,7 @@ static int dib3000mb_read_signal_strength(struct dvb_frontend* fe, u16 *strength | |||
611 | 611 | ||
612 | static int dib3000mb_read_snr(struct dvb_frontend* fe, u16 *snr) | 612 | static int dib3000mb_read_snr(struct dvb_frontend* fe, u16 *snr) |
613 | { | 613 | { |
614 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 614 | struct dib3000_state* state = fe->demodulator_priv; |
615 | short sigpow = rd(DIB3000MB_REG_SIGNAL_POWER); | 615 | short sigpow = rd(DIB3000MB_REG_SIGNAL_POWER); |
616 | int icipow = ((rd(DIB3000MB_REG_NOISE_POWER_MSB) & 0xff) << 16) | | 616 | int icipow = ((rd(DIB3000MB_REG_NOISE_POWER_MSB) & 0xff) << 16) | |
617 | rd(DIB3000MB_REG_NOISE_POWER_LSB); | 617 | rd(DIB3000MB_REG_NOISE_POWER_LSB); |
@@ -621,7 +621,7 @@ static int dib3000mb_read_snr(struct dvb_frontend* fe, u16 *snr) | |||
621 | 621 | ||
622 | static int dib3000mb_read_unc_blocks(struct dvb_frontend* fe, u32 *unc) | 622 | static int dib3000mb_read_unc_blocks(struct dvb_frontend* fe, u32 *unc) |
623 | { | 623 | { |
624 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 624 | struct dib3000_state* state = fe->demodulator_priv; |
625 | 625 | ||
626 | *unc = rd(DIB3000MB_REG_UNC); | 626 | *unc = rd(DIB3000MB_REG_UNC); |
627 | return 0; | 627 | return 0; |
@@ -629,7 +629,7 @@ static int dib3000mb_read_unc_blocks(struct dvb_frontend* fe, u32 *unc) | |||
629 | 629 | ||
630 | static int dib3000mb_sleep(struct dvb_frontend* fe) | 630 | static int dib3000mb_sleep(struct dvb_frontend* fe) |
631 | { | 631 | { |
632 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 632 | struct dib3000_state* state = fe->demodulator_priv; |
633 | deb_info("dib3000mb is going to bed.\n"); | 633 | deb_info("dib3000mb is going to bed.\n"); |
634 | wr(DIB3000MB_REG_POWER_CONTROL, DIB3000MB_POWER_DOWN); | 634 | wr(DIB3000MB_REG_POWER_CONTROL, DIB3000MB_POWER_DOWN); |
635 | return 0; | 635 | return 0; |
@@ -656,7 +656,7 @@ static int dib3000mb_set_frontend_and_tuner(struct dvb_frontend* fe, struct dvb_ | |||
656 | 656 | ||
657 | static void dib3000mb_release(struct dvb_frontend* fe) | 657 | static void dib3000mb_release(struct dvb_frontend* fe) |
658 | { | 658 | { |
659 | struct dib3000_state *state = (struct dib3000_state*) fe->demodulator_priv; | 659 | struct dib3000_state *state = fe->demodulator_priv; |
660 | kfree(state); | 660 | kfree(state); |
661 | } | 661 | } |
662 | 662 | ||
@@ -671,7 +671,7 @@ static int dib3000mb_pid_control(struct dvb_frontend *fe,int index, int pid,int | |||
671 | 671 | ||
672 | static int dib3000mb_fifo_control(struct dvb_frontend *fe, int onoff) | 672 | static int dib3000mb_fifo_control(struct dvb_frontend *fe, int onoff) |
673 | { | 673 | { |
674 | struct dib3000_state *state = (struct dib3000_state*) fe->demodulator_priv; | 674 | struct dib3000_state *state = fe->demodulator_priv; |
675 | 675 | ||
676 | deb_xfer("%s fifo\n",onoff ? "enabling" : "disabling"); | 676 | deb_xfer("%s fifo\n",onoff ? "enabling" : "disabling"); |
677 | if (onoff) { | 677 | if (onoff) { |
@@ -692,7 +692,7 @@ static int dib3000mb_pid_parse(struct dvb_frontend *fe, int onoff) | |||
692 | 692 | ||
693 | static int dib3000mb_tuner_pass_ctrl(struct dvb_frontend *fe, int onoff, u8 pll_addr) | 693 | static int dib3000mb_tuner_pass_ctrl(struct dvb_frontend *fe, int onoff, u8 pll_addr) |
694 | { | 694 | { |
695 | struct dib3000_state *state = (struct dib3000_state*) fe->demodulator_priv; | 695 | struct dib3000_state *state = fe->demodulator_priv; |
696 | if (onoff) { | 696 | if (onoff) { |
697 | wr(DIB3000MB_REG_TUNER, DIB3000_TUNER_WRITE_ENABLE(pll_addr)); | 697 | wr(DIB3000MB_REG_TUNER, DIB3000_TUNER_WRITE_ENABLE(pll_addr)); |
698 | } else { | 698 | } else { |
@@ -709,7 +709,7 @@ struct dvb_frontend* dib3000mb_attach(const struct dib3000_config* config, | |||
709 | struct dib3000_state* state = NULL; | 709 | struct dib3000_state* state = NULL; |
710 | 710 | ||
711 | /* allocate memory for the internal state */ | 711 | /* allocate memory for the internal state */ |
712 | state = (struct dib3000_state*) kmalloc(sizeof(struct dib3000_state), GFP_KERNEL); | 712 | state = kmalloc(sizeof(struct dib3000_state), GFP_KERNEL); |
713 | if (state == NULL) | 713 | if (state == NULL) |
714 | goto error; | 714 | goto error; |
715 | memset(state,0,sizeof(struct dib3000_state)); | 715 | memset(state,0,sizeof(struct dib3000_state)); |
diff --git a/drivers/media/dvb/frontends/dib3000mc.c b/drivers/media/dvb/frontends/dib3000mc.c index 4a31c05eaecd..888f10a5e96b 100644 --- a/drivers/media/dvb/frontends/dib3000mc.c +++ b/drivers/media/dvb/frontends/dib3000mc.c | |||
@@ -297,7 +297,7 @@ static int dib3000mc_set_general_cfg(struct dib3000_state *state, struct dvb_fro | |||
297 | static int dib3000mc_get_frontend(struct dvb_frontend* fe, | 297 | static int dib3000mc_get_frontend(struct dvb_frontend* fe, |
298 | struct dvb_frontend_parameters *fep) | 298 | struct dvb_frontend_parameters *fep) |
299 | { | 299 | { |
300 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 300 | struct dib3000_state* state = fe->demodulator_priv; |
301 | struct dvb_ofdm_parameters *ofdm = &fep->u.ofdm; | 301 | struct dvb_ofdm_parameters *ofdm = &fep->u.ofdm; |
302 | fe_code_rate_t *cr; | 302 | fe_code_rate_t *cr; |
303 | u16 tps_val,cr_val; | 303 | u16 tps_val,cr_val; |
@@ -458,12 +458,12 @@ static int dib3000mc_get_frontend(struct dvb_frontend* fe, | |||
458 | static int dib3000mc_set_frontend(struct dvb_frontend* fe, | 458 | static int dib3000mc_set_frontend(struct dvb_frontend* fe, |
459 | struct dvb_frontend_parameters *fep, int tuner) | 459 | struct dvb_frontend_parameters *fep, int tuner) |
460 | { | 460 | { |
461 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 461 | struct dib3000_state* state = fe->demodulator_priv; |
462 | struct dvb_ofdm_parameters *ofdm = &fep->u.ofdm; | 462 | struct dvb_ofdm_parameters *ofdm = &fep->u.ofdm; |
463 | int search_state,auto_val; | 463 | int search_state,auto_val; |
464 | u16 val; | 464 | u16 val; |
465 | 465 | ||
466 | if (tuner) { /* initial call from dvb */ | 466 | if (tuner && state->config.pll_addr && state->config.pll_set) { /* initial call from dvb */ |
467 | dib3000mc_tuner_pass_ctrl(fe,1,state->config.pll_addr(fe)); | 467 | dib3000mc_tuner_pass_ctrl(fe,1,state->config.pll_addr(fe)); |
468 | state->config.pll_set(fe,fep,NULL); | 468 | state->config.pll_set(fe,fep,NULL); |
469 | dib3000mc_tuner_pass_ctrl(fe,0,state->config.pll_addr(fe)); | 469 | dib3000mc_tuner_pass_ctrl(fe,0,state->config.pll_addr(fe)); |
@@ -659,7 +659,7 @@ static int dib3000mc_fe_init(struct dvb_frontend* fe, int mobile_mode) | |||
659 | } | 659 | } |
660 | static int dib3000mc_read_status(struct dvb_frontend* fe, fe_status_t *stat) | 660 | static int dib3000mc_read_status(struct dvb_frontend* fe, fe_status_t *stat) |
661 | { | 661 | { |
662 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 662 | struct dib3000_state* state = fe->demodulator_priv; |
663 | u16 lock = rd(DIB3000MC_REG_LOCKING); | 663 | u16 lock = rd(DIB3000MC_REG_LOCKING); |
664 | 664 | ||
665 | *stat = 0; | 665 | *stat = 0; |
@@ -679,14 +679,14 @@ static int dib3000mc_read_status(struct dvb_frontend* fe, fe_status_t *stat) | |||
679 | 679 | ||
680 | static int dib3000mc_read_ber(struct dvb_frontend* fe, u32 *ber) | 680 | static int dib3000mc_read_ber(struct dvb_frontend* fe, u32 *ber) |
681 | { | 681 | { |
682 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 682 | struct dib3000_state* state = fe->demodulator_priv; |
683 | *ber = ((rd(DIB3000MC_REG_BER_MSB) << 16) | rd(DIB3000MC_REG_BER_LSB)); | 683 | *ber = ((rd(DIB3000MC_REG_BER_MSB) << 16) | rd(DIB3000MC_REG_BER_LSB)); |
684 | return 0; | 684 | return 0; |
685 | } | 685 | } |
686 | 686 | ||
687 | static int dib3000mc_read_unc_blocks(struct dvb_frontend* fe, u32 *unc) | 687 | static int dib3000mc_read_unc_blocks(struct dvb_frontend* fe, u32 *unc) |
688 | { | 688 | { |
689 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 689 | struct dib3000_state* state = fe->demodulator_priv; |
690 | 690 | ||
691 | *unc = rd(DIB3000MC_REG_PACKET_ERROR_COUNT); | 691 | *unc = rd(DIB3000MC_REG_PACKET_ERROR_COUNT); |
692 | return 0; | 692 | return 0; |
@@ -695,7 +695,7 @@ static int dib3000mc_read_unc_blocks(struct dvb_frontend* fe, u32 *unc) | |||
695 | /* see dib3000mb.c for calculation comments */ | 695 | /* see dib3000mb.c for calculation comments */ |
696 | static int dib3000mc_read_signal_strength(struct dvb_frontend* fe, u16 *strength) | 696 | static int dib3000mc_read_signal_strength(struct dvb_frontend* fe, u16 *strength) |
697 | { | 697 | { |
698 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 698 | struct dib3000_state* state = fe->demodulator_priv; |
699 | u16 val = rd(DIB3000MC_REG_SIGNAL_NOISE_LSB); | 699 | u16 val = rd(DIB3000MC_REG_SIGNAL_NOISE_LSB); |
700 | *strength = (((val >> 6) & 0xff) << 8) + (val & 0x3f); | 700 | *strength = (((val >> 6) & 0xff) << 8) + (val & 0x3f); |
701 | 701 | ||
@@ -706,7 +706,7 @@ static int dib3000mc_read_signal_strength(struct dvb_frontend* fe, u16 *strength | |||
706 | /* see dib3000mb.c for calculation comments */ | 706 | /* see dib3000mb.c for calculation comments */ |
707 | static int dib3000mc_read_snr(struct dvb_frontend* fe, u16 *snr) | 707 | static int dib3000mc_read_snr(struct dvb_frontend* fe, u16 *snr) |
708 | { | 708 | { |
709 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 709 | struct dib3000_state* state = fe->demodulator_priv; |
710 | u16 val = rd(DIB3000MC_REG_SIGNAL_NOISE_LSB), | 710 | u16 val = rd(DIB3000MC_REG_SIGNAL_NOISE_LSB), |
711 | val2 = rd(DIB3000MC_REG_SIGNAL_NOISE_MSB); | 711 | val2 = rd(DIB3000MC_REG_SIGNAL_NOISE_MSB); |
712 | u16 sig,noise; | 712 | u16 sig,noise; |
@@ -726,7 +726,7 @@ static int dib3000mc_read_snr(struct dvb_frontend* fe, u16 *snr) | |||
726 | 726 | ||
727 | static int dib3000mc_sleep(struct dvb_frontend* fe) | 727 | static int dib3000mc_sleep(struct dvb_frontend* fe) |
728 | { | 728 | { |
729 | struct dib3000_state* state = (struct dib3000_state*) fe->demodulator_priv; | 729 | struct dib3000_state* state = fe->demodulator_priv; |
730 | 730 | ||
731 | set_or(DIB3000MC_REG_CLK_CFG_7,DIB3000MC_CLK_CFG_7_PWR_DOWN); | 731 | set_or(DIB3000MC_REG_CLK_CFG_7,DIB3000MC_CLK_CFG_7_PWR_DOWN); |
732 | wr(DIB3000MC_REG_CLK_CFG_1,DIB3000MC_CLK_CFG_1_POWER_DOWN); | 732 | wr(DIB3000MC_REG_CLK_CFG_1,DIB3000MC_CLK_CFG_1_POWER_DOWN); |
@@ -756,7 +756,7 @@ static int dib3000mc_set_frontend_and_tuner(struct dvb_frontend* fe, struct dvb_ | |||
756 | 756 | ||
757 | static void dib3000mc_release(struct dvb_frontend* fe) | 757 | static void dib3000mc_release(struct dvb_frontend* fe) |
758 | { | 758 | { |
759 | struct dib3000_state *state = (struct dib3000_state *) fe->demodulator_priv; | 759 | struct dib3000_state *state = fe->demodulator_priv; |
760 | kfree(state); | 760 | kfree(state); |
761 | } | 761 | } |
762 | 762 | ||
@@ -771,7 +771,7 @@ static int dib3000mc_pid_control(struct dvb_frontend *fe,int index, int pid,int | |||
771 | 771 | ||
772 | static int dib3000mc_fifo_control(struct dvb_frontend *fe, int onoff) | 772 | static int dib3000mc_fifo_control(struct dvb_frontend *fe, int onoff) |
773 | { | 773 | { |
774 | struct dib3000_state *state = (struct dib3000_state*) fe->demodulator_priv; | 774 | struct dib3000_state *state = fe->demodulator_priv; |
775 | u16 tmp = rd(DIB3000MC_REG_SMO_MODE); | 775 | u16 tmp = rd(DIB3000MC_REG_SMO_MODE); |
776 | 776 | ||
777 | deb_xfer("%s fifo\n",onoff ? "enabling" : "disabling"); | 777 | deb_xfer("%s fifo\n",onoff ? "enabling" : "disabling"); |
@@ -803,7 +803,7 @@ static int dib3000mc_pid_parse(struct dvb_frontend *fe, int onoff) | |||
803 | 803 | ||
804 | static int dib3000mc_tuner_pass_ctrl(struct dvb_frontend *fe, int onoff, u8 pll_addr) | 804 | static int dib3000mc_tuner_pass_ctrl(struct dvb_frontend *fe, int onoff, u8 pll_addr) |
805 | { | 805 | { |
806 | struct dib3000_state *state = (struct dib3000_state*) fe->demodulator_priv; | 806 | struct dib3000_state *state = fe->demodulator_priv; |
807 | if (onoff) { | 807 | if (onoff) { |
808 | wr(DIB3000MC_REG_TUNER, DIB3000_TUNER_WRITE_ENABLE(pll_addr)); | 808 | wr(DIB3000MC_REG_TUNER, DIB3000_TUNER_WRITE_ENABLE(pll_addr)); |
809 | } else { | 809 | } else { |
@@ -844,7 +844,7 @@ struct dvb_frontend* dib3000mc_attach(const struct dib3000_config* config, | |||
844 | u16 devid; | 844 | u16 devid; |
845 | 845 | ||
846 | /* allocate memory for the internal state */ | 846 | /* allocate memory for the internal state */ |
847 | state = (struct dib3000_state*) kmalloc(sizeof(struct dib3000_state), GFP_KERNEL); | 847 | state = kmalloc(sizeof(struct dib3000_state), GFP_KERNEL); |
848 | if (state == NULL) | 848 | if (state == NULL) |
849 | goto error; | 849 | goto error; |
850 | memset(state,0,sizeof(struct dib3000_state)); | 850 | memset(state,0,sizeof(struct dib3000_state)); |
diff --git a/drivers/media/dvb/frontends/dvb-pll.h b/drivers/media/dvb/frontends/dvb-pll.h index 016c794a5677..c4c3c56c4a81 100644 --- a/drivers/media/dvb/frontends/dvb-pll.h +++ b/drivers/media/dvb/frontends/dvb-pll.h | |||
@@ -2,6 +2,9 @@ | |||
2 | * $Id: dvb-pll.h,v 1.2 2005/02/10 11:43:41 kraxel Exp $ | 2 | * $Id: dvb-pll.h,v 1.2 2005/02/10 11:43:41 kraxel Exp $ |
3 | */ | 3 | */ |
4 | 4 | ||
5 | #ifndef __DVB_PLL_H__ | ||
6 | #define __DVB_PLL_H__ | ||
7 | |||
5 | struct dvb_pll_desc { | 8 | struct dvb_pll_desc { |
6 | char *name; | 9 | char *name; |
7 | u32 min; | 10 | u32 min; |
@@ -26,9 +29,4 @@ extern struct dvb_pll_desc dvb_pll_unknown_1; | |||
26 | int dvb_pll_configure(struct dvb_pll_desc *desc, u8 *buf, | 29 | int dvb_pll_configure(struct dvb_pll_desc *desc, u8 *buf, |
27 | u32 freq, int bandwidth); | 30 | u32 freq, int bandwidth); |
28 | 31 | ||
29 | /* | 32 | #endif |
30 | * Local variables: | ||
31 | * c-basic-offset: 8 | ||
32 | * compile-command: "make DVB=1" | ||
33 | * End: | ||
34 | */ | ||
diff --git a/drivers/media/dvb/frontends/dvb_dummy_fe.c b/drivers/media/dvb/frontends/dvb_dummy_fe.c index c05a9b05600c..cff93b9d8ab2 100644 --- a/drivers/media/dvb/frontends/dvb_dummy_fe.c +++ b/drivers/media/dvb/frontends/dvb_dummy_fe.c | |||
@@ -100,7 +100,7 @@ static int dvb_dummy_fe_set_voltage(struct dvb_frontend* fe, fe_sec_voltage_t vo | |||
100 | 100 | ||
101 | static void dvb_dummy_fe_release(struct dvb_frontend* fe) | 101 | static void dvb_dummy_fe_release(struct dvb_frontend* fe) |
102 | { | 102 | { |
103 | struct dvb_dummy_fe_state* state = (struct dvb_dummy_fe_state*) fe->demodulator_priv; | 103 | struct dvb_dummy_fe_state* state = fe->demodulator_priv; |
104 | kfree(state); | 104 | kfree(state); |
105 | } | 105 | } |
106 | 106 | ||
@@ -111,7 +111,7 @@ struct dvb_frontend* dvb_dummy_fe_ofdm_attach(void) | |||
111 | struct dvb_dummy_fe_state* state = NULL; | 111 | struct dvb_dummy_fe_state* state = NULL; |
112 | 112 | ||
113 | /* allocate memory for the internal state */ | 113 | /* allocate memory for the internal state */ |
114 | state = (struct dvb_dummy_fe_state*) kmalloc(sizeof(struct dvb_dummy_fe_state), GFP_KERNEL); | 114 | state = kmalloc(sizeof(struct dvb_dummy_fe_state), GFP_KERNEL); |
115 | if (state == NULL) goto error; | 115 | if (state == NULL) goto error; |
116 | 116 | ||
117 | /* setup the state */ | 117 | /* setup the state */ |
@@ -134,7 +134,7 @@ struct dvb_frontend* dvb_dummy_fe_qpsk_attach() | |||
134 | struct dvb_dummy_fe_state* state = NULL; | 134 | struct dvb_dummy_fe_state* state = NULL; |
135 | 135 | ||
136 | /* allocate memory for the internal state */ | 136 | /* allocate memory for the internal state */ |
137 | state = (struct dvb_dummy_fe_state*) kmalloc(sizeof(struct dvb_dummy_fe_state), GFP_KERNEL); | 137 | state = kmalloc(sizeof(struct dvb_dummy_fe_state), GFP_KERNEL); |
138 | if (state == NULL) goto error; | 138 | if (state == NULL) goto error; |
139 | 139 | ||
140 | /* setup the state */ | 140 | /* setup the state */ |
@@ -157,7 +157,7 @@ struct dvb_frontend* dvb_dummy_fe_qam_attach() | |||
157 | struct dvb_dummy_fe_state* state = NULL; | 157 | struct dvb_dummy_fe_state* state = NULL; |
158 | 158 | ||
159 | /* allocate memory for the internal state */ | 159 | /* allocate memory for the internal state */ |
160 | state = (struct dvb_dummy_fe_state*) kmalloc(sizeof(struct dvb_dummy_fe_state), GFP_KERNEL); | 160 | state = kmalloc(sizeof(struct dvb_dummy_fe_state), GFP_KERNEL); |
161 | if (state == NULL) goto error; | 161 | if (state == NULL) goto error; |
162 | 162 | ||
163 | /* setup the state */ | 163 | /* setup the state */ |
diff --git a/drivers/media/dvb/frontends/l64781.c b/drivers/media/dvb/frontends/l64781.c index 9ac95de9834d..031a1ddc7d11 100644 --- a/drivers/media/dvb/frontends/l64781.c +++ b/drivers/media/dvb/frontends/l64781.c | |||
@@ -121,7 +121,7 @@ static int reset_and_configure (struct l64781_state* state) | |||
121 | 121 | ||
122 | static int apply_frontend_param (struct dvb_frontend* fe, struct dvb_frontend_parameters *param) | 122 | static int apply_frontend_param (struct dvb_frontend* fe, struct dvb_frontend_parameters *param) |
123 | { | 123 | { |
124 | struct l64781_state* state = (struct l64781_state*) fe->demodulator_priv; | 124 | struct l64781_state* state = fe->demodulator_priv; |
125 | /* The coderates for FEC_NONE, FEC_4_5 and FEC_FEC_6_7 are arbitrary */ | 125 | /* The coderates for FEC_NONE, FEC_4_5 and FEC_FEC_6_7 are arbitrary */ |
126 | static const u8 fec_tab[] = { 7, 0, 1, 2, 9, 3, 10, 4 }; | 126 | static const u8 fec_tab[] = { 7, 0, 1, 2, 9, 3, 10, 4 }; |
127 | /* QPSK, QAM_16, QAM_64 */ | 127 | /* QPSK, QAM_16, QAM_64 */ |
@@ -234,7 +234,7 @@ static int apply_frontend_param (struct dvb_frontend* fe, struct dvb_frontend_pa | |||
234 | 234 | ||
235 | static int get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters* param) | 235 | static int get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters* param) |
236 | { | 236 | { |
237 | struct l64781_state* state = (struct l64781_state*) fe->demodulator_priv; | 237 | struct l64781_state* state = fe->demodulator_priv; |
238 | int tmp; | 238 | int tmp; |
239 | 239 | ||
240 | 240 | ||
@@ -352,7 +352,7 @@ static int get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters* | |||
352 | 352 | ||
353 | static int l64781_read_status(struct dvb_frontend* fe, fe_status_t* status) | 353 | static int l64781_read_status(struct dvb_frontend* fe, fe_status_t* status) |
354 | { | 354 | { |
355 | struct l64781_state* state = (struct l64781_state*) fe->demodulator_priv; | 355 | struct l64781_state* state = fe->demodulator_priv; |
356 | int sync = l64781_readreg (state, 0x32); | 356 | int sync = l64781_readreg (state, 0x32); |
357 | int gain = l64781_readreg (state, 0x0e); | 357 | int gain = l64781_readreg (state, 0x0e); |
358 | 358 | ||
@@ -381,7 +381,7 @@ static int l64781_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
381 | 381 | ||
382 | static int l64781_read_ber(struct dvb_frontend* fe, u32* ber) | 382 | static int l64781_read_ber(struct dvb_frontend* fe, u32* ber) |
383 | { | 383 | { |
384 | struct l64781_state* state = (struct l64781_state*) fe->demodulator_priv; | 384 | struct l64781_state* state = fe->demodulator_priv; |
385 | 385 | ||
386 | /* XXX FIXME: set up counting period (reg 0x26...0x28) | 386 | /* XXX FIXME: set up counting period (reg 0x26...0x28) |
387 | */ | 387 | */ |
@@ -393,7 +393,7 @@ static int l64781_read_ber(struct dvb_frontend* fe, u32* ber) | |||
393 | 393 | ||
394 | static int l64781_read_signal_strength(struct dvb_frontend* fe, u16* signal_strength) | 394 | static int l64781_read_signal_strength(struct dvb_frontend* fe, u16* signal_strength) |
395 | { | 395 | { |
396 | struct l64781_state* state = (struct l64781_state*) fe->demodulator_priv; | 396 | struct l64781_state* state = fe->demodulator_priv; |
397 | 397 | ||
398 | u8 gain = l64781_readreg (state, 0x0e); | 398 | u8 gain = l64781_readreg (state, 0x0e); |
399 | *signal_strength = (gain << 8) | gain; | 399 | *signal_strength = (gain << 8) | gain; |
@@ -403,7 +403,7 @@ static int l64781_read_signal_strength(struct dvb_frontend* fe, u16* signal_stre | |||
403 | 403 | ||
404 | static int l64781_read_snr(struct dvb_frontend* fe, u16* snr) | 404 | static int l64781_read_snr(struct dvb_frontend* fe, u16* snr) |
405 | { | 405 | { |
406 | struct l64781_state* state = (struct l64781_state*) fe->demodulator_priv; | 406 | struct l64781_state* state = fe->demodulator_priv; |
407 | 407 | ||
408 | u8 avg_quality = 0xff - l64781_readreg (state, 0x33); | 408 | u8 avg_quality = 0xff - l64781_readreg (state, 0x33); |
409 | *snr = (avg_quality << 8) | avg_quality; /* not exact, but...*/ | 409 | *snr = (avg_quality << 8) | avg_quality; /* not exact, but...*/ |
@@ -413,7 +413,7 @@ static int l64781_read_snr(struct dvb_frontend* fe, u16* snr) | |||
413 | 413 | ||
414 | static int l64781_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | 414 | static int l64781_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) |
415 | { | 415 | { |
416 | struct l64781_state* state = (struct l64781_state*) fe->demodulator_priv; | 416 | struct l64781_state* state = fe->demodulator_priv; |
417 | 417 | ||
418 | *ucblocks = l64781_readreg (state, 0x37) | 418 | *ucblocks = l64781_readreg (state, 0x37) |
419 | | (l64781_readreg (state, 0x38) << 8); | 419 | | (l64781_readreg (state, 0x38) << 8); |
@@ -423,7 +423,7 @@ static int l64781_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | |||
423 | 423 | ||
424 | static int l64781_sleep(struct dvb_frontend* fe) | 424 | static int l64781_sleep(struct dvb_frontend* fe) |
425 | { | 425 | { |
426 | struct l64781_state* state = (struct l64781_state*) fe->demodulator_priv; | 426 | struct l64781_state* state = fe->demodulator_priv; |
427 | 427 | ||
428 | /* Power down */ | 428 | /* Power down */ |
429 | return l64781_writereg (state, 0x3e, 0x5a); | 429 | return l64781_writereg (state, 0x3e, 0x5a); |
@@ -431,7 +431,7 @@ static int l64781_sleep(struct dvb_frontend* fe) | |||
431 | 431 | ||
432 | static int l64781_init(struct dvb_frontend* fe) | 432 | static int l64781_init(struct dvb_frontend* fe) |
433 | { | 433 | { |
434 | struct l64781_state* state = (struct l64781_state*) fe->demodulator_priv; | 434 | struct l64781_state* state = fe->demodulator_priv; |
435 | 435 | ||
436 | reset_and_configure (state); | 436 | reset_and_configure (state); |
437 | 437 | ||
@@ -484,7 +484,7 @@ static int l64781_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend | |||
484 | 484 | ||
485 | static void l64781_release(struct dvb_frontend* fe) | 485 | static void l64781_release(struct dvb_frontend* fe) |
486 | { | 486 | { |
487 | struct l64781_state* state = (struct l64781_state*) fe->demodulator_priv; | 487 | struct l64781_state* state = fe->demodulator_priv; |
488 | kfree(state); | 488 | kfree(state); |
489 | } | 489 | } |
490 | 490 | ||
@@ -501,7 +501,7 @@ struct dvb_frontend* l64781_attach(const struct l64781_config* config, | |||
501 | { .addr = config->demod_address, .flags = I2C_M_RD, .buf = b1, .len = 1 } }; | 501 | { .addr = config->demod_address, .flags = I2C_M_RD, .buf = b1, .len = 1 } }; |
502 | 502 | ||
503 | /* allocate memory for the internal state */ | 503 | /* allocate memory for the internal state */ |
504 | state = (struct l64781_state*) kmalloc(sizeof(struct l64781_state), GFP_KERNEL); | 504 | state = kmalloc(sizeof(struct l64781_state), GFP_KERNEL); |
505 | if (state == NULL) goto error; | 505 | if (state == NULL) goto error; |
506 | 506 | ||
507 | /* setup the state */ | 507 | /* setup the state */ |
diff --git a/drivers/media/dvb/frontends/mt312.c b/drivers/media/dvb/frontends/mt312.c index 176a22e3441b..e455aecd76b2 100644 --- a/drivers/media/dvb/frontends/mt312.c +++ b/drivers/media/dvb/frontends/mt312.c | |||
@@ -226,7 +226,7 @@ static int mt312_get_code_rate(struct mt312_state* state, fe_code_rate_t *cr) | |||
226 | 226 | ||
227 | static int mt312_initfe(struct dvb_frontend* fe) | 227 | static int mt312_initfe(struct dvb_frontend* fe) |
228 | { | 228 | { |
229 | struct mt312_state *state = (struct mt312_state*) fe->demodulator_priv; | 229 | struct mt312_state *state = fe->demodulator_priv; |
230 | int ret; | 230 | int ret; |
231 | u8 buf[2]; | 231 | u8 buf[2]; |
232 | 232 | ||
@@ -287,7 +287,7 @@ static int mt312_initfe(struct dvb_frontend* fe) | |||
287 | static int mt312_send_master_cmd(struct dvb_frontend* fe, | 287 | static int mt312_send_master_cmd(struct dvb_frontend* fe, |
288 | struct dvb_diseqc_master_cmd *c) | 288 | struct dvb_diseqc_master_cmd *c) |
289 | { | 289 | { |
290 | struct mt312_state *state = (struct mt312_state*) fe->demodulator_priv; | 290 | struct mt312_state *state = fe->demodulator_priv; |
291 | int ret; | 291 | int ret; |
292 | u8 diseqc_mode; | 292 | u8 diseqc_mode; |
293 | 293 | ||
@@ -318,7 +318,7 @@ static int mt312_send_master_cmd(struct dvb_frontend* fe, | |||
318 | 318 | ||
319 | static int mt312_send_burst(struct dvb_frontend* fe, const fe_sec_mini_cmd_t c) | 319 | static int mt312_send_burst(struct dvb_frontend* fe, const fe_sec_mini_cmd_t c) |
320 | { | 320 | { |
321 | struct mt312_state *state = (struct mt312_state*) fe->demodulator_priv; | 321 | struct mt312_state *state = fe->demodulator_priv; |
322 | const u8 mini_tab[2] = { 0x02, 0x03 }; | 322 | const u8 mini_tab[2] = { 0x02, 0x03 }; |
323 | 323 | ||
324 | int ret; | 324 | int ret; |
@@ -340,7 +340,7 @@ static int mt312_send_burst(struct dvb_frontend* fe, const fe_sec_mini_cmd_t c) | |||
340 | 340 | ||
341 | static int mt312_set_tone(struct dvb_frontend* fe, const fe_sec_tone_mode_t t) | 341 | static int mt312_set_tone(struct dvb_frontend* fe, const fe_sec_tone_mode_t t) |
342 | { | 342 | { |
343 | struct mt312_state *state = (struct mt312_state*) fe->demodulator_priv; | 343 | struct mt312_state *state = fe->demodulator_priv; |
344 | const u8 tone_tab[2] = { 0x01, 0x00 }; | 344 | const u8 tone_tab[2] = { 0x01, 0x00 }; |
345 | 345 | ||
346 | int ret; | 346 | int ret; |
@@ -362,7 +362,7 @@ static int mt312_set_tone(struct dvb_frontend* fe, const fe_sec_tone_mode_t t) | |||
362 | 362 | ||
363 | static int mt312_set_voltage(struct dvb_frontend* fe, const fe_sec_voltage_t v) | 363 | static int mt312_set_voltage(struct dvb_frontend* fe, const fe_sec_voltage_t v) |
364 | { | 364 | { |
365 | struct mt312_state *state = (struct mt312_state*) fe->demodulator_priv; | 365 | struct mt312_state *state = fe->demodulator_priv; |
366 | const u8 volt_tab[3] = { 0x00, 0x40, 0x00 }; | 366 | const u8 volt_tab[3] = { 0x00, 0x40, 0x00 }; |
367 | 367 | ||
368 | if (v > SEC_VOLTAGE_OFF) | 368 | if (v > SEC_VOLTAGE_OFF) |
@@ -373,7 +373,7 @@ static int mt312_set_voltage(struct dvb_frontend* fe, const fe_sec_voltage_t v) | |||
373 | 373 | ||
374 | static int mt312_read_status(struct dvb_frontend* fe, fe_status_t *s) | 374 | static int mt312_read_status(struct dvb_frontend* fe, fe_status_t *s) |
375 | { | 375 | { |
376 | struct mt312_state *state = (struct mt312_state*) fe->demodulator_priv; | 376 | struct mt312_state *state = fe->demodulator_priv; |
377 | int ret; | 377 | int ret; |
378 | u8 status[3]; | 378 | u8 status[3]; |
379 | 379 | ||
@@ -400,7 +400,7 @@ static int mt312_read_status(struct dvb_frontend* fe, fe_status_t *s) | |||
400 | 400 | ||
401 | static int mt312_read_ber(struct dvb_frontend* fe, u32 *ber) | 401 | static int mt312_read_ber(struct dvb_frontend* fe, u32 *ber) |
402 | { | 402 | { |
403 | struct mt312_state *state = (struct mt312_state*) fe->demodulator_priv; | 403 | struct mt312_state *state = fe->demodulator_priv; |
404 | int ret; | 404 | int ret; |
405 | u8 buf[3]; | 405 | u8 buf[3]; |
406 | 406 | ||
@@ -414,7 +414,7 @@ static int mt312_read_ber(struct dvb_frontend* fe, u32 *ber) | |||
414 | 414 | ||
415 | static int mt312_read_signal_strength(struct dvb_frontend* fe, u16 *signal_strength) | 415 | static int mt312_read_signal_strength(struct dvb_frontend* fe, u16 *signal_strength) |
416 | { | 416 | { |
417 | struct mt312_state *state = (struct mt312_state*) fe->demodulator_priv; | 417 | struct mt312_state *state = fe->demodulator_priv; |
418 | int ret; | 418 | int ret; |
419 | u8 buf[3]; | 419 | u8 buf[3]; |
420 | u16 agc; | 420 | u16 agc; |
@@ -435,7 +435,7 @@ static int mt312_read_signal_strength(struct dvb_frontend* fe, u16 *signal_stren | |||
435 | 435 | ||
436 | static int mt312_read_snr(struct dvb_frontend* fe, u16 *snr) | 436 | static int mt312_read_snr(struct dvb_frontend* fe, u16 *snr) |
437 | { | 437 | { |
438 | struct mt312_state *state = (struct mt312_state*) fe->demodulator_priv; | 438 | struct mt312_state *state = fe->demodulator_priv; |
439 | int ret; | 439 | int ret; |
440 | u8 buf[2]; | 440 | u8 buf[2]; |
441 | 441 | ||
@@ -449,7 +449,7 @@ static int mt312_read_snr(struct dvb_frontend* fe, u16 *snr) | |||
449 | 449 | ||
450 | static int mt312_read_ucblocks(struct dvb_frontend* fe, u32 *ubc) | 450 | static int mt312_read_ucblocks(struct dvb_frontend* fe, u32 *ubc) |
451 | { | 451 | { |
452 | struct mt312_state *state = (struct mt312_state*) fe->demodulator_priv; | 452 | struct mt312_state *state = fe->demodulator_priv; |
453 | int ret; | 453 | int ret; |
454 | u8 buf[2]; | 454 | u8 buf[2]; |
455 | 455 | ||
@@ -464,7 +464,7 @@ static int mt312_read_ucblocks(struct dvb_frontend* fe, u32 *ubc) | |||
464 | static int mt312_set_frontend(struct dvb_frontend* fe, | 464 | static int mt312_set_frontend(struct dvb_frontend* fe, |
465 | struct dvb_frontend_parameters *p) | 465 | struct dvb_frontend_parameters *p) |
466 | { | 466 | { |
467 | struct mt312_state *state = (struct mt312_state*) fe->demodulator_priv; | 467 | struct mt312_state *state = fe->demodulator_priv; |
468 | int ret; | 468 | int ret; |
469 | u8 buf[5], config_val; | 469 | u8 buf[5], config_val; |
470 | u16 sr; | 470 | u16 sr; |
@@ -560,7 +560,7 @@ static int mt312_set_frontend(struct dvb_frontend* fe, | |||
560 | static int mt312_get_frontend(struct dvb_frontend* fe, | 560 | static int mt312_get_frontend(struct dvb_frontend* fe, |
561 | struct dvb_frontend_parameters *p) | 561 | struct dvb_frontend_parameters *p) |
562 | { | 562 | { |
563 | struct mt312_state *state = (struct mt312_state*) fe->demodulator_priv; | 563 | struct mt312_state *state = fe->demodulator_priv; |
564 | int ret; | 564 | int ret; |
565 | 565 | ||
566 | if ((ret = mt312_get_inversion(state, &p->inversion)) < 0) | 566 | if ((ret = mt312_get_inversion(state, &p->inversion)) < 0) |
@@ -577,7 +577,7 @@ static int mt312_get_frontend(struct dvb_frontend* fe, | |||
577 | 577 | ||
578 | static int mt312_sleep(struct dvb_frontend* fe) | 578 | static int mt312_sleep(struct dvb_frontend* fe) |
579 | { | 579 | { |
580 | struct mt312_state *state = (struct mt312_state*) fe->demodulator_priv; | 580 | struct mt312_state *state = fe->demodulator_priv; |
581 | int ret; | 581 | int ret; |
582 | u8 config; | 582 | u8 config; |
583 | 583 | ||
@@ -605,7 +605,7 @@ static int mt312_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_ | |||
605 | 605 | ||
606 | static void mt312_release(struct dvb_frontend* fe) | 606 | static void mt312_release(struct dvb_frontend* fe) |
607 | { | 607 | { |
608 | struct mt312_state* state = (struct mt312_state*) fe->demodulator_priv; | 608 | struct mt312_state* state = fe->demodulator_priv; |
609 | kfree(state); | 609 | kfree(state); |
610 | } | 610 | } |
611 | 611 | ||
@@ -617,7 +617,7 @@ struct dvb_frontend* vp310_attach(const struct mt312_config* config, | |||
617 | struct mt312_state* state = NULL; | 617 | struct mt312_state* state = NULL; |
618 | 618 | ||
619 | /* allocate memory for the internal state */ | 619 | /* allocate memory for the internal state */ |
620 | state = (struct mt312_state*) kmalloc(sizeof(struct mt312_state), GFP_KERNEL); | 620 | state = kmalloc(sizeof(struct mt312_state), GFP_KERNEL); |
621 | if (state == NULL) | 621 | if (state == NULL) |
622 | goto error; | 622 | goto error; |
623 | 623 | ||
@@ -651,7 +651,7 @@ struct dvb_frontend* mt312_attach(const struct mt312_config* config, | |||
651 | struct mt312_state* state = NULL; | 651 | struct mt312_state* state = NULL; |
652 | 652 | ||
653 | /* allocate memory for the internal state */ | 653 | /* allocate memory for the internal state */ |
654 | state = (struct mt312_state*) kmalloc(sizeof(struct mt312_state), GFP_KERNEL); | 654 | state = kmalloc(sizeof(struct mt312_state), GFP_KERNEL); |
655 | if (state == NULL) | 655 | if (state == NULL) |
656 | goto error; | 656 | goto error; |
657 | 657 | ||
diff --git a/drivers/media/dvb/frontends/mt352.c b/drivers/media/dvb/frontends/mt352.c index 50326c7248fa..d32dc4de9e7f 100644 --- a/drivers/media/dvb/frontends/mt352.c +++ b/drivers/media/dvb/frontends/mt352.c | |||
@@ -46,7 +46,7 @@ struct mt352_state { | |||
46 | struct dvb_frontend_ops ops; | 46 | struct dvb_frontend_ops ops; |
47 | 47 | ||
48 | /* configuration settings */ | 48 | /* configuration settings */ |
49 | const struct mt352_config* config; | 49 | struct mt352_config config; |
50 | }; | 50 | }; |
51 | 51 | ||
52 | static int debug; | 52 | static int debug; |
@@ -59,7 +59,7 @@ static int mt352_single_write(struct dvb_frontend *fe, u8 reg, u8 val) | |||
59 | { | 59 | { |
60 | struct mt352_state* state = fe->demodulator_priv; | 60 | struct mt352_state* state = fe->demodulator_priv; |
61 | u8 buf[2] = { reg, val }; | 61 | u8 buf[2] = { reg, val }; |
62 | struct i2c_msg msg = { .addr = state->config->demod_address, .flags = 0, | 62 | struct i2c_msg msg = { .addr = state->config.demod_address, .flags = 0, |
63 | .buf = buf, .len = 2 }; | 63 | .buf = buf, .len = 2 }; |
64 | int err = i2c_transfer(state->i2c, &msg, 1); | 64 | int err = i2c_transfer(state->i2c, &msg, 1); |
65 | if (err != 1) { | 65 | if (err != 1) { |
@@ -84,10 +84,10 @@ static int mt352_read_register(struct mt352_state* state, u8 reg) | |||
84 | int ret; | 84 | int ret; |
85 | u8 b0 [] = { reg }; | 85 | u8 b0 [] = { reg }; |
86 | u8 b1 [] = { 0 }; | 86 | u8 b1 [] = { 0 }; |
87 | struct i2c_msg msg [] = { { .addr = state->config->demod_address, | 87 | struct i2c_msg msg [] = { { .addr = state->config.demod_address, |
88 | .flags = 0, | 88 | .flags = 0, |
89 | .buf = b0, .len = 1 }, | 89 | .buf = b0, .len = 1 }, |
90 | { .addr = state->config->demod_address, | 90 | { .addr = state->config.demod_address, |
91 | .flags = I2C_M_RD, | 91 | .flags = I2C_M_RD, |
92 | .buf = b1, .len = 1 } }; | 92 | .buf = b1, .len = 1 } }; |
93 | 93 | ||
@@ -102,11 +102,6 @@ static int mt352_read_register(struct mt352_state* state, u8 reg) | |||
102 | return b1[0]; | 102 | return b1[0]; |
103 | } | 103 | } |
104 | 104 | ||
105 | int mt352_read(struct dvb_frontend *fe, u8 reg) | ||
106 | { | ||
107 | return mt352_read_register(fe->demodulator_priv,reg); | ||
108 | } | ||
109 | |||
110 | static int mt352_sleep(struct dvb_frontend* fe) | 105 | static int mt352_sleep(struct dvb_frontend* fe) |
111 | { | 106 | { |
112 | static u8 mt352_softdown[] = { CLOCK_CTL, 0x20, 0x08 }; | 107 | static u8 mt352_softdown[] = { CLOCK_CTL, 0x20, 0x08 }; |
@@ -134,8 +129,8 @@ static void mt352_calc_nominal_rate(struct mt352_state* state, | |||
134 | bw = 8; | 129 | bw = 8; |
135 | break; | 130 | break; |
136 | } | 131 | } |
137 | if (state->config->adc_clock) | 132 | if (state->config.adc_clock) |
138 | adc_clock = state->config->adc_clock; | 133 | adc_clock = state->config.adc_clock; |
139 | 134 | ||
140 | value = 64 * bw * (1<<16) / (7 * 8); | 135 | value = 64 * bw * (1<<16) / (7 * 8); |
141 | value = value * 1000 / adc_clock; | 136 | value = value * 1000 / adc_clock; |
@@ -152,10 +147,10 @@ static void mt352_calc_input_freq(struct mt352_state* state, | |||
152 | int if2 = 36167; /* 36.166667 MHz */ | 147 | int if2 = 36167; /* 36.166667 MHz */ |
153 | int ife,value; | 148 | int ife,value; |
154 | 149 | ||
155 | if (state->config->adc_clock) | 150 | if (state->config.adc_clock) |
156 | adc_clock = state->config->adc_clock; | 151 | adc_clock = state->config.adc_clock; |
157 | if (state->config->if2) | 152 | if (state->config.if2) |
158 | if2 = state->config->if2; | 153 | if2 = state->config.if2; |
159 | 154 | ||
160 | ife = (2*adc_clock - if2); | 155 | ife = (2*adc_clock - if2); |
161 | value = -16374 * ife / adc_clock; | 156 | value = -16374 * ife / adc_clock; |
@@ -289,10 +284,10 @@ static int mt352_set_parameters(struct dvb_frontend* fe, | |||
289 | 284 | ||
290 | mt352_calc_nominal_rate(state, op->bandwidth, buf+4); | 285 | mt352_calc_nominal_rate(state, op->bandwidth, buf+4); |
291 | mt352_calc_input_freq(state, buf+6); | 286 | mt352_calc_input_freq(state, buf+6); |
292 | state->config->pll_set(fe, param, buf+8); | 287 | state->config.pll_set(fe, param, buf+8); |
293 | 288 | ||
294 | mt352_write(fe, buf, sizeof(buf)); | 289 | mt352_write(fe, buf, sizeof(buf)); |
295 | if (state->config->no_tuner) { | 290 | if (state->config.no_tuner) { |
296 | /* start decoding */ | 291 | /* start decoding */ |
297 | mt352_write(fe, fsm_go, 2); | 292 | mt352_write(fe, fsm_go, 2); |
298 | } else { | 293 | } else { |
@@ -516,7 +511,7 @@ static int mt352_init(struct dvb_frontend* fe) | |||
516 | 511 | ||
517 | /* Do a "hard" reset */ | 512 | /* Do a "hard" reset */ |
518 | mt352_write(fe, mt352_reset_attach, sizeof(mt352_reset_attach)); | 513 | mt352_write(fe, mt352_reset_attach, sizeof(mt352_reset_attach)); |
519 | return state->config->demod_init(fe); | 514 | return state->config.demod_init(fe); |
520 | } | 515 | } |
521 | 516 | ||
522 | return 0; | 517 | return 0; |
@@ -541,8 +536,8 @@ struct dvb_frontend* mt352_attach(const struct mt352_config* config, | |||
541 | memset(state,0,sizeof(*state)); | 536 | memset(state,0,sizeof(*state)); |
542 | 537 | ||
543 | /* setup the state */ | 538 | /* setup the state */ |
544 | state->config = config; | ||
545 | state->i2c = i2c; | 539 | state->i2c = i2c; |
540 | memcpy(&state->config,config,sizeof(struct mt352_config)); | ||
546 | memcpy(&state->ops, &mt352_ops, sizeof(struct dvb_frontend_ops)); | 541 | memcpy(&state->ops, &mt352_ops, sizeof(struct dvb_frontend_ops)); |
547 | 542 | ||
548 | /* check if the demod is there */ | 543 | /* check if the demod is there */ |
@@ -601,10 +596,3 @@ MODULE_LICENSE("GPL"); | |||
601 | 596 | ||
602 | EXPORT_SYMBOL(mt352_attach); | 597 | EXPORT_SYMBOL(mt352_attach); |
603 | EXPORT_SYMBOL(mt352_write); | 598 | EXPORT_SYMBOL(mt352_write); |
604 | EXPORT_SYMBOL(mt352_read); | ||
605 | /* | ||
606 | * Local variables: | ||
607 | * c-basic-offset: 8 | ||
608 | * compile-command: "make DVB=1" | ||
609 | * End: | ||
610 | */ | ||
diff --git a/drivers/media/dvb/frontends/mt352.h b/drivers/media/dvb/frontends/mt352.h index f5d8a5aed8a9..03040cd595bb 100644 --- a/drivers/media/dvb/frontends/mt352.h +++ b/drivers/media/dvb/frontends/mt352.h | |||
@@ -61,12 +61,5 @@ extern struct dvb_frontend* mt352_attach(const struct mt352_config* config, | |||
61 | struct i2c_adapter* i2c); | 61 | struct i2c_adapter* i2c); |
62 | 62 | ||
63 | extern int mt352_write(struct dvb_frontend* fe, u8* ibuf, int ilen); | 63 | extern int mt352_write(struct dvb_frontend* fe, u8* ibuf, int ilen); |
64 | extern int mt352_read(struct dvb_frontend *fe, u8 reg); | ||
65 | 64 | ||
66 | #endif // MT352_H | 65 | #endif // MT352_H |
67 | |||
68 | /* | ||
69 | * Local variables: | ||
70 | * c-basic-offset: 8 | ||
71 | * End: | ||
72 | */ | ||
diff --git a/drivers/media/dvb/frontends/nxt2002.c b/drivers/media/dvb/frontends/nxt2002.c index 4743aa17406e..35a1d60f1927 100644 --- a/drivers/media/dvb/frontends/nxt2002.c +++ b/drivers/media/dvb/frontends/nxt2002.c | |||
@@ -241,7 +241,7 @@ static void nxt2002_agc_reset(struct nxt2002_state* state) | |||
241 | static int nxt2002_load_firmware (struct dvb_frontend* fe, const struct firmware *fw) | 241 | static int nxt2002_load_firmware (struct dvb_frontend* fe, const struct firmware *fw) |
242 | { | 242 | { |
243 | 243 | ||
244 | struct nxt2002_state* state = (struct nxt2002_state*) fe->demodulator_priv; | 244 | struct nxt2002_state* state = fe->demodulator_priv; |
245 | u8 buf[256],written = 0,chunkpos = 0; | 245 | u8 buf[256],written = 0,chunkpos = 0; |
246 | u16 rambase,position,crc = 0; | 246 | u16 rambase,position,crc = 0; |
247 | 247 | ||
@@ -309,7 +309,7 @@ static int nxt2002_load_firmware (struct dvb_frontend* fe, const struct firmware | |||
309 | static int nxt2002_setup_frontend_parameters (struct dvb_frontend* fe, | 309 | static int nxt2002_setup_frontend_parameters (struct dvb_frontend* fe, |
310 | struct dvb_frontend_parameters *p) | 310 | struct dvb_frontend_parameters *p) |
311 | { | 311 | { |
312 | struct nxt2002_state* state = (struct nxt2002_state*) fe->demodulator_priv; | 312 | struct nxt2002_state* state = fe->demodulator_priv; |
313 | u32 freq = 0; | 313 | u32 freq = 0; |
314 | u16 tunerfreq = 0; | 314 | u16 tunerfreq = 0; |
315 | u8 buf[4]; | 315 | u8 buf[4]; |
@@ -343,8 +343,6 @@ static int nxt2002_setup_frontend_parameters (struct dvb_frontend* fe, | |||
343 | /* reset the agc now that tuning has been completed */ | 343 | /* reset the agc now that tuning has been completed */ |
344 | nxt2002_agc_reset(state); | 344 | nxt2002_agc_reset(state); |
345 | 345 | ||
346 | |||
347 | |||
348 | /* set target power level */ | 346 | /* set target power level */ |
349 | switch (p->u.vsb.modulation) { | 347 | switch (p->u.vsb.modulation) { |
350 | case QAM_64: | 348 | case QAM_64: |
@@ -453,7 +451,7 @@ static int nxt2002_setup_frontend_parameters (struct dvb_frontend* fe, | |||
453 | 451 | ||
454 | static int nxt2002_read_status(struct dvb_frontend* fe, fe_status_t* status) | 452 | static int nxt2002_read_status(struct dvb_frontend* fe, fe_status_t* status) |
455 | { | 453 | { |
456 | struct nxt2002_state* state = (struct nxt2002_state*) fe->demodulator_priv; | 454 | struct nxt2002_state* state = fe->demodulator_priv; |
457 | u8 lock; | 455 | u8 lock; |
458 | i2c_readbytes(state,0x31,&lock,1); | 456 | i2c_readbytes(state,0x31,&lock,1); |
459 | 457 | ||
@@ -470,7 +468,7 @@ static int nxt2002_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
470 | 468 | ||
471 | static int nxt2002_read_ber(struct dvb_frontend* fe, u32* ber) | 469 | static int nxt2002_read_ber(struct dvb_frontend* fe, u32* ber) |
472 | { | 470 | { |
473 | struct nxt2002_state* state = (struct nxt2002_state*) fe->demodulator_priv; | 471 | struct nxt2002_state* state = fe->demodulator_priv; |
474 | u8 b[3]; | 472 | u8 b[3]; |
475 | 473 | ||
476 | nxt2002_readreg_multibyte(state,0xE6,b,3); | 474 | nxt2002_readreg_multibyte(state,0xE6,b,3); |
@@ -482,7 +480,7 @@ static int nxt2002_read_ber(struct dvb_frontend* fe, u32* ber) | |||
482 | 480 | ||
483 | static int nxt2002_read_signal_strength(struct dvb_frontend* fe, u16* strength) | 481 | static int nxt2002_read_signal_strength(struct dvb_frontend* fe, u16* strength) |
484 | { | 482 | { |
485 | struct nxt2002_state* state = (struct nxt2002_state*) fe->demodulator_priv; | 483 | struct nxt2002_state* state = fe->demodulator_priv; |
486 | u8 b[2]; | 484 | u8 b[2]; |
487 | u16 temp = 0; | 485 | u16 temp = 0; |
488 | 486 | ||
@@ -502,7 +500,7 @@ static int nxt2002_read_signal_strength(struct dvb_frontend* fe, u16* strength) | |||
502 | static int nxt2002_read_snr(struct dvb_frontend* fe, u16* snr) | 500 | static int nxt2002_read_snr(struct dvb_frontend* fe, u16* snr) |
503 | { | 501 | { |
504 | 502 | ||
505 | struct nxt2002_state* state = (struct nxt2002_state*) fe->demodulator_priv; | 503 | struct nxt2002_state* state = fe->demodulator_priv; |
506 | u8 b[2]; | 504 | u8 b[2]; |
507 | u16 temp = 0, temp2; | 505 | u16 temp = 0, temp2; |
508 | u32 snrdb = 0; | 506 | u32 snrdb = 0; |
@@ -536,7 +534,7 @@ static int nxt2002_read_snr(struct dvb_frontend* fe, u16* snr) | |||
536 | 534 | ||
537 | static int nxt2002_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | 535 | static int nxt2002_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) |
538 | { | 536 | { |
539 | struct nxt2002_state* state = (struct nxt2002_state*) fe->demodulator_priv; | 537 | struct nxt2002_state* state = fe->demodulator_priv; |
540 | u8 b[3]; | 538 | u8 b[3]; |
541 | 539 | ||
542 | nxt2002_readreg_multibyte(state,0xE6,b,3); | 540 | nxt2002_readreg_multibyte(state,0xE6,b,3); |
@@ -552,7 +550,7 @@ static int nxt2002_sleep(struct dvb_frontend* fe) | |||
552 | 550 | ||
553 | static int nxt2002_init(struct dvb_frontend* fe) | 551 | static int nxt2002_init(struct dvb_frontend* fe) |
554 | { | 552 | { |
555 | struct nxt2002_state* state = (struct nxt2002_state*) fe->demodulator_priv; | 553 | struct nxt2002_state* state = fe->demodulator_priv; |
556 | const struct firmware *fw; | 554 | const struct firmware *fw; |
557 | int ret; | 555 | int ret; |
558 | u8 buf[2]; | 556 | u8 buf[2]; |
@@ -624,7 +622,7 @@ static int nxt2002_get_tune_settings(struct dvb_frontend* fe, struct dvb_fronten | |||
624 | 622 | ||
625 | static void nxt2002_release(struct dvb_frontend* fe) | 623 | static void nxt2002_release(struct dvb_frontend* fe) |
626 | { | 624 | { |
627 | struct nxt2002_state* state = (struct nxt2002_state*) fe->demodulator_priv; | 625 | struct nxt2002_state* state = fe->demodulator_priv; |
628 | kfree(state); | 626 | kfree(state); |
629 | } | 627 | } |
630 | 628 | ||
@@ -637,7 +635,7 @@ struct dvb_frontend* nxt2002_attach(const struct nxt2002_config* config, | |||
637 | u8 buf [] = {0,0,0,0,0}; | 635 | u8 buf [] = {0,0,0,0,0}; |
638 | 636 | ||
639 | /* allocate memory for the internal state */ | 637 | /* allocate memory for the internal state */ |
640 | state = (struct nxt2002_state*) kmalloc(sizeof(struct nxt2002_state), GFP_KERNEL); | 638 | state = kmalloc(sizeof(struct nxt2002_state), GFP_KERNEL); |
641 | if (state == NULL) goto error; | 639 | if (state == NULL) goto error; |
642 | 640 | ||
643 | /* setup the state */ | 641 | /* setup the state */ |
diff --git a/drivers/media/dvb/frontends/nxt6000.c b/drivers/media/dvb/frontends/nxt6000.c index a41f7da8b842..966de9853d18 100644 --- a/drivers/media/dvb/frontends/nxt6000.c +++ b/drivers/media/dvb/frontends/nxt6000.c | |||
@@ -176,11 +176,16 @@ static int nxt6000_set_transmission_mode(struct nxt6000_state* state, fe_transmi | |||
176 | 176 | ||
177 | static void nxt6000_setup(struct dvb_frontend* fe) | 177 | static void nxt6000_setup(struct dvb_frontend* fe) |
178 | { | 178 | { |
179 | struct nxt6000_state* state = (struct nxt6000_state*) fe->demodulator_priv; | 179 | struct nxt6000_state* state = fe->demodulator_priv; |
180 | 180 | ||
181 | nxt6000_writereg(state, RS_COR_SYNC_PARAM, SYNC_PARAM); | 181 | nxt6000_writereg(state, RS_COR_SYNC_PARAM, SYNC_PARAM); |
182 | nxt6000_writereg(state, BER_CTRL, /*(1 << 2) | */ (0x01 << 1) | 0x01); | 182 | nxt6000_writereg(state, BER_CTRL, /*(1 << 2) | */ (0x01 << 1) | 0x01); |
183 | nxt6000_writereg(state, VIT_COR_CTL, VIT_COR_RESYNC); | 183 | nxt6000_writereg(state, VIT_BERTIME_2, 0x00); // BER Timer = 0x000200 * 256 = 131072 bits |
184 | nxt6000_writereg(state, VIT_BERTIME_1, 0x02); // | ||
185 | nxt6000_writereg(state, VIT_BERTIME_0, 0x00); // | ||
186 | nxt6000_writereg(state, VIT_COR_INTEN, 0x98); // Enable BER interrupts | ||
187 | nxt6000_writereg(state, VIT_COR_CTL, 0x82); // Enable BER measurement | ||
188 | nxt6000_writereg(state, VIT_COR_CTL, VIT_COR_RESYNC | 0x02 ); | ||
184 | nxt6000_writereg(state, OFDM_COR_CTL, (0x01 << 5) | (nxt6000_readreg(state, OFDM_COR_CTL) & 0x0F)); | 189 | nxt6000_writereg(state, OFDM_COR_CTL, (0x01 << 5) | (nxt6000_readreg(state, OFDM_COR_CTL) & 0x0F)); |
185 | nxt6000_writereg(state, OFDM_COR_MODEGUARD, FORCEMODE8K | 0x02); | 190 | nxt6000_writereg(state, OFDM_COR_MODEGUARD, FORCEMODE8K | 0x02); |
186 | nxt6000_writereg(state, OFDM_AGC_CTL, AGCLAST | INITIAL_AGC_BW); | 191 | nxt6000_writereg(state, OFDM_AGC_CTL, AGCLAST | INITIAL_AGC_BW); |
@@ -422,7 +427,7 @@ static void nxt6000_dump_status(struct nxt6000_state *state) | |||
422 | static int nxt6000_read_status(struct dvb_frontend* fe, fe_status_t* status) | 427 | static int nxt6000_read_status(struct dvb_frontend* fe, fe_status_t* status) |
423 | { | 428 | { |
424 | u8 core_status; | 429 | u8 core_status; |
425 | struct nxt6000_state* state = (struct nxt6000_state*) fe->demodulator_priv; | 430 | struct nxt6000_state* state = fe->demodulator_priv; |
426 | 431 | ||
427 | *status = 0; | 432 | *status = 0; |
428 | 433 | ||
@@ -451,7 +456,7 @@ static int nxt6000_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
451 | 456 | ||
452 | static int nxt6000_init(struct dvb_frontend* fe) | 457 | static int nxt6000_init(struct dvb_frontend* fe) |
453 | { | 458 | { |
454 | struct nxt6000_state* state = (struct nxt6000_state*) fe->demodulator_priv; | 459 | struct nxt6000_state* state = fe->demodulator_priv; |
455 | 460 | ||
456 | nxt6000_reset(state); | 461 | nxt6000_reset(state); |
457 | nxt6000_setup(fe); | 462 | nxt6000_setup(fe); |
@@ -461,7 +466,7 @@ static int nxt6000_init(struct dvb_frontend* fe) | |||
461 | 466 | ||
462 | static int nxt6000_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *param) | 467 | static int nxt6000_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *param) |
463 | { | 468 | { |
464 | struct nxt6000_state* state = (struct nxt6000_state*) fe->demodulator_priv; | 469 | struct nxt6000_state* state = fe->demodulator_priv; |
465 | int result; | 470 | int result; |
466 | 471 | ||
467 | nxt6000_writereg(state, ENABLE_TUNER_IIC, 0x01); /* open i2c bus switch */ | 472 | nxt6000_writereg(state, ENABLE_TUNER_IIC, 0x01); /* open i2c bus switch */ |
@@ -482,10 +487,44 @@ static int nxt6000_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
482 | 487 | ||
483 | static void nxt6000_release(struct dvb_frontend* fe) | 488 | static void nxt6000_release(struct dvb_frontend* fe) |
484 | { | 489 | { |
485 | struct nxt6000_state* state = (struct nxt6000_state*) fe->demodulator_priv; | 490 | struct nxt6000_state* state = fe->demodulator_priv; |
486 | kfree(state); | 491 | kfree(state); |
487 | } | 492 | } |
488 | 493 | ||
494 | static int nxt6000_read_snr(struct dvb_frontend* fe, u16* snr) | ||
495 | { | ||
496 | struct nxt6000_state* state = fe->demodulator_priv; | ||
497 | |||
498 | *snr = nxt6000_readreg( state, OFDM_CHC_SNR) / 8; | ||
499 | |||
500 | return 0; | ||
501 | } | ||
502 | |||
503 | static int nxt6000_read_ber(struct dvb_frontend* fe, u32* ber) | ||
504 | { | ||
505 | struct nxt6000_state* state = fe->demodulator_priv; | ||
506 | |||
507 | nxt6000_writereg( state, VIT_COR_INTSTAT, 0x18 ); | ||
508 | |||
509 | *ber = (nxt6000_readreg( state, VIT_BER_1 ) << 8 ) | | ||
510 | nxt6000_readreg( state, VIT_BER_0 ); | ||
511 | |||
512 | nxt6000_writereg( state, VIT_COR_INTSTAT, 0x18); // Clear BER Done interrupts | ||
513 | |||
514 | return 0; | ||
515 | } | ||
516 | |||
517 | static int nxt6000_read_signal_strength(struct dvb_frontend* fe, u16* signal_strength) | ||
518 | { | ||
519 | struct nxt6000_state* state = fe->demodulator_priv; | ||
520 | |||
521 | *signal_strength = (short) (511 - | ||
522 | (nxt6000_readreg(state, AGC_GAIN_1) + | ||
523 | ((nxt6000_readreg(state, AGC_GAIN_2) & 0x03) << 8))); | ||
524 | |||
525 | return 0; | ||
526 | } | ||
527 | |||
489 | static struct dvb_frontend_ops nxt6000_ops; | 528 | static struct dvb_frontend_ops nxt6000_ops; |
490 | 529 | ||
491 | struct dvb_frontend* nxt6000_attach(const struct nxt6000_config* config, | 530 | struct dvb_frontend* nxt6000_attach(const struct nxt6000_config* config, |
@@ -494,7 +533,7 @@ struct dvb_frontend* nxt6000_attach(const struct nxt6000_config* config, | |||
494 | struct nxt6000_state* state = NULL; | 533 | struct nxt6000_state* state = NULL; |
495 | 534 | ||
496 | /* allocate memory for the internal state */ | 535 | /* allocate memory for the internal state */ |
497 | state = (struct nxt6000_state*) kmalloc(sizeof(struct nxt6000_state), GFP_KERNEL); | 536 | state = kmalloc(sizeof(struct nxt6000_state), GFP_KERNEL); |
498 | if (state == NULL) goto error; | 537 | if (state == NULL) goto error; |
499 | 538 | ||
500 | /* setup the state */ | 539 | /* setup the state */ |
@@ -542,6 +581,9 @@ static struct dvb_frontend_ops nxt6000_ops = { | |||
542 | .set_frontend = nxt6000_set_frontend, | 581 | .set_frontend = nxt6000_set_frontend, |
543 | 582 | ||
544 | .read_status = nxt6000_read_status, | 583 | .read_status = nxt6000_read_status, |
584 | .read_ber = nxt6000_read_ber, | ||
585 | .read_signal_strength = nxt6000_read_signal_strength, | ||
586 | .read_snr = nxt6000_read_snr, | ||
545 | }; | 587 | }; |
546 | 588 | ||
547 | module_param(debug, int, 0644); | 589 | module_param(debug, int, 0644); |
diff --git a/drivers/media/dvb/frontends/nxt6000_priv.h b/drivers/media/dvb/frontends/nxt6000_priv.h index 64b1a89b2a22..0422e580038a 100644 --- a/drivers/media/dvb/frontends/nxt6000_priv.h +++ b/drivers/media/dvb/frontends/nxt6000_priv.h | |||
@@ -65,12 +65,27 @@ | |||
65 | #define BER_DONE (0x08) | 65 | #define BER_DONE (0x08) |
66 | #define BER_OVERFLOW (0x10) | 66 | #define BER_OVERFLOW (0x10) |
67 | 67 | ||
68 | /* 0x38 VIT_BERTIME_2 */ | ||
69 | #define VIT_BERTIME_2 (0x38) | ||
70 | |||
71 | /* 0x39 VIT_BERTIME_1 */ | ||
72 | #define VIT_BERTIME_1 (0x39) | ||
73 | |||
74 | /* 0x3A VIT_BERTIME_0 */ | ||
75 | #define VIT_BERTIME_0 (0x3a) | ||
76 | |||
68 | /* 0x38 OFDM_BERTimer *//* Use the alias registers */ | 77 | /* 0x38 OFDM_BERTimer *//* Use the alias registers */ |
69 | #define A_VIT_BER_TIMER_0 (0x1D) | 78 | #define A_VIT_BER_TIMER_0 (0x1D) |
70 | 79 | ||
71 | /* 0x3A VIT_BER_TIMER_0 *//* Use the alias registers */ | 80 | /* 0x3A VIT_BER_TIMER_0 *//* Use the alias registers */ |
72 | #define A_VIT_BER_0 (0x1B) | 81 | #define A_VIT_BER_0 (0x1B) |
73 | 82 | ||
83 | /* 0x3B VIT_BER_1 */ | ||
84 | #define VIT_BER_1 (0x3b) | ||
85 | |||
86 | /* 0x3C VIT_BER_0 */ | ||
87 | #define VIT_BER_0 (0x3c) | ||
88 | |||
74 | /* 0x40 OFDM_COR_CTL */ | 89 | /* 0x40 OFDM_COR_CTL */ |
75 | #define OFDM_COR_CTL (0x40) | 90 | #define OFDM_COR_CTL (0x40) |
76 | #define COREACT (0x20) | 91 | #define COREACT (0x20) |
@@ -117,6 +132,12 @@ | |||
117 | #define OFDM_ITB_CTL (0x4B) | 132 | #define OFDM_ITB_CTL (0x4B) |
118 | #define ITBINV (0x01) | 133 | #define ITBINV (0x01) |
119 | 134 | ||
135 | /* 0x49 AGC_GAIN_1 */ | ||
136 | #define AGC_GAIN_1 (0x49) | ||
137 | |||
138 | /* 0x4A AGC_GAIN_2 */ | ||
139 | #define AGC_GAIN_2 (0x4A) | ||
140 | |||
120 | /* 0x4C OFDM_ITB_FREQ_1 */ | 141 | /* 0x4C OFDM_ITB_FREQ_1 */ |
121 | #define OFDM_ITB_FREQ_1 (0x4C) | 142 | #define OFDM_ITB_FREQ_1 (0x4C) |
122 | 143 | ||
diff --git a/drivers/media/dvb/frontends/or51132.c b/drivers/media/dvb/frontends/or51132.c index df5dee7760a3..cc0a77c790f1 100644 --- a/drivers/media/dvb/frontends/or51132.c +++ b/drivers/media/dvb/frontends/or51132.c | |||
@@ -102,7 +102,7 @@ static u8 i2c_readbytes (struct or51132_state* state, u8 reg, u8* buf, int len) | |||
102 | 102 | ||
103 | static int or51132_load_firmware (struct dvb_frontend* fe, const struct firmware *fw) | 103 | static int or51132_load_firmware (struct dvb_frontend* fe, const struct firmware *fw) |
104 | { | 104 | { |
105 | struct or51132_state* state = (struct or51132_state*) fe->demodulator_priv; | 105 | struct or51132_state* state = fe->demodulator_priv; |
106 | static u8 run_buf[] = {0x7F,0x01}; | 106 | static u8 run_buf[] = {0x7F,0x01}; |
107 | static u8 get_ver_buf[] = {0x04,0x00,0x30,0x00,0x00}; | 107 | static u8 get_ver_buf[] = {0x04,0x00,0x30,0x00,0x00}; |
108 | u8 rec_buf[14]; | 108 | u8 rec_buf[14]; |
@@ -240,7 +240,7 @@ static int or51132_sleep(struct dvb_frontend* fe) | |||
240 | 240 | ||
241 | static int or51132_setmode(struct dvb_frontend* fe) | 241 | static int or51132_setmode(struct dvb_frontend* fe) |
242 | { | 242 | { |
243 | struct or51132_state* state = (struct or51132_state*) fe->demodulator_priv; | 243 | struct or51132_state* state = fe->demodulator_priv; |
244 | unsigned char cmd_buf[4]; | 244 | unsigned char cmd_buf[4]; |
245 | 245 | ||
246 | dprintk("setmode %d\n",(int)state->current_modulation); | 246 | dprintk("setmode %d\n",(int)state->current_modulation); |
@@ -316,7 +316,7 @@ static int or51132_set_parameters(struct dvb_frontend* fe, | |||
316 | { | 316 | { |
317 | int ret; | 317 | int ret; |
318 | u8 buf[4]; | 318 | u8 buf[4]; |
319 | struct or51132_state* state = (struct or51132_state*) fe->demodulator_priv; | 319 | struct or51132_state* state = fe->demodulator_priv; |
320 | const struct firmware *fw; | 320 | const struct firmware *fw; |
321 | 321 | ||
322 | /* Change only if we are actually changing the modulation */ | 322 | /* Change only if we are actually changing the modulation */ |
@@ -391,7 +391,7 @@ static int or51132_set_parameters(struct dvb_frontend* fe, | |||
391 | 391 | ||
392 | static int or51132_read_status(struct dvb_frontend* fe, fe_status_t* status) | 392 | static int or51132_read_status(struct dvb_frontend* fe, fe_status_t* status) |
393 | { | 393 | { |
394 | struct or51132_state* state = (struct or51132_state*) fe->demodulator_priv; | 394 | struct or51132_state* state = fe->demodulator_priv; |
395 | unsigned char rec_buf[2]; | 395 | unsigned char rec_buf[2]; |
396 | unsigned char snd_buf[2]; | 396 | unsigned char snd_buf[2]; |
397 | *status = 0; | 397 | *status = 0; |
@@ -464,7 +464,7 @@ static unsigned int i20Log10(unsigned short val) | |||
464 | 464 | ||
465 | static int or51132_read_signal_strength(struct dvb_frontend* fe, u16* strength) | 465 | static int or51132_read_signal_strength(struct dvb_frontend* fe, u16* strength) |
466 | { | 466 | { |
467 | struct or51132_state* state = (struct or51132_state*) fe->demodulator_priv; | 467 | struct or51132_state* state = fe->demodulator_priv; |
468 | unsigned char rec_buf[2]; | 468 | unsigned char rec_buf[2]; |
469 | unsigned char snd_buf[2]; | 469 | unsigned char snd_buf[2]; |
470 | u8 rcvr_stat; | 470 | u8 rcvr_stat; |
@@ -512,7 +512,7 @@ static int or51132_read_signal_strength(struct dvb_frontend* fe, u16* strength) | |||
512 | 512 | ||
513 | static int or51132_read_snr(struct dvb_frontend* fe, u16* snr) | 513 | static int or51132_read_snr(struct dvb_frontend* fe, u16* snr) |
514 | { | 514 | { |
515 | struct or51132_state* state = (struct or51132_state*) fe->demodulator_priv; | 515 | struct or51132_state* state = fe->demodulator_priv; |
516 | unsigned char rec_buf[2]; | 516 | unsigned char rec_buf[2]; |
517 | unsigned char snd_buf[2]; | 517 | unsigned char snd_buf[2]; |
518 | u16 snr_equ; | 518 | u16 snr_equ; |
@@ -549,7 +549,7 @@ static int or51132_get_tune_settings(struct dvb_frontend* fe, struct dvb_fronten | |||
549 | 549 | ||
550 | static void or51132_release(struct dvb_frontend* fe) | 550 | static void or51132_release(struct dvb_frontend* fe) |
551 | { | 551 | { |
552 | struct or51132_state* state = (struct or51132_state*) fe->demodulator_priv; | 552 | struct or51132_state* state = fe->demodulator_priv; |
553 | kfree(state); | 553 | kfree(state); |
554 | } | 554 | } |
555 | 555 | ||
diff --git a/drivers/media/dvb/frontends/sp8870.c b/drivers/media/dvb/frontends/sp8870.c index 58ad34ef0a00..764a95a2e212 100644 --- a/drivers/media/dvb/frontends/sp8870.c +++ b/drivers/media/dvb/frontends/sp8870.c | |||
@@ -248,7 +248,7 @@ static int sp8870_wake_up(struct sp8870_state* state) | |||
248 | static int sp8870_set_frontend_parameters (struct dvb_frontend* fe, | 248 | static int sp8870_set_frontend_parameters (struct dvb_frontend* fe, |
249 | struct dvb_frontend_parameters *p) | 249 | struct dvb_frontend_parameters *p) |
250 | { | 250 | { |
251 | struct sp8870_state* state = (struct sp8870_state*) fe->demodulator_priv; | 251 | struct sp8870_state* state = fe->demodulator_priv; |
252 | int err; | 252 | int err; |
253 | u16 reg0xc05; | 253 | u16 reg0xc05; |
254 | 254 | ||
@@ -302,7 +302,7 @@ static int sp8870_set_frontend_parameters (struct dvb_frontend* fe, | |||
302 | 302 | ||
303 | static int sp8870_init (struct dvb_frontend* fe) | 303 | static int sp8870_init (struct dvb_frontend* fe) |
304 | { | 304 | { |
305 | struct sp8870_state* state = (struct sp8870_state*) fe->demodulator_priv; | 305 | struct sp8870_state* state = fe->demodulator_priv; |
306 | const struct firmware *fw = NULL; | 306 | const struct firmware *fw = NULL; |
307 | 307 | ||
308 | sp8870_wake_up(state); | 308 | sp8870_wake_up(state); |
@@ -358,7 +358,7 @@ static int sp8870_init (struct dvb_frontend* fe) | |||
358 | 358 | ||
359 | static int sp8870_read_status (struct dvb_frontend* fe, fe_status_t * fe_status) | 359 | static int sp8870_read_status (struct dvb_frontend* fe, fe_status_t * fe_status) |
360 | { | 360 | { |
361 | struct sp8870_state* state = (struct sp8870_state*) fe->demodulator_priv; | 361 | struct sp8870_state* state = fe->demodulator_priv; |
362 | int status; | 362 | int status; |
363 | int signal; | 363 | int signal; |
364 | 364 | ||
@@ -384,7 +384,7 @@ static int sp8870_read_status (struct dvb_frontend* fe, fe_status_t * fe_status) | |||
384 | 384 | ||
385 | static int sp8870_read_ber (struct dvb_frontend* fe, u32 * ber) | 385 | static int sp8870_read_ber (struct dvb_frontend* fe, u32 * ber) |
386 | { | 386 | { |
387 | struct sp8870_state* state = (struct sp8870_state*) fe->demodulator_priv; | 387 | struct sp8870_state* state = fe->demodulator_priv; |
388 | int ret; | 388 | int ret; |
389 | u32 tmp; | 389 | u32 tmp; |
390 | 390 | ||
@@ -412,7 +412,7 @@ static int sp8870_read_ber (struct dvb_frontend* fe, u32 * ber) | |||
412 | 412 | ||
413 | static int sp8870_read_signal_strength(struct dvb_frontend* fe, u16 * signal) | 413 | static int sp8870_read_signal_strength(struct dvb_frontend* fe, u16 * signal) |
414 | { | 414 | { |
415 | struct sp8870_state* state = (struct sp8870_state*) fe->demodulator_priv; | 415 | struct sp8870_state* state = fe->demodulator_priv; |
416 | int ret; | 416 | int ret; |
417 | u16 tmp; | 417 | u16 tmp; |
418 | 418 | ||
@@ -438,7 +438,7 @@ static int sp8870_read_signal_strength(struct dvb_frontend* fe, u16 * signal) | |||
438 | 438 | ||
439 | static int sp8870_read_uncorrected_blocks (struct dvb_frontend* fe, u32* ublocks) | 439 | static int sp8870_read_uncorrected_blocks (struct dvb_frontend* fe, u32* ublocks) |
440 | { | 440 | { |
441 | struct sp8870_state* state = (struct sp8870_state*) fe->demodulator_priv; | 441 | struct sp8870_state* state = fe->demodulator_priv; |
442 | int ret; | 442 | int ret; |
443 | 443 | ||
444 | *ublocks = 0; | 444 | *ublocks = 0; |
@@ -467,7 +467,7 @@ static int switches = 0; | |||
467 | 467 | ||
468 | static int sp8870_set_frontend (struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 468 | static int sp8870_set_frontend (struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
469 | { | 469 | { |
470 | struct sp8870_state* state = (struct sp8870_state*) fe->demodulator_priv; | 470 | struct sp8870_state* state = fe->demodulator_priv; |
471 | 471 | ||
472 | /* | 472 | /* |
473 | The firmware of the sp8870 sometimes locks up after setting frontend parameters. | 473 | The firmware of the sp8870 sometimes locks up after setting frontend parameters. |
@@ -524,7 +524,7 @@ static int sp8870_set_frontend (struct dvb_frontend* fe, struct dvb_frontend_par | |||
524 | 524 | ||
525 | static int sp8870_sleep(struct dvb_frontend* fe) | 525 | static int sp8870_sleep(struct dvb_frontend* fe) |
526 | { | 526 | { |
527 | struct sp8870_state* state = (struct sp8870_state*) fe->demodulator_priv; | 527 | struct sp8870_state* state = fe->demodulator_priv; |
528 | 528 | ||
529 | // tristate TS output and disable interface pins | 529 | // tristate TS output and disable interface pins |
530 | return sp8870_writereg(state, 0xC18, 0x000); | 530 | return sp8870_writereg(state, 0xC18, 0x000); |
@@ -540,7 +540,7 @@ static int sp8870_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend | |||
540 | 540 | ||
541 | static void sp8870_release(struct dvb_frontend* fe) | 541 | static void sp8870_release(struct dvb_frontend* fe) |
542 | { | 542 | { |
543 | struct sp8870_state* state = (struct sp8870_state*) fe->demodulator_priv; | 543 | struct sp8870_state* state = fe->demodulator_priv; |
544 | kfree(state); | 544 | kfree(state); |
545 | } | 545 | } |
546 | 546 | ||
@@ -552,7 +552,7 @@ struct dvb_frontend* sp8870_attach(const struct sp8870_config* config, | |||
552 | struct sp8870_state* state = NULL; | 552 | struct sp8870_state* state = NULL; |
553 | 553 | ||
554 | /* allocate memory for the internal state */ | 554 | /* allocate memory for the internal state */ |
555 | state = (struct sp8870_state*) kmalloc(sizeof(struct sp8870_state), GFP_KERNEL); | 555 | state = kmalloc(sizeof(struct sp8870_state), GFP_KERNEL); |
556 | if (state == NULL) goto error; | 556 | if (state == NULL) goto error; |
557 | 557 | ||
558 | /* setup the state */ | 558 | /* setup the state */ |
diff --git a/drivers/media/dvb/frontends/sp887x.c b/drivers/media/dvb/frontends/sp887x.c index 7eae833ece49..d868a6927a16 100644 --- a/drivers/media/dvb/frontends/sp887x.c +++ b/drivers/media/dvb/frontends/sp887x.c | |||
@@ -135,7 +135,7 @@ static void sp887x_setup_agc (struct sp887x_state* state) | |||
135 | */ | 135 | */ |
136 | static int sp887x_initial_setup (struct dvb_frontend* fe, const struct firmware *fw) | 136 | static int sp887x_initial_setup (struct dvb_frontend* fe, const struct firmware *fw) |
137 | { | 137 | { |
138 | struct sp887x_state* state = (struct sp887x_state*) fe->demodulator_priv; | 138 | struct sp887x_state* state = fe->demodulator_priv; |
139 | u8 buf [BLOCKSIZE+2]; | 139 | u8 buf [BLOCKSIZE+2]; |
140 | int i; | 140 | int i; |
141 | int fw_size = fw->size; | 141 | int fw_size = fw->size; |
@@ -344,7 +344,7 @@ static void sp887x_correct_offsets (struct sp887x_state* state, | |||
344 | static int sp887x_setup_frontend_parameters (struct dvb_frontend* fe, | 344 | static int sp887x_setup_frontend_parameters (struct dvb_frontend* fe, |
345 | struct dvb_frontend_parameters *p) | 345 | struct dvb_frontend_parameters *p) |
346 | { | 346 | { |
347 | struct sp887x_state* state = (struct sp887x_state*) fe->demodulator_priv; | 347 | struct sp887x_state* state = fe->demodulator_priv; |
348 | int actual_freq, err; | 348 | int actual_freq, err; |
349 | u16 val, reg0xc05; | 349 | u16 val, reg0xc05; |
350 | 350 | ||
@@ -405,7 +405,7 @@ static int sp887x_setup_frontend_parameters (struct dvb_frontend* fe, | |||
405 | 405 | ||
406 | static int sp887x_read_status(struct dvb_frontend* fe, fe_status_t* status) | 406 | static int sp887x_read_status(struct dvb_frontend* fe, fe_status_t* status) |
407 | { | 407 | { |
408 | struct sp887x_state* state = (struct sp887x_state*) fe->demodulator_priv; | 408 | struct sp887x_state* state = fe->demodulator_priv; |
409 | u16 snr12 = sp887x_readreg(state, 0xf16); | 409 | u16 snr12 = sp887x_readreg(state, 0xf16); |
410 | u16 sync0x200 = sp887x_readreg(state, 0x200); | 410 | u16 sync0x200 = sp887x_readreg(state, 0x200); |
411 | u16 sync0xf17 = sp887x_readreg(state, 0xf17); | 411 | u16 sync0xf17 = sp887x_readreg(state, 0xf17); |
@@ -439,7 +439,7 @@ static int sp887x_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
439 | 439 | ||
440 | static int sp887x_read_ber(struct dvb_frontend* fe, u32* ber) | 440 | static int sp887x_read_ber(struct dvb_frontend* fe, u32* ber) |
441 | { | 441 | { |
442 | struct sp887x_state* state = (struct sp887x_state*) fe->demodulator_priv; | 442 | struct sp887x_state* state = fe->demodulator_priv; |
443 | 443 | ||
444 | *ber = (sp887x_readreg(state, 0xc08) & 0x3f) | | 444 | *ber = (sp887x_readreg(state, 0xc08) & 0x3f) | |
445 | (sp887x_readreg(state, 0xc07) << 6); | 445 | (sp887x_readreg(state, 0xc07) << 6); |
@@ -453,7 +453,7 @@ static int sp887x_read_ber(struct dvb_frontend* fe, u32* ber) | |||
453 | 453 | ||
454 | static int sp887x_read_signal_strength(struct dvb_frontend* fe, u16* strength) | 454 | static int sp887x_read_signal_strength(struct dvb_frontend* fe, u16* strength) |
455 | { | 455 | { |
456 | struct sp887x_state* state = (struct sp887x_state*) fe->demodulator_priv; | 456 | struct sp887x_state* state = fe->demodulator_priv; |
457 | 457 | ||
458 | u16 snr12 = sp887x_readreg(state, 0xf16); | 458 | u16 snr12 = sp887x_readreg(state, 0xf16); |
459 | u32 signal = 3 * (snr12 << 4); | 459 | u32 signal = 3 * (snr12 << 4); |
@@ -464,7 +464,7 @@ static int sp887x_read_signal_strength(struct dvb_frontend* fe, u16* strength) | |||
464 | 464 | ||
465 | static int sp887x_read_snr(struct dvb_frontend* fe, u16* snr) | 465 | static int sp887x_read_snr(struct dvb_frontend* fe, u16* snr) |
466 | { | 466 | { |
467 | struct sp887x_state* state = (struct sp887x_state*) fe->demodulator_priv; | 467 | struct sp887x_state* state = fe->demodulator_priv; |
468 | 468 | ||
469 | u16 snr12 = sp887x_readreg(state, 0xf16); | 469 | u16 snr12 = sp887x_readreg(state, 0xf16); |
470 | *snr = (snr12 << 4) | (snr12 >> 8); | 470 | *snr = (snr12 << 4) | (snr12 >> 8); |
@@ -474,7 +474,7 @@ static int sp887x_read_snr(struct dvb_frontend* fe, u16* snr) | |||
474 | 474 | ||
475 | static int sp887x_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | 475 | static int sp887x_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) |
476 | { | 476 | { |
477 | struct sp887x_state* state = (struct sp887x_state*) fe->demodulator_priv; | 477 | struct sp887x_state* state = fe->demodulator_priv; |
478 | 478 | ||
479 | *ucblocks = sp887x_readreg(state, 0xc0c); | 479 | *ucblocks = sp887x_readreg(state, 0xc0c); |
480 | if (*ucblocks == 0xfff) | 480 | if (*ucblocks == 0xfff) |
@@ -485,7 +485,7 @@ static int sp887x_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | |||
485 | 485 | ||
486 | static int sp887x_sleep(struct dvb_frontend* fe) | 486 | static int sp887x_sleep(struct dvb_frontend* fe) |
487 | { | 487 | { |
488 | struct sp887x_state* state = (struct sp887x_state*) fe->demodulator_priv; | 488 | struct sp887x_state* state = fe->demodulator_priv; |
489 | 489 | ||
490 | /* tristate TS output and disable interface pins */ | 490 | /* tristate TS output and disable interface pins */ |
491 | sp887x_writereg(state, 0xc18, 0x000); | 491 | sp887x_writereg(state, 0xc18, 0x000); |
@@ -495,7 +495,7 @@ static int sp887x_sleep(struct dvb_frontend* fe) | |||
495 | 495 | ||
496 | static int sp887x_init(struct dvb_frontend* fe) | 496 | static int sp887x_init(struct dvb_frontend* fe) |
497 | { | 497 | { |
498 | struct sp887x_state* state = (struct sp887x_state*) fe->demodulator_priv; | 498 | struct sp887x_state* state = fe->demodulator_priv; |
499 | const struct firmware *fw = NULL; | 499 | const struct firmware *fw = NULL; |
500 | int ret; | 500 | int ret; |
501 | 501 | ||
@@ -534,7 +534,7 @@ static int sp887x_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend | |||
534 | 534 | ||
535 | static void sp887x_release(struct dvb_frontend* fe) | 535 | static void sp887x_release(struct dvb_frontend* fe) |
536 | { | 536 | { |
537 | struct sp887x_state* state = (struct sp887x_state*) fe->demodulator_priv; | 537 | struct sp887x_state* state = fe->demodulator_priv; |
538 | kfree(state); | 538 | kfree(state); |
539 | } | 539 | } |
540 | 540 | ||
@@ -546,7 +546,7 @@ struct dvb_frontend* sp887x_attach(const struct sp887x_config* config, | |||
546 | struct sp887x_state* state = NULL; | 546 | struct sp887x_state* state = NULL; |
547 | 547 | ||
548 | /* allocate memory for the internal state */ | 548 | /* allocate memory for the internal state */ |
549 | state = (struct sp887x_state*) kmalloc(sizeof(struct sp887x_state), GFP_KERNEL); | 549 | state = kmalloc(sizeof(struct sp887x_state), GFP_KERNEL); |
550 | if (state == NULL) goto error; | 550 | if (state == NULL) goto error; |
551 | 551 | ||
552 | /* setup the state */ | 552 | /* setup the state */ |
diff --git a/drivers/media/dvb/frontends/stv0297.c b/drivers/media/dvb/frontends/stv0297.c index 502c6403dfc6..e681263bf079 100644 --- a/drivers/media/dvb/frontends/stv0297.c +++ b/drivers/media/dvb/frontends/stv0297.c | |||
@@ -365,7 +365,7 @@ static int stv0297_set_inversion(struct stv0297_state *state, fe_spectral_invers | |||
365 | 365 | ||
366 | int stv0297_enable_plli2c(struct dvb_frontend *fe) | 366 | int stv0297_enable_plli2c(struct dvb_frontend *fe) |
367 | { | 367 | { |
368 | struct stv0297_state *state = (struct stv0297_state *) fe->demodulator_priv; | 368 | struct stv0297_state *state = fe->demodulator_priv; |
369 | 369 | ||
370 | stv0297_writereg(state, 0x87, 0x78); | 370 | stv0297_writereg(state, 0x87, 0x78); |
371 | stv0297_writereg(state, 0x86, 0xc8); | 371 | stv0297_writereg(state, 0x86, 0xc8); |
@@ -375,7 +375,7 @@ int stv0297_enable_plli2c(struct dvb_frontend *fe) | |||
375 | 375 | ||
376 | static int stv0297_init(struct dvb_frontend *fe) | 376 | static int stv0297_init(struct dvb_frontend *fe) |
377 | { | 377 | { |
378 | struct stv0297_state *state = (struct stv0297_state *) fe->demodulator_priv; | 378 | struct stv0297_state *state = fe->demodulator_priv; |
379 | int i; | 379 | int i; |
380 | 380 | ||
381 | /* soft reset */ | 381 | /* soft reset */ |
@@ -416,7 +416,7 @@ static int stv0297_init(struct dvb_frontend *fe) | |||
416 | 416 | ||
417 | static int stv0297_sleep(struct dvb_frontend *fe) | 417 | static int stv0297_sleep(struct dvb_frontend *fe) |
418 | { | 418 | { |
419 | struct stv0297_state *state = (struct stv0297_state *) fe->demodulator_priv; | 419 | struct stv0297_state *state = fe->demodulator_priv; |
420 | 420 | ||
421 | stv0297_writereg_mask(state, 0x80, 1, 1); | 421 | stv0297_writereg_mask(state, 0x80, 1, 1); |
422 | 422 | ||
@@ -425,7 +425,7 @@ static int stv0297_sleep(struct dvb_frontend *fe) | |||
425 | 425 | ||
426 | static int stv0297_read_status(struct dvb_frontend *fe, fe_status_t * status) | 426 | static int stv0297_read_status(struct dvb_frontend *fe, fe_status_t * status) |
427 | { | 427 | { |
428 | struct stv0297_state *state = (struct stv0297_state *) fe->demodulator_priv; | 428 | struct stv0297_state *state = fe->demodulator_priv; |
429 | 429 | ||
430 | u8 sync = stv0297_readreg(state, 0xDF); | 430 | u8 sync = stv0297_readreg(state, 0xDF); |
431 | 431 | ||
@@ -438,7 +438,7 @@ static int stv0297_read_status(struct dvb_frontend *fe, fe_status_t * status) | |||
438 | 438 | ||
439 | static int stv0297_read_ber(struct dvb_frontend *fe, u32 * ber) | 439 | static int stv0297_read_ber(struct dvb_frontend *fe, u32 * ber) |
440 | { | 440 | { |
441 | struct stv0297_state *state = (struct stv0297_state *) fe->demodulator_priv; | 441 | struct stv0297_state *state = fe->demodulator_priv; |
442 | u8 BER[3]; | 442 | u8 BER[3]; |
443 | 443 | ||
444 | stv0297_writereg(state, 0xA0, 0x80); // Start Counting bit errors for 4096 Bytes | 444 | stv0297_writereg(state, 0xA0, 0x80); // Start Counting bit errors for 4096 Bytes |
@@ -453,7 +453,7 @@ static int stv0297_read_ber(struct dvb_frontend *fe, u32 * ber) | |||
453 | 453 | ||
454 | static int stv0297_read_signal_strength(struct dvb_frontend *fe, u16 * strength) | 454 | static int stv0297_read_signal_strength(struct dvb_frontend *fe, u16 * strength) |
455 | { | 455 | { |
456 | struct stv0297_state *state = (struct stv0297_state *) fe->demodulator_priv; | 456 | struct stv0297_state *state = fe->demodulator_priv; |
457 | u8 STRENGTH[2]; | 457 | u8 STRENGTH[2]; |
458 | 458 | ||
459 | stv0297_readregs(state, 0x41, STRENGTH, 2); | 459 | stv0297_readregs(state, 0x41, STRENGTH, 2); |
@@ -464,7 +464,7 @@ static int stv0297_read_signal_strength(struct dvb_frontend *fe, u16 * strength) | |||
464 | 464 | ||
465 | static int stv0297_read_snr(struct dvb_frontend *fe, u16 * snr) | 465 | static int stv0297_read_snr(struct dvb_frontend *fe, u16 * snr) |
466 | { | 466 | { |
467 | struct stv0297_state *state = (struct stv0297_state *) fe->demodulator_priv; | 467 | struct stv0297_state *state = fe->demodulator_priv; |
468 | u8 SNR[2]; | 468 | u8 SNR[2]; |
469 | 469 | ||
470 | stv0297_readregs(state, 0x07, SNR, 2); | 470 | stv0297_readregs(state, 0x07, SNR, 2); |
@@ -475,7 +475,7 @@ static int stv0297_read_snr(struct dvb_frontend *fe, u16 * snr) | |||
475 | 475 | ||
476 | static int stv0297_read_ucblocks(struct dvb_frontend *fe, u32 * ucblocks) | 476 | static int stv0297_read_ucblocks(struct dvb_frontend *fe, u32 * ucblocks) |
477 | { | 477 | { |
478 | struct stv0297_state *state = (struct stv0297_state *) fe->demodulator_priv; | 478 | struct stv0297_state *state = fe->demodulator_priv; |
479 | 479 | ||
480 | *ucblocks = (stv0297_readreg(state, 0xD5) << 8) | 480 | *ucblocks = (stv0297_readreg(state, 0xD5) << 8) |
481 | | stv0297_readreg(state, 0xD4); | 481 | | stv0297_readreg(state, 0xD4); |
@@ -485,7 +485,7 @@ static int stv0297_read_ucblocks(struct dvb_frontend *fe, u32 * ucblocks) | |||
485 | 485 | ||
486 | static int stv0297_set_frontend(struct dvb_frontend *fe, struct dvb_frontend_parameters *p) | 486 | static int stv0297_set_frontend(struct dvb_frontend *fe, struct dvb_frontend_parameters *p) |
487 | { | 487 | { |
488 | struct stv0297_state *state = (struct stv0297_state *) fe->demodulator_priv; | 488 | struct stv0297_state *state = fe->demodulator_priv; |
489 | int u_threshold; | 489 | int u_threshold; |
490 | int initial_u; | 490 | int initial_u; |
491 | int blind_u; | 491 | int blind_u; |
@@ -689,7 +689,7 @@ timeout: | |||
689 | 689 | ||
690 | static int stv0297_get_frontend(struct dvb_frontend *fe, struct dvb_frontend_parameters *p) | 690 | static int stv0297_get_frontend(struct dvb_frontend *fe, struct dvb_frontend_parameters *p) |
691 | { | 691 | { |
692 | struct stv0297_state *state = (struct stv0297_state *) fe->demodulator_priv; | 692 | struct stv0297_state *state = fe->demodulator_priv; |
693 | int reg_00, reg_83; | 693 | int reg_00, reg_83; |
694 | 694 | ||
695 | reg_00 = stv0297_readreg(state, 0x00); | 695 | reg_00 = stv0297_readreg(state, 0x00); |
@@ -725,7 +725,7 @@ static int stv0297_get_frontend(struct dvb_frontend *fe, struct dvb_frontend_par | |||
725 | 725 | ||
726 | static void stv0297_release(struct dvb_frontend *fe) | 726 | static void stv0297_release(struct dvb_frontend *fe) |
727 | { | 727 | { |
728 | struct stv0297_state *state = (struct stv0297_state *) fe->demodulator_priv; | 728 | struct stv0297_state *state = fe->demodulator_priv; |
729 | kfree(state); | 729 | kfree(state); |
730 | } | 730 | } |
731 | 731 | ||
@@ -737,7 +737,7 @@ struct dvb_frontend *stv0297_attach(const struct stv0297_config *config, | |||
737 | struct stv0297_state *state = NULL; | 737 | struct stv0297_state *state = NULL; |
738 | 738 | ||
739 | /* allocate memory for the internal state */ | 739 | /* allocate memory for the internal state */ |
740 | state = (struct stv0297_state *) kmalloc(sizeof(struct stv0297_state), GFP_KERNEL); | 740 | state = kmalloc(sizeof(struct stv0297_state), GFP_KERNEL); |
741 | if (state == NULL) | 741 | if (state == NULL) |
742 | goto error; | 742 | goto error; |
743 | 743 | ||
diff --git a/drivers/media/dvb/frontends/stv0299.c b/drivers/media/dvb/frontends/stv0299.c index 15b40541b62d..cfa3928bb487 100644 --- a/drivers/media/dvb/frontends/stv0299.c +++ b/drivers/media/dvb/frontends/stv0299.c | |||
@@ -70,6 +70,7 @@ struct stv0299_state { | |||
70 | #define STATUS_UCBLOCKS 1 | 70 | #define STATUS_UCBLOCKS 1 |
71 | 71 | ||
72 | static int debug; | 72 | static int debug; |
73 | static int debug_legacy_dish_switch; | ||
73 | #define dprintk(args...) \ | 74 | #define dprintk(args...) \ |
74 | do { \ | 75 | do { \ |
75 | if (debug) printk(KERN_DEBUG "stv0299: " args); \ | 76 | if (debug) printk(KERN_DEBUG "stv0299: " args); \ |
@@ -93,7 +94,7 @@ static int stv0299_writeregI (struct stv0299_state* state, u8 reg, u8 data) | |||
93 | 94 | ||
94 | int stv0299_writereg (struct dvb_frontend* fe, u8 reg, u8 data) | 95 | int stv0299_writereg (struct dvb_frontend* fe, u8 reg, u8 data) |
95 | { | 96 | { |
96 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 97 | struct stv0299_state* state = fe->demodulator_priv; |
97 | 98 | ||
98 | return stv0299_writeregI(state, reg, data); | 99 | return stv0299_writeregI(state, reg, data); |
99 | } | 100 | } |
@@ -218,7 +219,7 @@ static int stv0299_wait_diseqc_idle (struct stv0299_state* state, int timeout) | |||
218 | 219 | ||
219 | static int stv0299_set_symbolrate (struct dvb_frontend* fe, u32 srate) | 220 | static int stv0299_set_symbolrate (struct dvb_frontend* fe, u32 srate) |
220 | { | 221 | { |
221 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 222 | struct stv0299_state* state = fe->demodulator_priv; |
222 | u64 big = srate; | 223 | u64 big = srate; |
223 | u32 ratio; | 224 | u32 ratio; |
224 | 225 | ||
@@ -269,7 +270,7 @@ static int stv0299_get_symbolrate (struct stv0299_state* state) | |||
269 | static int stv0299_send_diseqc_msg (struct dvb_frontend* fe, | 270 | static int stv0299_send_diseqc_msg (struct dvb_frontend* fe, |
270 | struct dvb_diseqc_master_cmd *m) | 271 | struct dvb_diseqc_master_cmd *m) |
271 | { | 272 | { |
272 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 273 | struct stv0299_state* state = fe->demodulator_priv; |
273 | u8 val; | 274 | u8 val; |
274 | int i; | 275 | int i; |
275 | 276 | ||
@@ -299,7 +300,7 @@ static int stv0299_send_diseqc_msg (struct dvb_frontend* fe, | |||
299 | 300 | ||
300 | static int stv0299_send_diseqc_burst (struct dvb_frontend* fe, fe_sec_mini_cmd_t burst) | 301 | static int stv0299_send_diseqc_burst (struct dvb_frontend* fe, fe_sec_mini_cmd_t burst) |
301 | { | 302 | { |
302 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 303 | struct stv0299_state* state = fe->demodulator_priv; |
303 | u8 val; | 304 | u8 val; |
304 | 305 | ||
305 | dprintk ("%s\n", __FUNCTION__); | 306 | dprintk ("%s\n", __FUNCTION__); |
@@ -326,7 +327,7 @@ static int stv0299_send_diseqc_burst (struct dvb_frontend* fe, fe_sec_mini_cmd_t | |||
326 | 327 | ||
327 | static int stv0299_set_tone (struct dvb_frontend* fe, fe_sec_tone_mode_t tone) | 328 | static int stv0299_set_tone (struct dvb_frontend* fe, fe_sec_tone_mode_t tone) |
328 | { | 329 | { |
329 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 330 | struct stv0299_state* state = fe->demodulator_priv; |
330 | u8 val; | 331 | u8 val; |
331 | 332 | ||
332 | if (stv0299_wait_diseqc_idle (state, 100) < 0) | 333 | if (stv0299_wait_diseqc_idle (state, 100) < 0) |
@@ -348,7 +349,7 @@ static int stv0299_set_tone (struct dvb_frontend* fe, fe_sec_tone_mode_t tone) | |||
348 | 349 | ||
349 | static int stv0299_set_voltage (struct dvb_frontend* fe, fe_sec_voltage_t voltage) | 350 | static int stv0299_set_voltage (struct dvb_frontend* fe, fe_sec_voltage_t voltage) |
350 | { | 351 | { |
351 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 352 | struct stv0299_state* state = fe->demodulator_priv; |
352 | u8 reg0x08; | 353 | u8 reg0x08; |
353 | u8 reg0x0c; | 354 | u8 reg0x0c; |
354 | 355 | ||
@@ -385,34 +386,84 @@ static int stv0299_set_voltage (struct dvb_frontend* fe, fe_sec_voltage_t voltag | |||
385 | }; | 386 | }; |
386 | } | 387 | } |
387 | 388 | ||
388 | static int stv0299_send_legacy_dish_cmd(struct dvb_frontend* fe, u32 cmd) | 389 | static inline s32 stv0299_calc_usec_delay (struct timeval lasttime, struct timeval curtime) |
389 | { | 390 | { |
391 | return ((curtime.tv_usec < lasttime.tv_usec) ? | ||
392 | 1000000 - lasttime.tv_usec + curtime.tv_usec : | ||
393 | curtime.tv_usec - lasttime.tv_usec); | ||
394 | } | ||
395 | |||
396 | static void stv0299_sleep_until (struct timeval *waketime, u32 add_usec) | ||
397 | { | ||
398 | struct timeval lasttime; | ||
399 | s32 delta, newdelta; | ||
400 | |||
401 | waketime->tv_usec += add_usec; | ||
402 | if (waketime->tv_usec >= 1000000) { | ||
403 | waketime->tv_usec -= 1000000; | ||
404 | waketime->tv_sec++; | ||
405 | } | ||
406 | |||
407 | do_gettimeofday (&lasttime); | ||
408 | delta = stv0299_calc_usec_delay (lasttime, *waketime); | ||
409 | if (delta > 2500) { | ||
410 | msleep ((delta - 1500) / 1000); | ||
411 | do_gettimeofday (&lasttime); | ||
412 | newdelta = stv0299_calc_usec_delay (lasttime, *waketime); | ||
413 | delta = (newdelta > delta) ? 0 : newdelta; | ||
414 | } | ||
415 | if (delta > 0) | ||
416 | udelay (delta); | ||
417 | } | ||
418 | |||
419 | static int stv0299_send_legacy_dish_cmd (struct dvb_frontend* fe, u32 cmd) | ||
420 | { | ||
421 | struct stv0299_state* state = fe->demodulator_priv; | ||
422 | u8 reg0x08; | ||
423 | u8 reg0x0c; | ||
424 | u8 lv_mask = 0x40; | ||
390 | u8 last = 1; | 425 | u8 last = 1; |
391 | int i; | 426 | int i; |
427 | struct timeval nexttime; | ||
428 | struct timeval tv[10]; | ||
392 | 429 | ||
393 | /* reset voltage at the end | 430 | reg0x08 = stv0299_readreg (state, 0x08); |
394 | if((0x50 & stv0299_readreg (i2c, 0x0c)) == 0x50) | 431 | reg0x0c = stv0299_readreg (state, 0x0c); |
395 | cmd |= 0x80; | 432 | reg0x0c &= 0x0f; |
396 | else | 433 | stv0299_writeregI (state, 0x08, (reg0x08 & 0x3f) | (state->config->lock_output << 6)); |
397 | cmd &= 0x7F; | 434 | if (state->config->volt13_op0_op1 == STV0299_VOLT13_OP0) |
398 | */ | 435 | lv_mask = 0x10; |
399 | 436 | ||
400 | cmd = cmd << 1; | 437 | cmd = cmd << 1; |
401 | dprintk("%s switch command: 0x%04x\n",__FUNCTION__, cmd); | 438 | if (debug_legacy_dish_switch) |
439 | printk ("%s switch command: 0x%04x\n",__FUNCTION__, cmd); | ||
440 | |||
441 | do_gettimeofday (&nexttime); | ||
442 | if (debug_legacy_dish_switch) | ||
443 | memcpy (&tv[0], &nexttime, sizeof (struct timeval)); | ||
444 | stv0299_writeregI (state, 0x0c, reg0x0c | 0x50); /* set LNB to 18V */ | ||
402 | 445 | ||
403 | stv0299_set_voltage(fe,SEC_VOLTAGE_18); | 446 | stv0299_sleep_until (&nexttime, 32000); |
404 | msleep(32); | ||
405 | 447 | ||
406 | for (i=0; i<9; i++) { | 448 | for (i=0; i<9; i++) { |
449 | if (debug_legacy_dish_switch) | ||
450 | do_gettimeofday (&tv[i+1]); | ||
407 | if((cmd & 0x01) != last) { | 451 | if((cmd & 0x01) != last) { |
408 | stv0299_set_voltage(fe, last ? SEC_VOLTAGE_13 : SEC_VOLTAGE_18); | 452 | /* set voltage to (last ? 13V : 18V) */ |
453 | stv0299_writeregI (state, 0x0c, reg0x0c | (last ? lv_mask : 0x50)); | ||
409 | last = (last) ? 0 : 1; | 454 | last = (last) ? 0 : 1; |
410 | } | 455 | } |
411 | 456 | ||
412 | cmd = cmd >> 1; | 457 | cmd = cmd >> 1; |
413 | 458 | ||
414 | if (i != 8) | 459 | if (i != 8) |
415 | msleep(8); | 460 | stv0299_sleep_until (&nexttime, 8000); |
461 | } | ||
462 | if (debug_legacy_dish_switch) { | ||
463 | printk ("%s(%d): switch delay (should be 32k followed by all 8k\n", | ||
464 | __FUNCTION__, fe->dvb->num); | ||
465 | for (i=1; i < 10; i++) | ||
466 | printk ("%d: %d\n", i, stv0299_calc_usec_delay (tv[i-1] , tv[i])); | ||
416 | } | 467 | } |
417 | 468 | ||
418 | return 0; | 469 | return 0; |
@@ -420,7 +471,7 @@ static int stv0299_send_legacy_dish_cmd(struct dvb_frontend* fe, u32 cmd) | |||
420 | 471 | ||
421 | static int stv0299_init (struct dvb_frontend* fe) | 472 | static int stv0299_init (struct dvb_frontend* fe) |
422 | { | 473 | { |
423 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 474 | struct stv0299_state* state = fe->demodulator_priv; |
424 | int i; | 475 | int i; |
425 | 476 | ||
426 | dprintk("stv0299: init chip\n"); | 477 | dprintk("stv0299: init chip\n"); |
@@ -439,7 +490,7 @@ static int stv0299_init (struct dvb_frontend* fe) | |||
439 | 490 | ||
440 | static int stv0299_read_status(struct dvb_frontend* fe, fe_status_t* status) | 491 | static int stv0299_read_status(struct dvb_frontend* fe, fe_status_t* status) |
441 | { | 492 | { |
442 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 493 | struct stv0299_state* state = fe->demodulator_priv; |
443 | 494 | ||
444 | u8 signal = 0xff - stv0299_readreg (state, 0x18); | 495 | u8 signal = 0xff - stv0299_readreg (state, 0x18); |
445 | u8 sync = stv0299_readreg (state, 0x1b); | 496 | u8 sync = stv0299_readreg (state, 0x1b); |
@@ -467,7 +518,7 @@ static int stv0299_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
467 | 518 | ||
468 | static int stv0299_read_ber(struct dvb_frontend* fe, u32* ber) | 519 | static int stv0299_read_ber(struct dvb_frontend* fe, u32* ber) |
469 | { | 520 | { |
470 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 521 | struct stv0299_state* state = fe->demodulator_priv; |
471 | 522 | ||
472 | if (state->errmode != STATUS_BER) return 0; | 523 | if (state->errmode != STATUS_BER) return 0; |
473 | *ber = (stv0299_readreg (state, 0x1d) << 8) | stv0299_readreg (state, 0x1e); | 524 | *ber = (stv0299_readreg (state, 0x1d) << 8) | stv0299_readreg (state, 0x1e); |
@@ -477,7 +528,7 @@ static int stv0299_read_ber(struct dvb_frontend* fe, u32* ber) | |||
477 | 528 | ||
478 | static int stv0299_read_signal_strength(struct dvb_frontend* fe, u16* strength) | 529 | static int stv0299_read_signal_strength(struct dvb_frontend* fe, u16* strength) |
479 | { | 530 | { |
480 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 531 | struct stv0299_state* state = fe->demodulator_priv; |
481 | 532 | ||
482 | s32 signal = 0xffff - ((stv0299_readreg (state, 0x18) << 8) | 533 | s32 signal = 0xffff - ((stv0299_readreg (state, 0x18) << 8) |
483 | | stv0299_readreg (state, 0x19)); | 534 | | stv0299_readreg (state, 0x19)); |
@@ -494,7 +545,7 @@ static int stv0299_read_signal_strength(struct dvb_frontend* fe, u16* strength) | |||
494 | 545 | ||
495 | static int stv0299_read_snr(struct dvb_frontend* fe, u16* snr) | 546 | static int stv0299_read_snr(struct dvb_frontend* fe, u16* snr) |
496 | { | 547 | { |
497 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 548 | struct stv0299_state* state = fe->demodulator_priv; |
498 | 549 | ||
499 | s32 xsnr = 0xffff - ((stv0299_readreg (state, 0x24) << 8) | 550 | s32 xsnr = 0xffff - ((stv0299_readreg (state, 0x24) << 8) |
500 | | stv0299_readreg (state, 0x25)); | 551 | | stv0299_readreg (state, 0x25)); |
@@ -506,7 +557,7 @@ static int stv0299_read_snr(struct dvb_frontend* fe, u16* snr) | |||
506 | 557 | ||
507 | static int stv0299_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | 558 | static int stv0299_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) |
508 | { | 559 | { |
509 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 560 | struct stv0299_state* state = fe->demodulator_priv; |
510 | 561 | ||
511 | if (state->errmode != STATUS_UCBLOCKS) *ucblocks = 0; | 562 | if (state->errmode != STATUS_UCBLOCKS) *ucblocks = 0; |
512 | else *ucblocks = (stv0299_readreg (state, 0x1d) << 8) | stv0299_readreg (state, 0x1e); | 563 | else *ucblocks = (stv0299_readreg (state, 0x1d) << 8) | stv0299_readreg (state, 0x1e); |
@@ -516,7 +567,7 @@ static int stv0299_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | |||
516 | 567 | ||
517 | static int stv0299_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters * p) | 568 | static int stv0299_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters * p) |
518 | { | 569 | { |
519 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 570 | struct stv0299_state* state = fe->demodulator_priv; |
520 | int invval = 0; | 571 | int invval = 0; |
521 | 572 | ||
522 | dprintk ("%s : FE_SET_FRONTEND\n", __FUNCTION__); | 573 | dprintk ("%s : FE_SET_FRONTEND\n", __FUNCTION__); |
@@ -584,7 +635,7 @@ static int stv0299_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
584 | 635 | ||
585 | static int stv0299_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters * p) | 636 | static int stv0299_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters * p) |
586 | { | 637 | { |
587 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 638 | struct stv0299_state* state = fe->demodulator_priv; |
588 | s32 derot_freq; | 639 | s32 derot_freq; |
589 | int invval; | 640 | int invval; |
590 | 641 | ||
@@ -609,7 +660,7 @@ static int stv0299_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
609 | 660 | ||
610 | static int stv0299_sleep(struct dvb_frontend* fe) | 661 | static int stv0299_sleep(struct dvb_frontend* fe) |
611 | { | 662 | { |
612 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 663 | struct stv0299_state* state = fe->demodulator_priv; |
613 | 664 | ||
614 | stv0299_writeregI(state, 0x02, 0x80); | 665 | stv0299_writeregI(state, 0x02, 0x80); |
615 | state->initialised = 0; | 666 | state->initialised = 0; |
@@ -619,7 +670,7 @@ static int stv0299_sleep(struct dvb_frontend* fe) | |||
619 | 670 | ||
620 | static int stv0299_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings* fesettings) | 671 | static int stv0299_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings* fesettings) |
621 | { | 672 | { |
622 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 673 | struct stv0299_state* state = fe->demodulator_priv; |
623 | 674 | ||
624 | fesettings->min_delay_ms = state->config->min_delay_ms; | 675 | fesettings->min_delay_ms = state->config->min_delay_ms; |
625 | if (fesettings->parameters.u.qpsk.symbol_rate < 10000000) { | 676 | if (fesettings->parameters.u.qpsk.symbol_rate < 10000000) { |
@@ -634,7 +685,7 @@ static int stv0299_get_tune_settings(struct dvb_frontend* fe, struct dvb_fronten | |||
634 | 685 | ||
635 | static void stv0299_release(struct dvb_frontend* fe) | 686 | static void stv0299_release(struct dvb_frontend* fe) |
636 | { | 687 | { |
637 | struct stv0299_state* state = (struct stv0299_state*) fe->demodulator_priv; | 688 | struct stv0299_state* state = fe->demodulator_priv; |
638 | kfree(state); | 689 | kfree(state); |
639 | } | 690 | } |
640 | 691 | ||
@@ -647,7 +698,7 @@ struct dvb_frontend* stv0299_attach(const struct stv0299_config* config, | |||
647 | int id; | 698 | int id; |
648 | 699 | ||
649 | /* allocate memory for the internal state */ | 700 | /* allocate memory for the internal state */ |
650 | state = (struct stv0299_state*) kmalloc(sizeof(struct stv0299_state), GFP_KERNEL); | 701 | state = kmalloc(sizeof(struct stv0299_state), GFP_KERNEL); |
651 | if (state == NULL) goto error; | 702 | if (state == NULL) goto error; |
652 | 703 | ||
653 | /* setup the state */ | 704 | /* setup the state */ |
@@ -719,6 +770,9 @@ static struct dvb_frontend_ops stv0299_ops = { | |||
719 | .dishnetwork_send_legacy_command = stv0299_send_legacy_dish_cmd, | 770 | .dishnetwork_send_legacy_command = stv0299_send_legacy_dish_cmd, |
720 | }; | 771 | }; |
721 | 772 | ||
773 | module_param(debug_legacy_dish_switch, int, 0444); | ||
774 | MODULE_PARM_DESC(debug_legacy_dish_switch, "Enable timing analysis for Dish Network legacy switches"); | ||
775 | |||
722 | module_param(debug, int, 0644); | 776 | module_param(debug, int, 0644); |
723 | MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off)."); | 777 | MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off)."); |
724 | 778 | ||
diff --git a/drivers/media/dvb/frontends/tda10021.c b/drivers/media/dvb/frontends/tda10021.c index 4e40d95ee95d..87d5f4d8790f 100644 --- a/drivers/media/dvb/frontends/tda10021.c +++ b/drivers/media/dvb/frontends/tda10021.c | |||
@@ -205,7 +205,7 @@ static int tda10021_set_symbolrate (struct tda10021_state* state, u32 symbolrate | |||
205 | 205 | ||
206 | static int tda10021_init (struct dvb_frontend *fe) | 206 | static int tda10021_init (struct dvb_frontend *fe) |
207 | { | 207 | { |
208 | struct tda10021_state* state = (struct tda10021_state*) fe->demodulator_priv; | 208 | struct tda10021_state* state = fe->demodulator_priv; |
209 | int i; | 209 | int i; |
210 | 210 | ||
211 | dprintk("DVB: TDA10021(%d): init chip\n", fe->adapter->num); | 211 | dprintk("DVB: TDA10021(%d): init chip\n", fe->adapter->num); |
@@ -238,7 +238,7 @@ static int tda10021_init (struct dvb_frontend *fe) | |||
238 | static int tda10021_set_parameters (struct dvb_frontend *fe, | 238 | static int tda10021_set_parameters (struct dvb_frontend *fe, |
239 | struct dvb_frontend_parameters *p) | 239 | struct dvb_frontend_parameters *p) |
240 | { | 240 | { |
241 | struct tda10021_state* state = (struct tda10021_state*) fe->demodulator_priv; | 241 | struct tda10021_state* state = fe->demodulator_priv; |
242 | 242 | ||
243 | //table for QAM4-QAM256 ready QAM4 QAM16 QAM32 QAM64 QAM128 QAM256 | 243 | //table for QAM4-QAM256 ready QAM4 QAM16 QAM32 QAM64 QAM128 QAM256 |
244 | //CONF | 244 | //CONF |
@@ -278,7 +278,7 @@ static int tda10021_set_parameters (struct dvb_frontend *fe, | |||
278 | 278 | ||
279 | static int tda10021_read_status(struct dvb_frontend* fe, fe_status_t* status) | 279 | static int tda10021_read_status(struct dvb_frontend* fe, fe_status_t* status) |
280 | { | 280 | { |
281 | struct tda10021_state* state = (struct tda10021_state*) fe->demodulator_priv; | 281 | struct tda10021_state* state = fe->demodulator_priv; |
282 | int sync; | 282 | int sync; |
283 | 283 | ||
284 | *status = 0; | 284 | *status = 0; |
@@ -303,7 +303,7 @@ static int tda10021_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
303 | 303 | ||
304 | static int tda10021_read_ber(struct dvb_frontend* fe, u32* ber) | 304 | static int tda10021_read_ber(struct dvb_frontend* fe, u32* ber) |
305 | { | 305 | { |
306 | struct tda10021_state* state = (struct tda10021_state*) fe->demodulator_priv; | 306 | struct tda10021_state* state = fe->demodulator_priv; |
307 | 307 | ||
308 | u32 _ber = tda10021_readreg(state, 0x14) | | 308 | u32 _ber = tda10021_readreg(state, 0x14) | |
309 | (tda10021_readreg(state, 0x15) << 8) | | 309 | (tda10021_readreg(state, 0x15) << 8) | |
@@ -315,7 +315,7 @@ static int tda10021_read_ber(struct dvb_frontend* fe, u32* ber) | |||
315 | 315 | ||
316 | static int tda10021_read_signal_strength(struct dvb_frontend* fe, u16* strength) | 316 | static int tda10021_read_signal_strength(struct dvb_frontend* fe, u16* strength) |
317 | { | 317 | { |
318 | struct tda10021_state* state = (struct tda10021_state*) fe->demodulator_priv; | 318 | struct tda10021_state* state = fe->demodulator_priv; |
319 | 319 | ||
320 | u8 gain = tda10021_readreg(state, 0x17); | 320 | u8 gain = tda10021_readreg(state, 0x17); |
321 | *strength = (gain << 8) | gain; | 321 | *strength = (gain << 8) | gain; |
@@ -325,7 +325,7 @@ static int tda10021_read_signal_strength(struct dvb_frontend* fe, u16* strength) | |||
325 | 325 | ||
326 | static int tda10021_read_snr(struct dvb_frontend* fe, u16* snr) | 326 | static int tda10021_read_snr(struct dvb_frontend* fe, u16* snr) |
327 | { | 327 | { |
328 | struct tda10021_state* state = (struct tda10021_state*) fe->demodulator_priv; | 328 | struct tda10021_state* state = fe->demodulator_priv; |
329 | 329 | ||
330 | u8 quality = ~tda10021_readreg(state, 0x18); | 330 | u8 quality = ~tda10021_readreg(state, 0x18); |
331 | *snr = (quality << 8) | quality; | 331 | *snr = (quality << 8) | quality; |
@@ -335,7 +335,7 @@ static int tda10021_read_snr(struct dvb_frontend* fe, u16* snr) | |||
335 | 335 | ||
336 | static int tda10021_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | 336 | static int tda10021_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) |
337 | { | 337 | { |
338 | struct tda10021_state* state = (struct tda10021_state*) fe->demodulator_priv; | 338 | struct tda10021_state* state = fe->demodulator_priv; |
339 | 339 | ||
340 | *ucblocks = tda10021_readreg (state, 0x13) & 0x7f; | 340 | *ucblocks = tda10021_readreg (state, 0x13) & 0x7f; |
341 | if (*ucblocks == 0x7f) | 341 | if (*ucblocks == 0x7f) |
@@ -350,7 +350,7 @@ static int tda10021_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | |||
350 | 350 | ||
351 | static int tda10021_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 351 | static int tda10021_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
352 | { | 352 | { |
353 | struct tda10021_state* state = (struct tda10021_state*) fe->demodulator_priv; | 353 | struct tda10021_state* state = fe->demodulator_priv; |
354 | int sync; | 354 | int sync; |
355 | s8 afc = 0; | 355 | s8 afc = 0; |
356 | 356 | ||
@@ -378,7 +378,7 @@ static int tda10021_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_pa | |||
378 | 378 | ||
379 | static int tda10021_sleep(struct dvb_frontend* fe) | 379 | static int tda10021_sleep(struct dvb_frontend* fe) |
380 | { | 380 | { |
381 | struct tda10021_state* state = (struct tda10021_state*) fe->demodulator_priv; | 381 | struct tda10021_state* state = fe->demodulator_priv; |
382 | 382 | ||
383 | tda10021_writereg (state, 0x1b, 0x02); /* pdown ADC */ | 383 | tda10021_writereg (state, 0x1b, 0x02); /* pdown ADC */ |
384 | tda10021_writereg (state, 0x00, 0x80); /* standby */ | 384 | tda10021_writereg (state, 0x00, 0x80); /* standby */ |
@@ -388,7 +388,7 @@ static int tda10021_sleep(struct dvb_frontend* fe) | |||
388 | 388 | ||
389 | static void tda10021_release(struct dvb_frontend* fe) | 389 | static void tda10021_release(struct dvb_frontend* fe) |
390 | { | 390 | { |
391 | struct tda10021_state* state = (struct tda10021_state*) fe->demodulator_priv; | 391 | struct tda10021_state* state = fe->demodulator_priv; |
392 | kfree(state); | 392 | kfree(state); |
393 | } | 393 | } |
394 | 394 | ||
@@ -401,7 +401,7 @@ struct dvb_frontend* tda10021_attach(const struct tda10021_config* config, | |||
401 | struct tda10021_state* state = NULL; | 401 | struct tda10021_state* state = NULL; |
402 | 402 | ||
403 | /* allocate memory for the internal state */ | 403 | /* allocate memory for the internal state */ |
404 | state = (struct tda10021_state*) kmalloc(sizeof(struct tda10021_state), GFP_KERNEL); | 404 | state = kmalloc(sizeof(struct tda10021_state), GFP_KERNEL); |
405 | if (state == NULL) goto error; | 405 | if (state == NULL) goto error; |
406 | 406 | ||
407 | /* setup the state */ | 407 | /* setup the state */ |
diff --git a/drivers/media/dvb/frontends/tda1004x.c b/drivers/media/dvb/frontends/tda1004x.c index 687ad9cf3384..0beb370792ae 100644 --- a/drivers/media/dvb/frontends/tda1004x.c +++ b/drivers/media/dvb/frontends/tda1004x.c | |||
@@ -35,9 +35,10 @@ | |||
35 | #include "dvb_frontend.h" | 35 | #include "dvb_frontend.h" |
36 | #include "tda1004x.h" | 36 | #include "tda1004x.h" |
37 | 37 | ||
38 | #define TDA1004X_DEMOD_TDA10045 0 | 38 | enum tda1004x_demod { |
39 | #define TDA1004X_DEMOD_TDA10046 1 | 39 | TDA1004X_DEMOD_TDA10045, |
40 | 40 | TDA1004X_DEMOD_TDA10046, | |
41 | }; | ||
41 | 42 | ||
42 | struct tda1004x_state { | 43 | struct tda1004x_state { |
43 | struct i2c_adapter* i2c; | 44 | struct i2c_adapter* i2c; |
@@ -46,8 +47,9 @@ struct tda1004x_state { | |||
46 | struct dvb_frontend frontend; | 47 | struct dvb_frontend frontend; |
47 | 48 | ||
48 | /* private demod data */ | 49 | /* private demod data */ |
49 | u8 initialised:1; | 50 | u8 initialised; |
50 | u8 demod_type; | 51 | enum tda1004x_demod demod_type; |
52 | u8 fw_version; | ||
51 | }; | 53 | }; |
52 | 54 | ||
53 | 55 | ||
@@ -139,7 +141,7 @@ static int tda1004x_write_byteI(struct tda1004x_state *state, int reg, int data) | |||
139 | { | 141 | { |
140 | int ret; | 142 | int ret; |
141 | u8 buf[] = { reg, data }; | 143 | u8 buf[] = { reg, data }; |
142 | struct i2c_msg msg = { .addr=0, .flags=0, .buf=buf, .len=2 }; | 144 | struct i2c_msg msg = { .flags = 0, .buf = buf, .len = 2 }; |
143 | 145 | ||
144 | dprintk("%s: reg=0x%x, data=0x%x\n", __FUNCTION__, reg, data); | 146 | dprintk("%s: reg=0x%x, data=0x%x\n", __FUNCTION__, reg, data); |
145 | 147 | ||
@@ -160,8 +162,8 @@ static int tda1004x_read_byte(struct tda1004x_state *state, int reg) | |||
160 | int ret; | 162 | int ret; |
161 | u8 b0[] = { reg }; | 163 | u8 b0[] = { reg }; |
162 | u8 b1[] = { 0 }; | 164 | u8 b1[] = { 0 }; |
163 | struct i2c_msg msg[] = {{ .addr=0, .flags=0, .buf=b0, .len=1}, | 165 | struct i2c_msg msg[] = {{ .flags = 0, .buf = b0, .len = 1 }, |
164 | { .addr=0, .flags=I2C_M_RD, .buf=b1, .len = 1}}; | 166 | { .flags = I2C_M_RD, .buf = b1, .len = 1 }}; |
165 | 167 | ||
166 | dprintk("%s: reg=0x%x\n", __FUNCTION__, reg); | 168 | dprintk("%s: reg=0x%x\n", __FUNCTION__, reg); |
167 | 169 | ||
@@ -294,7 +296,7 @@ static int tda1004x_do_upload(struct tda1004x_state *state, | |||
294 | u8 dspCodeCounterReg, u8 dspCodeInReg) | 296 | u8 dspCodeCounterReg, u8 dspCodeInReg) |
295 | { | 297 | { |
296 | u8 buf[65]; | 298 | u8 buf[65]; |
297 | struct i2c_msg fw_msg = {.addr = 0,.flags = 0,.buf = buf,.len = 0 }; | 299 | struct i2c_msg fw_msg = { .flags = 0, .buf = buf, .len = 0 }; |
298 | int tx_size; | 300 | int tx_size; |
299 | int pos = 0; | 301 | int pos = 0; |
300 | 302 | ||
@@ -304,12 +306,10 @@ static int tda1004x_do_upload(struct tda1004x_state *state, | |||
304 | 306 | ||
305 | buf[0] = dspCodeInReg; | 307 | buf[0] = dspCodeInReg; |
306 | while (pos != len) { | 308 | while (pos != len) { |
307 | |||
308 | // work out how much to send this time | 309 | // work out how much to send this time |
309 | tx_size = len - pos; | 310 | tx_size = len - pos; |
310 | if (tx_size > 0x10) { | 311 | if (tx_size > 0x10) |
311 | tx_size = 0x10; | 312 | tx_size = 0x10; |
312 | } | ||
313 | 313 | ||
314 | // send the chunk | 314 | // send the chunk |
315 | memcpy(buf + 1, mem + pos, tx_size); | 315 | memcpy(buf + 1, mem + pos, tx_size); |
@@ -322,6 +322,7 @@ static int tda1004x_do_upload(struct tda1004x_state *state, | |||
322 | 322 | ||
323 | dprintk("%s: fw_pos=0x%x\n", __FUNCTION__, pos); | 323 | dprintk("%s: fw_pos=0x%x\n", __FUNCTION__, pos); |
324 | } | 324 | } |
325 | |||
325 | return 0; | 326 | return 0; |
326 | } | 327 | } |
327 | 328 | ||
@@ -335,9 +336,8 @@ static int tda1004x_check_upload_ok(struct tda1004x_state *state, u8 dspVersion) | |||
335 | 336 | ||
336 | data1 = tda1004x_read_byte(state, TDA1004X_DSP_DATA1); | 337 | data1 = tda1004x_read_byte(state, TDA1004X_DSP_DATA1); |
337 | data2 = tda1004x_read_byte(state, TDA1004X_DSP_DATA2); | 338 | data2 = tda1004x_read_byte(state, TDA1004X_DSP_DATA2); |
338 | if (data1 != 0x67 || data2 != dspVersion) { | 339 | if ((data1 != 0x67) || (data2 != dspVersion)) |
339 | return -EIO; | 340 | return -EIO; |
340 | } | ||
341 | 341 | ||
342 | return 0; | 342 | return 0; |
343 | } | 343 | } |
@@ -348,9 +348,9 @@ static int tda10045_fwupload(struct dvb_frontend* fe) | |||
348 | int ret; | 348 | int ret; |
349 | const struct firmware *fw; | 349 | const struct firmware *fw; |
350 | 350 | ||
351 | |||
352 | /* don't re-upload unless necessary */ | 351 | /* don't re-upload unless necessary */ |
353 | if (tda1004x_check_upload_ok(state, 0x2c) == 0) return 0; | 352 | if (tda1004x_check_upload_ok(state, 0x2c) == 0) |
353 | return 0; | ||
354 | 354 | ||
355 | /* request the firmware, this will block until someone uploads it */ | 355 | /* request the firmware, this will block until someone uploads it */ |
356 | printk("tda1004x: waiting for firmware upload (%s)...\n", TDA10045_DEFAULT_FIRMWARE); | 356 | printk("tda1004x: waiting for firmware upload (%s)...\n", TDA10045_DEFAULT_FIRMWARE); |
@@ -381,6 +381,25 @@ static int tda10045_fwupload(struct dvb_frontend* fe) | |||
381 | return tda1004x_check_upload_ok(state, 0x2c); | 381 | return tda1004x_check_upload_ok(state, 0x2c); |
382 | } | 382 | } |
383 | 383 | ||
384 | static int tda10046_get_fw_version(struct tda1004x_state *state, | ||
385 | const struct firmware *fw) | ||
386 | { | ||
387 | const unsigned char pattern[] = { 0x67, 0x00, 0x50, 0x62, 0x5e, 0x18, 0x67 }; | ||
388 | unsigned int i; | ||
389 | |||
390 | /* area guessed from firmware v20, v21 and v25 */ | ||
391 | for (i = 0x660; i < 0x700; i++) { | ||
392 | if (!memcmp(&fw->data[i], pattern, sizeof(pattern))) { | ||
393 | state->fw_version = fw->data[i + sizeof(pattern)]; | ||
394 | printk(KERN_INFO "tda1004x: using firmware v%02x\n", | ||
395 | state->fw_version); | ||
396 | return 0; | ||
397 | } | ||
398 | } | ||
399 | |||
400 | return -EINVAL; | ||
401 | } | ||
402 | |||
384 | static int tda10046_fwupload(struct dvb_frontend* fe) | 403 | static int tda10046_fwupload(struct dvb_frontend* fe) |
385 | { | 404 | { |
386 | struct tda1004x_state* state = fe->demodulator_priv; | 405 | struct tda1004x_state* state = fe->demodulator_priv; |
@@ -394,7 +413,8 @@ static int tda10046_fwupload(struct dvb_frontend* fe) | |||
394 | msleep(100); | 413 | msleep(100); |
395 | 414 | ||
396 | /* don't re-upload unless necessary */ | 415 | /* don't re-upload unless necessary */ |
397 | if (tda1004x_check_upload_ok(state, 0x20) == 0) return 0; | 416 | if (tda1004x_check_upload_ok(state, state->fw_version) == 0) |
417 | return 0; | ||
398 | 418 | ||
399 | /* request the firmware, this will block until someone uploads it */ | 419 | /* request the firmware, this will block until someone uploads it */ |
400 | printk("tda1004x: waiting for firmware upload (%s)...\n", TDA10046_DEFAULT_FIRMWARE); | 420 | printk("tda1004x: waiting for firmware upload (%s)...\n", TDA10046_DEFAULT_FIRMWARE); |
@@ -404,9 +424,20 @@ static int tda10046_fwupload(struct dvb_frontend* fe) | |||
404 | return ret; | 424 | return ret; |
405 | } | 425 | } |
406 | 426 | ||
427 | if (fw->size < 24478) { /* size of firmware v20, which is the smallest of v20, v21 and v25 */ | ||
428 | printk("tda1004x: firmware file seems to be too small (%d bytes)\n", fw->size); | ||
429 | return -EINVAL; | ||
430 | } | ||
431 | |||
432 | ret = tda10046_get_fw_version(state, fw); | ||
433 | if (ret < 0) { | ||
434 | printk("tda1004x: unable to find firmware version\n"); | ||
435 | return ret; | ||
436 | } | ||
437 | |||
407 | /* set parameters */ | 438 | /* set parameters */ |
408 | tda1004x_write_byteI(state, TDA10046H_CONFPLL2, 10); | 439 | tda1004x_write_byteI(state, TDA10046H_CONFPLL2, 10); |
409 | tda1004x_write_byteI(state, TDA10046H_CONFPLL3, 0); | 440 | tda1004x_write_byteI(state, TDA10046H_CONFPLL3, state->config->n_i2c); |
410 | tda1004x_write_byteI(state, TDA10046H_FREQ_OFFSET, 99); | 441 | tda1004x_write_byteI(state, TDA10046H_FREQ_OFFSET, 99); |
411 | tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_MSB, 0xd4); | 442 | tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_MSB, 0xd4); |
412 | tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_LSB, 0x2c); | 443 | tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_LSB, 0x2c); |
@@ -419,7 +450,7 @@ static int tda10046_fwupload(struct dvb_frontend* fe) | |||
419 | 450 | ||
420 | /* wait for DSP to initialise */ | 451 | /* wait for DSP to initialise */ |
421 | timeout = jiffies + HZ; | 452 | timeout = jiffies + HZ; |
422 | while(!(tda1004x_read_byte(state, TDA1004X_STATUS_CD) & 0x20)) { | 453 | while (!(tda1004x_read_byte(state, TDA1004X_STATUS_CD) & 0x20)) { |
423 | if (time_after(jiffies, timeout)) { | 454 | if (time_after(jiffies, timeout)) { |
424 | printk("tda1004x: DSP failed to initialised.\n"); | 455 | printk("tda1004x: DSP failed to initialised.\n"); |
425 | return -EIO; | 456 | return -EIO; |
@@ -427,7 +458,7 @@ static int tda10046_fwupload(struct dvb_frontend* fe) | |||
427 | msleep(1); | 458 | msleep(1); |
428 | } | 459 | } |
429 | 460 | ||
430 | return tda1004x_check_upload_ok(state, 0x20); | 461 | return tda1004x_check_upload_ok(state, state->fw_version); |
431 | } | 462 | } |
432 | 463 | ||
433 | static int tda1004x_encode_fec(int fec) | 464 | static int tda1004x_encode_fec(int fec) |
@@ -483,7 +514,8 @@ static int tda10045_init(struct dvb_frontend* fe) | |||
483 | 514 | ||
484 | dprintk("%s\n", __FUNCTION__); | 515 | dprintk("%s\n", __FUNCTION__); |
485 | 516 | ||
486 | if (state->initialised) return 0; | 517 | if (state->initialised) |
518 | return 0; | ||
487 | 519 | ||
488 | if (tda10045_fwupload(fe)) { | 520 | if (tda10045_fwupload(fe)) { |
489 | printk("tda1004x: firmware upload failed\n"); | 521 | printk("tda1004x: firmware upload failed\n"); |
@@ -523,7 +555,8 @@ static int tda10046_init(struct dvb_frontend* fe) | |||
523 | struct tda1004x_state* state = fe->demodulator_priv; | 555 | struct tda1004x_state* state = fe->demodulator_priv; |
524 | dprintk("%s\n", __FUNCTION__); | 556 | dprintk("%s\n", __FUNCTION__); |
525 | 557 | ||
526 | if (state->initialised) return 0; | 558 | if (state->initialised) |
559 | return 0; | ||
527 | 560 | ||
528 | if (tda10046_fwupload(fe)) { | 561 | if (tda10046_fwupload(fe)) { |
529 | printk("tda1004x: firmware upload failed\n"); | 562 | printk("tda1004x: firmware upload failed\n"); |
@@ -545,7 +578,7 @@ static int tda10046_init(struct dvb_frontend* fe) | |||
545 | tda1004x_write_mask(state, TDA1004X_AUTO, 8, 0); // select HP stream | 578 | tda1004x_write_mask(state, TDA1004X_AUTO, 8, 0); // select HP stream |
546 | tda1004x_write_mask(state, TDA1004X_CONFC1, 0x80, 0); // disable pulse killer | 579 | tda1004x_write_mask(state, TDA1004X_CONFC1, 0x80, 0); // disable pulse killer |
547 | tda1004x_write_byteI(state, TDA10046H_CONFPLL2, 10); // PLL M = 10 | 580 | tda1004x_write_byteI(state, TDA10046H_CONFPLL2, 10); // PLL M = 10 |
548 | tda1004x_write_byteI(state, TDA10046H_CONFPLL3, 0); // PLL P = N = 0 | 581 | tda1004x_write_byteI(state, TDA10046H_CONFPLL3, state->config->n_i2c); // PLL P = N = 0 |
549 | tda1004x_write_byteI(state, TDA10046H_FREQ_OFFSET, 99); // FREQOFFS = 99 | 582 | tda1004x_write_byteI(state, TDA10046H_FREQ_OFFSET, 99); // FREQOFFS = 99 |
550 | tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_MSB, 0xd4); // } PHY2 = -11221 | 583 | tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_MSB, 0xd4); // } PHY2 = -11221 |
551 | tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_LSB, 0x2c); // } | 584 | tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_LSB, 0x2c); // } |
@@ -621,12 +654,14 @@ static int tda1004x_set_fe(struct dvb_frontend* fe, | |||
621 | 654 | ||
622 | // set HP FEC | 655 | // set HP FEC |
623 | tmp = tda1004x_encode_fec(fe_params->u.ofdm.code_rate_HP); | 656 | tmp = tda1004x_encode_fec(fe_params->u.ofdm.code_rate_HP); |
624 | if (tmp < 0) return tmp; | 657 | if (tmp < 0) |
658 | return tmp; | ||
625 | tda1004x_write_mask(state, TDA1004X_IN_CONF2, 7, tmp); | 659 | tda1004x_write_mask(state, TDA1004X_IN_CONF2, 7, tmp); |
626 | 660 | ||
627 | // set LP FEC | 661 | // set LP FEC |
628 | tmp = tda1004x_encode_fec(fe_params->u.ofdm.code_rate_LP); | 662 | tmp = tda1004x_encode_fec(fe_params->u.ofdm.code_rate_LP); |
629 | if (tmp < 0) return tmp; | 663 | if (tmp < 0) |
664 | return tmp; | ||
630 | tda1004x_write_mask(state, TDA1004X_IN_CONF2, 0x38, tmp << 3); | 665 | tda1004x_write_mask(state, TDA1004X_IN_CONF2, 0x38, tmp << 3); |
631 | 666 | ||
632 | // set constellation | 667 | // set constellation |
@@ -671,7 +706,7 @@ static int tda1004x_set_fe(struct dvb_frontend* fe, | |||
671 | } | 706 | } |
672 | 707 | ||
673 | // set bandwidth | 708 | // set bandwidth |
674 | switch(state->demod_type) { | 709 | switch (state->demod_type) { |
675 | case TDA1004X_DEMOD_TDA10045: | 710 | case TDA1004X_DEMOD_TDA10045: |
676 | tda10045h_set_bandwidth(state, fe_params->u.ofdm.bandwidth); | 711 | tda10045h_set_bandwidth(state, fe_params->u.ofdm.bandwidth); |
677 | break; | 712 | break; |
@@ -683,7 +718,8 @@ static int tda1004x_set_fe(struct dvb_frontend* fe, | |||
683 | 718 | ||
684 | // set inversion | 719 | // set inversion |
685 | inversion = fe_params->inversion; | 720 | inversion = fe_params->inversion; |
686 | if (state->config->invert) inversion = inversion ? INVERSION_OFF : INVERSION_ON; | 721 | if (state->config->invert) |
722 | inversion = inversion ? INVERSION_OFF : INVERSION_ON; | ||
687 | switch (inversion) { | 723 | switch (inversion) { |
688 | case INVERSION_OFF: | 724 | case INVERSION_OFF: |
689 | tda1004x_write_mask(state, TDA1004X_CONFC1, 0x20, 0); | 725 | tda1004x_write_mask(state, TDA1004X_CONFC1, 0x20, 0); |
@@ -750,19 +786,19 @@ static int tda1004x_set_fe(struct dvb_frontend* fe, | |||
750 | } | 786 | } |
751 | 787 | ||
752 | // start the lock | 788 | // start the lock |
753 | switch(state->demod_type) { | 789 | switch (state->demod_type) { |
754 | case TDA1004X_DEMOD_TDA10045: | 790 | case TDA1004X_DEMOD_TDA10045: |
755 | tda1004x_write_mask(state, TDA1004X_CONFC4, 8, 8); | 791 | tda1004x_write_mask(state, TDA1004X_CONFC4, 8, 8); |
756 | tda1004x_write_mask(state, TDA1004X_CONFC4, 8, 0); | 792 | tda1004x_write_mask(state, TDA1004X_CONFC4, 8, 0); |
757 | msleep(10); | ||
758 | break; | 793 | break; |
759 | 794 | ||
760 | case TDA1004X_DEMOD_TDA10046: | 795 | case TDA1004X_DEMOD_TDA10046: |
761 | tda1004x_write_mask(state, TDA1004X_AUTO, 0x40, 0x40); | 796 | tda1004x_write_mask(state, TDA1004X_AUTO, 0x40, 0x40); |
762 | msleep(10); | ||
763 | break; | 797 | break; |
764 | } | 798 | } |
765 | 799 | ||
800 | msleep(10); | ||
801 | |||
766 | return 0; | 802 | return 0; |
767 | } | 803 | } |
768 | 804 | ||
@@ -773,13 +809,13 @@ static int tda1004x_get_fe(struct dvb_frontend* fe, struct dvb_frontend_paramete | |||
773 | 809 | ||
774 | // inversion status | 810 | // inversion status |
775 | fe_params->inversion = INVERSION_OFF; | 811 | fe_params->inversion = INVERSION_OFF; |
776 | if (tda1004x_read_byte(state, TDA1004X_CONFC1) & 0x20) { | 812 | if (tda1004x_read_byte(state, TDA1004X_CONFC1) & 0x20) |
777 | fe_params->inversion = INVERSION_ON; | 813 | fe_params->inversion = INVERSION_ON; |
778 | } | 814 | if (state->config->invert) |
779 | if (state->config->invert) fe_params->inversion = fe_params->inversion ? INVERSION_OFF : INVERSION_ON; | 815 | fe_params->inversion = fe_params->inversion ? INVERSION_OFF : INVERSION_ON; |
780 | 816 | ||
781 | // bandwidth | 817 | // bandwidth |
782 | switch(state->demod_type) { | 818 | switch (state->demod_type) { |
783 | case TDA1004X_DEMOD_TDA10045: | 819 | case TDA1004X_DEMOD_TDA10045: |
784 | switch (tda1004x_read_byte(state, TDA10045H_WREF_LSB)) { | 820 | switch (tda1004x_read_byte(state, TDA10045H_WREF_LSB)) { |
785 | case 0x14: | 821 | case 0x14: |
@@ -830,9 +866,8 @@ static int tda1004x_get_fe(struct dvb_frontend* fe, struct dvb_frontend_paramete | |||
830 | 866 | ||
831 | // transmission mode | 867 | // transmission mode |
832 | fe_params->u.ofdm.transmission_mode = TRANSMISSION_MODE_2K; | 868 | fe_params->u.ofdm.transmission_mode = TRANSMISSION_MODE_2K; |
833 | if (tda1004x_read_byte(state, TDA1004X_OUT_CONF1) & 0x10) { | 869 | if (tda1004x_read_byte(state, TDA1004X_OUT_CONF1) & 0x10) |
834 | fe_params->u.ofdm.transmission_mode = TRANSMISSION_MODE_8K; | 870 | fe_params->u.ofdm.transmission_mode = TRANSMISSION_MODE_8K; |
835 | } | ||
836 | 871 | ||
837 | // guard interval | 872 | // guard interval |
838 | switch ((tda1004x_read_byte(state, TDA1004X_OUT_CONF1) & 0x0c) >> 2) { | 873 | switch ((tda1004x_read_byte(state, TDA1004X_OUT_CONF1) & 0x0c) >> 2) { |
@@ -880,30 +915,33 @@ static int tda1004x_read_status(struct dvb_frontend* fe, fe_status_t * fe_status | |||
880 | 915 | ||
881 | // read status | 916 | // read status |
882 | status = tda1004x_read_byte(state, TDA1004X_STATUS_CD); | 917 | status = tda1004x_read_byte(state, TDA1004X_STATUS_CD); |
883 | if (status == -1) { | 918 | if (status == -1) |
884 | return -EIO; | 919 | return -EIO; |
885 | } | ||
886 | 920 | ||
887 | // decode | 921 | // decode |
888 | *fe_status = 0; | 922 | *fe_status = 0; |
889 | if (status & 4) *fe_status |= FE_HAS_SIGNAL; | 923 | if (status & 4) |
890 | if (status & 2) *fe_status |= FE_HAS_CARRIER; | 924 | *fe_status |= FE_HAS_SIGNAL; |
891 | if (status & 8) *fe_status |= FE_HAS_VITERBI | FE_HAS_SYNC | FE_HAS_LOCK; | 925 | if (status & 2) |
926 | *fe_status |= FE_HAS_CARRIER; | ||
927 | if (status & 8) | ||
928 | *fe_status |= FE_HAS_VITERBI | FE_HAS_SYNC | FE_HAS_LOCK; | ||
892 | 929 | ||
893 | // if we don't already have VITERBI (i.e. not LOCKED), see if the viterbi | 930 | // if we don't already have VITERBI (i.e. not LOCKED), see if the viterbi |
894 | // is getting anything valid | 931 | // is getting anything valid |
895 | if (!(*fe_status & FE_HAS_VITERBI)) { | 932 | if (!(*fe_status & FE_HAS_VITERBI)) { |
896 | // read the CBER | 933 | // read the CBER |
897 | cber = tda1004x_read_byte(state, TDA1004X_CBER_LSB); | 934 | cber = tda1004x_read_byte(state, TDA1004X_CBER_LSB); |
898 | if (cber == -1) return -EIO; | 935 | if (cber == -1) |
936 | return -EIO; | ||
899 | status = tda1004x_read_byte(state, TDA1004X_CBER_MSB); | 937 | status = tda1004x_read_byte(state, TDA1004X_CBER_MSB); |
900 | if (status == -1) return -EIO; | 938 | if (status == -1) |
939 | return -EIO; | ||
901 | cber |= (status << 8); | 940 | cber |= (status << 8); |
902 | tda1004x_read_byte(state, TDA1004X_CBER_RESET); | 941 | tda1004x_read_byte(state, TDA1004X_CBER_RESET); |
903 | 942 | ||
904 | if (cber != 65535) { | 943 | if (cber != 65535) |
905 | *fe_status |= FE_HAS_VITERBI; | 944 | *fe_status |= FE_HAS_VITERBI; |
906 | } | ||
907 | } | 945 | } |
908 | 946 | ||
909 | // if we DO have some valid VITERBI output, but don't already have SYNC | 947 | // if we DO have some valid VITERBI output, but don't already have SYNC |
@@ -911,20 +949,22 @@ static int tda1004x_read_status(struct dvb_frontend* fe, fe_status_t * fe_status | |||
911 | if ((*fe_status & FE_HAS_VITERBI) && (!(*fe_status & FE_HAS_SYNC))) { | 949 | if ((*fe_status & FE_HAS_VITERBI) && (!(*fe_status & FE_HAS_SYNC))) { |
912 | // read the VBER | 950 | // read the VBER |
913 | vber = tda1004x_read_byte(state, TDA1004X_VBER_LSB); | 951 | vber = tda1004x_read_byte(state, TDA1004X_VBER_LSB); |
914 | if (vber == -1) return -EIO; | 952 | if (vber == -1) |
953 | return -EIO; | ||
915 | status = tda1004x_read_byte(state, TDA1004X_VBER_MID); | 954 | status = tda1004x_read_byte(state, TDA1004X_VBER_MID); |
916 | if (status == -1) return -EIO; | 955 | if (status == -1) |
956 | return -EIO; | ||
917 | vber |= (status << 8); | 957 | vber |= (status << 8); |
918 | status = tda1004x_read_byte(state, TDA1004X_VBER_MSB); | 958 | status = tda1004x_read_byte(state, TDA1004X_VBER_MSB); |
919 | if (status == -1) return -EIO; | 959 | if (status == -1) |
960 | return -EIO; | ||
920 | vber |= ((status << 16) & 0x0f); | 961 | vber |= ((status << 16) & 0x0f); |
921 | tda1004x_read_byte(state, TDA1004X_CVBER_LUT); | 962 | tda1004x_read_byte(state, TDA1004X_CVBER_LUT); |
922 | 963 | ||
923 | // if RS has passed some valid TS packets, then we must be | 964 | // if RS has passed some valid TS packets, then we must be |
924 | // getting some SYNC bytes | 965 | // getting some SYNC bytes |
925 | if (vber < 16632) { | 966 | if (vber < 16632) |
926 | *fe_status |= FE_HAS_SYNC; | 967 | *fe_status |= FE_HAS_SYNC; |
927 | } | ||
928 | } | 968 | } |
929 | 969 | ||
930 | // success | 970 | // success |
@@ -941,7 +981,7 @@ static int tda1004x_read_signal_strength(struct dvb_frontend* fe, u16 * signal) | |||
941 | dprintk("%s\n", __FUNCTION__); | 981 | dprintk("%s\n", __FUNCTION__); |
942 | 982 | ||
943 | // determine the register to use | 983 | // determine the register to use |
944 | switch(state->demod_type) { | 984 | switch (state->demod_type) { |
945 | case TDA1004X_DEMOD_TDA10045: | 985 | case TDA1004X_DEMOD_TDA10045: |
946 | reg = TDA10045H_S_AGC; | 986 | reg = TDA10045H_S_AGC; |
947 | break; | 987 | break; |
@@ -972,9 +1012,8 @@ static int tda1004x_read_snr(struct dvb_frontend* fe, u16 * snr) | |||
972 | tmp = tda1004x_read_byte(state, TDA1004X_SNR); | 1012 | tmp = tda1004x_read_byte(state, TDA1004X_SNR); |
973 | if (tmp < 0) | 1013 | if (tmp < 0) |
974 | return -EIO; | 1014 | return -EIO; |
975 | if (tmp) { | 1015 | if (tmp) |
976 | tmp = 255 - tmp; | 1016 | tmp = 255 - tmp; |
977 | } | ||
978 | 1017 | ||
979 | *snr = ((tmp << 8) | tmp); | 1018 | *snr = ((tmp << 8) | tmp); |
980 | dprintk("%s: snr=0x%x\n", __FUNCTION__, *snr); | 1019 | dprintk("%s: snr=0x%x\n", __FUNCTION__, *snr); |
@@ -1009,11 +1048,11 @@ static int tda1004x_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | |||
1009 | break; | 1048 | break; |
1010 | } | 1049 | } |
1011 | 1050 | ||
1012 | if (tmp != 0x7f) { | 1051 | if (tmp != 0x7f) |
1013 | *ucblocks = tmp; | 1052 | *ucblocks = tmp; |
1014 | } else { | 1053 | else |
1015 | *ucblocks = 0xffffffff; | 1054 | *ucblocks = 0xffffffff; |
1016 | } | 1055 | |
1017 | dprintk("%s: ucblocks=0x%x\n", __FUNCTION__, *ucblocks); | 1056 | dprintk("%s: ucblocks=0x%x\n", __FUNCTION__, *ucblocks); |
1018 | return 0; | 1057 | return 0; |
1019 | } | 1058 | } |
@@ -1027,10 +1066,12 @@ static int tda1004x_read_ber(struct dvb_frontend* fe, u32* ber) | |||
1027 | 1066 | ||
1028 | // read it in | 1067 | // read it in |
1029 | tmp = tda1004x_read_byte(state, TDA1004X_CBER_LSB); | 1068 | tmp = tda1004x_read_byte(state, TDA1004X_CBER_LSB); |
1030 | if (tmp < 0) return -EIO; | 1069 | if (tmp < 0) |
1070 | return -EIO; | ||
1031 | *ber = tmp << 1; | 1071 | *ber = tmp << 1; |
1032 | tmp = tda1004x_read_byte(state, TDA1004X_CBER_MSB); | 1072 | tmp = tda1004x_read_byte(state, TDA1004X_CBER_MSB); |
1033 | if (tmp < 0) return -EIO; | 1073 | if (tmp < 0) |
1074 | return -EIO; | ||
1034 | *ber |= (tmp << 9); | 1075 | *ber |= (tmp << 9); |
1035 | tda1004x_read_byte(state, TDA1004X_CBER_RESET); | 1076 | tda1004x_read_byte(state, TDA1004X_CBER_RESET); |
1036 | 1077 | ||
@@ -1042,7 +1083,7 @@ static int tda1004x_sleep(struct dvb_frontend* fe) | |||
1042 | { | 1083 | { |
1043 | struct tda1004x_state* state = fe->demodulator_priv; | 1084 | struct tda1004x_state* state = fe->demodulator_priv; |
1044 | 1085 | ||
1045 | switch(state->demod_type) { | 1086 | switch (state->demod_type) { |
1046 | case TDA1004X_DEMOD_TDA10045: | 1087 | case TDA1004X_DEMOD_TDA10045: |
1047 | tda1004x_write_mask(state, TDA1004X_CONFADC1, 0x10, 0x10); | 1088 | tda1004x_write_mask(state, TDA1004X_CONFADC1, 0x10, 0x10); |
1048 | break; | 1089 | break; |
@@ -1066,74 +1107,11 @@ static int tda1004x_get_tune_settings(struct dvb_frontend* fe, struct dvb_fronte | |||
1066 | 1107 | ||
1067 | static void tda1004x_release(struct dvb_frontend* fe) | 1108 | static void tda1004x_release(struct dvb_frontend* fe) |
1068 | { | 1109 | { |
1069 | struct tda1004x_state* state = (struct tda1004x_state*) fe->demodulator_priv; | 1110 | struct tda1004x_state *state = fe->demodulator_priv; |
1070 | kfree(state); | ||
1071 | } | ||
1072 | |||
1073 | static struct dvb_frontend_ops tda10045_ops; | ||
1074 | |||
1075 | struct dvb_frontend* tda10045_attach(const struct tda1004x_config* config, | ||
1076 | struct i2c_adapter* i2c) | ||
1077 | { | ||
1078 | struct tda1004x_state* state = NULL; | ||
1079 | |||
1080 | /* allocate memory for the internal state */ | ||
1081 | state = (struct tda1004x_state*) kmalloc(sizeof(struct tda1004x_state), GFP_KERNEL); | ||
1082 | if (state == NULL) goto error; | ||
1083 | |||
1084 | /* setup the state */ | ||
1085 | state->config = config; | ||
1086 | state->i2c = i2c; | ||
1087 | memcpy(&state->ops, &tda10045_ops, sizeof(struct dvb_frontend_ops)); | ||
1088 | state->initialised = 0; | ||
1089 | state->demod_type = TDA1004X_DEMOD_TDA10045; | ||
1090 | |||
1091 | /* check if the demod is there */ | ||
1092 | if (tda1004x_read_byte(state, TDA1004X_CHIPID) != 0x25) goto error; | ||
1093 | |||
1094 | /* create dvb_frontend */ | ||
1095 | state->frontend.ops = &state->ops; | ||
1096 | state->frontend.demodulator_priv = state; | ||
1097 | return &state->frontend; | ||
1098 | |||
1099 | error: | ||
1100 | kfree(state); | 1111 | kfree(state); |
1101 | return NULL; | ||
1102 | } | ||
1103 | |||
1104 | static struct dvb_frontend_ops tda10046_ops; | ||
1105 | |||
1106 | struct dvb_frontend* tda10046_attach(const struct tda1004x_config* config, | ||
1107 | struct i2c_adapter* i2c) | ||
1108 | { | ||
1109 | struct tda1004x_state* state = NULL; | ||
1110 | |||
1111 | /* allocate memory for the internal state */ | ||
1112 | state = (struct tda1004x_state*) kmalloc(sizeof(struct tda1004x_state), GFP_KERNEL); | ||
1113 | if (state == NULL) goto error; | ||
1114 | |||
1115 | /* setup the state */ | ||
1116 | state->config = config; | ||
1117 | state->i2c = i2c; | ||
1118 | memcpy(&state->ops, &tda10046_ops, sizeof(struct dvb_frontend_ops)); | ||
1119 | state->initialised = 0; | ||
1120 | state->demod_type = TDA1004X_DEMOD_TDA10046; | ||
1121 | |||
1122 | /* check if the demod is there */ | ||
1123 | if (tda1004x_read_byte(state, TDA1004X_CHIPID) != 0x46) goto error; | ||
1124 | |||
1125 | /* create dvb_frontend */ | ||
1126 | state->frontend.ops = &state->ops; | ||
1127 | state->frontend.demodulator_priv = state; | ||
1128 | return &state->frontend; | ||
1129 | |||
1130 | error: | ||
1131 | if (state) kfree(state); | ||
1132 | return NULL; | ||
1133 | } | 1112 | } |
1134 | 1113 | ||
1135 | static struct dvb_frontend_ops tda10045_ops = { | 1114 | static struct dvb_frontend_ops tda10045_ops = { |
1136 | |||
1137 | .info = { | 1115 | .info = { |
1138 | .name = "Philips TDA10045H DVB-T", | 1116 | .name = "Philips TDA10045H DVB-T", |
1139 | .type = FE_OFDM, | 1117 | .type = FE_OFDM, |
@@ -1163,8 +1141,36 @@ static struct dvb_frontend_ops tda10045_ops = { | |||
1163 | .read_ucblocks = tda1004x_read_ucblocks, | 1141 | .read_ucblocks = tda1004x_read_ucblocks, |
1164 | }; | 1142 | }; |
1165 | 1143 | ||
1166 | static struct dvb_frontend_ops tda10046_ops = { | 1144 | struct dvb_frontend* tda10045_attach(const struct tda1004x_config* config, |
1145 | struct i2c_adapter* i2c) | ||
1146 | { | ||
1147 | struct tda1004x_state *state; | ||
1148 | |||
1149 | /* allocate memory for the internal state */ | ||
1150 | state = kmalloc(sizeof(struct tda1004x_state), GFP_KERNEL); | ||
1151 | if (!state) | ||
1152 | return NULL; | ||
1153 | |||
1154 | /* setup the state */ | ||
1155 | state->config = config; | ||
1156 | state->i2c = i2c; | ||
1157 | memcpy(&state->ops, &tda10045_ops, sizeof(struct dvb_frontend_ops)); | ||
1158 | state->initialised = 0; | ||
1159 | state->demod_type = TDA1004X_DEMOD_TDA10045; | ||
1160 | |||
1161 | /* check if the demod is there */ | ||
1162 | if (tda1004x_read_byte(state, TDA1004X_CHIPID) != 0x25) { | ||
1163 | kfree(state); | ||
1164 | return NULL; | ||
1165 | } | ||
1167 | 1166 | ||
1167 | /* create dvb_frontend */ | ||
1168 | state->frontend.ops = &state->ops; | ||
1169 | state->frontend.demodulator_priv = state; | ||
1170 | return &state->frontend; | ||
1171 | } | ||
1172 | |||
1173 | static struct dvb_frontend_ops tda10046_ops = { | ||
1168 | .info = { | 1174 | .info = { |
1169 | .name = "Philips TDA10046H DVB-T", | 1175 | .name = "Philips TDA10046H DVB-T", |
1170 | .type = FE_OFDM, | 1176 | .type = FE_OFDM, |
@@ -1194,6 +1200,36 @@ static struct dvb_frontend_ops tda10046_ops = { | |||
1194 | .read_ucblocks = tda1004x_read_ucblocks, | 1200 | .read_ucblocks = tda1004x_read_ucblocks, |
1195 | }; | 1201 | }; |
1196 | 1202 | ||
1203 | struct dvb_frontend* tda10046_attach(const struct tda1004x_config* config, | ||
1204 | struct i2c_adapter* i2c) | ||
1205 | { | ||
1206 | struct tda1004x_state *state; | ||
1207 | |||
1208 | /* allocate memory for the internal state */ | ||
1209 | state = kmalloc(sizeof(struct tda1004x_state), GFP_KERNEL); | ||
1210 | if (!state) | ||
1211 | return NULL; | ||
1212 | |||
1213 | /* setup the state */ | ||
1214 | state->config = config; | ||
1215 | state->i2c = i2c; | ||
1216 | memcpy(&state->ops, &tda10046_ops, sizeof(struct dvb_frontend_ops)); | ||
1217 | state->initialised = 0; | ||
1218 | state->demod_type = TDA1004X_DEMOD_TDA10046; | ||
1219 | state->fw_version = 0x20; /* dummy default value */ | ||
1220 | |||
1221 | /* check if the demod is there */ | ||
1222 | if (tda1004x_read_byte(state, TDA1004X_CHIPID) != 0x46) { | ||
1223 | kfree(state); | ||
1224 | return NULL; | ||
1225 | } | ||
1226 | |||
1227 | /* create dvb_frontend */ | ||
1228 | state->frontend.ops = &state->ops; | ||
1229 | state->frontend.demodulator_priv = state; | ||
1230 | return &state->frontend; | ||
1231 | } | ||
1232 | |||
1197 | module_param(debug, int, 0644); | 1233 | module_param(debug, int, 0644); |
1198 | MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off)."); | 1234 | MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off)."); |
1199 | 1235 | ||
diff --git a/drivers/media/dvb/frontends/tda1004x.h b/drivers/media/dvb/frontends/tda1004x.h index e452fc0bad11..c8e1d54ff262 100644 --- a/drivers/media/dvb/frontends/tda1004x.h +++ b/drivers/media/dvb/frontends/tda1004x.h | |||
@@ -32,10 +32,13 @@ struct tda1004x_config | |||
32 | u8 demod_address; | 32 | u8 demod_address; |
33 | 33 | ||
34 | /* does the "inversion" need inverted? */ | 34 | /* does the "inversion" need inverted? */ |
35 | u8 invert:1; | 35 | u8 invert; |
36 | 36 | ||
37 | /* Does the OCLK signal need inverted? */ | 37 | /* Does the OCLK signal need inverted? */ |
38 | u8 invert_oclk:1; | 38 | u8 invert_oclk; |
39 | |||
40 | /* value of N_I2C of the CONF_PLL3 register */ | ||
41 | u8 n_i2c; | ||
39 | 42 | ||
40 | /* PLL maintenance */ | 43 | /* PLL maintenance */ |
41 | int (*pll_init)(struct dvb_frontend* fe); | 44 | int (*pll_init)(struct dvb_frontend* fe); |
diff --git a/drivers/media/dvb/frontends/tda8083.c b/drivers/media/dvb/frontends/tda8083.c index da82e90d6d13..168e013d23bd 100644 --- a/drivers/media/dvb/frontends/tda8083.c +++ b/drivers/media/dvb/frontends/tda8083.c | |||
@@ -226,7 +226,7 @@ static int tda8083_send_diseqc_burst (struct tda8083_state* state, fe_sec_mini_c | |||
226 | static int tda8083_send_diseqc_msg (struct dvb_frontend* fe, | 226 | static int tda8083_send_diseqc_msg (struct dvb_frontend* fe, |
227 | struct dvb_diseqc_master_cmd *m) | 227 | struct dvb_diseqc_master_cmd *m) |
228 | { | 228 | { |
229 | struct tda8083_state* state = (struct tda8083_state*) fe->demodulator_priv; | 229 | struct tda8083_state* state = fe->demodulator_priv; |
230 | int i; | 230 | int i; |
231 | 231 | ||
232 | tda8083_writereg (state, 0x29, (m->msg_len - 3) | (1 << 2)); /* enable */ | 232 | tda8083_writereg (state, 0x29, (m->msg_len - 3) | (1 << 2)); /* enable */ |
@@ -243,7 +243,7 @@ static int tda8083_send_diseqc_msg (struct dvb_frontend* fe, | |||
243 | 243 | ||
244 | static int tda8083_read_status(struct dvb_frontend* fe, fe_status_t* status) | 244 | static int tda8083_read_status(struct dvb_frontend* fe, fe_status_t* status) |
245 | { | 245 | { |
246 | struct tda8083_state* state = (struct tda8083_state*) fe->demodulator_priv; | 246 | struct tda8083_state* state = fe->demodulator_priv; |
247 | 247 | ||
248 | u8 signal = ~tda8083_readreg (state, 0x01); | 248 | u8 signal = ~tda8083_readreg (state, 0x01); |
249 | u8 sync = tda8083_readreg (state, 0x02); | 249 | u8 sync = tda8083_readreg (state, 0x02); |
@@ -270,7 +270,7 @@ static int tda8083_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
270 | 270 | ||
271 | static int tda8083_read_signal_strength(struct dvb_frontend* fe, u16* strength) | 271 | static int tda8083_read_signal_strength(struct dvb_frontend* fe, u16* strength) |
272 | { | 272 | { |
273 | struct tda8083_state* state = (struct tda8083_state*) fe->demodulator_priv; | 273 | struct tda8083_state* state = fe->demodulator_priv; |
274 | 274 | ||
275 | u8 signal = ~tda8083_readreg (state, 0x01); | 275 | u8 signal = ~tda8083_readreg (state, 0x01); |
276 | *strength = (signal << 8) | signal; | 276 | *strength = (signal << 8) | signal; |
@@ -280,7 +280,7 @@ static int tda8083_read_signal_strength(struct dvb_frontend* fe, u16* strength) | |||
280 | 280 | ||
281 | static int tda8083_read_snr(struct dvb_frontend* fe, u16* snr) | 281 | static int tda8083_read_snr(struct dvb_frontend* fe, u16* snr) |
282 | { | 282 | { |
283 | struct tda8083_state* state = (struct tda8083_state*) fe->demodulator_priv; | 283 | struct tda8083_state* state = fe->demodulator_priv; |
284 | 284 | ||
285 | u8 _snr = tda8083_readreg (state, 0x08); | 285 | u8 _snr = tda8083_readreg (state, 0x08); |
286 | *snr = (_snr << 8) | _snr; | 286 | *snr = (_snr << 8) | _snr; |
@@ -290,7 +290,7 @@ static int tda8083_read_snr(struct dvb_frontend* fe, u16* snr) | |||
290 | 290 | ||
291 | static int tda8083_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 291 | static int tda8083_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
292 | { | 292 | { |
293 | struct tda8083_state* state = (struct tda8083_state*) fe->demodulator_priv; | 293 | struct tda8083_state* state = fe->demodulator_priv; |
294 | 294 | ||
295 | state->config->pll_set(fe, p); | 295 | state->config->pll_set(fe, p); |
296 | tda8083_set_inversion (state, p->inversion); | 296 | tda8083_set_inversion (state, p->inversion); |
@@ -305,7 +305,7 @@ static int tda8083_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
305 | 305 | ||
306 | static int tda8083_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 306 | static int tda8083_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
307 | { | 307 | { |
308 | struct tda8083_state* state = (struct tda8083_state*) fe->demodulator_priv; | 308 | struct tda8083_state* state = fe->demodulator_priv; |
309 | 309 | ||
310 | /* FIXME: get symbolrate & frequency offset...*/ | 310 | /* FIXME: get symbolrate & frequency offset...*/ |
311 | /*p->frequency = ???;*/ | 311 | /*p->frequency = ???;*/ |
@@ -319,7 +319,7 @@ static int tda8083_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
319 | 319 | ||
320 | static int tda8083_sleep(struct dvb_frontend* fe) | 320 | static int tda8083_sleep(struct dvb_frontend* fe) |
321 | { | 321 | { |
322 | struct tda8083_state* state = (struct tda8083_state*) fe->demodulator_priv; | 322 | struct tda8083_state* state = fe->demodulator_priv; |
323 | 323 | ||
324 | tda8083_writereg (state, 0x00, 0x02); | 324 | tda8083_writereg (state, 0x00, 0x02); |
325 | return 0; | 325 | return 0; |
@@ -327,7 +327,7 @@ static int tda8083_sleep(struct dvb_frontend* fe) | |||
327 | 327 | ||
328 | static int tda8083_init(struct dvb_frontend* fe) | 328 | static int tda8083_init(struct dvb_frontend* fe) |
329 | { | 329 | { |
330 | struct tda8083_state* state = (struct tda8083_state*) fe->demodulator_priv; | 330 | struct tda8083_state* state = fe->demodulator_priv; |
331 | int i; | 331 | int i; |
332 | 332 | ||
333 | for (i=0; i<44; i++) | 333 | for (i=0; i<44; i++) |
@@ -343,7 +343,7 @@ static int tda8083_init(struct dvb_frontend* fe) | |||
343 | 343 | ||
344 | static int tda8083_diseqc_send_burst(struct dvb_frontend* fe, fe_sec_mini_cmd_t burst) | 344 | static int tda8083_diseqc_send_burst(struct dvb_frontend* fe, fe_sec_mini_cmd_t burst) |
345 | { | 345 | { |
346 | struct tda8083_state* state = (struct tda8083_state*) fe->demodulator_priv; | 346 | struct tda8083_state* state = fe->demodulator_priv; |
347 | 347 | ||
348 | tda8083_send_diseqc_burst (state, burst); | 348 | tda8083_send_diseqc_burst (state, burst); |
349 | tda8083_writereg (state, 0x00, 0x3c); | 349 | tda8083_writereg (state, 0x00, 0x3c); |
@@ -354,7 +354,7 @@ static int tda8083_diseqc_send_burst(struct dvb_frontend* fe, fe_sec_mini_cmd_t | |||
354 | 354 | ||
355 | static int tda8083_diseqc_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone) | 355 | static int tda8083_diseqc_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone) |
356 | { | 356 | { |
357 | struct tda8083_state* state = (struct tda8083_state*) fe->demodulator_priv; | 357 | struct tda8083_state* state = fe->demodulator_priv; |
358 | 358 | ||
359 | tda8083_set_tone (state, tone); | 359 | tda8083_set_tone (state, tone); |
360 | tda8083_writereg (state, 0x00, 0x3c); | 360 | tda8083_writereg (state, 0x00, 0x3c); |
@@ -365,7 +365,7 @@ static int tda8083_diseqc_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t t | |||
365 | 365 | ||
366 | static int tda8083_diseqc_set_voltage(struct dvb_frontend* fe, fe_sec_voltage_t voltage) | 366 | static int tda8083_diseqc_set_voltage(struct dvb_frontend* fe, fe_sec_voltage_t voltage) |
367 | { | 367 | { |
368 | struct tda8083_state* state = (struct tda8083_state*) fe->demodulator_priv; | 368 | struct tda8083_state* state = fe->demodulator_priv; |
369 | 369 | ||
370 | tda8083_set_voltage (state, voltage); | 370 | tda8083_set_voltage (state, voltage); |
371 | tda8083_writereg (state, 0x00, 0x3c); | 371 | tda8083_writereg (state, 0x00, 0x3c); |
@@ -376,7 +376,7 @@ static int tda8083_diseqc_set_voltage(struct dvb_frontend* fe, fe_sec_voltage_t | |||
376 | 376 | ||
377 | static void tda8083_release(struct dvb_frontend* fe) | 377 | static void tda8083_release(struct dvb_frontend* fe) |
378 | { | 378 | { |
379 | struct tda8083_state* state = (struct tda8083_state*) fe->demodulator_priv; | 379 | struct tda8083_state* state = fe->demodulator_priv; |
380 | kfree(state); | 380 | kfree(state); |
381 | } | 381 | } |
382 | 382 | ||
@@ -388,7 +388,7 @@ struct dvb_frontend* tda8083_attach(const struct tda8083_config* config, | |||
388 | struct tda8083_state* state = NULL; | 388 | struct tda8083_state* state = NULL; |
389 | 389 | ||
390 | /* allocate memory for the internal state */ | 390 | /* allocate memory for the internal state */ |
391 | state = (struct tda8083_state*) kmalloc(sizeof(struct tda8083_state), GFP_KERNEL); | 391 | state = kmalloc(sizeof(struct tda8083_state), GFP_KERNEL); |
392 | if (state == NULL) goto error; | 392 | if (state == NULL) goto error; |
393 | 393 | ||
394 | /* setup the state */ | 394 | /* setup the state */ |
diff --git a/drivers/media/dvb/frontends/tda80xx.c b/drivers/media/dvb/frontends/tda80xx.c index c99632114283..032d348dafb7 100644 --- a/drivers/media/dvb/frontends/tda80xx.c +++ b/drivers/media/dvb/frontends/tda80xx.c | |||
@@ -27,7 +27,7 @@ | |||
27 | #include <linux/spinlock.h> | 27 | #include <linux/spinlock.h> |
28 | #include <linux/threads.h> | 28 | #include <linux/threads.h> |
29 | #include <linux/interrupt.h> | 29 | #include <linux/interrupt.h> |
30 | #include <asm/irq.h> | 30 | #include <linux/irq.h> |
31 | #include <linux/kernel.h> | 31 | #include <linux/kernel.h> |
32 | #include <linux/module.h> | 32 | #include <linux/module.h> |
33 | #include <linux/slab.h> | 33 | #include <linux/slab.h> |
@@ -400,7 +400,7 @@ static void tda80xx_wait_diseqc_fifo(struct tda80xx_state* state) | |||
400 | 400 | ||
401 | static int tda8044_init(struct dvb_frontend* fe) | 401 | static int tda8044_init(struct dvb_frontend* fe) |
402 | { | 402 | { |
403 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 403 | struct tda80xx_state* state = fe->demodulator_priv; |
404 | int ret; | 404 | int ret; |
405 | 405 | ||
406 | /* | 406 | /* |
@@ -432,7 +432,7 @@ static int tda8044_init(struct dvb_frontend* fe) | |||
432 | 432 | ||
433 | static int tda8083_init(struct dvb_frontend* fe) | 433 | static int tda8083_init(struct dvb_frontend* fe) |
434 | { | 434 | { |
435 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 435 | struct tda80xx_state* state = fe->demodulator_priv; |
436 | 436 | ||
437 | tda80xx_write(state, 0x00, tda8083_inittab, sizeof(tda8083_inittab)); | 437 | tda80xx_write(state, 0x00, tda8083_inittab, sizeof(tda8083_inittab)); |
438 | 438 | ||
@@ -447,7 +447,7 @@ static int tda8083_init(struct dvb_frontend* fe) | |||
447 | 447 | ||
448 | static int tda80xx_set_voltage(struct dvb_frontend* fe, fe_sec_voltage_t voltage) | 448 | static int tda80xx_set_voltage(struct dvb_frontend* fe, fe_sec_voltage_t voltage) |
449 | { | 449 | { |
450 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 450 | struct tda80xx_state* state = fe->demodulator_priv; |
451 | 451 | ||
452 | switch (voltage) { | 452 | switch (voltage) { |
453 | case SEC_VOLTAGE_13: | 453 | case SEC_VOLTAGE_13: |
@@ -463,7 +463,7 @@ static int tda80xx_set_voltage(struct dvb_frontend* fe, fe_sec_voltage_t voltage | |||
463 | 463 | ||
464 | static int tda80xx_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone) | 464 | static int tda80xx_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone) |
465 | { | 465 | { |
466 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 466 | struct tda80xx_state* state = fe->demodulator_priv; |
467 | 467 | ||
468 | switch (tone) { | 468 | switch (tone) { |
469 | case SEC_TONE_OFF: | 469 | case SEC_TONE_OFF: |
@@ -477,7 +477,7 @@ static int tda80xx_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone) | |||
477 | 477 | ||
478 | static int tda80xx_send_diseqc_msg(struct dvb_frontend* fe, struct dvb_diseqc_master_cmd *cmd) | 478 | static int tda80xx_send_diseqc_msg(struct dvb_frontend* fe, struct dvb_diseqc_master_cmd *cmd) |
479 | { | 479 | { |
480 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 480 | struct tda80xx_state* state = fe->demodulator_priv; |
481 | 481 | ||
482 | if (cmd->msg_len > 6) | 482 | if (cmd->msg_len > 6) |
483 | return -EINVAL; | 483 | return -EINVAL; |
@@ -492,7 +492,7 @@ static int tda80xx_send_diseqc_msg(struct dvb_frontend* fe, struct dvb_diseqc_ma | |||
492 | 492 | ||
493 | static int tda80xx_send_diseqc_burst(struct dvb_frontend* fe, fe_sec_mini_cmd_t cmd) | 493 | static int tda80xx_send_diseqc_burst(struct dvb_frontend* fe, fe_sec_mini_cmd_t cmd) |
494 | { | 494 | { |
495 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 495 | struct tda80xx_state* state = fe->demodulator_priv; |
496 | 496 | ||
497 | switch (cmd) { | 497 | switch (cmd) { |
498 | case SEC_MINI_A: | 498 | case SEC_MINI_A: |
@@ -512,7 +512,7 @@ static int tda80xx_send_diseqc_burst(struct dvb_frontend* fe, fe_sec_mini_cmd_t | |||
512 | 512 | ||
513 | static int tda80xx_sleep(struct dvb_frontend* fe) | 513 | static int tda80xx_sleep(struct dvb_frontend* fe) |
514 | { | 514 | { |
515 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 515 | struct tda80xx_state* state = fe->demodulator_priv; |
516 | 516 | ||
517 | tda80xx_writereg(state, 0x00, 0x02); /* enter standby */ | 517 | tda80xx_writereg(state, 0x00, 0x02); /* enter standby */ |
518 | 518 | ||
@@ -521,7 +521,7 @@ static int tda80xx_sleep(struct dvb_frontend* fe) | |||
521 | 521 | ||
522 | static int tda80xx_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 522 | static int tda80xx_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
523 | { | 523 | { |
524 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 524 | struct tda80xx_state* state = fe->demodulator_priv; |
525 | 525 | ||
526 | tda80xx_writereg(state, 0x1c, 0x80); | 526 | tda80xx_writereg(state, 0x1c, 0x80); |
527 | state->config->pll_set(fe, p); | 527 | state->config->pll_set(fe, p); |
@@ -537,7 +537,7 @@ static int tda80xx_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
537 | 537 | ||
538 | static int tda80xx_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 538 | static int tda80xx_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
539 | { | 539 | { |
540 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 540 | struct tda80xx_state* state = fe->demodulator_priv; |
541 | 541 | ||
542 | if (!state->config->irq) | 542 | if (!state->config->irq) |
543 | tda80xx_read_status_int(state); | 543 | tda80xx_read_status_int(state); |
@@ -550,7 +550,7 @@ static int tda80xx_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
550 | 550 | ||
551 | static int tda80xx_read_status(struct dvb_frontend* fe, fe_status_t* status) | 551 | static int tda80xx_read_status(struct dvb_frontend* fe, fe_status_t* status) |
552 | { | 552 | { |
553 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 553 | struct tda80xx_state* state = fe->demodulator_priv; |
554 | 554 | ||
555 | if (!state->config->irq) | 555 | if (!state->config->irq) |
556 | tda80xx_read_status_int(state); | 556 | tda80xx_read_status_int(state); |
@@ -561,7 +561,7 @@ static int tda80xx_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
561 | 561 | ||
562 | static int tda80xx_read_ber(struct dvb_frontend* fe, u32* ber) | 562 | static int tda80xx_read_ber(struct dvb_frontend* fe, u32* ber) |
563 | { | 563 | { |
564 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 564 | struct tda80xx_state* state = fe->demodulator_priv; |
565 | int ret; | 565 | int ret; |
566 | u8 buf[3]; | 566 | u8 buf[3]; |
567 | 567 | ||
@@ -575,7 +575,7 @@ static int tda80xx_read_ber(struct dvb_frontend* fe, u32* ber) | |||
575 | 575 | ||
576 | static int tda80xx_read_signal_strength(struct dvb_frontend* fe, u16* strength) | 576 | static int tda80xx_read_signal_strength(struct dvb_frontend* fe, u16* strength) |
577 | { | 577 | { |
578 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 578 | struct tda80xx_state* state = fe->demodulator_priv; |
579 | 579 | ||
580 | u8 gain = ~tda80xx_readreg(state, 0x01); | 580 | u8 gain = ~tda80xx_readreg(state, 0x01); |
581 | *strength = (gain << 8) | gain; | 581 | *strength = (gain << 8) | gain; |
@@ -585,7 +585,7 @@ static int tda80xx_read_signal_strength(struct dvb_frontend* fe, u16* strength) | |||
585 | 585 | ||
586 | static int tda80xx_read_snr(struct dvb_frontend* fe, u16* snr) | 586 | static int tda80xx_read_snr(struct dvb_frontend* fe, u16* snr) |
587 | { | 587 | { |
588 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 588 | struct tda80xx_state* state = fe->demodulator_priv; |
589 | 589 | ||
590 | u8 quality = tda80xx_readreg(state, 0x08); | 590 | u8 quality = tda80xx_readreg(state, 0x08); |
591 | *snr = (quality << 8) | quality; | 591 | *snr = (quality << 8) | quality; |
@@ -595,7 +595,7 @@ static int tda80xx_read_snr(struct dvb_frontend* fe, u16* snr) | |||
595 | 595 | ||
596 | static int tda80xx_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | 596 | static int tda80xx_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) |
597 | { | 597 | { |
598 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 598 | struct tda80xx_state* state = fe->demodulator_priv; |
599 | 599 | ||
600 | *ucblocks = tda80xx_readreg(state, 0x0f); | 600 | *ucblocks = tda80xx_readreg(state, 0x0f); |
601 | if (*ucblocks == 0xff) | 601 | if (*ucblocks == 0xff) |
@@ -606,7 +606,7 @@ static int tda80xx_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | |||
606 | 606 | ||
607 | static int tda80xx_init(struct dvb_frontend* fe) | 607 | static int tda80xx_init(struct dvb_frontend* fe) |
608 | { | 608 | { |
609 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 609 | struct tda80xx_state* state = fe->demodulator_priv; |
610 | 610 | ||
611 | switch(state->id) { | 611 | switch(state->id) { |
612 | case ID_TDA8044: | 612 | case ID_TDA8044: |
@@ -620,7 +620,7 @@ static int tda80xx_init(struct dvb_frontend* fe) | |||
620 | 620 | ||
621 | static void tda80xx_release(struct dvb_frontend* fe) | 621 | static void tda80xx_release(struct dvb_frontend* fe) |
622 | { | 622 | { |
623 | struct tda80xx_state* state = (struct tda80xx_state*) fe->demodulator_priv; | 623 | struct tda80xx_state* state = fe->demodulator_priv; |
624 | 624 | ||
625 | if (state->config->irq) | 625 | if (state->config->irq) |
626 | free_irq(state->config->irq, &state->worklet); | 626 | free_irq(state->config->irq, &state->worklet); |
@@ -637,7 +637,7 @@ struct dvb_frontend* tda80xx_attach(const struct tda80xx_config* config, | |||
637 | int ret; | 637 | int ret; |
638 | 638 | ||
639 | /* allocate memory for the internal state */ | 639 | /* allocate memory for the internal state */ |
640 | state = (struct tda80xx_state*) kmalloc(sizeof(struct tda80xx_state), GFP_KERNEL); | 640 | state = kmalloc(sizeof(struct tda80xx_state), GFP_KERNEL); |
641 | if (state == NULL) goto error; | 641 | if (state == NULL) goto error; |
642 | 642 | ||
643 | /* setup the state */ | 643 | /* setup the state */ |
diff --git a/drivers/media/dvb/frontends/ves1820.c b/drivers/media/dvb/frontends/ves1820.c index 9c0d23e1d9e5..70fb44b391a7 100644 --- a/drivers/media/dvb/frontends/ves1820.c +++ b/drivers/media/dvb/frontends/ves1820.c | |||
@@ -70,7 +70,6 @@ static int ves1820_writereg(struct ves1820_state *state, u8 reg, u8 data) | |||
70 | printk("ves1820: %s(): writereg error (reg == 0x%02x," | 70 | printk("ves1820: %s(): writereg error (reg == 0x%02x," |
71 | "val == 0x%02x, ret == %i)\n", __FUNCTION__, reg, data, ret); | 71 | "val == 0x%02x, ret == %i)\n", __FUNCTION__, reg, data, ret); |
72 | 72 | ||
73 | msleep(10); | ||
74 | return (ret != 1) ? -EREMOTEIO : 0; | 73 | return (ret != 1) ? -EREMOTEIO : 0; |
75 | } | 74 | } |
76 | 75 | ||
@@ -193,7 +192,7 @@ static int ves1820_set_symbolrate(struct ves1820_state *state, u32 symbolrate) | |||
193 | 192 | ||
194 | static int ves1820_init(struct dvb_frontend* fe) | 193 | static int ves1820_init(struct dvb_frontend* fe) |
195 | { | 194 | { |
196 | struct ves1820_state* state = (struct ves1820_state*) fe->demodulator_priv; | 195 | struct ves1820_state* state = fe->demodulator_priv; |
197 | int i; | 196 | int i; |
198 | int val; | 197 | int val; |
199 | 198 | ||
@@ -214,7 +213,7 @@ static int ves1820_init(struct dvb_frontend* fe) | |||
214 | 213 | ||
215 | static int ves1820_set_parameters(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 214 | static int ves1820_set_parameters(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
216 | { | 215 | { |
217 | struct ves1820_state* state = (struct ves1820_state*) fe->demodulator_priv; | 216 | struct ves1820_state* state = fe->demodulator_priv; |
218 | static const u8 reg0x00[] = { 0x00, 0x04, 0x08, 0x0c, 0x10 }; | 217 | static const u8 reg0x00[] = { 0x00, 0x04, 0x08, 0x0c, 0x10 }; |
219 | static const u8 reg0x01[] = { 140, 140, 106, 100, 92 }; | 218 | static const u8 reg0x01[] = { 140, 140, 106, 100, 92 }; |
220 | static const u8 reg0x05[] = { 135, 100, 70, 54, 38 }; | 219 | static const u8 reg0x05[] = { 135, 100, 70, 54, 38 }; |
@@ -241,7 +240,7 @@ static int ves1820_set_parameters(struct dvb_frontend* fe, struct dvb_frontend_p | |||
241 | 240 | ||
242 | static int ves1820_read_status(struct dvb_frontend* fe, fe_status_t* status) | 241 | static int ves1820_read_status(struct dvb_frontend* fe, fe_status_t* status) |
243 | { | 242 | { |
244 | struct ves1820_state* state = (struct ves1820_state*) fe->demodulator_priv; | 243 | struct ves1820_state* state = fe->demodulator_priv; |
245 | int sync; | 244 | int sync; |
246 | 245 | ||
247 | *status = 0; | 246 | *status = 0; |
@@ -267,7 +266,7 @@ static int ves1820_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
267 | 266 | ||
268 | static int ves1820_read_ber(struct dvb_frontend* fe, u32* ber) | 267 | static int ves1820_read_ber(struct dvb_frontend* fe, u32* ber) |
269 | { | 268 | { |
270 | struct ves1820_state* state = (struct ves1820_state*) fe->demodulator_priv; | 269 | struct ves1820_state* state = fe->demodulator_priv; |
271 | 270 | ||
272 | u32 _ber = ves1820_readreg(state, 0x14) | | 271 | u32 _ber = ves1820_readreg(state, 0x14) | |
273 | (ves1820_readreg(state, 0x15) << 8) | | 272 | (ves1820_readreg(state, 0x15) << 8) | |
@@ -279,7 +278,7 @@ static int ves1820_read_ber(struct dvb_frontend* fe, u32* ber) | |||
279 | 278 | ||
280 | static int ves1820_read_signal_strength(struct dvb_frontend* fe, u16* strength) | 279 | static int ves1820_read_signal_strength(struct dvb_frontend* fe, u16* strength) |
281 | { | 280 | { |
282 | struct ves1820_state* state = (struct ves1820_state*) fe->demodulator_priv; | 281 | struct ves1820_state* state = fe->demodulator_priv; |
283 | 282 | ||
284 | u8 gain = ves1820_readreg(state, 0x17); | 283 | u8 gain = ves1820_readreg(state, 0x17); |
285 | *strength = (gain << 8) | gain; | 284 | *strength = (gain << 8) | gain; |
@@ -289,7 +288,7 @@ static int ves1820_read_signal_strength(struct dvb_frontend* fe, u16* strength) | |||
289 | 288 | ||
290 | static int ves1820_read_snr(struct dvb_frontend* fe, u16* snr) | 289 | static int ves1820_read_snr(struct dvb_frontend* fe, u16* snr) |
291 | { | 290 | { |
292 | struct ves1820_state* state = (struct ves1820_state*) fe->demodulator_priv; | 291 | struct ves1820_state* state = fe->demodulator_priv; |
293 | 292 | ||
294 | u8 quality = ~ves1820_readreg(state, 0x18); | 293 | u8 quality = ~ves1820_readreg(state, 0x18); |
295 | *snr = (quality << 8) | quality; | 294 | *snr = (quality << 8) | quality; |
@@ -299,7 +298,7 @@ static int ves1820_read_snr(struct dvb_frontend* fe, u16* snr) | |||
299 | 298 | ||
300 | static int ves1820_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | 299 | static int ves1820_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) |
301 | { | 300 | { |
302 | struct ves1820_state* state = (struct ves1820_state*) fe->demodulator_priv; | 301 | struct ves1820_state* state = fe->demodulator_priv; |
303 | 302 | ||
304 | *ucblocks = ves1820_readreg(state, 0x13) & 0x7f; | 303 | *ucblocks = ves1820_readreg(state, 0x13) & 0x7f; |
305 | if (*ucblocks == 0x7f) | 304 | if (*ucblocks == 0x7f) |
@@ -314,7 +313,7 @@ static int ves1820_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | |||
314 | 313 | ||
315 | static int ves1820_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 314 | static int ves1820_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
316 | { | 315 | { |
317 | struct ves1820_state* state = (struct ves1820_state*) fe->demodulator_priv; | 316 | struct ves1820_state* state = fe->demodulator_priv; |
318 | int sync; | 317 | int sync; |
319 | s8 afc = 0; | 318 | s8 afc = 0; |
320 | 319 | ||
@@ -345,7 +344,7 @@ static int ves1820_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
345 | 344 | ||
346 | static int ves1820_sleep(struct dvb_frontend* fe) | 345 | static int ves1820_sleep(struct dvb_frontend* fe) |
347 | { | 346 | { |
348 | struct ves1820_state* state = (struct ves1820_state*) fe->demodulator_priv; | 347 | struct ves1820_state* state = fe->demodulator_priv; |
349 | 348 | ||
350 | ves1820_writereg(state, 0x1b, 0x02); /* pdown ADC */ | 349 | ves1820_writereg(state, 0x1b, 0x02); /* pdown ADC */ |
351 | ves1820_writereg(state, 0x00, 0x80); /* standby */ | 350 | ves1820_writereg(state, 0x00, 0x80); /* standby */ |
@@ -364,7 +363,7 @@ static int ves1820_get_tune_settings(struct dvb_frontend* fe, struct dvb_fronten | |||
364 | 363 | ||
365 | static void ves1820_release(struct dvb_frontend* fe) | 364 | static void ves1820_release(struct dvb_frontend* fe) |
366 | { | 365 | { |
367 | struct ves1820_state* state = (struct ves1820_state*) fe->demodulator_priv; | 366 | struct ves1820_state* state = fe->demodulator_priv; |
368 | kfree(state); | 367 | kfree(state); |
369 | } | 368 | } |
370 | 369 | ||
@@ -377,7 +376,7 @@ struct dvb_frontend* ves1820_attach(const struct ves1820_config* config, | |||
377 | struct ves1820_state* state = NULL; | 376 | struct ves1820_state* state = NULL; |
378 | 377 | ||
379 | /* allocate memory for the internal state */ | 378 | /* allocate memory for the internal state */ |
380 | state = (struct ves1820_state*) kmalloc(sizeof(struct ves1820_state), GFP_KERNEL); | 379 | state = kmalloc(sizeof(struct ves1820_state), GFP_KERNEL); |
381 | if (state == NULL) | 380 | if (state == NULL) |
382 | goto error; | 381 | goto error; |
383 | 382 | ||
diff --git a/drivers/media/dvb/frontends/ves1x93.c b/drivers/media/dvb/frontends/ves1x93.c index edcad283aa86..821df8e839d0 100644 --- a/drivers/media/dvb/frontends/ves1x93.c +++ b/drivers/media/dvb/frontends/ves1x93.c | |||
@@ -263,7 +263,7 @@ static int ves1x93_set_symbolrate (struct ves1x93_state* state, u32 srate) | |||
263 | 263 | ||
264 | static int ves1x93_init (struct dvb_frontend* fe) | 264 | static int ves1x93_init (struct dvb_frontend* fe) |
265 | { | 265 | { |
266 | struct ves1x93_state* state = (struct ves1x93_state*) fe->demodulator_priv; | 266 | struct ves1x93_state* state = fe->demodulator_priv; |
267 | int i; | 267 | int i; |
268 | int val; | 268 | int val; |
269 | 269 | ||
@@ -289,7 +289,7 @@ static int ves1x93_init (struct dvb_frontend* fe) | |||
289 | 289 | ||
290 | static int ves1x93_set_voltage (struct dvb_frontend* fe, fe_sec_voltage_t voltage) | 290 | static int ves1x93_set_voltage (struct dvb_frontend* fe, fe_sec_voltage_t voltage) |
291 | { | 291 | { |
292 | struct ves1x93_state* state = (struct ves1x93_state*) fe->demodulator_priv; | 292 | struct ves1x93_state* state = fe->demodulator_priv; |
293 | 293 | ||
294 | switch (voltage) { | 294 | switch (voltage) { |
295 | case SEC_VOLTAGE_13: | 295 | case SEC_VOLTAGE_13: |
@@ -305,7 +305,7 @@ static int ves1x93_set_voltage (struct dvb_frontend* fe, fe_sec_voltage_t voltag | |||
305 | 305 | ||
306 | static int ves1x93_read_status(struct dvb_frontend* fe, fe_status_t* status) | 306 | static int ves1x93_read_status(struct dvb_frontend* fe, fe_status_t* status) |
307 | { | 307 | { |
308 | struct ves1x93_state* state = (struct ves1x93_state*) fe->demodulator_priv; | 308 | struct ves1x93_state* state = fe->demodulator_priv; |
309 | 309 | ||
310 | u8 sync = ves1x93_readreg (state, 0x0e); | 310 | u8 sync = ves1x93_readreg (state, 0x0e); |
311 | 311 | ||
@@ -346,7 +346,7 @@ static int ves1x93_read_status(struct dvb_frontend* fe, fe_status_t* status) | |||
346 | 346 | ||
347 | static int ves1x93_read_ber(struct dvb_frontend* fe, u32* ber) | 347 | static int ves1x93_read_ber(struct dvb_frontend* fe, u32* ber) |
348 | { | 348 | { |
349 | struct ves1x93_state* state = (struct ves1x93_state*) fe->demodulator_priv; | 349 | struct ves1x93_state* state = fe->demodulator_priv; |
350 | 350 | ||
351 | *ber = ves1x93_readreg (state, 0x15); | 351 | *ber = ves1x93_readreg (state, 0x15); |
352 | *ber |= (ves1x93_readreg (state, 0x16) << 8); | 352 | *ber |= (ves1x93_readreg (state, 0x16) << 8); |
@@ -358,7 +358,7 @@ static int ves1x93_read_ber(struct dvb_frontend* fe, u32* ber) | |||
358 | 358 | ||
359 | static int ves1x93_read_signal_strength(struct dvb_frontend* fe, u16* strength) | 359 | static int ves1x93_read_signal_strength(struct dvb_frontend* fe, u16* strength) |
360 | { | 360 | { |
361 | struct ves1x93_state* state = (struct ves1x93_state*) fe->demodulator_priv; | 361 | struct ves1x93_state* state = fe->demodulator_priv; |
362 | 362 | ||
363 | u8 signal = ~ves1x93_readreg (state, 0x0b); | 363 | u8 signal = ~ves1x93_readreg (state, 0x0b); |
364 | *strength = (signal << 8) | signal; | 364 | *strength = (signal << 8) | signal; |
@@ -368,7 +368,7 @@ static int ves1x93_read_signal_strength(struct dvb_frontend* fe, u16* strength) | |||
368 | 368 | ||
369 | static int ves1x93_read_snr(struct dvb_frontend* fe, u16* snr) | 369 | static int ves1x93_read_snr(struct dvb_frontend* fe, u16* snr) |
370 | { | 370 | { |
371 | struct ves1x93_state* state = (struct ves1x93_state*) fe->demodulator_priv; | 371 | struct ves1x93_state* state = fe->demodulator_priv; |
372 | 372 | ||
373 | u8 _snr = ~ves1x93_readreg (state, 0x1c); | 373 | u8 _snr = ~ves1x93_readreg (state, 0x1c); |
374 | *snr = (_snr << 8) | _snr; | 374 | *snr = (_snr << 8) | _snr; |
@@ -378,7 +378,7 @@ static int ves1x93_read_snr(struct dvb_frontend* fe, u16* snr) | |||
378 | 378 | ||
379 | static int ves1x93_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | 379 | static int ves1x93_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) |
380 | { | 380 | { |
381 | struct ves1x93_state* state = (struct ves1x93_state*) fe->demodulator_priv; | 381 | struct ves1x93_state* state = fe->demodulator_priv; |
382 | 382 | ||
383 | *ucblocks = ves1x93_readreg (state, 0x18) & 0x7f; | 383 | *ucblocks = ves1x93_readreg (state, 0x18) & 0x7f; |
384 | 384 | ||
@@ -393,7 +393,7 @@ static int ves1x93_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks) | |||
393 | 393 | ||
394 | static int ves1x93_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 394 | static int ves1x93_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
395 | { | 395 | { |
396 | struct ves1x93_state* state = (struct ves1x93_state*) fe->demodulator_priv; | 396 | struct ves1x93_state* state = fe->demodulator_priv; |
397 | 397 | ||
398 | ves1x93_writereg(state, 0x00, 0x11); | 398 | ves1x93_writereg(state, 0x00, 0x11); |
399 | state->config->pll_set(fe, p); | 399 | state->config->pll_set(fe, p); |
@@ -408,7 +408,7 @@ static int ves1x93_set_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
408 | 408 | ||
409 | static int ves1x93_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) | 409 | static int ves1x93_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *p) |
410 | { | 410 | { |
411 | struct ves1x93_state* state = (struct ves1x93_state*) fe->demodulator_priv; | 411 | struct ves1x93_state* state = fe->demodulator_priv; |
412 | int afc; | 412 | int afc; |
413 | 413 | ||
414 | afc = ((int)((char)(ves1x93_readreg (state, 0x0a) << 1)))/2; | 414 | afc = ((int)((char)(ves1x93_readreg (state, 0x0a) << 1)))/2; |
@@ -431,14 +431,14 @@ static int ves1x93_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_par | |||
431 | 431 | ||
432 | static int ves1x93_sleep(struct dvb_frontend* fe) | 432 | static int ves1x93_sleep(struct dvb_frontend* fe) |
433 | { | 433 | { |
434 | struct ves1x93_state* state = (struct ves1x93_state*) fe->demodulator_priv; | 434 | struct ves1x93_state* state = fe->demodulator_priv; |
435 | 435 | ||
436 | return ves1x93_writereg (state, 0x00, 0x08); | 436 | return ves1x93_writereg (state, 0x00, 0x08); |
437 | } | 437 | } |
438 | 438 | ||
439 | static void ves1x93_release(struct dvb_frontend* fe) | 439 | static void ves1x93_release(struct dvb_frontend* fe) |
440 | { | 440 | { |
441 | struct ves1x93_state* state = (struct ves1x93_state*) fe->demodulator_priv; | 441 | struct ves1x93_state* state = fe->demodulator_priv; |
442 | kfree(state); | 442 | kfree(state); |
443 | } | 443 | } |
444 | 444 | ||
@@ -451,7 +451,7 @@ struct dvb_frontend* ves1x93_attach(const struct ves1x93_config* config, | |||
451 | u8 identity; | 451 | u8 identity; |
452 | 452 | ||
453 | /* allocate memory for the internal state */ | 453 | /* allocate memory for the internal state */ |
454 | state = (struct ves1x93_state*) kmalloc(sizeof(struct ves1x93_state), GFP_KERNEL); | 454 | state = kmalloc(sizeof(struct ves1x93_state), GFP_KERNEL); |
455 | if (state == NULL) goto error; | 455 | if (state == NULL) goto error; |
456 | 456 | ||
457 | /* setup the state */ | 457 | /* setup the state */ |
diff --git a/drivers/media/dvb/ttpci/av7110.c b/drivers/media/dvb/ttpci/av7110.c index 922c205a2652..8e33a850e13e 100644 --- a/drivers/media/dvb/ttpci/av7110.c +++ b/drivers/media/dvb/ttpci/av7110.c | |||
@@ -130,7 +130,7 @@ static void init_av7110_av(struct av7110 *av7110) | |||
130 | av7110->current_input = 0; | 130 | av7110->current_input = 0; |
131 | if (i2c_writereg(av7110, 0x20, 0x00, 0x00) == 1) { | 131 | if (i2c_writereg(av7110, 0x20, 0x00, 0x00) == 1) { |
132 | printk ("dvb-ttpci: Crystal audio DAC @ card %d detected\n", | 132 | printk ("dvb-ttpci: Crystal audio DAC @ card %d detected\n", |
133 | av7110->dvb_adapter->num); | 133 | av7110->dvb_adapter.num); |
134 | av7110->adac_type = DVB_ADAC_CRYSTAL; | 134 | av7110->adac_type = DVB_ADAC_CRYSTAL; |
135 | i2c_writereg(av7110, 0x20, 0x01, 0xd2); | 135 | i2c_writereg(av7110, 0x20, 0x01, 0xd2); |
136 | i2c_writereg(av7110, 0x20, 0x02, 0x49); | 136 | i2c_writereg(av7110, 0x20, 0x02, 0x49); |
@@ -145,13 +145,13 @@ static void init_av7110_av(struct av7110 *av7110) | |||
145 | } | 145 | } |
146 | else if (dev->pci->subsystem_vendor == 0x110a) { | 146 | else if (dev->pci->subsystem_vendor == 0x110a) { |
147 | printk("dvb-ttpci: DVB-C w/o analog module @ card %d detected\n", | 147 | printk("dvb-ttpci: DVB-C w/o analog module @ card %d detected\n", |
148 | av7110->dvb_adapter->num); | 148 | av7110->dvb_adapter.num); |
149 | av7110->adac_type = DVB_ADAC_NONE; | 149 | av7110->adac_type = DVB_ADAC_NONE; |
150 | } | 150 | } |
151 | else { | 151 | else { |
152 | av7110->adac_type = adac; | 152 | av7110->adac_type = adac; |
153 | printk("dvb-ttpci: adac type set to %d @ card %d\n", | 153 | printk("dvb-ttpci: adac type set to %d @ card %d\n", |
154 | av7110->dvb_adapter->num, av7110->adac_type); | 154 | av7110->dvb_adapter.num, av7110->adac_type); |
155 | } | 155 | } |
156 | 156 | ||
157 | if (av7110->adac_type == DVB_ADAC_NONE || av7110->adac_type == DVB_ADAC_MSP) { | 157 | if (av7110->adac_type == DVB_ADAC_NONE || av7110->adac_type == DVB_ADAC_MSP) { |
@@ -231,7 +231,7 @@ static int arm_thread(void *data) | |||
231 | 231 | ||
232 | if (newloops == av7110->arm_loops) { | 232 | if (newloops == av7110->arm_loops) { |
233 | printk(KERN_ERR "dvb-ttpci: ARM crashed @ card %d\n", | 233 | printk(KERN_ERR "dvb-ttpci: ARM crashed @ card %d\n", |
234 | av7110->dvb_adapter->num); | 234 | av7110->dvb_adapter.num); |
235 | 235 | ||
236 | arm_error(av7110); | 236 | arm_error(av7110); |
237 | av7710_set_video_mode(av7110, vidmode); | 237 | av7710_set_video_mode(av7110, vidmode); |
@@ -1282,7 +1282,7 @@ static int av7110_register(struct av7110 *av7110) | |||
1282 | av7110->dmxdev.demux = &dvbdemux->dmx; | 1282 | av7110->dmxdev.demux = &dvbdemux->dmx; |
1283 | av7110->dmxdev.capabilities = 0; | 1283 | av7110->dmxdev.capabilities = 0; |
1284 | 1284 | ||
1285 | dvb_dmxdev_init(&av7110->dmxdev, av7110->dvb_adapter); | 1285 | dvb_dmxdev_init(&av7110->dmxdev, &av7110->dvb_adapter); |
1286 | 1286 | ||
1287 | av7110->hw_frontend.source = DMX_FRONTEND_0; | 1287 | av7110->hw_frontend.source = DMX_FRONTEND_0; |
1288 | 1288 | ||
@@ -1307,11 +1307,11 @@ static int av7110_register(struct av7110 *av7110) | |||
1307 | av7110_ca_register(av7110); | 1307 | av7110_ca_register(av7110); |
1308 | 1308 | ||
1309 | #ifdef CONFIG_DVB_AV7110_OSD | 1309 | #ifdef CONFIG_DVB_AV7110_OSD |
1310 | dvb_register_device(av7110->dvb_adapter, &av7110->osd_dev, | 1310 | dvb_register_device(&av7110->dvb_adapter, &av7110->osd_dev, |
1311 | &dvbdev_osd, av7110, DVB_DEVICE_OSD); | 1311 | &dvbdev_osd, av7110, DVB_DEVICE_OSD); |
1312 | #endif | 1312 | #endif |
1313 | 1313 | ||
1314 | dvb_net_init(av7110->dvb_adapter, &av7110->dvb_net, &dvbdemux->dmx); | 1314 | dvb_net_init(&av7110->dvb_adapter, &av7110->dvb_net, &dvbdemux->dmx); |
1315 | 1315 | ||
1316 | if (budgetpatch) { | 1316 | if (budgetpatch) { |
1317 | /* initialize software demux1 without its own frontend | 1317 | /* initialize software demux1 without its own frontend |
@@ -1334,9 +1334,9 @@ static int av7110_register(struct av7110 *av7110) | |||
1334 | av7110->dmxdev1.demux = &dvbdemux1->dmx; | 1334 | av7110->dmxdev1.demux = &dvbdemux1->dmx; |
1335 | av7110->dmxdev1.capabilities = 0; | 1335 | av7110->dmxdev1.capabilities = 0; |
1336 | 1336 | ||
1337 | dvb_dmxdev_init(&av7110->dmxdev1, av7110->dvb_adapter); | 1337 | dvb_dmxdev_init(&av7110->dmxdev1, &av7110->dvb_adapter); |
1338 | 1338 | ||
1339 | dvb_net_init(av7110->dvb_adapter, &av7110->dvb_net1, &dvbdemux1->dmx); | 1339 | dvb_net_init(&av7110->dvb_adapter, &av7110->dvb_net1, &dvbdemux1->dmx); |
1340 | printk("dvb-ttpci: additional demux1 for budget-patch registered\n"); | 1340 | printk("dvb-ttpci: additional demux1 for budget-patch registered\n"); |
1341 | } | 1341 | } |
1342 | return 0; | 1342 | return 0; |
@@ -1673,6 +1673,106 @@ static struct stv0299_config alps_bsru6_config = { | |||
1673 | }; | 1673 | }; |
1674 | 1674 | ||
1675 | 1675 | ||
1676 | static u8 alps_bsbe1_inittab[] = { | ||
1677 | 0x01, 0x15, | ||
1678 | 0x02, 0x30, | ||
1679 | 0x03, 0x00, | ||
1680 | 0x04, 0x7d, /* F22FR = 0x7d, F22 = f_VCO / 128 / 0x7d = 22 kHz */ | ||
1681 | 0x05, 0x35, /* I2CT = 0, SCLT = 1, SDAT = 1 */ | ||
1682 | 0x06, 0x40, /* DAC not used, set to high impendance mode */ | ||
1683 | 0x07, 0x00, /* DAC LSB */ | ||
1684 | 0x08, 0x40, /* DiSEqC off, LNB power on OP2/LOCK pin on */ | ||
1685 | 0x09, 0x00, /* FIFO */ | ||
1686 | 0x0c, 0x51, /* OP1 ctl = Normal, OP1 val = 1 (LNB Power ON) */ | ||
1687 | 0x0d, 0x82, /* DC offset compensation = ON, beta_agc1 = 2 */ | ||
1688 | 0x0e, 0x23, /* alpha_tmg = 2, beta_tmg = 3 */ | ||
1689 | 0x10, 0x3f, // AGC2 0x3d | ||
1690 | 0x11, 0x84, | ||
1691 | 0x12, 0xb5, // Lock detect: -64 Carrier freq detect:on | ||
1692 | 0x15, 0xc9, // lock detector threshold | ||
1693 | 0x16, 0x00, | ||
1694 | 0x17, 0x00, | ||
1695 | 0x18, 0x00, | ||
1696 | 0x19, 0x00, | ||
1697 | 0x1a, 0x00, | ||
1698 | 0x1f, 0x50, | ||
1699 | 0x20, 0x00, | ||
1700 | 0x21, 0x00, | ||
1701 | 0x22, 0x00, | ||
1702 | 0x23, 0x00, | ||
1703 | 0x28, 0x00, // out imp: normal out type: parallel FEC mode:0 | ||
1704 | 0x29, 0x1e, // 1/2 threshold | ||
1705 | 0x2a, 0x14, // 2/3 threshold | ||
1706 | 0x2b, 0x0f, // 3/4 threshold | ||
1707 | 0x2c, 0x09, // 5/6 threshold | ||
1708 | 0x2d, 0x05, // 7/8 threshold | ||
1709 | 0x2e, 0x01, | ||
1710 | 0x31, 0x1f, // test all FECs | ||
1711 | 0x32, 0x19, // viterbi and synchro search | ||
1712 | 0x33, 0xfc, // rs control | ||
1713 | 0x34, 0x93, // error control | ||
1714 | 0x0f, 0x92, | ||
1715 | 0xff, 0xff | ||
1716 | }; | ||
1717 | |||
1718 | static int alps_bsbe1_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params) | ||
1719 | { | ||
1720 | struct av7110* av7110 = (struct av7110*) fe->dvb->priv; | ||
1721 | int ret; | ||
1722 | u8 data[4]; | ||
1723 | u32 div; | ||
1724 | struct i2c_msg msg = { .addr = 0x61, .flags = 0, .buf = data, .len = sizeof(data) }; | ||
1725 | |||
1726 | if ((params->frequency < 950000) || (params->frequency > 2150000)) | ||
1727 | return -EINVAL; | ||
1728 | |||
1729 | div = (params->frequency + (125 - 1)) / 125; // round correctly | ||
1730 | data[0] = (div >> 8) & 0x7f; | ||
1731 | data[1] = div & 0xff; | ||
1732 | data[2] = 0x80 | ((div & 0x18000) >> 10) | 4; | ||
1733 | data[3] = (params->frequency > 1530000) ? 0xE0 : 0xE4; | ||
1734 | |||
1735 | ret = i2c_transfer(&av7110->i2c_adap, &msg, 1); | ||
1736 | return (ret != 1) ? -EIO : 0; | ||
1737 | } | ||
1738 | |||
1739 | static struct stv0299_config alps_bsbe1_config = { | ||
1740 | .demod_address = 0x68, | ||
1741 | .inittab = alps_bsbe1_inittab, | ||
1742 | .mclk = 88000000UL, | ||
1743 | .invert = 1, | ||
1744 | .enhanced_tuning = 0, | ||
1745 | .skip_reinit = 0, | ||
1746 | .min_delay_ms = 100, | ||
1747 | .set_symbol_rate = alps_bsru6_set_symbol_rate, | ||
1748 | .pll_set = alps_bsbe1_pll_set, | ||
1749 | }; | ||
1750 | |||
1751 | static int lnbp21_set_voltage(struct dvb_frontend* fe, fe_sec_voltage_t voltage) | ||
1752 | { | ||
1753 | struct av7110* av7110 = (struct av7110*) fe->dvb->priv; | ||
1754 | int ret; | ||
1755 | u8 data[1]; | ||
1756 | struct i2c_msg msg = { .addr = 0x08, .flags = 0, .buf = data, .len = sizeof(data) }; | ||
1757 | |||
1758 | switch(voltage) { | ||
1759 | case SEC_VOLTAGE_OFF: | ||
1760 | data[0] = 0x00; | ||
1761 | break; | ||
1762 | case SEC_VOLTAGE_13: | ||
1763 | data[0] = 0x44; | ||
1764 | break; | ||
1765 | case SEC_VOLTAGE_18: | ||
1766 | data[0] = 0x4c; | ||
1767 | break; | ||
1768 | default: | ||
1769 | return -EINVAL; | ||
1770 | }; | ||
1771 | |||
1772 | ret = i2c_transfer(&av7110->i2c_adap, &msg, 1); | ||
1773 | return (ret != 1) ? -EIO : 0; | ||
1774 | } | ||
1775 | |||
1676 | 1776 | ||
1677 | static int alps_tdbe2_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params) | 1777 | static int alps_tdbe2_pll_set(struct dvb_frontend* fe, struct dvb_frontend_parameters* params) |
1678 | { | 1778 | { |
@@ -2116,6 +2216,14 @@ static int frontend_init(struct av7110 *av7110) | |||
2116 | av7110->dev->i2c_bitrate = SAA7146_I2C_BUS_BIT_RATE_240; | 2216 | av7110->dev->i2c_bitrate = SAA7146_I2C_BUS_BIT_RATE_240; |
2117 | break; | 2217 | break; |
2118 | } | 2218 | } |
2219 | break; | ||
2220 | |||
2221 | case 0x000E: /* Hauppauge/TT Nexus-S rev 2.3 */ | ||
2222 | /* ALPS BSBE1 */ | ||
2223 | av7110->fe = stv0299_attach(&alps_bsbe1_config, &av7110->i2c_adap); | ||
2224 | if (av7110->fe) | ||
2225 | av7110->fe->ops->set_voltage = lnbp21_set_voltage; | ||
2226 | break; | ||
2119 | } | 2227 | } |
2120 | } | 2228 | } |
2121 | 2229 | ||
@@ -2138,7 +2246,7 @@ static int frontend_init(struct av7110 *av7110) | |||
2138 | FE_FUNC_OVERRIDE(av7110->fe->ops->dishnetwork_send_legacy_command, av7110->fe_dishnetwork_send_legacy_command, av7110_fe_dishnetwork_send_legacy_command); | 2246 | FE_FUNC_OVERRIDE(av7110->fe->ops->dishnetwork_send_legacy_command, av7110->fe_dishnetwork_send_legacy_command, av7110_fe_dishnetwork_send_legacy_command); |
2139 | FE_FUNC_OVERRIDE(av7110->fe->ops->set_frontend, av7110->fe_set_frontend, av7110_fe_set_frontend); | 2247 | FE_FUNC_OVERRIDE(av7110->fe->ops->set_frontend, av7110->fe_set_frontend, av7110_fe_set_frontend); |
2140 | 2248 | ||
2141 | ret = dvb_register_frontend(av7110->dvb_adapter, av7110->fe); | 2249 | ret = dvb_register_frontend(&av7110->dvb_adapter, av7110->fe); |
2142 | if (ret < 0) { | 2250 | if (ret < 0) { |
2143 | printk("av7110: Frontend registration failed!\n"); | 2251 | printk("av7110: Frontend registration failed!\n"); |
2144 | if (av7110->fe->ops->release) | 2252 | if (av7110->fe->ops->release) |
@@ -2352,7 +2460,7 @@ static int av7110_attach(struct saa7146_dev* dev, struct saa7146_pci_extension_d | |||
2352 | goto err_dvb_unregister_adapter_2; | 2460 | goto err_dvb_unregister_adapter_2; |
2353 | 2461 | ||
2354 | ttpci_eeprom_parse_mac(&av7110->i2c_adap, | 2462 | ttpci_eeprom_parse_mac(&av7110->i2c_adap, |
2355 | av7110->dvb_adapter->proposed_mac); | 2463 | av7110->dvb_adapter.proposed_mac); |
2356 | ret = -ENOMEM; | 2464 | ret = -ENOMEM; |
2357 | 2465 | ||
2358 | if (budgetpatch) { | 2466 | if (budgetpatch) { |
@@ -2523,7 +2631,7 @@ static int av7110_attach(struct saa7146_dev* dev, struct saa7146_pci_extension_d | |||
2523 | if (ret < 0) | 2631 | if (ret < 0) |
2524 | goto err_av7110_unregister_11; | 2632 | goto err_av7110_unregister_11; |
2525 | 2633 | ||
2526 | av7110->dvb_adapter->priv = av7110; | 2634 | av7110->dvb_adapter.priv = av7110; |
2527 | ret = frontend_init(av7110); | 2635 | ret = frontend_init(av7110); |
2528 | if (ret < 0) | 2636 | if (ret < 0) |
2529 | goto err_av7110_exit_v4l_12; | 2637 | goto err_av7110_exit_v4l_12; |
@@ -2558,7 +2666,7 @@ err_saa71466_vfree_4: | |||
2558 | err_i2c_del_3: | 2666 | err_i2c_del_3: |
2559 | i2c_del_adapter(&av7110->i2c_adap); | 2667 | i2c_del_adapter(&av7110->i2c_adap); |
2560 | err_dvb_unregister_adapter_2: | 2668 | err_dvb_unregister_adapter_2: |
2561 | dvb_unregister_adapter(av7110->dvb_adapter); | 2669 | dvb_unregister_adapter(&av7110->dvb_adapter); |
2562 | err_put_firmware_1: | 2670 | err_put_firmware_1: |
2563 | put_firmware(av7110); | 2671 | put_firmware(av7110); |
2564 | err_kfree_0: | 2672 | err_kfree_0: |
@@ -2604,7 +2712,7 @@ static int av7110_detach(struct saa7146_dev* saa) | |||
2604 | 2712 | ||
2605 | i2c_del_adapter(&av7110->i2c_adap); | 2713 | i2c_del_adapter(&av7110->i2c_adap); |
2606 | 2714 | ||
2607 | dvb_unregister_adapter (av7110->dvb_adapter); | 2715 | dvb_unregister_adapter (&av7110->dvb_adapter); |
2608 | 2716 | ||
2609 | av7110_num--; | 2717 | av7110_num--; |
2610 | 2718 | ||
@@ -2672,21 +2780,23 @@ MAKE_AV7110_INFO(ttt_1_X, "Technotrend/Hauppauge WinTV DVB-T rev1.X"); | |||
2672 | MAKE_AV7110_INFO(ttc_1_X, "Technotrend/Hauppauge WinTV Nexus-CA rev1.X"); | 2780 | MAKE_AV7110_INFO(ttc_1_X, "Technotrend/Hauppauge WinTV Nexus-CA rev1.X"); |
2673 | MAKE_AV7110_INFO(ttc_2_X, "Technotrend/Hauppauge WinTV DVB-C rev2.X"); | 2781 | MAKE_AV7110_INFO(ttc_2_X, "Technotrend/Hauppauge WinTV DVB-C rev2.X"); |
2674 | MAKE_AV7110_INFO(tts_2_X, "Technotrend/Hauppauge WinTV Nexus-S rev2.X"); | 2782 | MAKE_AV7110_INFO(tts_2_X, "Technotrend/Hauppauge WinTV Nexus-S rev2.X"); |
2783 | MAKE_AV7110_INFO(tts_2_3, "Technotrend/Hauppauge WinTV Nexus-S rev2.3"); | ||
2675 | MAKE_AV7110_INFO(tts_1_3se, "Technotrend/Hauppauge WinTV DVB-S rev1.3 SE"); | 2784 | MAKE_AV7110_INFO(tts_1_3se, "Technotrend/Hauppauge WinTV DVB-S rev1.3 SE"); |
2676 | MAKE_AV7110_INFO(ttt, "Technotrend/Hauppauge DVB-T"); | 2785 | MAKE_AV7110_INFO(ttt, "Technotrend/Hauppauge DVB-T"); |
2677 | MAKE_AV7110_INFO(fsc, "Fujitsu Siemens DVB-C"); | 2786 | MAKE_AV7110_INFO(fsc, "Fujitsu Siemens DVB-C"); |
2678 | MAKE_AV7110_INFO(fss, "Fujitsu Siemens DVB-S rev1.6"); | 2787 | MAKE_AV7110_INFO(fss, "Fujitsu Siemens DVB-S rev1.6"); |
2679 | 2788 | ||
2680 | static struct pci_device_id pci_tbl[] = { | 2789 | static struct pci_device_id pci_tbl[] = { |
2790 | MAKE_EXTENSION_PCI(fsc, 0x110a, 0x0000), | ||
2681 | MAKE_EXTENSION_PCI(tts_1_X, 0x13c2, 0x0000), | 2791 | MAKE_EXTENSION_PCI(tts_1_X, 0x13c2, 0x0000), |
2682 | MAKE_EXTENSION_PCI(ttt_1_X, 0x13c2, 0x0001), | 2792 | MAKE_EXTENSION_PCI(ttt_1_X, 0x13c2, 0x0001), |
2683 | MAKE_EXTENSION_PCI(ttc_2_X, 0x13c2, 0x0002), | 2793 | MAKE_EXTENSION_PCI(ttc_2_X, 0x13c2, 0x0002), |
2684 | MAKE_EXTENSION_PCI(tts_2_X, 0x13c2, 0x0003), | 2794 | MAKE_EXTENSION_PCI(tts_2_X, 0x13c2, 0x0003), |
2685 | MAKE_EXTENSION_PCI(tts_1_3se, 0x13c2, 0x1002), | ||
2686 | MAKE_EXTENSION_PCI(fsc, 0x110a, 0x0000), | ||
2687 | MAKE_EXTENSION_PCI(ttc_1_X, 0x13c2, 0x000a), | ||
2688 | MAKE_EXTENSION_PCI(fss, 0x13c2, 0x0006), | 2795 | MAKE_EXTENSION_PCI(fss, 0x13c2, 0x0006), |
2689 | MAKE_EXTENSION_PCI(ttt, 0x13c2, 0x0008), | 2796 | MAKE_EXTENSION_PCI(ttt, 0x13c2, 0x0008), |
2797 | MAKE_EXTENSION_PCI(ttc_1_X, 0x13c2, 0x000a), | ||
2798 | MAKE_EXTENSION_PCI(tts_2_3, 0x13c2, 0x000e), | ||
2799 | MAKE_EXTENSION_PCI(tts_1_3se, 0x13c2, 0x1002), | ||
2690 | 2800 | ||
2691 | /* MAKE_EXTENSION_PCI(???, 0x13c2, 0x0004), UNDEFINED CARD */ // Galaxis DVB PC-Sat-Carte | 2801 | /* MAKE_EXTENSION_PCI(???, 0x13c2, 0x0004), UNDEFINED CARD */ // Galaxis DVB PC-Sat-Carte |
2692 | /* MAKE_EXTENSION_PCI(???, 0x13c2, 0x0005), UNDEFINED CARD */ // Technisat SkyStar1 | 2802 | /* MAKE_EXTENSION_PCI(???, 0x13c2, 0x0005), UNDEFINED CARD */ // Technisat SkyStar1 |
diff --git a/drivers/media/dvb/ttpci/av7110.h b/drivers/media/dvb/ttpci/av7110.h index 5070e0523da7..4f69b4d01479 100644 --- a/drivers/media/dvb/ttpci/av7110.h +++ b/drivers/media/dvb/ttpci/av7110.h | |||
@@ -220,7 +220,7 @@ struct av7110 { | |||
220 | 220 | ||
221 | struct audio_mixer mixer; | 221 | struct audio_mixer mixer; |
222 | 222 | ||
223 | struct dvb_adapter *dvb_adapter; | 223 | struct dvb_adapter dvb_adapter; |
224 | struct dvb_device *video_dev; | 224 | struct dvb_device *video_dev; |
225 | struct dvb_device *audio_dev; | 225 | struct dvb_device *audio_dev; |
226 | struct dvb_device *ca_dev; | 226 | struct dvb_device *ca_dev; |
@@ -274,7 +274,6 @@ extern void av7110_ir_exit (void); | |||
274 | extern int i2c_writereg(struct av7110 *av7110, u8 id, u8 reg, u8 val); | 274 | extern int i2c_writereg(struct av7110 *av7110, u8 id, u8 reg, u8 val); |
275 | extern u8 i2c_readreg(struct av7110 *av7110, u8 id, u8 reg); | 275 | extern u8 i2c_readreg(struct av7110 *av7110, u8 id, u8 reg); |
276 | extern int msp_writereg(struct av7110 *av7110, u8 dev, u16 reg, u16 val); | 276 | extern int msp_writereg(struct av7110 *av7110, u8 dev, u16 reg, u16 val); |
277 | extern int msp_readreg(struct av7110 *av7110, u8 dev, u16 reg, u16 *val); | ||
278 | 277 | ||
279 | 278 | ||
280 | extern int av7110_init_analog_module(struct av7110 *av7110); | 279 | extern int av7110_init_analog_module(struct av7110 *av7110); |
diff --git a/drivers/media/dvb/ttpci/av7110_av.c b/drivers/media/dvb/ttpci/av7110_av.c index d77e8a00688f..ccf946125d02 100644 --- a/drivers/media/dvb/ttpci/av7110_av.c +++ b/drivers/media/dvb/ttpci/av7110_av.c | |||
@@ -1075,7 +1075,7 @@ static int dvb_video_ioctl(struct inode *inode, struct file *file, | |||
1075 | } | 1075 | } |
1076 | if (ret < 0) | 1076 | if (ret < 0) |
1077 | break; | 1077 | break; |
1078 | av7110->videostate.video_format = format; | 1078 | av7110->videostate.display_format = format; |
1079 | ret = av7110_fw_cmd(av7110, COMTYPE_ENCODER, SetPanScanType, | 1079 | ret = av7110_fw_cmd(av7110, COMTYPE_ENCODER, SetPanScanType, |
1080 | 1, (u16) val); | 1080 | 1, (u16) val); |
1081 | break; | 1081 | break; |
@@ -1230,14 +1230,20 @@ static int dvb_audio_ioctl(struct inode *inode, struct file *file, | |||
1230 | switch(av7110->audiostate.channel_select) { | 1230 | switch(av7110->audiostate.channel_select) { |
1231 | case AUDIO_STEREO: | 1231 | case AUDIO_STEREO: |
1232 | audcom(av7110, AUDIO_CMD_STEREO); | 1232 | audcom(av7110, AUDIO_CMD_STEREO); |
1233 | if (av7110->adac_type == DVB_ADAC_CRYSTAL) | ||
1234 | i2c_writereg(av7110, 0x20, 0x02, 0x49); | ||
1233 | break; | 1235 | break; |
1234 | 1236 | ||
1235 | case AUDIO_MONO_LEFT: | 1237 | case AUDIO_MONO_LEFT: |
1236 | audcom(av7110, AUDIO_CMD_MONO_L); | 1238 | audcom(av7110, AUDIO_CMD_MONO_L); |
1239 | if (av7110->adac_type == DVB_ADAC_CRYSTAL) | ||
1240 | i2c_writereg(av7110, 0x20, 0x02, 0x4a); | ||
1237 | break; | 1241 | break; |
1238 | 1242 | ||
1239 | case AUDIO_MONO_RIGHT: | 1243 | case AUDIO_MONO_RIGHT: |
1240 | audcom(av7110, AUDIO_CMD_MONO_R); | 1244 | audcom(av7110, AUDIO_CMD_MONO_R); |
1245 | if (av7110->adac_type == DVB_ADAC_CRYSTAL) | ||
1246 | i2c_writereg(av7110, 0x20, 0x02, 0x45); | ||
1241 | break; | 1247 | break; |
1242 | 1248 | ||
1243 | default: | 1249 | default: |
@@ -1409,10 +1415,10 @@ int av7110_av_register(struct av7110 *av7110) | |||
1409 | av7110->video_events.overflow = 0; | 1415 | av7110->video_events.overflow = 0; |
1410 | memset(&av7110->video_size, 0, sizeof (video_size_t)); | 1416 | memset(&av7110->video_size, 0, sizeof (video_size_t)); |
1411 | 1417 | ||
1412 | dvb_register_device(av7110->dvb_adapter, &av7110->video_dev, | 1418 | dvb_register_device(&av7110->dvb_adapter, &av7110->video_dev, |
1413 | &dvbdev_video, av7110, DVB_DEVICE_VIDEO); | 1419 | &dvbdev_video, av7110, DVB_DEVICE_VIDEO); |
1414 | 1420 | ||
1415 | dvb_register_device(av7110->dvb_adapter, &av7110->audio_dev, | 1421 | dvb_register_device(&av7110->dvb_adapter, &av7110->audio_dev, |
1416 | &dvbdev_audio, av7110, DVB_DEVICE_AUDIO); | 1422 | &dvbdev_audio, av7110, DVB_DEVICE_AUDIO); |
1417 | 1423 | ||
1418 | return 0; | 1424 | return 0; |
diff --git a/drivers/media/dvb/ttpci/av7110_ca.c b/drivers/media/dvb/ttpci/av7110_ca.c index 21f7aacf7726..c3801e328fe9 100644 --- a/drivers/media/dvb/ttpci/av7110_ca.c +++ b/drivers/media/dvb/ttpci/av7110_ca.c | |||
@@ -123,7 +123,7 @@ static void ci_ll_release(struct dvb_ringbuffer *cirbuf, struct dvb_ringbuffer * | |||
123 | } | 123 | } |
124 | 124 | ||
125 | static int ci_ll_reset(struct dvb_ringbuffer *cibuf, struct file *file, | 125 | static int ci_ll_reset(struct dvb_ringbuffer *cibuf, struct file *file, |
126 | int slots, ca_slot_info_t *slot) | 126 | int slots, ca_slot_info_t *slot) |
127 | { | 127 | { |
128 | int i; | 128 | int i; |
129 | int len = 0; | 129 | int len = 0; |
@@ -370,7 +370,7 @@ static struct dvb_device dvbdev_ca = { | |||
370 | 370 | ||
371 | int av7110_ca_register(struct av7110 *av7110) | 371 | int av7110_ca_register(struct av7110 *av7110) |
372 | { | 372 | { |
373 | return dvb_register_device(av7110->dvb_adapter, &av7110->ca_dev, | 373 | return dvb_register_device(&av7110->dvb_adapter, &av7110->ca_dev, |
374 | &dvbdev_ca, av7110, DVB_DEVICE_CA); | 374 | &dvbdev_ca, av7110, DVB_DEVICE_CA); |
375 | } | 375 | } |
376 | 376 | ||
diff --git a/drivers/media/dvb/ttpci/av7110_hw.c b/drivers/media/dvb/ttpci/av7110_hw.c index bd6e5ea4aefe..7fa4a0ebe133 100644 --- a/drivers/media/dvb/ttpci/av7110_hw.c +++ b/drivers/media/dvb/ttpci/av7110_hw.c | |||
@@ -104,7 +104,7 @@ u32 av7110_debiread(struct av7110 *av7110, u32 config, int addr, int count) | |||
104 | 104 | ||
105 | 105 | ||
106 | /* av7110 ARM core boot stuff */ | 106 | /* av7110 ARM core boot stuff */ |
107 | 107 | #if 0 | |
108 | void av7110_reset_arm(struct av7110 *av7110) | 108 | void av7110_reset_arm(struct av7110 *av7110) |
109 | { | 109 | { |
110 | saa7146_setgpio(av7110->dev, RESET_LINE, SAA7146_GPIO_OUTLO); | 110 | saa7146_setgpio(av7110->dev, RESET_LINE, SAA7146_GPIO_OUTLO); |
@@ -124,7 +124,7 @@ void av7110_reset_arm(struct av7110 *av7110) | |||
124 | av7110->arm_ready = 1; | 124 | av7110->arm_ready = 1; |
125 | dprintk(1, "reset ARM\n"); | 125 | dprintk(1, "reset ARM\n"); |
126 | } | 126 | } |
127 | 127 | #endif /* 0 */ | |
128 | 128 | ||
129 | static int waitdebi(struct av7110 *av7110, int adr, int state) | 129 | static int waitdebi(struct av7110 *av7110, int adr, int state) |
130 | { | 130 | { |
@@ -335,7 +335,7 @@ int av7110_wait_msgstate(struct av7110 *av7110, u16 flags) | |||
335 | return 0; | 335 | return 0; |
336 | } | 336 | } |
337 | 337 | ||
338 | int __av7110_send_fw_cmd(struct av7110 *av7110, u16* buf, int length) | 338 | static int __av7110_send_fw_cmd(struct av7110 *av7110, u16* buf, int length) |
339 | { | 339 | { |
340 | int i; | 340 | int i; |
341 | unsigned long start; | 341 | unsigned long start; |
@@ -455,7 +455,7 @@ int __av7110_send_fw_cmd(struct av7110 *av7110, u16* buf, int length) | |||
455 | return 0; | 455 | return 0; |
456 | } | 456 | } |
457 | 457 | ||
458 | int av7110_send_fw_cmd(struct av7110 *av7110, u16* buf, int length) | 458 | static int av7110_send_fw_cmd(struct av7110 *av7110, u16* buf, int length) |
459 | { | 459 | { |
460 | int ret; | 460 | int ret; |
461 | 461 | ||
@@ -500,6 +500,7 @@ int av7110_fw_cmd(struct av7110 *av7110, int type, int com, int num, ...) | |||
500 | return ret; | 500 | return ret; |
501 | } | 501 | } |
502 | 502 | ||
503 | #if 0 | ||
503 | int av7110_send_ci_cmd(struct av7110 *av7110, u8 subcom, u8 *buf, u8 len) | 504 | int av7110_send_ci_cmd(struct av7110 *av7110, u8 subcom, u8 *buf, u8 len) |
504 | { | 505 | { |
505 | int i, ret; | 506 | int i, ret; |
@@ -521,6 +522,7 @@ int av7110_send_ci_cmd(struct av7110 *av7110, u8 subcom, u8 *buf, u8 len) | |||
521 | printk(KERN_ERR "dvb-ttpci: av7110_send_ci_cmd error %d\n", ret); | 522 | printk(KERN_ERR "dvb-ttpci: av7110_send_ci_cmd error %d\n", ret); |
522 | return ret; | 523 | return ret; |
523 | } | 524 | } |
525 | #endif /* 0 */ | ||
524 | 526 | ||
525 | int av7110_fw_request(struct av7110 *av7110, u16 *request_buf, | 527 | int av7110_fw_request(struct av7110 *av7110, u16 *request_buf, |
526 | int request_buf_len, u16 *reply_buf, int reply_buf_len) | 528 | int request_buf_len, u16 *reply_buf, int reply_buf_len) |
@@ -593,7 +595,7 @@ int av7110_fw_request(struct av7110 *av7110, u16 *request_buf, | |||
593 | return 0; | 595 | return 0; |
594 | } | 596 | } |
595 | 597 | ||
596 | int av7110_fw_query(struct av7110 *av7110, u16 tag, u16* buf, s16 length) | 598 | static int av7110_fw_query(struct av7110 *av7110, u16 tag, u16* buf, s16 length) |
597 | { | 599 | { |
598 | int ret; | 600 | int ret; |
599 | ret = av7110_fw_request(av7110, &tag, 0, buf, length); | 601 | ret = av7110_fw_request(av7110, &tag, 0, buf, length); |
@@ -617,7 +619,7 @@ int av7110_firmversion(struct av7110 *av7110) | |||
617 | 619 | ||
618 | if (av7110_fw_query(av7110, tag, buf, 16)) { | 620 | if (av7110_fw_query(av7110, tag, buf, 16)) { |
619 | printk("dvb-ttpci: failed to boot firmware @ card %d\n", | 621 | printk("dvb-ttpci: failed to boot firmware @ card %d\n", |
620 | av7110->dvb_adapter->num); | 622 | av7110->dvb_adapter.num); |
621 | return -EIO; | 623 | return -EIO; |
622 | } | 624 | } |
623 | 625 | ||
@@ -628,16 +630,16 @@ int av7110_firmversion(struct av7110 *av7110) | |||
628 | av7110->avtype = (buf[8] << 16) + buf[9]; | 630 | av7110->avtype = (buf[8] << 16) + buf[9]; |
629 | 631 | ||
630 | printk("dvb-ttpci: info @ card %d: firm %08x, rtsl %08x, vid %08x, app %08x\n", | 632 | printk("dvb-ttpci: info @ card %d: firm %08x, rtsl %08x, vid %08x, app %08x\n", |
631 | av7110->dvb_adapter->num, av7110->arm_fw, | 633 | av7110->dvb_adapter.num, av7110->arm_fw, |
632 | av7110->arm_rtsl, av7110->arm_vid, av7110->arm_app); | 634 | av7110->arm_rtsl, av7110->arm_vid, av7110->arm_app); |
633 | 635 | ||
634 | /* print firmware capabilities */ | 636 | /* print firmware capabilities */ |
635 | if (FW_CI_LL_SUPPORT(av7110->arm_app)) | 637 | if (FW_CI_LL_SUPPORT(av7110->arm_app)) |
636 | printk("dvb-ttpci: firmware @ card %d supports CI link layer interface\n", | 638 | printk("dvb-ttpci: firmware @ card %d supports CI link layer interface\n", |
637 | av7110->dvb_adapter->num); | 639 | av7110->dvb_adapter.num); |
638 | else | 640 | else |
639 | printk("dvb-ttpci: no firmware support for CI link layer interface @ card %d\n", | 641 | printk("dvb-ttpci: no firmware support for CI link layer interface @ card %d\n", |
640 | av7110->dvb_adapter->num); | 642 | av7110->dvb_adapter.num); |
641 | 643 | ||
642 | return 0; | 644 | return 0; |
643 | } | 645 | } |
diff --git a/drivers/media/dvb/ttpci/av7110_hw.h b/drivers/media/dvb/ttpci/av7110_hw.h index bf901c624682..52061e17c6dd 100644 --- a/drivers/media/dvb/ttpci/av7110_hw.h +++ b/drivers/media/dvb/ttpci/av7110_hw.h | |||
@@ -364,7 +364,6 @@ enum av7110_command_type { | |||
364 | 364 | ||
365 | 365 | ||
366 | 366 | ||
367 | extern void av7110_reset_arm(struct av7110 *av7110); | ||
368 | extern int av7110_bootarm(struct av7110 *av7110); | 367 | extern int av7110_bootarm(struct av7110 *av7110); |
369 | extern int av7110_firmversion(struct av7110 *av7110); | 368 | extern int av7110_firmversion(struct av7110 *av7110); |
370 | #define FW_CI_LL_SUPPORT(arm_app) ((arm_app) & 0x80000000) | 369 | #define FW_CI_LL_SUPPORT(arm_app) ((arm_app) & 0x80000000) |
@@ -373,12 +372,8 @@ extern int av7110_firmversion(struct av7110 *av7110); | |||
373 | 372 | ||
374 | extern int av7110_wait_msgstate(struct av7110 *av7110, u16 flags); | 373 | extern int av7110_wait_msgstate(struct av7110 *av7110, u16 flags); |
375 | extern int av7110_fw_cmd(struct av7110 *av7110, int type, int com, int num, ...); | 374 | extern int av7110_fw_cmd(struct av7110 *av7110, int type, int com, int num, ...); |
376 | extern int __av7110_send_fw_cmd(struct av7110 *av7110, u16* buf, int length); | ||
377 | extern int av7110_send_fw_cmd(struct av7110 *av7110, u16* buf, int length); | ||
378 | extern int av7110_send_ci_cmd(struct av7110 *av7110, u8 subcom, u8 *buf, u8 len); | ||
379 | extern int av7110_fw_request(struct av7110 *av7110, u16 *request_buf, | 375 | extern int av7110_fw_request(struct av7110 *av7110, u16 *request_buf, |
380 | int request_buf_len, u16 *reply_buf, int reply_buf_len); | 376 | int request_buf_len, u16 *reply_buf, int reply_buf_len); |
381 | extern int av7110_fw_query(struct av7110 *av7110, u16 tag, u16* Buff, s16 length); | ||
382 | 377 | ||
383 | 378 | ||
384 | /* DEBI (saa7146 data extension bus interface) access */ | 379 | /* DEBI (saa7146 data extension bus interface) access */ |
diff --git a/drivers/media/dvb/ttpci/av7110_ir.c b/drivers/media/dvb/ttpci/av7110_ir.c index 6d2256f1e354..665cdb8a3f71 100644 --- a/drivers/media/dvb/ttpci/av7110_ir.c +++ b/drivers/media/dvb/ttpci/av7110_ir.c | |||
@@ -10,7 +10,7 @@ | |||
10 | 10 | ||
11 | #define UP_TIMEOUT (HZ/4) | 11 | #define UP_TIMEOUT (HZ/4) |
12 | 12 | ||
13 | /* enable ir debugging by or'ing av7110_debug with 16 */ | 13 | /* enable ir debugging by or'ing debug with 16 */ |
14 | 14 | ||
15 | static int ir_initialized; | 15 | static int ir_initialized; |
16 | static struct input_dev input_dev; | 16 | static struct input_dev input_dev; |
diff --git a/drivers/media/dvb/ttpci/av7110_v4l.c b/drivers/media/dvb/ttpci/av7110_v4l.c index eb84fb08d95c..e65fc36e2ce8 100644 --- a/drivers/media/dvb/ttpci/av7110_v4l.c +++ b/drivers/media/dvb/ttpci/av7110_v4l.c | |||
@@ -46,13 +46,13 @@ int msp_writereg(struct av7110 *av7110, u8 dev, u16 reg, u16 val) | |||
46 | 46 | ||
47 | if (i2c_transfer(&av7110->i2c_adap, &msgs, 1) != 1) { | 47 | if (i2c_transfer(&av7110->i2c_adap, &msgs, 1) != 1) { |
48 | dprintk(1, "dvb-ttpci: failed @ card %d, %u = %u\n", | 48 | dprintk(1, "dvb-ttpci: failed @ card %d, %u = %u\n", |
49 | av7110->dvb_adapter->num, reg, val); | 49 | av7110->dvb_adapter.num, reg, val); |
50 | return -EIO; | 50 | return -EIO; |
51 | } | 51 | } |
52 | return 0; | 52 | return 0; |
53 | } | 53 | } |
54 | 54 | ||
55 | int msp_readreg(struct av7110 *av7110, u8 dev, u16 reg, u16 *val) | 55 | static int msp_readreg(struct av7110 *av7110, u8 dev, u16 reg, u16 *val) |
56 | { | 56 | { |
57 | u8 msg1[3] = { dev, reg >> 8, reg & 0xff }; | 57 | u8 msg1[3] = { dev, reg >> 8, reg & 0xff }; |
58 | u8 msg2[2]; | 58 | u8 msg2[2]; |
@@ -63,7 +63,7 @@ int msp_readreg(struct av7110 *av7110, u8 dev, u16 reg, u16 *val) | |||
63 | 63 | ||
64 | if (i2c_transfer(&av7110->i2c_adap, &msgs[0], 2) != 2) { | 64 | if (i2c_transfer(&av7110->i2c_adap, &msgs[0], 2) != 2) { |
65 | dprintk(1, "dvb-ttpci: failed @ card %d, %u\n", | 65 | dprintk(1, "dvb-ttpci: failed @ card %d, %u\n", |
66 | av7110->dvb_adapter->num, reg); | 66 | av7110->dvb_adapter.num, reg); |
67 | return -EIO; | 67 | return -EIO; |
68 | } | 68 | } |
69 | *val = (msg2[0] << 8) | msg2[1]; | 69 | *val = (msg2[0] << 8) | msg2[1]; |
@@ -552,13 +552,13 @@ int av7110_init_analog_module(struct av7110 *av7110) | |||
552 | return -ENODEV; | 552 | return -ENODEV; |
553 | 553 | ||
554 | printk("dvb-ttpci: DVB-C analog module @ card %d detected, initializing MSP3400\n", | 554 | printk("dvb-ttpci: DVB-C analog module @ card %d detected, initializing MSP3400\n", |
555 | av7110->dvb_adapter->num); | 555 | av7110->dvb_adapter.num); |
556 | av7110->adac_type = DVB_ADAC_MSP; | 556 | av7110->adac_type = DVB_ADAC_MSP; |
557 | msleep(100); // the probing above resets the msp... | 557 | msleep(100); // the probing above resets the msp... |
558 | msp_readreg(av7110, MSP_RD_DSP, 0x001e, &version1); | 558 | msp_readreg(av7110, MSP_RD_DSP, 0x001e, &version1); |
559 | msp_readreg(av7110, MSP_RD_DSP, 0x001f, &version2); | 559 | msp_readreg(av7110, MSP_RD_DSP, 0x001f, &version2); |
560 | dprintk(1, "dvb-ttpci: @ card %d MSP3400 version 0x%04x 0x%04x\n", | 560 | dprintk(1, "dvb-ttpci: @ card %d MSP3400 version 0x%04x 0x%04x\n", |
561 | av7110->dvb_adapter->num, version1, version2); | 561 | av7110->dvb_adapter.num, version1, version2); |
562 | msp_writereg(av7110, MSP_WR_DSP, 0x0013, 0x0c00); | 562 | msp_writereg(av7110, MSP_WR_DSP, 0x0013, 0x0c00); |
563 | msp_writereg(av7110, MSP_WR_DSP, 0x0000, 0x7f00); // loudspeaker + headphone | 563 | msp_writereg(av7110, MSP_WR_DSP, 0x0000, 0x7f00); // loudspeaker + headphone |
564 | msp_writereg(av7110, MSP_WR_DSP, 0x0008, 0x0220); // loudspeaker source | 564 | msp_writereg(av7110, MSP_WR_DSP, 0x0008, 0x0220); // loudspeaker source |
@@ -596,7 +596,7 @@ int av7110_init_analog_module(struct av7110 *av7110) | |||
596 | /* init the saa7113 */ | 596 | /* init the saa7113 */ |
597 | while (*i != 0xff) { | 597 | while (*i != 0xff) { |
598 | if (i2c_writereg(av7110, 0x48, i[0], i[1]) != 1) { | 598 | if (i2c_writereg(av7110, 0x48, i[0], i[1]) != 1) { |
599 | dprintk(1, "saa7113 initialization failed @ card %d", av7110->dvb_adapter->num); | 599 | dprintk(1, "saa7113 initialization failed @ card %d", av7110->dvb_adapter.num); |
600 | break; | 600 | break; |
601 | } | 601 | } |
602 | i += 2; | 602 | i += 2; |
@@ -726,11 +726,11 @@ static int std_callback(struct saa7146_dev* dev, struct saa7146_standard *std) | |||
726 | { | 726 | { |
727 | struct av7110 *av7110 = (struct av7110*) dev->ext_priv; | 727 | struct av7110 *av7110 = (struct av7110*) dev->ext_priv; |
728 | 728 | ||
729 | if (std->id == V4L2_STD_PAL) { | 729 | if (std->id & V4L2_STD_PAL) { |
730 | av7110->vidmode = VIDEO_MODE_PAL; | 730 | av7110->vidmode = VIDEO_MODE_PAL; |
731 | av7110_set_vidmode(av7110, av7110->vidmode); | 731 | av7110_set_vidmode(av7110, av7110->vidmode); |
732 | } | 732 | } |
733 | else if (std->id == V4L2_STD_NTSC) { | 733 | else if (std->id & V4L2_STD_NTSC) { |
734 | av7110->vidmode = VIDEO_MODE_NTSC; | 734 | av7110->vidmode = VIDEO_MODE_NTSC; |
735 | av7110_set_vidmode(av7110, av7110->vidmode); | 735 | av7110_set_vidmode(av7110, av7110->vidmode); |
736 | } | 736 | } |
diff --git a/drivers/media/dvb/ttpci/budget-av.c b/drivers/media/dvb/ttpci/budget-av.c index 14e963206b89..6e0f5d307c52 100644 --- a/drivers/media/dvb/ttpci/budget-av.c +++ b/drivers/media/dvb/ttpci/budget-av.c | |||
@@ -59,8 +59,12 @@ struct budget_av { | |||
59 | struct dvb_ca_en50221 ca; | 59 | struct dvb_ca_en50221 ca; |
60 | }; | 60 | }; |
61 | 61 | ||
62 | static int enable_ci = 0; | 62 | /* GPIO CI Connections: |
63 | 63 | * 0 - Vcc/Reset (Reset is controlled by capacitor) | |
64 | * 1 - Attribute Memory | ||
65 | * 2 - Card Enable (Active Low) | ||
66 | * 3 - Card Detect | ||
67 | */ | ||
64 | 68 | ||
65 | /**************************************************************************** | 69 | /**************************************************************************** |
66 | * INITIALIZATION | 70 | * INITIALIZATION |
@@ -188,22 +192,35 @@ static int ciintf_slot_reset(struct dvb_ca_en50221 *ca, int slot) | |||
188 | { | 192 | { |
189 | struct budget_av *budget_av = (struct budget_av *) ca->data; | 193 | struct budget_av *budget_av = (struct budget_av *) ca->data; |
190 | struct saa7146_dev *saa = budget_av->budget.dev; | 194 | struct saa7146_dev *saa = budget_av->budget.dev; |
191 | int max = 20; | 195 | int timeout = 50; // 5 seconds (4.4.6 Ready) |
192 | 196 | ||
193 | if (slot != 0) | 197 | if (slot != 0) |
194 | return -EINVAL; | 198 | return -EINVAL; |
195 | 199 | ||
196 | dprintk(1, "ciintf_slot_reset\n"); | 200 | dprintk(1, "ciintf_slot_reset\n"); |
197 | 201 | ||
198 | /* reset the card */ | 202 | saa7146_setgpio(saa, 2, SAA7146_GPIO_OUTHI); /* disable card */ |
199 | saa7146_setgpio(saa, 0, SAA7146_GPIO_OUTHI); | ||
200 | msleep(100); | ||
201 | saa7146_setgpio(saa, 0, SAA7146_GPIO_OUTLO); | ||
202 | 203 | ||
203 | while (--max > 0 && ciintf_read_attribute_mem(ca, slot, 0) != 0x1d) | 204 | saa7146_setgpio(saa, 0, SAA7146_GPIO_OUTHI); /* Vcc off */ |
205 | msleep(2); | ||
206 | saa7146_setgpio(saa, 0, SAA7146_GPIO_OUTLO); /* Vcc on */ | ||
207 | msleep(20); /* 20 ms Vcc settling time */ | ||
208 | |||
209 | saa7146_setgpio(saa, 2, SAA7146_GPIO_OUTLO); /* enable card */ | ||
210 | |||
211 | /* This should have been based on pin 16 READY of the pcmcia port, | ||
212 | * but AFAICS it is not routed to the saa7146 */ | ||
213 | while (--timeout > 0 && ciintf_read_attribute_mem(ca, slot, 0) != 0x1d) | ||
204 | msleep(100); | 214 | msleep(100); |
205 | 215 | ||
206 | ttpci_budget_set_video_port(saa, BUDGET_VIDEO_PORTB); | 216 | if (timeout <= 0) |
217 | { | ||
218 | printk(KERN_ERR "budget-av: cam reset failed (timeout).\n"); | ||
219 | saa7146_setgpio(saa, 2, SAA7146_GPIO_OUTHI); /* disable card */ | ||
220 | saa7146_setgpio(saa, 0, SAA7146_GPIO_OUTHI); /* Vcc off */ | ||
221 | return -ETIMEDOUT; | ||
222 | } | ||
223 | |||
207 | return 0; | 224 | return 0; |
208 | } | 225 | } |
209 | 226 | ||
@@ -240,7 +257,6 @@ static int ciintf_poll_slot_status(struct dvb_ca_en50221 *ca, int slot, int open | |||
240 | { | 257 | { |
241 | struct budget_av *budget_av = (struct budget_av *) ca->data; | 258 | struct budget_av *budget_av = (struct budget_av *) ca->data; |
242 | struct saa7146_dev *saa = budget_av->budget.dev; | 259 | struct saa7146_dev *saa = budget_av->budget.dev; |
243 | int cam = 0; | ||
244 | 260 | ||
245 | if (slot != 0) | 261 | if (slot != 0) |
246 | return -EINVAL; | 262 | return -EINVAL; |
@@ -248,15 +264,21 @@ static int ciintf_poll_slot_status(struct dvb_ca_en50221 *ca, int slot, int open | |||
248 | if (!budget_av->slot_status) { | 264 | if (!budget_av->slot_status) { |
249 | saa7146_setgpio(saa, 3, SAA7146_GPIO_INPUT); | 265 | saa7146_setgpio(saa, 3, SAA7146_GPIO_INPUT); |
250 | udelay(1); | 266 | udelay(1); |
251 | cam = saa7146_read(saa, PSR) & MASK_06; | 267 | if (saa7146_read(saa, PSR) & MASK_06) |
252 | saa7146_setgpio(saa, 3, SAA7146_GPIO_OUTLO); | 268 | { |
253 | 269 | printk(KERN_INFO "budget-av: cam inserted\n"); | |
254 | if (cam) | ||
255 | budget_av->slot_status = 1; | 270 | budget_av->slot_status = 1; |
271 | } | ||
272 | saa7146_setgpio(saa, 3, SAA7146_GPIO_OUTLO); | ||
256 | } else if (!open) { | 273 | } else if (!open) { |
257 | saa7146_setgpio(budget_av->budget.dev, 1, SAA7146_GPIO_OUTLO); | 274 | saa7146_setgpio(budget_av->budget.dev, 1, SAA7146_GPIO_OUTLO); |
258 | if (ttpci_budget_debiread(&budget_av->budget, DEBICICAM, 0, 1, 0, 1) == -ETIMEDOUT) | 275 | if (ttpci_budget_debiread(&budget_av->budget, DEBICICAM, 0, 1, 0, 1) == -ETIMEDOUT) |
276 | { | ||
277 | printk(KERN_INFO "budget-av: cam ejected\n"); | ||
278 | saa7146_setgpio(saa, 2, SAA7146_GPIO_OUTHI); /* disable card */ | ||
279 | saa7146_setgpio(saa, 0, SAA7146_GPIO_OUTHI); /* Vcc off */ | ||
259 | budget_av->slot_status = 0; | 280 | budget_av->slot_status = 0; |
281 | } | ||
260 | } | 282 | } |
261 | 283 | ||
262 | if (budget_av->slot_status == 1) | 284 | if (budget_av->slot_status == 1) |
@@ -272,17 +294,11 @@ static int ciintf_init(struct budget_av *budget_av) | |||
272 | 294 | ||
273 | memset(&budget_av->ca, 0, sizeof(struct dvb_ca_en50221)); | 295 | memset(&budget_av->ca, 0, sizeof(struct dvb_ca_en50221)); |
274 | 296 | ||
275 | /* setup GPIOs */ | 297 | saa7146_setgpio(saa, 0, SAA7146_GPIO_OUTLO); |
276 | saa7146_setgpio(saa, 1, SAA7146_GPIO_OUTHI); | 298 | saa7146_setgpio(saa, 1, SAA7146_GPIO_OUTLO); |
277 | saa7146_setgpio(saa, 2, SAA7146_GPIO_OUTLO); | 299 | saa7146_setgpio(saa, 2, SAA7146_GPIO_OUTLO); |
278 | saa7146_setgpio(saa, 3, SAA7146_GPIO_OUTLO); | 300 | saa7146_setgpio(saa, 3, SAA7146_GPIO_OUTLO); |
279 | 301 | ||
280 | /* Reset the card */ | ||
281 | saa7146_setgpio(saa, 0, SAA7146_GPIO_OUTHI); | ||
282 | msleep(50); | ||
283 | saa7146_setgpio(saa, 0, SAA7146_GPIO_OUTLO); | ||
284 | msleep(100); | ||
285 | |||
286 | /* Enable DEBI pins */ | 302 | /* Enable DEBI pins */ |
287 | saa7146_write(saa, MC1, saa7146_read(saa, MC1) | (0x800 << 16) | 0x800); | 303 | saa7146_write(saa, MC1, saa7146_read(saa, MC1) | (0x800 << 16) | 0x800); |
288 | 304 | ||
@@ -297,13 +313,14 @@ static int ciintf_init(struct budget_av *budget_av) | |||
297 | budget_av->ca.slot_ts_enable = ciintf_slot_ts_enable; | 313 | budget_av->ca.slot_ts_enable = ciintf_slot_ts_enable; |
298 | budget_av->ca.poll_slot_status = ciintf_poll_slot_status; | 314 | budget_av->ca.poll_slot_status = ciintf_poll_slot_status; |
299 | budget_av->ca.data = budget_av; | 315 | budget_av->ca.data = budget_av; |
300 | if ((result = dvb_ca_en50221_init(budget_av->budget.dvb_adapter, | 316 | |
317 | if ((result = dvb_ca_en50221_init(&budget_av->budget.dvb_adapter, | ||
301 | &budget_av->ca, 0, 1)) != 0) { | 318 | &budget_av->ca, 0, 1)) != 0) { |
302 | printk("budget_av: CI interface detected, but initialisation failed.\n"); | 319 | printk(KERN_ERR "budget-av: ci initialisation failed.\n"); |
303 | goto error; | 320 | goto error; |
304 | } | 321 | } |
305 | // success! | 322 | |
306 | printk("ciintf_init: CI interface initialised\n"); | 323 | printk(KERN_INFO "budget-av: ci interface initialised.\n"); |
307 | budget_av->budget.ci_present = 1; | 324 | budget_av->budget.ci_present = 1; |
308 | return 0; | 325 | return 0; |
309 | 326 | ||
@@ -361,8 +378,12 @@ static const u8 saa7113_tab[] = { | |||
361 | static int saa7113_init(struct budget_av *budget_av) | 378 | static int saa7113_init(struct budget_av *budget_av) |
362 | { | 379 | { |
363 | struct budget *budget = &budget_av->budget; | 380 | struct budget *budget = &budget_av->budget; |
381 | struct saa7146_dev *saa = budget->dev; | ||
364 | const u8 *data = saa7113_tab; | 382 | const u8 *data = saa7113_tab; |
365 | 383 | ||
384 | saa7146_setgpio(saa, 0, SAA7146_GPIO_OUTHI); | ||
385 | msleep(200); | ||
386 | |||
366 | if (i2c_writereg(&budget->i2c_adap, 0x4a, 0x01, 0x08) != 1) { | 387 | if (i2c_writereg(&budget->i2c_adap, 0x4a, 0x01, 0x08) != 1) { |
367 | dprintk(1, "saa7113 not found on KNC card\n"); | 388 | dprintk(1, "saa7113 not found on KNC card\n"); |
368 | return -ENODEV; | 389 | return -ENODEV; |
@@ -697,75 +718,90 @@ static u8 read_pwm(struct budget_av *budget_av) | |||
697 | return pwm; | 718 | return pwm; |
698 | } | 719 | } |
699 | 720 | ||
721 | #define SUBID_DVBS_KNC1 0x0010 | ||
722 | #define SUBID_DVBS_KNC1_PLUS 0x0011 | ||
723 | #define SUBID_DVBS_TYPHOON 0x4f56 | ||
724 | #define SUBID_DVBS_CINERGY1200 0x1154 | ||
725 | |||
726 | #define SUBID_DVBC_KNC1 0x0020 | ||
727 | #define SUBID_DVBC_KNC1_PLUS 0x0021 | ||
728 | #define SUBID_DVBC_CINERGY1200 0x1156 | ||
729 | |||
730 | #define SUBID_DVBT_KNC1_PLUS 0x0031 | ||
731 | #define SUBID_DVBT_KNC1 0x0030 | ||
732 | #define SUBID_DVBT_CINERGY1200 0x1157 | ||
700 | 733 | ||
701 | static void frontend_init(struct budget_av *budget_av) | 734 | static void frontend_init(struct budget_av *budget_av) |
702 | { | 735 | { |
703 | switch (budget_av->budget.dev->pci->subsystem_device) { | 736 | struct saa7146_dev * saa = budget_av->budget.dev; |
704 | case 0x4f56: // Typhoon/KNC1 DVB-S budget (stv0299/Philips SU1278(tsa5059)) | 737 | struct dvb_frontend * fe = NULL; |
705 | budget_av->budget.dvb_frontend = | 738 | |
706 | stv0299_attach(&typhoon_config, &budget_av->budget.i2c_adap); | 739 | switch (saa->pci->subsystem_device) { |
707 | if (budget_av->budget.dvb_frontend != NULL) { | 740 | case SUBID_DVBS_KNC1_PLUS: |
741 | case SUBID_DVBC_KNC1_PLUS: | ||
742 | case SUBID_DVBT_KNC1_PLUS: | ||
743 | // Enable / PowerON Frontend | ||
744 | saa7146_setgpio(saa, 3, SAA7146_GPIO_OUTHI); | ||
708 | break; | 745 | break; |
709 | } | 746 | } |
747 | |||
748 | switch (saa->pci->subsystem_device) { | ||
749 | |||
750 | case SUBID_DVBS_KNC1: | ||
751 | case SUBID_DVBS_KNC1_PLUS: | ||
752 | case SUBID_DVBS_TYPHOON: | ||
753 | fe = stv0299_attach(&typhoon_config, | ||
754 | &budget_av->budget.i2c_adap); | ||
710 | break; | 755 | break; |
711 | 756 | ||
712 | case 0x0020: // KNC1 DVB-C budget (tda10021/Philips CU1216(tua6034)) | 757 | case SUBID_DVBS_CINERGY1200: |
713 | budget_av->budget.dvb_frontend = | 758 | fe = stv0299_attach(&cinergy_1200s_config, |
714 | tda10021_attach(&philips_cu1216_config, | 759 | &budget_av->budget.i2c_adap); |
715 | &budget_av->budget.i2c_adap, read_pwm(budget_av)); | ||
716 | if (budget_av->budget.dvb_frontend != NULL) { | ||
717 | break; | ||
718 | } | ||
719 | break; | 760 | break; |
720 | 761 | ||
721 | case 0x0030: // KNC1 DVB-T budget (tda10046/Philips TU1216(tda6651tt)) | 762 | case SUBID_DVBC_KNC1: |
722 | budget_av->budget.dvb_frontend = | 763 | case SUBID_DVBC_KNC1_PLUS: |
723 | tda10046_attach(&philips_tu1216_config, &budget_av->budget.i2c_adap); | 764 | fe = tda10021_attach(&philips_cu1216_config, |
724 | if (budget_av->budget.dvb_frontend != NULL) { | 765 | &budget_av->budget.i2c_adap, |
725 | break; | 766 | read_pwm(budget_av)); |
726 | } | ||
727 | break; | 767 | break; |
728 | 768 | ||
729 | case 0x1154: // TerraTec Cinergy 1200 DVB-S (stv0299/Philips SU1278(tsa5059)) | 769 | case SUBID_DVBT_KNC1: |
730 | budget_av->budget.dvb_frontend = | 770 | case SUBID_DVBT_KNC1_PLUS: |
731 | stv0299_attach(&cinergy_1200s_config, &budget_av->budget.i2c_adap); | 771 | fe = tda10046_attach(&philips_tu1216_config, |
732 | if (budget_av->budget.dvb_frontend != NULL) { | 772 | &budget_av->budget.i2c_adap); |
733 | break; | ||
734 | } | ||
735 | break; | 773 | break; |
736 | 774 | ||
737 | case 0x1156: // Terratec Cinergy 1200 DVB-C (tda10021/Philips CU1216(tua6034)) | 775 | case SUBID_DVBC_CINERGY1200: |
738 | budget_av->budget.dvb_frontend = | 776 | fe = tda10021_attach(&philips_cu1216_config, |
739 | tda10021_attach(&philips_cu1216_config, | 777 | &budget_av->budget.i2c_adap, |
740 | &budget_av->budget.i2c_adap, read_pwm(budget_av)); | 778 | read_pwm(budget_av)); |
741 | if (budget_av->budget.dvb_frontend) { | ||
742 | break; | ||
743 | } | ||
744 | break; | 779 | break; |
745 | 780 | ||
746 | case 0x1157: // Terratec Cinergy 1200 DVB-T (tda10046/Philips TU1216(tda6651tt)) | 781 | case SUBID_DVBT_CINERGY1200: |
747 | budget_av->budget.dvb_frontend = | 782 | fe = tda10046_attach(&philips_tu1216_config, |
748 | tda10046_attach(&philips_tu1216_config, &budget_av->budget.i2c_adap); | 783 | &budget_av->budget.i2c_adap); |
749 | if (budget_av->budget.dvb_frontend) { | ||
750 | break; | ||
751 | } | ||
752 | break; | 784 | break; |
753 | } | 785 | } |
754 | 786 | ||
755 | if (budget_av->budget.dvb_frontend == NULL) { | 787 | if (fe == NULL) { |
756 | printk("budget_av: A frontend driver was not found for device %04x/%04x subsystem %04x/%04x\n", | 788 | printk(KERN_ERR "budget-av: A frontend driver was not found " |
757 | budget_av->budget.dev->pci->vendor, | 789 | "for device %04x/%04x subsystem %04x/%04x\n", |
758 | budget_av->budget.dev->pci->device, | 790 | saa->pci->vendor, |
759 | budget_av->budget.dev->pci->subsystem_vendor, | 791 | saa->pci->device, |
760 | budget_av->budget.dev->pci->subsystem_device); | 792 | saa->pci->subsystem_vendor, |
761 | } else { | 793 | saa->pci->subsystem_device); |
762 | if (dvb_register_frontend | 794 | return; |
763 | (budget_av->budget.dvb_adapter, budget_av->budget.dvb_frontend)) { | 795 | } |
764 | printk("budget-av: Frontend registration failed!\n"); | 796 | |
765 | if (budget_av->budget.dvb_frontend->ops->release) | 797 | budget_av->budget.dvb_frontend = fe; |
766 | budget_av->budget.dvb_frontend->ops->release(budget_av->budget.dvb_frontend); | 798 | |
767 | budget_av->budget.dvb_frontend = NULL; | 799 | if (dvb_register_frontend(&budget_av->budget.dvb_adapter, |
768 | } | 800 | budget_av->budget.dvb_frontend)) { |
801 | printk(KERN_ERR "budget-av: Frontend registration failed!\n"); | ||
802 | if (budget_av->budget.dvb_frontend->ops->release) | ||
803 | budget_av->budget.dvb_frontend->ops->release(budget_av->budget.dvb_frontend); | ||
804 | budget_av->budget.dvb_frontend = NULL; | ||
769 | } | 805 | } |
770 | } | 806 | } |
771 | 807 | ||
@@ -822,6 +858,7 @@ static int budget_av_attach(struct saa7146_dev *dev, struct saa7146_pci_extensio | |||
822 | 858 | ||
823 | memset(budget_av, 0, sizeof(struct budget_av)); | 859 | memset(budget_av, 0, sizeof(struct budget_av)); |
824 | 860 | ||
861 | budget_av->has_saa7113 = 0; | ||
825 | budget_av->budget.ci_present = 0; | 862 | budget_av->budget.ci_present = 0; |
826 | 863 | ||
827 | dev->ext_priv = budget_av; | 864 | dev->ext_priv = budget_av; |
@@ -836,10 +873,7 @@ static int budget_av_attach(struct saa7146_dev *dev, struct saa7146_pci_extensio | |||
836 | saa7146_write(dev, DD1_INIT, 0x07000600); | 873 | saa7146_write(dev, DD1_INIT, 0x07000600); |
837 | saa7146_write(dev, MC2, MASK_09 | MASK_25 | MASK_10 | MASK_26); | 874 | saa7146_write(dev, MC2, MASK_09 | MASK_25 | MASK_10 | MASK_26); |
838 | 875 | ||
839 | saa7146_setgpio(dev, 0, SAA7146_GPIO_OUTHI); | 876 | if (saa7113_init(budget_av) == 0) { |
840 | msleep(500); | ||
841 | |||
842 | if (0 == saa7113_init(budget_av)) { | ||
843 | budget_av->has_saa7113 = 1; | 877 | budget_av->has_saa7113 = 1; |
844 | 878 | ||
845 | if (0 != saa7146_vv_init(dev, &vv_data)) { | 879 | if (0 != saa7146_vv_init(dev, &vv_data)) { |
@@ -860,31 +894,26 @@ static int budget_av_attach(struct saa7146_dev *dev, struct saa7146_pci_extensio | |||
860 | 894 | ||
861 | saa7113_setinput(budget_av, 0); | 895 | saa7113_setinput(budget_av, 0); |
862 | } else { | 896 | } else { |
863 | budget_av->has_saa7113 = 0; | 897 | ciintf_init(budget_av); |
864 | |||
865 | saa7146_setgpio(dev, 0, SAA7146_GPIO_OUTLO); | ||
866 | } | 898 | } |
867 | 899 | ||
868 | /* fixme: find some sane values here... */ | 900 | /* fixme: find some sane values here... */ |
869 | saa7146_write(dev, PCI_BT_V1, 0x1c00101f); | 901 | saa7146_write(dev, PCI_BT_V1, 0x1c00101f); |
870 | 902 | ||
871 | mac = budget_av->budget.dvb_adapter->proposed_mac; | 903 | mac = budget_av->budget.dvb_adapter.proposed_mac; |
872 | if (i2c_readregs(&budget_av->budget.i2c_adap, 0xa0, 0x30, mac, 6)) { | 904 | if (i2c_readregs(&budget_av->budget.i2c_adap, 0xa0, 0x30, mac, 6)) { |
873 | printk("KNC1-%d: Could not read MAC from KNC1 card\n", | 905 | printk(KERN_ERR "KNC1-%d: Could not read MAC from KNC1 card\n", |
874 | budget_av->budget.dvb_adapter->num); | 906 | budget_av->budget.dvb_adapter.num); |
875 | memset(mac, 0, 6); | 907 | memset(mac, 0, 6); |
876 | } else { | 908 | } else { |
877 | printk("KNC1-%d: MAC addr = %.2x:%.2x:%.2x:%.2x:%.2x:%.2x\n", | 909 | printk(KERN_INFO "KNC1-%d: MAC addr = %.2x:%.2x:%.2x:%.2x:%.2x:%.2x\n", |
878 | budget_av->budget.dvb_adapter->num, | 910 | budget_av->budget.dvb_adapter.num, |
879 | mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]); | 911 | mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]); |
880 | } | 912 | } |
881 | 913 | ||
882 | budget_av->budget.dvb_adapter->priv = budget_av; | 914 | budget_av->budget.dvb_adapter.priv = budget_av; |
883 | frontend_init(budget_av); | 915 | frontend_init(budget_av); |
884 | 916 | ||
885 | if (enable_ci) | ||
886 | ciintf_init(budget_av); | ||
887 | |||
888 | return 0; | 917 | return 0; |
889 | } | 918 | } |
890 | 919 | ||
@@ -963,14 +992,21 @@ static struct saa7146_extension budget_extension; | |||
963 | MAKE_BUDGET_INFO(knc1s, "KNC1 DVB-S", BUDGET_KNC1S); | 992 | MAKE_BUDGET_INFO(knc1s, "KNC1 DVB-S", BUDGET_KNC1S); |
964 | MAKE_BUDGET_INFO(knc1c, "KNC1 DVB-C", BUDGET_KNC1C); | 993 | MAKE_BUDGET_INFO(knc1c, "KNC1 DVB-C", BUDGET_KNC1C); |
965 | MAKE_BUDGET_INFO(knc1t, "KNC1 DVB-T", BUDGET_KNC1T); | 994 | MAKE_BUDGET_INFO(knc1t, "KNC1 DVB-T", BUDGET_KNC1T); |
995 | MAKE_BUDGET_INFO(knc1sp, "KNC1 DVB-S Plus", BUDGET_KNC1SP); | ||
996 | MAKE_BUDGET_INFO(knc1cp, "KNC1 DVB-C Plus", BUDGET_KNC1CP); | ||
997 | MAKE_BUDGET_INFO(knc1tp, "KNC1 DVB-T Plus", BUDGET_KNC1TP); | ||
966 | MAKE_BUDGET_INFO(cin1200s, "TerraTec Cinergy 1200 DVB-S", BUDGET_CIN1200S); | 998 | MAKE_BUDGET_INFO(cin1200s, "TerraTec Cinergy 1200 DVB-S", BUDGET_CIN1200S); |
967 | MAKE_BUDGET_INFO(cin1200c, "Terratec Cinergy 1200 DVB-C", BUDGET_CIN1200C); | 999 | MAKE_BUDGET_INFO(cin1200c, "Terratec Cinergy 1200 DVB-C", BUDGET_CIN1200C); |
968 | MAKE_BUDGET_INFO(cin1200t, "Terratec Cinergy 1200 DVB-T", BUDGET_CIN1200T); | 1000 | MAKE_BUDGET_INFO(cin1200t, "Terratec Cinergy 1200 DVB-T", BUDGET_CIN1200T); |
969 | 1001 | ||
970 | static struct pci_device_id pci_tbl[] = { | 1002 | static struct pci_device_id pci_tbl[] = { |
971 | MAKE_EXTENSION_PCI(knc1s, 0x1131, 0x4f56), | 1003 | MAKE_EXTENSION_PCI(knc1s, 0x1131, 0x4f56), |
1004 | MAKE_EXTENSION_PCI(knc1s, 0x1131, 0x0010), | ||
1005 | MAKE_EXTENSION_PCI(knc1sp, 0x1131, 0x0011), | ||
972 | MAKE_EXTENSION_PCI(knc1c, 0x1894, 0x0020), | 1006 | MAKE_EXTENSION_PCI(knc1c, 0x1894, 0x0020), |
1007 | MAKE_EXTENSION_PCI(knc1cp, 0x1894, 0x0021), | ||
973 | MAKE_EXTENSION_PCI(knc1t, 0x1894, 0x0030), | 1008 | MAKE_EXTENSION_PCI(knc1t, 0x1894, 0x0030), |
1009 | MAKE_EXTENSION_PCI(knc1tp, 0x1894, 0x0031), | ||
974 | MAKE_EXTENSION_PCI(cin1200s, 0x153b, 0x1154), | 1010 | MAKE_EXTENSION_PCI(cin1200s, 0x153b, 0x1154), |
975 | MAKE_EXTENSION_PCI(cin1200c, 0x153b, 0x1156), | 1011 | MAKE_EXTENSION_PCI(cin1200c, 0x153b, 0x1156), |
976 | MAKE_EXTENSION_PCI(cin1200t, 0x153b, 0x1157), | 1012 | MAKE_EXTENSION_PCI(cin1200t, 0x153b, 0x1157), |
@@ -1010,5 +1046,3 @@ MODULE_LICENSE("GPL"); | |||
1010 | MODULE_AUTHOR("Ralph Metzler, Marcus Metzler, Michael Hunold, others"); | 1046 | MODULE_AUTHOR("Ralph Metzler, Marcus Metzler, Michael Hunold, others"); |
1011 | MODULE_DESCRIPTION("driver for the SAA7146 based so-called " | 1047 | MODULE_DESCRIPTION("driver for the SAA7146 based so-called " |
1012 | "budget PCI DVB w/ analog input and CI-module (e.g. the KNC cards)"); | 1048 | "budget PCI DVB w/ analog input and CI-module (e.g. the KNC cards)"); |
1013 | module_param_named(enable_ci, enable_ci, int, 0644); | ||
1014 | MODULE_PARM_DESC(enable_ci, "Turn on/off CI module (default:off)."); | ||
diff --git a/drivers/media/dvb/ttpci/budget-ci.c b/drivers/media/dvb/ttpci/budget-ci.c index 521111be3558..dce116111376 100644 --- a/drivers/media/dvb/ttpci/budget-ci.c +++ b/drivers/media/dvb/ttpci/budget-ci.c | |||
@@ -395,7 +395,7 @@ static int ciintf_init(struct budget_ci *budget_ci) | |||
395 | budget_ci->ca.slot_shutdown = ciintf_slot_shutdown; | 395 | budget_ci->ca.slot_shutdown = ciintf_slot_shutdown; |
396 | budget_ci->ca.slot_ts_enable = ciintf_slot_ts_enable; | 396 | budget_ci->ca.slot_ts_enable = ciintf_slot_ts_enable; |
397 | budget_ci->ca.data = budget_ci; | 397 | budget_ci->ca.data = budget_ci; |
398 | if ((result = dvb_ca_en50221_init(budget_ci->budget.dvb_adapter, | 398 | if ((result = dvb_ca_en50221_init(&budget_ci->budget.dvb_adapter, |
399 | &budget_ci->ca, | 399 | &budget_ci->ca, |
400 | DVB_CA_EN50221_FLAG_IRQ_CAMCHANGE | | 400 | DVB_CA_EN50221_FLAG_IRQ_CAMCHANGE | |
401 | DVB_CA_EN50221_FLAG_IRQ_FR | | 401 | DVB_CA_EN50221_FLAG_IRQ_FR | |
@@ -881,7 +881,7 @@ static void frontend_init(struct budget_ci *budget_ci) | |||
881 | budget_ci->budget.dev->pci->subsystem_device); | 881 | budget_ci->budget.dev->pci->subsystem_device); |
882 | } else { | 882 | } else { |
883 | if (dvb_register_frontend | 883 | if (dvb_register_frontend |
884 | (budget_ci->budget.dvb_adapter, budget_ci->budget.dvb_frontend)) { | 884 | (&budget_ci->budget.dvb_adapter, budget_ci->budget.dvb_frontend)) { |
885 | printk("budget-ci: Frontend registration failed!\n"); | 885 | printk("budget-ci: Frontend registration failed!\n"); |
886 | if (budget_ci->budget.dvb_frontend->ops->release) | 886 | if (budget_ci->budget.dvb_frontend->ops->release) |
887 | budget_ci->budget.dvb_frontend->ops->release(budget_ci->budget.dvb_frontend); | 887 | budget_ci->budget.dvb_frontend->ops->release(budget_ci->budget.dvb_frontend); |
@@ -916,7 +916,7 @@ static int budget_ci_attach(struct saa7146_dev *dev, struct saa7146_pci_extensio | |||
916 | 916 | ||
917 | ciintf_init(budget_ci); | 917 | ciintf_init(budget_ci); |
918 | 918 | ||
919 | budget_ci->budget.dvb_adapter->priv = budget_ci; | 919 | budget_ci->budget.dvb_adapter.priv = budget_ci; |
920 | frontend_init(budget_ci); | 920 | frontend_init(budget_ci); |
921 | 921 | ||
922 | return 0; | 922 | return 0; |
diff --git a/drivers/media/dvb/ttpci/budget-core.c b/drivers/media/dvb/ttpci/budget-core.c index 93a9b40917e4..0498a055a4cd 100644 --- a/drivers/media/dvb/ttpci/budget-core.c +++ b/drivers/media/dvb/ttpci/budget-core.c | |||
@@ -298,7 +298,7 @@ static int budget_register(struct budget *budget) | |||
298 | budget->dmxdev.demux = &dvbdemux->dmx; | 298 | budget->dmxdev.demux = &dvbdemux->dmx; |
299 | budget->dmxdev.capabilities = 0; | 299 | budget->dmxdev.capabilities = 0; |
300 | 300 | ||
301 | dvb_dmxdev_init(&budget->dmxdev, budget->dvb_adapter); | 301 | dvb_dmxdev_init(&budget->dmxdev, &budget->dvb_adapter); |
302 | 302 | ||
303 | budget->hw_frontend.source = DMX_FRONTEND_0; | 303 | budget->hw_frontend.source = DMX_FRONTEND_0; |
304 | 304 | ||
@@ -316,7 +316,7 @@ static int budget_register(struct budget *budget) | |||
316 | if (ret < 0) | 316 | if (ret < 0) |
317 | return ret; | 317 | return ret; |
318 | 318 | ||
319 | dvb_net_init(budget->dvb_adapter, &budget->dvb_net, &dvbdemux->dmx); | 319 | dvb_net_init(&budget->dvb_adapter, &budget->dvb_net, &dvbdemux->dmx); |
320 | 320 | ||
321 | return 0; | 321 | return 0; |
322 | } | 322 | } |
@@ -385,11 +385,11 @@ int ttpci_budget_init(struct budget *budget, struct saa7146_dev *dev, | |||
385 | strcpy(budget->i2c_adap.name, budget->card->name); | 385 | strcpy(budget->i2c_adap.name, budget->card->name); |
386 | 386 | ||
387 | if (i2c_add_adapter(&budget->i2c_adap) < 0) { | 387 | if (i2c_add_adapter(&budget->i2c_adap) < 0) { |
388 | dvb_unregister_adapter(budget->dvb_adapter); | 388 | dvb_unregister_adapter(&budget->dvb_adapter); |
389 | return -ENOMEM; | 389 | return -ENOMEM; |
390 | } | 390 | } |
391 | 391 | ||
392 | ttpci_eeprom_parse_mac(&budget->i2c_adap, budget->dvb_adapter->proposed_mac); | 392 | ttpci_eeprom_parse_mac(&budget->i2c_adap, budget->dvb_adapter.proposed_mac); |
393 | 393 | ||
394 | if (NULL == | 394 | if (NULL == |
395 | (budget->grabbing = saa7146_vmalloc_build_pgtable(dev->pci, length, &budget->pt))) { | 395 | (budget->grabbing = saa7146_vmalloc_build_pgtable(dev->pci, length, &budget->pt))) { |
@@ -417,7 +417,7 @@ err: | |||
417 | 417 | ||
418 | vfree(budget->grabbing); | 418 | vfree(budget->grabbing); |
419 | 419 | ||
420 | dvb_unregister_adapter(budget->dvb_adapter); | 420 | dvb_unregister_adapter(&budget->dvb_adapter); |
421 | 421 | ||
422 | return ret; | 422 | return ret; |
423 | } | 423 | } |
@@ -432,7 +432,7 @@ int ttpci_budget_deinit(struct budget *budget) | |||
432 | 432 | ||
433 | i2c_del_adapter(&budget->i2c_adap); | 433 | i2c_del_adapter(&budget->i2c_adap); |
434 | 434 | ||
435 | dvb_unregister_adapter(budget->dvb_adapter); | 435 | dvb_unregister_adapter(&budget->dvb_adapter); |
436 | 436 | ||
437 | tasklet_kill(&budget->vpe_tasklet); | 437 | tasklet_kill(&budget->vpe_tasklet); |
438 | 438 | ||
diff --git a/drivers/media/dvb/ttpci/budget-patch.c b/drivers/media/dvb/ttpci/budget-patch.c index 5d524a4f213f..8142e26b47f5 100644 --- a/drivers/media/dvb/ttpci/budget-patch.c +++ b/drivers/media/dvb/ttpci/budget-patch.c | |||
@@ -453,7 +453,7 @@ static void frontend_init(struct budget_patch* budget) | |||
453 | budget->dev->pci->subsystem_vendor, | 453 | budget->dev->pci->subsystem_vendor, |
454 | budget->dev->pci->subsystem_device); | 454 | budget->dev->pci->subsystem_device); |
455 | } else { | 455 | } else { |
456 | if (dvb_register_frontend(budget->dvb_adapter, budget->dvb_frontend)) { | 456 | if (dvb_register_frontend(&budget->dvb_adapter, budget->dvb_frontend)) { |
457 | printk("budget-av: Frontend registration failed!\n"); | 457 | printk("budget-av: Frontend registration failed!\n"); |
458 | if (budget->dvb_frontend->ops->release) | 458 | if (budget->dvb_frontend->ops->release) |
459 | budget->dvb_frontend->ops->release(budget->dvb_frontend); | 459 | budget->dvb_frontend->ops->release(budget->dvb_frontend); |
@@ -702,7 +702,7 @@ static int budget_patch_attach (struct saa7146_dev* dev, struct saa7146_pci_exte | |||
702 | 702 | ||
703 | dev->ext_priv = budget; | 703 | dev->ext_priv = budget; |
704 | 704 | ||
705 | budget->dvb_adapter->priv = budget; | 705 | budget->dvb_adapter.priv = budget; |
706 | frontend_init(budget); | 706 | frontend_init(budget); |
707 | 707 | ||
708 | return 0; | 708 | return 0; |
diff --git a/drivers/media/dvb/ttpci/budget.c b/drivers/media/dvb/ttpci/budget.c index 5e6a10f4ad95..083fd44e5f90 100644 --- a/drivers/media/dvb/ttpci/budget.c +++ b/drivers/media/dvb/ttpci/budget.c | |||
@@ -468,7 +468,7 @@ static void frontend_init(struct budget *budget) | |||
468 | budget->dev->pci->subsystem_vendor, | 468 | budget->dev->pci->subsystem_vendor, |
469 | budget->dev->pci->subsystem_device); | 469 | budget->dev->pci->subsystem_device); |
470 | } else { | 470 | } else { |
471 | if (dvb_register_frontend(budget->dvb_adapter, budget->dvb_frontend)) { | 471 | if (dvb_register_frontend(&budget->dvb_adapter, budget->dvb_frontend)) { |
472 | printk("budget: Frontend registration failed!\n"); | 472 | printk("budget: Frontend registration failed!\n"); |
473 | if (budget->dvb_frontend->ops->release) | 473 | if (budget->dvb_frontend->ops->release) |
474 | budget->dvb_frontend->ops->release(budget->dvb_frontend); | 474 | budget->dvb_frontend->ops->release(budget->dvb_frontend); |
@@ -497,7 +497,7 @@ static int budget_attach (struct saa7146_dev* dev, struct saa7146_pci_extension_ | |||
497 | return err; | 497 | return err; |
498 | } | 498 | } |
499 | 499 | ||
500 | budget->dvb_adapter->priv = budget; | 500 | budget->dvb_adapter.priv = budget; |
501 | frontend_init(budget); | 501 | frontend_init(budget); |
502 | 502 | ||
503 | return 0; | 503 | return 0; |
diff --git a/drivers/media/dvb/ttpci/budget.h b/drivers/media/dvb/ttpci/budget.h index 10bd41f0363b..c6ef496ba70a 100644 --- a/drivers/media/dvb/ttpci/budget.h +++ b/drivers/media/dvb/ttpci/budget.h | |||
@@ -64,7 +64,7 @@ struct budget { | |||
64 | 64 | ||
65 | spinlock_t debilock; | 65 | spinlock_t debilock; |
66 | 66 | ||
67 | struct dvb_adapter *dvb_adapter; | 67 | struct dvb_adapter dvb_adapter; |
68 | struct dvb_frontend *dvb_frontend; | 68 | struct dvb_frontend *dvb_frontend; |
69 | void *priv; | 69 | void *priv; |
70 | }; | 70 | }; |
@@ -92,6 +92,9 @@ static struct saa7146_pci_extension_data x_var = { \ | |||
92 | #define BUDGET_KNC1S 8 | 92 | #define BUDGET_KNC1S 8 |
93 | #define BUDGET_KNC1C 9 | 93 | #define BUDGET_KNC1C 9 |
94 | #define BUDGET_KNC1T 10 | 94 | #define BUDGET_KNC1T 10 |
95 | #define BUDGET_KNC1SP 11 | ||
96 | #define BUDGET_KNC1CP 12 | ||
97 | #define BUDGET_KNC1TP 13 | ||
95 | 98 | ||
96 | #define BUDGET_VIDEO_PORTA 0 | 99 | #define BUDGET_VIDEO_PORTA 0 |
97 | #define BUDGET_VIDEO_PORTB 1 | 100 | #define BUDGET_VIDEO_PORTB 1 |
diff --git a/drivers/media/dvb/ttusb-budget/dvb-ttusb-budget.c b/drivers/media/dvb/ttusb-budget/dvb-ttusb-budget.c index 4c046ece883a..afa0e7a0e506 100644 --- a/drivers/media/dvb/ttusb-budget/dvb-ttusb-budget.c +++ b/drivers/media/dvb/ttusb-budget/dvb-ttusb-budget.c | |||
@@ -84,7 +84,7 @@ struct ttusb { | |||
84 | struct semaphore semi2c; | 84 | struct semaphore semi2c; |
85 | struct semaphore semusb; | 85 | struct semaphore semusb; |
86 | 86 | ||
87 | struct dvb_adapter *adapter; | 87 | struct dvb_adapter adapter; |
88 | struct usb_device *dev; | 88 | struct usb_device *dev; |
89 | 89 | ||
90 | struct i2c_adapter i2c_adap; | 90 | struct i2c_adapter i2c_adap; |
@@ -1065,7 +1065,7 @@ static int alps_tdmb7_pll_set(struct dvb_frontend* fe, struct dvb_frontend_param | |||
1065 | return 0; | 1065 | return 0; |
1066 | } | 1066 | } |
1067 | 1067 | ||
1068 | struct cx22700_config alps_tdmb7_config = { | 1068 | static struct cx22700_config alps_tdmb7_config = { |
1069 | .demod_address = 0x43, | 1069 | .demod_address = 0x43, |
1070 | .pll_set = alps_tdmb7_pll_set, | 1070 | .pll_set = alps_tdmb7_pll_set, |
1071 | }; | 1071 | }; |
@@ -1412,7 +1412,7 @@ static void frontend_init(struct ttusb* ttusb) | |||
1412 | le16_to_cpu(ttusb->dev->descriptor.idVendor), | 1412 | le16_to_cpu(ttusb->dev->descriptor.idVendor), |
1413 | le16_to_cpu(ttusb->dev->descriptor.idProduct)); | 1413 | le16_to_cpu(ttusb->dev->descriptor.idProduct)); |
1414 | } else { | 1414 | } else { |
1415 | if (dvb_register_frontend(ttusb->adapter, ttusb->fe)) { | 1415 | if (dvb_register_frontend(&ttusb->adapter, ttusb->fe)) { |
1416 | printk("dvb-ttusb-budget: Frontend registration failed!\n"); | 1416 | printk("dvb-ttusb-budget: Frontend registration failed!\n"); |
1417 | if (ttusb->fe->ops->release) | 1417 | if (ttusb->fe->ops->release) |
1418 | ttusb->fe->ops->release(ttusb->fe); | 1418 | ttusb->fe->ops->release(ttusb->fe); |
@@ -1462,7 +1462,7 @@ static int ttusb_probe(struct usb_interface *intf, const struct usb_device_id *i | |||
1462 | up(&ttusb->semi2c); | 1462 | up(&ttusb->semi2c); |
1463 | 1463 | ||
1464 | dvb_register_adapter(&ttusb->adapter, "Technotrend/Hauppauge Nova-USB", THIS_MODULE); | 1464 | dvb_register_adapter(&ttusb->adapter, "Technotrend/Hauppauge Nova-USB", THIS_MODULE); |
1465 | ttusb->adapter->priv = ttusb; | 1465 | ttusb->adapter.priv = ttusb; |
1466 | 1466 | ||
1467 | /* i2c */ | 1467 | /* i2c */ |
1468 | memset(&ttusb->i2c_adap, 0, sizeof(struct i2c_adapter)); | 1468 | memset(&ttusb->i2c_adap, 0, sizeof(struct i2c_adapter)); |
@@ -1481,7 +1481,7 @@ static int ttusb_probe(struct usb_interface *intf, const struct usb_device_id *i | |||
1481 | 1481 | ||
1482 | result = i2c_add_adapter(&ttusb->i2c_adap); | 1482 | result = i2c_add_adapter(&ttusb->i2c_adap); |
1483 | if (result) { | 1483 | if (result) { |
1484 | dvb_unregister_adapter (ttusb->adapter); | 1484 | dvb_unregister_adapter (&ttusb->adapter); |
1485 | return result; | 1485 | return result; |
1486 | } | 1486 | } |
1487 | 1487 | ||
@@ -1503,7 +1503,7 @@ static int ttusb_probe(struct usb_interface *intf, const struct usb_device_id *i | |||
1503 | if ((result = dvb_dmx_init(&ttusb->dvb_demux)) < 0) { | 1503 | if ((result = dvb_dmx_init(&ttusb->dvb_demux)) < 0) { |
1504 | printk("ttusb_dvb: dvb_dmx_init failed (errno = %d)\n", result); | 1504 | printk("ttusb_dvb: dvb_dmx_init failed (errno = %d)\n", result); |
1505 | i2c_del_adapter(&ttusb->i2c_adap); | 1505 | i2c_del_adapter(&ttusb->i2c_adap); |
1506 | dvb_unregister_adapter (ttusb->adapter); | 1506 | dvb_unregister_adapter (&ttusb->adapter); |
1507 | return -ENODEV; | 1507 | return -ENODEV; |
1508 | } | 1508 | } |
1509 | //FIXME dmxdev (nur WAS?) | 1509 | //FIXME dmxdev (nur WAS?) |
@@ -1511,21 +1511,21 @@ static int ttusb_probe(struct usb_interface *intf, const struct usb_device_id *i | |||
1511 | ttusb->dmxdev.demux = &ttusb->dvb_demux.dmx; | 1511 | ttusb->dmxdev.demux = &ttusb->dvb_demux.dmx; |
1512 | ttusb->dmxdev.capabilities = 0; | 1512 | ttusb->dmxdev.capabilities = 0; |
1513 | 1513 | ||
1514 | if ((result = dvb_dmxdev_init(&ttusb->dmxdev, ttusb->adapter)) < 0) { | 1514 | if ((result = dvb_dmxdev_init(&ttusb->dmxdev, &ttusb->adapter)) < 0) { |
1515 | printk("ttusb_dvb: dvb_dmxdev_init failed (errno = %d)\n", | 1515 | printk("ttusb_dvb: dvb_dmxdev_init failed (errno = %d)\n", |
1516 | result); | 1516 | result); |
1517 | dvb_dmx_release(&ttusb->dvb_demux); | 1517 | dvb_dmx_release(&ttusb->dvb_demux); |
1518 | i2c_del_adapter(&ttusb->i2c_adap); | 1518 | i2c_del_adapter(&ttusb->i2c_adap); |
1519 | dvb_unregister_adapter (ttusb->adapter); | 1519 | dvb_unregister_adapter (&ttusb->adapter); |
1520 | return -ENODEV; | 1520 | return -ENODEV; |
1521 | } | 1521 | } |
1522 | 1522 | ||
1523 | if (dvb_net_init(ttusb->adapter, &ttusb->dvbnet, &ttusb->dvb_demux.dmx)) { | 1523 | if (dvb_net_init(&ttusb->adapter, &ttusb->dvbnet, &ttusb->dvb_demux.dmx)) { |
1524 | printk("ttusb_dvb: dvb_net_init failed!\n"); | 1524 | printk("ttusb_dvb: dvb_net_init failed!\n"); |
1525 | dvb_dmxdev_release(&ttusb->dmxdev); | 1525 | dvb_dmxdev_release(&ttusb->dmxdev); |
1526 | dvb_dmx_release(&ttusb->dvb_demux); | 1526 | dvb_dmx_release(&ttusb->dvb_demux); |
1527 | i2c_del_adapter(&ttusb->i2c_adap); | 1527 | i2c_del_adapter(&ttusb->i2c_adap); |
1528 | dvb_unregister_adapter (ttusb->adapter); | 1528 | dvb_unregister_adapter (&ttusb->adapter); |
1529 | return -ENODEV; | 1529 | return -ENODEV; |
1530 | } | 1530 | } |
1531 | 1531 | ||
@@ -1559,7 +1559,7 @@ static void ttusb_disconnect(struct usb_interface *intf) | |||
1559 | dvb_dmx_release(&ttusb->dvb_demux); | 1559 | dvb_dmx_release(&ttusb->dvb_demux); |
1560 | if (ttusb->fe != NULL) dvb_unregister_frontend(ttusb->fe); | 1560 | if (ttusb->fe != NULL) dvb_unregister_frontend(ttusb->fe); |
1561 | i2c_del_adapter(&ttusb->i2c_adap); | 1561 | i2c_del_adapter(&ttusb->i2c_adap); |
1562 | dvb_unregister_adapter(ttusb->adapter); | 1562 | dvb_unregister_adapter(&ttusb->adapter); |
1563 | 1563 | ||
1564 | ttusb_free_iso_urbs(ttusb); | 1564 | ttusb_free_iso_urbs(ttusb); |
1565 | 1565 | ||
diff --git a/drivers/media/dvb/ttusb-dec/ttusb_dec.c b/drivers/media/dvb/ttusb-dec/ttusb_dec.c index 64e771bd8907..505bdaff5a7e 100644 --- a/drivers/media/dvb/ttusb-dec/ttusb_dec.c +++ b/drivers/media/dvb/ttusb-dec/ttusb_dec.c | |||
@@ -98,7 +98,7 @@ struct ttusb_dec { | |||
98 | int can_playback; | 98 | int can_playback; |
99 | 99 | ||
100 | /* DVB bits */ | 100 | /* DVB bits */ |
101 | struct dvb_adapter *adapter; | 101 | struct dvb_adapter adapter; |
102 | struct dmxdev dmxdev; | 102 | struct dmxdev dmxdev; |
103 | struct dvb_demux demux; | 103 | struct dvb_demux demux; |
104 | struct dmx_frontend frontend; | 104 | struct dmx_frontend frontend; |
@@ -1435,7 +1435,7 @@ static int ttusb_dec_init_dvb(struct ttusb_dec *dec) | |||
1435 | printk("%s: dvb_dmx_init failed: error %d\n", __FUNCTION__, | 1435 | printk("%s: dvb_dmx_init failed: error %d\n", __FUNCTION__, |
1436 | result); | 1436 | result); |
1437 | 1437 | ||
1438 | dvb_unregister_adapter(dec->adapter); | 1438 | dvb_unregister_adapter(&dec->adapter); |
1439 | 1439 | ||
1440 | return result; | 1440 | return result; |
1441 | } | 1441 | } |
@@ -1444,12 +1444,12 @@ static int ttusb_dec_init_dvb(struct ttusb_dec *dec) | |||
1444 | dec->dmxdev.demux = &dec->demux.dmx; | 1444 | dec->dmxdev.demux = &dec->demux.dmx; |
1445 | dec->dmxdev.capabilities = 0; | 1445 | dec->dmxdev.capabilities = 0; |
1446 | 1446 | ||
1447 | if ((result = dvb_dmxdev_init(&dec->dmxdev, dec->adapter)) < 0) { | 1447 | if ((result = dvb_dmxdev_init(&dec->dmxdev, &dec->adapter)) < 0) { |
1448 | printk("%s: dvb_dmxdev_init failed: error %d\n", | 1448 | printk("%s: dvb_dmxdev_init failed: error %d\n", |
1449 | __FUNCTION__, result); | 1449 | __FUNCTION__, result); |
1450 | 1450 | ||
1451 | dvb_dmx_release(&dec->demux); | 1451 | dvb_dmx_release(&dec->demux); |
1452 | dvb_unregister_adapter(dec->adapter); | 1452 | dvb_unregister_adapter(&dec->adapter); |
1453 | 1453 | ||
1454 | return result; | 1454 | return result; |
1455 | } | 1455 | } |
@@ -1463,7 +1463,7 @@ static int ttusb_dec_init_dvb(struct ttusb_dec *dec) | |||
1463 | 1463 | ||
1464 | dvb_dmxdev_release(&dec->dmxdev); | 1464 | dvb_dmxdev_release(&dec->dmxdev); |
1465 | dvb_dmx_release(&dec->demux); | 1465 | dvb_dmx_release(&dec->demux); |
1466 | dvb_unregister_adapter(dec->adapter); | 1466 | dvb_unregister_adapter(&dec->adapter); |
1467 | 1467 | ||
1468 | return result; | 1468 | return result; |
1469 | } | 1469 | } |
@@ -1476,12 +1476,12 @@ static int ttusb_dec_init_dvb(struct ttusb_dec *dec) | |||
1476 | dec->demux.dmx.remove_frontend(&dec->demux.dmx, &dec->frontend); | 1476 | dec->demux.dmx.remove_frontend(&dec->demux.dmx, &dec->frontend); |
1477 | dvb_dmxdev_release(&dec->dmxdev); | 1477 | dvb_dmxdev_release(&dec->dmxdev); |
1478 | dvb_dmx_release(&dec->demux); | 1478 | dvb_dmx_release(&dec->demux); |
1479 | dvb_unregister_adapter(dec->adapter); | 1479 | dvb_unregister_adapter(&dec->adapter); |
1480 | 1480 | ||
1481 | return result; | 1481 | return result; |
1482 | } | 1482 | } |
1483 | 1483 | ||
1484 | dvb_net_init(dec->adapter, &dec->dvb_net, &dec->demux.dmx); | 1484 | dvb_net_init(&dec->adapter, &dec->dvb_net, &dec->demux.dmx); |
1485 | 1485 | ||
1486 | return 0; | 1486 | return 0; |
1487 | } | 1487 | } |
@@ -1496,7 +1496,7 @@ static void ttusb_dec_exit_dvb(struct ttusb_dec *dec) | |||
1496 | dvb_dmxdev_release(&dec->dmxdev); | 1496 | dvb_dmxdev_release(&dec->dmxdev); |
1497 | dvb_dmx_release(&dec->demux); | 1497 | dvb_dmx_release(&dec->demux); |
1498 | if (dec->fe) dvb_unregister_frontend(dec->fe); | 1498 | if (dec->fe) dvb_unregister_frontend(dec->fe); |
1499 | dvb_unregister_adapter(dec->adapter); | 1499 | dvb_unregister_adapter(&dec->adapter); |
1500 | } | 1500 | } |
1501 | 1501 | ||
1502 | static void ttusb_dec_exit_rc(struct ttusb_dec *dec) | 1502 | static void ttusb_dec_exit_rc(struct ttusb_dec *dec) |
@@ -1565,15 +1565,15 @@ static void ttusb_dec_exit_filters(struct ttusb_dec *dec) | |||
1565 | } | 1565 | } |
1566 | } | 1566 | } |
1567 | 1567 | ||
1568 | int fe_send_command(struct dvb_frontend* fe, const u8 command, | 1568 | static int fe_send_command(struct dvb_frontend* fe, const u8 command, |
1569 | int param_length, const u8 params[], | 1569 | int param_length, const u8 params[], |
1570 | int *result_length, u8 cmd_result[]) | 1570 | int *result_length, u8 cmd_result[]) |
1571 | { | 1571 | { |
1572 | struct ttusb_dec* dec = (struct ttusb_dec*) fe->dvb->priv; | 1572 | struct ttusb_dec* dec = (struct ttusb_dec*) fe->dvb->priv; |
1573 | return ttusb_dec_send_command(dec, command, param_length, params, result_length, cmd_result); | 1573 | return ttusb_dec_send_command(dec, command, param_length, params, result_length, cmd_result); |
1574 | } | 1574 | } |
1575 | 1575 | ||
1576 | struct ttusbdecfe_config fe_config = { | 1576 | static struct ttusbdecfe_config fe_config = { |
1577 | .send_command = fe_send_command | 1577 | .send_command = fe_send_command |
1578 | }; | 1578 | }; |
1579 | 1579 | ||
@@ -1620,7 +1620,7 @@ static int ttusb_dec_probe(struct usb_interface *intf, | |||
1620 | } | 1620 | } |
1621 | ttusb_dec_init_dvb(dec); | 1621 | ttusb_dec_init_dvb(dec); |
1622 | 1622 | ||
1623 | dec->adapter->priv = dec; | 1623 | dec->adapter.priv = dec; |
1624 | switch (le16_to_cpu(id->idProduct)) { | 1624 | switch (le16_to_cpu(id->idProduct)) { |
1625 | case 0x1006: | 1625 | case 0x1006: |
1626 | dec->fe = ttusbdecfe_dvbs_attach(&fe_config); | 1626 | dec->fe = ttusbdecfe_dvbs_attach(&fe_config); |
@@ -1637,7 +1637,7 @@ static int ttusb_dec_probe(struct usb_interface *intf, | |||
1637 | le16_to_cpu(dec->udev->descriptor.idVendor), | 1637 | le16_to_cpu(dec->udev->descriptor.idVendor), |
1638 | le16_to_cpu(dec->udev->descriptor.idProduct)); | 1638 | le16_to_cpu(dec->udev->descriptor.idProduct)); |
1639 | } else { | 1639 | } else { |
1640 | if (dvb_register_frontend(dec->adapter, dec->fe)) { | 1640 | if (dvb_register_frontend(&dec->adapter, dec->fe)) { |
1641 | printk("budget-ci: Frontend registration failed!\n"); | 1641 | printk("budget-ci: Frontend registration failed!\n"); |
1642 | if (dec->fe->ops->release) | 1642 | if (dec->fe->ops->release) |
1643 | dec->fe->ops->release(dec->fe); | 1643 | dec->fe->ops->release(dec->fe); |
diff --git a/drivers/media/video/Kconfig b/drivers/media/video/Kconfig index d3dd4228b72d..6c05fddb69ab 100644 --- a/drivers/media/video/Kconfig +++ b/drivers/media/video/Kconfig | |||
@@ -240,6 +240,7 @@ config VIDEO_SAA7134 | |||
240 | select VIDEO_BUF | 240 | select VIDEO_BUF |
241 | select VIDEO_IR | 241 | select VIDEO_IR |
242 | select VIDEO_TUNER | 242 | select VIDEO_TUNER |
243 | select CRC32 | ||
243 | ---help--- | 244 | ---help--- |
244 | This is a video4linux driver for Philips SAA7130/7134 based | 245 | This is a video4linux driver for Philips SAA7130/7134 based |
245 | TV cards. | 246 | TV cards. |
diff --git a/drivers/media/video/bttv-cards.c b/drivers/media/video/bttv-cards.c index 85224b90e394..6334122704ae 100644 --- a/drivers/media/video/bttv-cards.c +++ b/drivers/media/video/bttv-cards.c | |||
@@ -1946,7 +1946,6 @@ struct tvcard bttv_tvcards[] = { | |||
1946 | .no_tda9875 = 1, | 1946 | .no_tda9875 = 1, |
1947 | .no_tda7432 = 1, | 1947 | .no_tda7432 = 1, |
1948 | .tuner_type = TUNER_ABSENT, | 1948 | .tuner_type = TUNER_ABSENT, |
1949 | .no_video = 1, | ||
1950 | .pll = PLL_28, | 1949 | .pll = PLL_28, |
1951 | },{ | 1950 | },{ |
1952 | .name = "Teppro TEV-560/InterVision IV-560", | 1951 | .name = "Teppro TEV-560/InterVision IV-560", |
diff --git a/drivers/media/video/video-buf-dvb.c b/drivers/media/video/video-buf-dvb.c index 31cc4ed9b747..5f870075b55e 100644 --- a/drivers/media/video/video-buf-dvb.c +++ b/drivers/media/video/video-buf-dvb.c | |||
@@ -149,10 +149,10 @@ int videobuf_dvb_register(struct videobuf_dvb *dvb, | |||
149 | dvb->name, result); | 149 | dvb->name, result); |
150 | goto fail_adapter; | 150 | goto fail_adapter; |
151 | } | 151 | } |
152 | dvb->adapter->priv = adapter_priv; | 152 | dvb->adapter.priv = adapter_priv; |
153 | 153 | ||
154 | /* register frontend */ | 154 | /* register frontend */ |
155 | result = dvb_register_frontend(dvb->adapter, dvb->frontend); | 155 | result = dvb_register_frontend(&dvb->adapter, dvb->frontend); |
156 | if (result < 0) { | 156 | if (result < 0) { |
157 | printk(KERN_WARNING "%s: dvb_register_frontend failed (errno = %d)\n", | 157 | printk(KERN_WARNING "%s: dvb_register_frontend failed (errno = %d)\n", |
158 | dvb->name, result); | 158 | dvb->name, result); |
@@ -178,7 +178,7 @@ int videobuf_dvb_register(struct videobuf_dvb *dvb, | |||
178 | dvb->dmxdev.filternum = 256; | 178 | dvb->dmxdev.filternum = 256; |
179 | dvb->dmxdev.demux = &dvb->demux.dmx; | 179 | dvb->dmxdev.demux = &dvb->demux.dmx; |
180 | dvb->dmxdev.capabilities = 0; | 180 | dvb->dmxdev.capabilities = 0; |
181 | result = dvb_dmxdev_init(&dvb->dmxdev, dvb->adapter); | 181 | result = dvb_dmxdev_init(&dvb->dmxdev, &dvb->adapter); |
182 | if (result < 0) { | 182 | if (result < 0) { |
183 | printk(KERN_WARNING "%s: dvb_dmxdev_init failed (errno = %d)\n", | 183 | printk(KERN_WARNING "%s: dvb_dmxdev_init failed (errno = %d)\n", |
184 | dvb->name, result); | 184 | dvb->name, result); |
@@ -209,7 +209,7 @@ int videobuf_dvb_register(struct videobuf_dvb *dvb, | |||
209 | } | 209 | } |
210 | 210 | ||
211 | /* register network adapter */ | 211 | /* register network adapter */ |
212 | dvb_net_init(dvb->adapter, &dvb->net, &dvb->demux.dmx); | 212 | dvb_net_init(&dvb->adapter, &dvb->net, &dvb->demux.dmx); |
213 | return 0; | 213 | return 0; |
214 | 214 | ||
215 | fail_fe_conn: | 215 | fail_fe_conn: |
@@ -223,7 +223,7 @@ fail_dmxdev: | |||
223 | fail_dmx: | 223 | fail_dmx: |
224 | dvb_unregister_frontend(dvb->frontend); | 224 | dvb_unregister_frontend(dvb->frontend); |
225 | fail_frontend: | 225 | fail_frontend: |
226 | dvb_unregister_adapter(dvb->adapter); | 226 | dvb_unregister_adapter(&dvb->adapter); |
227 | fail_adapter: | 227 | fail_adapter: |
228 | return result; | 228 | return result; |
229 | } | 229 | } |
@@ -236,7 +236,7 @@ void videobuf_dvb_unregister(struct videobuf_dvb *dvb) | |||
236 | dvb_dmxdev_release(&dvb->dmxdev); | 236 | dvb_dmxdev_release(&dvb->dmxdev); |
237 | dvb_dmx_release(&dvb->demux); | 237 | dvb_dmx_release(&dvb->demux); |
238 | dvb_unregister_frontend(dvb->frontend); | 238 | dvb_unregister_frontend(dvb->frontend); |
239 | dvb_unregister_adapter(dvb->adapter); | 239 | dvb_unregister_adapter(&dvb->adapter); |
240 | } | 240 | } |
241 | 241 | ||
242 | EXPORT_SYMBOL(videobuf_dvb_register); | 242 | EXPORT_SYMBOL(videobuf_dvb_register); |
diff --git a/drivers/pci/hotplug.c b/drivers/pci/hotplug.c index 021d0f76bc4c..3903f8c559b6 100644 --- a/drivers/pci/hotplug.c +++ b/drivers/pci/hotplug.c | |||
@@ -52,116 +52,17 @@ int pci_hotplug (struct device *dev, char **envp, int num_envp, | |||
52 | if ((buffer_size - length <= 0) || (i >= num_envp)) | 52 | if ((buffer_size - length <= 0) || (i >= num_envp)) |
53 | return -ENOMEM; | 53 | return -ENOMEM; |
54 | 54 | ||
55 | envp[i++] = scratch; | ||
56 | length += scnprintf (scratch, buffer_size - length, | ||
57 | "MODALIAS=pci:v%08Xd%08Xsv%08Xsd%08Xbc%02Xsc%02Xi%02x\n", | ||
58 | pdev->vendor, pdev->device, | ||
59 | pdev->subsystem_vendor, pdev->subsystem_device, | ||
60 | (u8)(pdev->class >> 16), (u8)(pdev->class >> 8), | ||
61 | (u8)(pdev->class)); | ||
62 | if ((buffer_size - length <= 0) || (i >= num_envp)) | ||
63 | return -ENOMEM; | ||
64 | |||
55 | envp[i] = NULL; | 65 | envp[i] = NULL; |
56 | 66 | ||
57 | return 0; | 67 | return 0; |
58 | } | 68 | } |
59 | |||
60 | static int pci_visit_bus (struct pci_visit * fn, struct pci_bus_wrapped *wrapped_bus, struct pci_dev_wrapped *wrapped_parent) | ||
61 | { | ||
62 | struct list_head *ln; | ||
63 | struct pci_dev *dev; | ||
64 | struct pci_dev_wrapped wrapped_dev; | ||
65 | int result = 0; | ||
66 | |||
67 | pr_debug("PCI: Scanning bus %04x:%02x\n", pci_domain_nr(wrapped_bus->bus), | ||
68 | wrapped_bus->bus->number); | ||
69 | |||
70 | if (fn->pre_visit_pci_bus) { | ||
71 | result = fn->pre_visit_pci_bus(wrapped_bus, wrapped_parent); | ||
72 | if (result) | ||
73 | return result; | ||
74 | } | ||
75 | |||
76 | ln = wrapped_bus->bus->devices.next; | ||
77 | while (ln != &wrapped_bus->bus->devices) { | ||
78 | dev = pci_dev_b(ln); | ||
79 | ln = ln->next; | ||
80 | |||
81 | memset(&wrapped_dev, 0, sizeof(struct pci_dev_wrapped)); | ||
82 | wrapped_dev.dev = dev; | ||
83 | |||
84 | result = pci_visit_dev(fn, &wrapped_dev, wrapped_bus); | ||
85 | if (result) | ||
86 | return result; | ||
87 | } | ||
88 | |||
89 | if (fn->post_visit_pci_bus) | ||
90 | result = fn->post_visit_pci_bus(wrapped_bus, wrapped_parent); | ||
91 | |||
92 | return result; | ||
93 | } | ||
94 | |||
95 | static int pci_visit_bridge (struct pci_visit * fn, | ||
96 | struct pci_dev_wrapped *wrapped_dev, | ||
97 | struct pci_bus_wrapped *wrapped_parent) | ||
98 | { | ||
99 | struct pci_bus *bus; | ||
100 | struct pci_bus_wrapped wrapped_bus; | ||
101 | int result = 0; | ||
102 | |||
103 | pr_debug("PCI: Scanning bridge %s\n", pci_name(wrapped_dev->dev)); | ||
104 | |||
105 | if (fn->visit_pci_dev) { | ||
106 | result = fn->visit_pci_dev(wrapped_dev, wrapped_parent); | ||
107 | if (result) | ||
108 | return result; | ||
109 | } | ||
110 | |||
111 | bus = wrapped_dev->dev->subordinate; | ||
112 | if (bus) { | ||
113 | memset(&wrapped_bus, 0, sizeof(struct pci_bus_wrapped)); | ||
114 | wrapped_bus.bus = bus; | ||
115 | |||
116 | result = pci_visit_bus(fn, &wrapped_bus, wrapped_dev); | ||
117 | } | ||
118 | return result; | ||
119 | } | ||
120 | |||
121 | /** | ||
122 | * pci_visit_dev - scans the pci buses. | ||
123 | * @fn: callback functions that are called while visiting | ||
124 | * @wrapped_dev: the device to scan | ||
125 | * @wrapped_parent: the bus where @wrapped_dev is connected to | ||
126 | * | ||
127 | * Every bus and every function is presented to a custom | ||
128 | * function that can act upon it. | ||
129 | */ | ||
130 | int pci_visit_dev(struct pci_visit *fn, struct pci_dev_wrapped *wrapped_dev, | ||
131 | struct pci_bus_wrapped *wrapped_parent) | ||
132 | { | ||
133 | struct pci_dev* dev = wrapped_dev ? wrapped_dev->dev : NULL; | ||
134 | int result = 0; | ||
135 | |||
136 | if (!dev) | ||
137 | return 0; | ||
138 | |||
139 | if (fn->pre_visit_pci_dev) { | ||
140 | result = fn->pre_visit_pci_dev(wrapped_dev, wrapped_parent); | ||
141 | if (result) | ||
142 | return result; | ||
143 | } | ||
144 | |||
145 | switch (dev->class >> 8) { | ||
146 | case PCI_CLASS_BRIDGE_PCI: | ||
147 | result = pci_visit_bridge(fn, wrapped_dev, | ||
148 | wrapped_parent); | ||
149 | if (result) | ||
150 | return result; | ||
151 | break; | ||
152 | default: | ||
153 | pr_debug("PCI: Scanning device %s\n", pci_name(dev)); | ||
154 | if (fn->visit_pci_dev) { | ||
155 | result = fn->visit_pci_dev (wrapped_dev, | ||
156 | wrapped_parent); | ||
157 | if (result) | ||
158 | return result; | ||
159 | } | ||
160 | } | ||
161 | |||
162 | if (fn->post_visit_pci_dev) | ||
163 | result = fn->post_visit_pci_dev(wrapped_dev, wrapped_parent); | ||
164 | |||
165 | return result; | ||
166 | } | ||
167 | EXPORT_SYMBOL(pci_visit_dev); | ||
diff --git a/drivers/pci/hotplug/cpci_hotplug.h b/drivers/pci/hotplug/cpci_hotplug.h index 3ddd75937a40..d9769b30be9a 100644 --- a/drivers/pci/hotplug/cpci_hotplug.h +++ b/drivers/pci/hotplug/cpci_hotplug.h | |||
@@ -31,7 +31,7 @@ | |||
31 | #include <linux/types.h> | 31 | #include <linux/types.h> |
32 | #include <linux/pci.h> | 32 | #include <linux/pci.h> |
33 | 33 | ||
34 | /* PICMG 2.12 R2.0 HS CSR bits: */ | 34 | /* PICMG 2.1 R2.0 HS CSR bits: */ |
35 | #define HS_CSR_INS 0x0080 | 35 | #define HS_CSR_INS 0x0080 |
36 | #define HS_CSR_EXT 0x0040 | 36 | #define HS_CSR_EXT 0x0040 |
37 | #define HS_CSR_PI 0x0030 | 37 | #define HS_CSR_PI 0x0030 |
diff --git a/drivers/pci/hotplug/cpci_hotplug_core.c b/drivers/pci/hotplug/cpci_hotplug_core.c index ed243605dc7b..9e9dab7fe86a 100644 --- a/drivers/pci/hotplug/cpci_hotplug_core.c +++ b/drivers/pci/hotplug/cpci_hotplug_core.c | |||
@@ -33,11 +33,11 @@ | |||
33 | #include <linux/init.h> | 33 | #include <linux/init.h> |
34 | #include <linux/interrupt.h> | 34 | #include <linux/interrupt.h> |
35 | #include <linux/smp_lock.h> | 35 | #include <linux/smp_lock.h> |
36 | #include <asm/atomic.h> | ||
36 | #include <linux/delay.h> | 37 | #include <linux/delay.h> |
37 | #include "pci_hotplug.h" | 38 | #include "pci_hotplug.h" |
38 | #include "cpci_hotplug.h" | 39 | #include "cpci_hotplug.h" |
39 | 40 | ||
40 | #define DRIVER_VERSION "0.2" | ||
41 | #define DRIVER_AUTHOR "Scott Murray <scottm@somanetworks.com>" | 41 | #define DRIVER_AUTHOR "Scott Murray <scottm@somanetworks.com>" |
42 | #define DRIVER_DESC "CompactPCI Hot Plug Core" | 42 | #define DRIVER_DESC "CompactPCI Hot Plug Core" |
43 | 43 | ||
@@ -54,9 +54,10 @@ | |||
54 | #define warn(format, arg...) printk(KERN_WARNING "%s: " format "\n", MY_NAME , ## arg) | 54 | #define warn(format, arg...) printk(KERN_WARNING "%s: " format "\n", MY_NAME , ## arg) |
55 | 55 | ||
56 | /* local variables */ | 56 | /* local variables */ |
57 | static spinlock_t list_lock; | 57 | static DECLARE_RWSEM(list_rwsem); |
58 | static LIST_HEAD(slot_list); | 58 | static LIST_HEAD(slot_list); |
59 | static int slots; | 59 | static int slots; |
60 | static atomic_t extracting; | ||
60 | int cpci_debug; | 61 | int cpci_debug; |
61 | static struct cpci_hp_controller *controller; | 62 | static struct cpci_hp_controller *controller; |
62 | static struct semaphore event_semaphore; /* mutex for process loop (up if something to process) */ | 63 | static struct semaphore event_semaphore; /* mutex for process loop (up if something to process) */ |
@@ -68,6 +69,8 @@ static int disable_slot(struct hotplug_slot *slot); | |||
68 | static int set_attention_status(struct hotplug_slot *slot, u8 value); | 69 | static int set_attention_status(struct hotplug_slot *slot, u8 value); |
69 | static int get_power_status(struct hotplug_slot *slot, u8 * value); | 70 | static int get_power_status(struct hotplug_slot *slot, u8 * value); |
70 | static int get_attention_status(struct hotplug_slot *slot, u8 * value); | 71 | static int get_attention_status(struct hotplug_slot *slot, u8 * value); |
72 | static int get_adapter_status(struct hotplug_slot *slot, u8 * value); | ||
73 | static int get_latch_status(struct hotplug_slot *slot, u8 * value); | ||
71 | 74 | ||
72 | static struct hotplug_slot_ops cpci_hotplug_slot_ops = { | 75 | static struct hotplug_slot_ops cpci_hotplug_slot_ops = { |
73 | .owner = THIS_MODULE, | 76 | .owner = THIS_MODULE, |
@@ -76,6 +79,8 @@ static struct hotplug_slot_ops cpci_hotplug_slot_ops = { | |||
76 | .set_attention_status = set_attention_status, | 79 | .set_attention_status = set_attention_status, |
77 | .get_power_status = get_power_status, | 80 | .get_power_status = get_power_status, |
78 | .get_attention_status = get_attention_status, | 81 | .get_attention_status = get_attention_status, |
82 | .get_adapter_status = get_adapter_status, | ||
83 | .get_latch_status = get_latch_status, | ||
79 | }; | 84 | }; |
80 | 85 | ||
81 | static int | 86 | static int |
@@ -148,8 +153,10 @@ disable_slot(struct hotplug_slot *hotplug_slot) | |||
148 | warn("failure to update adapter file"); | 153 | warn("failure to update adapter file"); |
149 | } | 154 | } |
150 | 155 | ||
151 | slot->extracting = 0; | 156 | if(slot->extracting) { |
152 | 157 | slot->extracting = 0; | |
158 | atomic_dec(&extracting); | ||
159 | } | ||
153 | return retval; | 160 | return retval; |
154 | } | 161 | } |
155 | 162 | ||
@@ -188,6 +195,20 @@ set_attention_status(struct hotplug_slot *hotplug_slot, u8 status) | |||
188 | return cpci_set_attention_status(hotplug_slot->private, status); | 195 | return cpci_set_attention_status(hotplug_slot->private, status); |
189 | } | 196 | } |
190 | 197 | ||
198 | static int | ||
199 | get_adapter_status(struct hotplug_slot *hotplug_slot, u8 * value) | ||
200 | { | ||
201 | *value = hotplug_slot->info->adapter_status; | ||
202 | return 0; | ||
203 | } | ||
204 | |||
205 | static int | ||
206 | get_latch_status(struct hotplug_slot *hotplug_slot, u8 * value) | ||
207 | { | ||
208 | *value = hotplug_slot->info->latch_status; | ||
209 | return 0; | ||
210 | } | ||
211 | |||
191 | static void release_slot(struct hotplug_slot *hotplug_slot) | 212 | static void release_slot(struct hotplug_slot *hotplug_slot) |
192 | { | 213 | { |
193 | struct slot *slot = hotplug_slot->private; | 214 | struct slot *slot = hotplug_slot->private; |
@@ -273,10 +294,10 @@ cpci_hp_register_bus(struct pci_bus *bus, u8 first, u8 last) | |||
273 | } | 294 | } |
274 | 295 | ||
275 | /* Add slot to our internal list */ | 296 | /* Add slot to our internal list */ |
276 | spin_lock(&list_lock); | 297 | down_write(&list_rwsem); |
277 | list_add(&slot->slot_list, &slot_list); | 298 | list_add(&slot->slot_list, &slot_list); |
278 | slots++; | 299 | slots++; |
279 | spin_unlock(&list_lock); | 300 | up_write(&list_rwsem); |
280 | } | 301 | } |
281 | return 0; | 302 | return 0; |
282 | error_name: | 303 | error_name: |
@@ -299,9 +320,9 @@ cpci_hp_unregister_bus(struct pci_bus *bus) | |||
299 | struct list_head *next; | 320 | struct list_head *next; |
300 | int status; | 321 | int status; |
301 | 322 | ||
302 | spin_lock(&list_lock); | 323 | down_write(&list_rwsem); |
303 | if(!slots) { | 324 | if(!slots) { |
304 | spin_unlock(&list_lock); | 325 | up_write(&list_rwsem); |
305 | return -1; | 326 | return -1; |
306 | } | 327 | } |
307 | list_for_each_safe(tmp, next, &slot_list) { | 328 | list_for_each_safe(tmp, next, &slot_list) { |
@@ -319,7 +340,7 @@ cpci_hp_unregister_bus(struct pci_bus *bus) | |||
319 | slots--; | 340 | slots--; |
320 | } | 341 | } |
321 | } | 342 | } |
322 | spin_unlock(&list_lock); | 343 | up_write(&list_rwsem); |
323 | return 0; | 344 | return 0; |
324 | } | 345 | } |
325 | 346 | ||
@@ -347,7 +368,7 @@ cpci_hp_intr(int irq, void *data, struct pt_regs *regs) | |||
347 | } | 368 | } |
348 | 369 | ||
349 | /* | 370 | /* |
350 | * According to PICMG 2.12 R2.0, section 6.3.2, upon | 371 | * According to PICMG 2.1 R2.0, section 6.3.2, upon |
351 | * initialization, the system driver shall clear the | 372 | * initialization, the system driver shall clear the |
352 | * INS bits of the cold-inserted devices. | 373 | * INS bits of the cold-inserted devices. |
353 | */ | 374 | */ |
@@ -359,9 +380,9 @@ init_slots(void) | |||
359 | struct pci_dev* dev; | 380 | struct pci_dev* dev; |
360 | 381 | ||
361 | dbg("%s - enter", __FUNCTION__); | 382 | dbg("%s - enter", __FUNCTION__); |
362 | spin_lock(&list_lock); | 383 | down_read(&list_rwsem); |
363 | if(!slots) { | 384 | if(!slots) { |
364 | spin_unlock(&list_lock); | 385 | up_read(&list_rwsem); |
365 | return -1; | 386 | return -1; |
366 | } | 387 | } |
367 | list_for_each(tmp, &slot_list) { | 388 | list_for_each(tmp, &slot_list) { |
@@ -386,7 +407,7 @@ init_slots(void) | |||
386 | } | 407 | } |
387 | } | 408 | } |
388 | } | 409 | } |
389 | spin_unlock(&list_lock); | 410 | up_read(&list_rwsem); |
390 | dbg("%s - exit", __FUNCTION__); | 411 | dbg("%s - exit", __FUNCTION__); |
391 | return 0; | 412 | return 0; |
392 | } | 413 | } |
@@ -398,10 +419,11 @@ check_slots(void) | |||
398 | struct list_head *tmp; | 419 | struct list_head *tmp; |
399 | int extracted; | 420 | int extracted; |
400 | int inserted; | 421 | int inserted; |
422 | u16 hs_csr; | ||
401 | 423 | ||
402 | spin_lock(&list_lock); | 424 | down_read(&list_rwsem); |
403 | if(!slots) { | 425 | if(!slots) { |
404 | spin_unlock(&list_lock); | 426 | up_read(&list_rwsem); |
405 | err("no slots registered, shutting down"); | 427 | err("no slots registered, shutting down"); |
406 | return -1; | 428 | return -1; |
407 | } | 429 | } |
@@ -411,8 +433,6 @@ check_slots(void) | |||
411 | dbg("%s - looking at slot %s", | 433 | dbg("%s - looking at slot %s", |
412 | __FUNCTION__, slot->hotplug_slot->name); | 434 | __FUNCTION__, slot->hotplug_slot->name); |
413 | if(cpci_check_and_clear_ins(slot)) { | 435 | if(cpci_check_and_clear_ins(slot)) { |
414 | u16 hs_csr; | ||
415 | |||
416 | /* Some broken hardware (e.g. PLX 9054AB) asserts ENUM# twice... */ | 436 | /* Some broken hardware (e.g. PLX 9054AB) asserts ENUM# twice... */ |
417 | if(slot->dev) { | 437 | if(slot->dev) { |
418 | warn("slot %s already inserted", slot->hotplug_slot->name); | 438 | warn("slot %s already inserted", slot->hotplug_slot->name); |
@@ -462,8 +482,6 @@ check_slots(void) | |||
462 | 482 | ||
463 | inserted++; | 483 | inserted++; |
464 | } else if(cpci_check_ext(slot)) { | 484 | } else if(cpci_check_ext(slot)) { |
465 | u16 hs_csr; | ||
466 | |||
467 | /* Process extraction request */ | 485 | /* Process extraction request */ |
468 | dbg("%s - slot %s extracted", | 486 | dbg("%s - slot %s extracted", |
469 | __FUNCTION__, slot->hotplug_slot->name); | 487 | __FUNCTION__, slot->hotplug_slot->name); |
@@ -476,20 +494,40 @@ check_slots(void) | |||
476 | if(!slot->extracting) { | 494 | if(!slot->extracting) { |
477 | if(update_latch_status(slot->hotplug_slot, 0)) { | 495 | if(update_latch_status(slot->hotplug_slot, 0)) { |
478 | warn("failure to update latch file"); | 496 | warn("failure to update latch file"); |
497 | |||
479 | } | 498 | } |
499 | atomic_inc(&extracting); | ||
480 | slot->extracting = 1; | 500 | slot->extracting = 1; |
481 | } | 501 | } |
482 | extracted++; | 502 | extracted++; |
503 | } else if(slot->extracting) { | ||
504 | hs_csr = cpci_get_hs_csr(slot); | ||
505 | if(hs_csr == 0xffff) { | ||
506 | /* | ||
507 | * Hmmm, we're likely hosed at this point, should we | ||
508 | * bother trying to tell the driver or not? | ||
509 | */ | ||
510 | err("card in slot %s was improperly removed", | ||
511 | slot->hotplug_slot->name); | ||
512 | if(update_adapter_status(slot->hotplug_slot, 0)) { | ||
513 | warn("failure to update adapter file"); | ||
514 | } | ||
515 | slot->extracting = 0; | ||
516 | atomic_dec(&extracting); | ||
517 | } | ||
483 | } | 518 | } |
484 | } | 519 | } |
485 | spin_unlock(&list_lock); | 520 | up_read(&list_rwsem); |
521 | dbg("inserted=%d, extracted=%d, extracting=%d", | ||
522 | inserted, extracted, atomic_read(&extracting)); | ||
486 | if(inserted || extracted) { | 523 | if(inserted || extracted) { |
487 | return extracted; | 524 | return extracted; |
488 | } | 525 | } |
489 | else { | 526 | else if(!atomic_read(&extracting)) { |
490 | err("cannot find ENUM# source, shutting down"); | 527 | err("cannot find ENUM# source, shutting down"); |
491 | return -1; | 528 | return -1; |
492 | } | 529 | } |
530 | return 0; | ||
493 | } | 531 | } |
494 | 532 | ||
495 | /* This is the interrupt mode worker thread body */ | 533 | /* This is the interrupt mode worker thread body */ |
@@ -497,8 +535,6 @@ static int | |||
497 | event_thread(void *data) | 535 | event_thread(void *data) |
498 | { | 536 | { |
499 | int rc; | 537 | int rc; |
500 | struct slot *slot; | ||
501 | struct list_head *tmp; | ||
502 | 538 | ||
503 | lock_kernel(); | 539 | lock_kernel(); |
504 | daemonize("cpci_hp_eventd"); | 540 | daemonize("cpci_hp_eventd"); |
@@ -512,39 +548,22 @@ event_thread(void *data) | |||
512 | thread_finished); | 548 | thread_finished); |
513 | if(thread_finished || signal_pending(current)) | 549 | if(thread_finished || signal_pending(current)) |
514 | break; | 550 | break; |
515 | while(controller->ops->query_enum()) { | 551 | do { |
516 | rc = check_slots(); | 552 | rc = check_slots(); |
517 | if (rc > 0) | 553 | if (rc > 0) { |
518 | /* Give userspace a chance to handle extraction */ | 554 | /* Give userspace a chance to handle extraction */ |
519 | msleep(500); | 555 | msleep(500); |
520 | else if (rc < 0) { | 556 | } else if (rc < 0) { |
521 | dbg("%s - error checking slots", __FUNCTION__); | 557 | dbg("%s - error checking slots", __FUNCTION__); |
522 | thread_finished = 1; | 558 | thread_finished = 1; |
523 | break; | 559 | break; |
524 | } | 560 | } |
525 | } | 561 | } while(atomic_read(&extracting) != 0); |
526 | /* Check for someone yanking out a board */ | ||
527 | list_for_each(tmp, &slot_list) { | ||
528 | slot = list_entry(tmp, struct slot, slot_list); | ||
529 | if(slot->extracting) { | ||
530 | /* | ||
531 | * Hmmm, we're likely hosed at this point, should we | ||
532 | * bother trying to tell the driver or not? | ||
533 | */ | ||
534 | err("card in slot %s was improperly removed", | ||
535 | slot->hotplug_slot->name); | ||
536 | if(update_adapter_status(slot->hotplug_slot, 0)) { | ||
537 | warn("failure to update adapter file"); | ||
538 | } | ||
539 | slot->extracting = 0; | ||
540 | } | ||
541 | } | ||
542 | 562 | ||
543 | /* Re-enable ENUM# interrupt */ | 563 | /* Re-enable ENUM# interrupt */ |
544 | dbg("%s - re-enabling irq", __FUNCTION__); | 564 | dbg("%s - re-enabling irq", __FUNCTION__); |
545 | controller->ops->enable_irq(); | 565 | controller->ops->enable_irq(); |
546 | } | 566 | } |
547 | |||
548 | dbg("%s - event thread signals exit", __FUNCTION__); | 567 | dbg("%s - event thread signals exit", __FUNCTION__); |
549 | up(&thread_exit); | 568 | up(&thread_exit); |
550 | return 0; | 569 | return 0; |
@@ -555,8 +574,6 @@ static int | |||
555 | poll_thread(void *data) | 574 | poll_thread(void *data) |
556 | { | 575 | { |
557 | int rc; | 576 | int rc; |
558 | struct slot *slot; | ||
559 | struct list_head *tmp; | ||
560 | 577 | ||
561 | lock_kernel(); | 578 | lock_kernel(); |
562 | daemonize("cpci_hp_polld"); | 579 | daemonize("cpci_hp_polld"); |
@@ -565,35 +582,19 @@ poll_thread(void *data) | |||
565 | while(1) { | 582 | while(1) { |
566 | if(thread_finished || signal_pending(current)) | 583 | if(thread_finished || signal_pending(current)) |
567 | break; | 584 | break; |
568 | 585 | if(controller->ops->query_enum()) { | |
569 | while(controller->ops->query_enum()) { | 586 | do { |
570 | rc = check_slots(); | 587 | rc = check_slots(); |
571 | if(rc > 0) | 588 | if(rc > 0) { |
572 | /* Give userspace a chance to handle extraction */ | 589 | /* Give userspace a chance to handle extraction */ |
573 | msleep(500); | 590 | msleep(500); |
574 | else if (rc < 0) { | 591 | } else if(rc < 0) { |
575 | dbg("%s - error checking slots", __FUNCTION__); | 592 | dbg("%s - error checking slots", __FUNCTION__); |
576 | thread_finished = 1; | 593 | thread_finished = 1; |
577 | break; | 594 | break; |
578 | } | ||
579 | } | ||
580 | /* Check for someone yanking out a board */ | ||
581 | list_for_each(tmp, &slot_list) { | ||
582 | slot = list_entry(tmp, struct slot, slot_list); | ||
583 | if(slot->extracting) { | ||
584 | /* | ||
585 | * Hmmm, we're likely hosed at this point, should we | ||
586 | * bother trying to tell the driver or not? | ||
587 | */ | ||
588 | err("card in slot %s was improperly removed", | ||
589 | slot->hotplug_slot->name); | ||
590 | if(update_adapter_status(slot->hotplug_slot, 0)) { | ||
591 | warn("failure to update adapter file"); | ||
592 | } | 595 | } |
593 | slot->extracting = 0; | 596 | } while(atomic_read(&extracting) != 0); |
594 | } | ||
595 | } | 597 | } |
596 | |||
597 | msleep(100); | 598 | msleep(100); |
598 | } | 599 | } |
599 | dbg("poll thread signals exit"); | 600 | dbg("poll thread signals exit"); |
@@ -667,6 +668,9 @@ cpci_hp_unregister_controller(struct cpci_hp_controller *old_controller) | |||
667 | int status = 0; | 668 | int status = 0; |
668 | 669 | ||
669 | if(controller) { | 670 | if(controller) { |
671 | if(atomic_read(&extracting) != 0) { | ||
672 | return -EBUSY; | ||
673 | } | ||
670 | if(!thread_finished) { | 674 | if(!thread_finished) { |
671 | cpci_stop_thread(); | 675 | cpci_stop_thread(); |
672 | } | 676 | } |
@@ -691,12 +695,12 @@ cpci_hp_start(void) | |||
691 | return -ENODEV; | 695 | return -ENODEV; |
692 | } | 696 | } |
693 | 697 | ||
694 | spin_lock(&list_lock); | 698 | down_read(&list_rwsem); |
695 | if(!slots) { | 699 | if(list_empty(&slot_list)) { |
696 | spin_unlock(&list_lock); | 700 | up_read(&list_rwsem); |
697 | return -ENODEV; | 701 | return -ENODEV; |
698 | } | 702 | } |
699 | spin_unlock(&list_lock); | 703 | up_read(&list_rwsem); |
700 | 704 | ||
701 | if(first) { | 705 | if(first) { |
702 | status = init_slots(); | 706 | status = init_slots(); |
@@ -727,7 +731,9 @@ cpci_hp_stop(void) | |||
727 | if(!controller) { | 731 | if(!controller) { |
728 | return -ENODEV; | 732 | return -ENODEV; |
729 | } | 733 | } |
730 | 734 | if(atomic_read(&extracting) != 0) { | |
735 | return -EBUSY; | ||
736 | } | ||
731 | if(controller->irq) { | 737 | if(controller->irq) { |
732 | /* Stop enum interrupt processing */ | 738 | /* Stop enum interrupt processing */ |
733 | dbg("%s - disabling irq", __FUNCTION__); | 739 | dbg("%s - disabling irq", __FUNCTION__); |
@@ -747,7 +753,7 @@ cleanup_slots(void) | |||
747 | * Unregister all of our slots with the pci_hotplug subsystem, | 753 | * Unregister all of our slots with the pci_hotplug subsystem, |
748 | * and free up all memory that we had allocated. | 754 | * and free up all memory that we had allocated. |
749 | */ | 755 | */ |
750 | spin_lock(&list_lock); | 756 | down_write(&list_rwsem); |
751 | if(!slots) { | 757 | if(!slots) { |
752 | goto null_cleanup; | 758 | goto null_cleanup; |
753 | } | 759 | } |
@@ -761,17 +767,14 @@ cleanup_slots(void) | |||
761 | kfree(slot); | 767 | kfree(slot); |
762 | } | 768 | } |
763 | null_cleanup: | 769 | null_cleanup: |
764 | spin_unlock(&list_lock); | 770 | up_write(&list_rwsem); |
765 | return; | 771 | return; |
766 | } | 772 | } |
767 | 773 | ||
768 | int __init | 774 | int __init |
769 | cpci_hotplug_init(int debug) | 775 | cpci_hotplug_init(int debug) |
770 | { | 776 | { |
771 | spin_lock_init(&list_lock); | ||
772 | cpci_debug = debug; | 777 | cpci_debug = debug; |
773 | |||
774 | info(DRIVER_DESC " version: " DRIVER_VERSION); | ||
775 | return 0; | 778 | return 0; |
776 | } | 779 | } |
777 | 780 | ||
diff --git a/drivers/pci/hotplug/cpci_hotplug_pci.c b/drivers/pci/hotplug/cpci_hotplug_pci.c index 2e969616f298..69eb4fc54f2f 100644 --- a/drivers/pci/hotplug/cpci_hotplug_pci.c +++ b/drivers/pci/hotplug/cpci_hotplug_pci.c | |||
@@ -32,11 +32,7 @@ | |||
32 | #include "pci_hotplug.h" | 32 | #include "pci_hotplug.h" |
33 | #include "cpci_hotplug.h" | 33 | #include "cpci_hotplug.h" |
34 | 34 | ||
35 | #if !defined(MODULE) | ||
36 | #define MY_NAME "cpci_hotplug" | 35 | #define MY_NAME "cpci_hotplug" |
37 | #else | ||
38 | #define MY_NAME THIS_MODULE->name | ||
39 | #endif | ||
40 | 36 | ||
41 | extern int cpci_debug; | 37 | extern int cpci_debug; |
42 | 38 | ||
@@ -127,38 +123,6 @@ u16 cpci_get_hs_csr(struct slot* slot) | |||
127 | return hs_csr; | 123 | return hs_csr; |
128 | } | 124 | } |
129 | 125 | ||
130 | #if 0 | ||
131 | u16 cpci_set_hs_csr(struct slot* slot, u16 hs_csr) | ||
132 | { | ||
133 | int hs_cap; | ||
134 | u16 new_hs_csr; | ||
135 | |||
136 | hs_cap = pci_bus_find_capability(slot->bus, | ||
137 | slot->devfn, | ||
138 | PCI_CAP_ID_CHSWP); | ||
139 | if(!hs_cap) { | ||
140 | return 0xFFFF; | ||
141 | } | ||
142 | |||
143 | /* Write out the new value */ | ||
144 | if(pci_bus_write_config_word(slot->bus, | ||
145 | slot->devfn, | ||
146 | hs_cap + 2, | ||
147 | hs_csr)) { | ||
148 | return 0xFFFF; | ||
149 | } | ||
150 | |||
151 | /* Read back what we just wrote out */ | ||
152 | if(pci_bus_read_config_word(slot->bus, | ||
153 | slot->devfn, | ||
154 | hs_cap + 2, | ||
155 | &new_hs_csr)) { | ||
156 | return 0xFFFF; | ||
157 | } | ||
158 | return new_hs_csr; | ||
159 | } | ||
160 | #endif | ||
161 | |||
162 | int cpci_check_and_clear_ins(struct slot* slot) | 126 | int cpci_check_and_clear_ins(struct slot* slot) |
163 | { | 127 | { |
164 | int hs_cap; | 128 | int hs_cap; |
@@ -261,7 +225,6 @@ int cpci_led_on(struct slot* slot) | |||
261 | return -ENODEV; | 225 | return -ENODEV; |
262 | } | 226 | } |
263 | if((hs_csr & HS_CSR_LOO) != HS_CSR_LOO) { | 227 | if((hs_csr & HS_CSR_LOO) != HS_CSR_LOO) { |
264 | /* Set LOO */ | ||
265 | hs_csr |= HS_CSR_LOO; | 228 | hs_csr |= HS_CSR_LOO; |
266 | if(pci_bus_write_config_word(slot->bus, | 229 | if(pci_bus_write_config_word(slot->bus, |
267 | slot->devfn, | 230 | slot->devfn, |
@@ -293,7 +256,6 @@ int cpci_led_off(struct slot* slot) | |||
293 | return -ENODEV; | 256 | return -ENODEV; |
294 | } | 257 | } |
295 | if(hs_csr & HS_CSR_LOO) { | 258 | if(hs_csr & HS_CSR_LOO) { |
296 | /* Clear LOO */ | ||
297 | hs_csr &= ~HS_CSR_LOO; | 259 | hs_csr &= ~HS_CSR_LOO; |
298 | if(pci_bus_write_config_word(slot->bus, | 260 | if(pci_bus_write_config_word(slot->bus, |
299 | slot->devfn, | 261 | slot->devfn, |
@@ -312,257 +274,23 @@ int cpci_led_off(struct slot* slot) | |||
312 | * Device configuration functions | 274 | * Device configuration functions |
313 | */ | 275 | */ |
314 | 276 | ||
315 | static int cpci_configure_dev(struct pci_bus *bus, struct pci_dev *dev) | 277 | static void cpci_enable_device(struct pci_dev *dev) |
316 | { | ||
317 | u8 irq_pin; | ||
318 | int r; | ||
319 | |||
320 | dbg("%s - enter", __FUNCTION__); | ||
321 | |||
322 | /* NOTE: device already setup from prior scan */ | ||
323 | |||
324 | /* FIXME: How would we know if we need to enable the expansion ROM? */ | ||
325 | pci_write_config_word(dev, PCI_ROM_ADDRESS, 0x00L); | ||
326 | |||
327 | /* Assign resources */ | ||
328 | dbg("assigning resources for %02x:%02x.%x", | ||
329 | dev->bus->number, PCI_SLOT(dev->devfn), PCI_FUNC(dev->devfn)); | ||
330 | for (r = 0; r < 6; r++) { | ||
331 | struct resource *res = dev->resource + r; | ||
332 | if(res->flags) | ||
333 | pci_assign_resource(dev, r); | ||
334 | } | ||
335 | dbg("finished assigning resources for %02x:%02x.%x", | ||
336 | dev->bus->number, PCI_SLOT(dev->devfn), PCI_FUNC(dev->devfn)); | ||
337 | |||
338 | /* Does this function have an interrupt at all? */ | ||
339 | dbg("checking for function interrupt"); | ||
340 | pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &irq_pin); | ||
341 | if(irq_pin) { | ||
342 | dbg("function uses interrupt pin %d", irq_pin); | ||
343 | } | ||
344 | |||
345 | /* | ||
346 | * Need to explicitly set irq field to 0 so that it'll get assigned | ||
347 | * by the pcibios platform dependent code called by pci_enable_device. | ||
348 | */ | ||
349 | dev->irq = 0; | ||
350 | |||
351 | dbg("enabling device"); | ||
352 | pci_enable_device(dev); /* XXX check return */ | ||
353 | dbg("now dev->irq = %d", dev->irq); | ||
354 | if(irq_pin && dev->irq) { | ||
355 | pci_write_config_byte(dev, PCI_INTERRUPT_LINE, dev->irq); | ||
356 | } | ||
357 | |||
358 | /* Can't use pci_insert_device at the moment, do it manually for now */ | ||
359 | pci_proc_attach_device(dev); | ||
360 | dbg("notifying drivers"); | ||
361 | //pci_announce_device_to_drivers(dev); | ||
362 | dbg("%s - exit", __FUNCTION__); | ||
363 | return 0; | ||
364 | } | ||
365 | |||
366 | static int cpci_configure_bridge(struct pci_bus* bus, struct pci_dev* dev) | ||
367 | { | 278 | { |
368 | int rc; | 279 | struct pci_bus *bus; |
369 | struct pci_bus* child; | ||
370 | struct resource* r; | ||
371 | u8 max, n; | ||
372 | u16 command; | ||
373 | |||
374 | dbg("%s - enter", __FUNCTION__); | ||
375 | 280 | ||
376 | /* Do basic bridge initialization */ | 281 | pci_enable_device(dev); |
377 | rc = pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x40); | ||
378 | if(rc) { | ||
379 | printk(KERN_ERR "%s - write of PCI_LATENCY_TIMER failed\n", __FUNCTION__); | ||
380 | } | ||
381 | rc = pci_write_config_byte(dev, PCI_SEC_LATENCY_TIMER, 0x40); | ||
382 | if(rc) { | ||
383 | printk(KERN_ERR "%s - write of PCI_SEC_LATENCY_TIMER failed\n", __FUNCTION__); | ||
384 | } | ||
385 | rc = pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, L1_CACHE_BYTES / 4); | ||
386 | if(rc) { | ||
387 | printk(KERN_ERR "%s - write of PCI_CACHE_LINE_SIZE failed\n", __FUNCTION__); | ||
388 | } | ||
389 | |||
390 | /* | ||
391 | * Set parent bridge's subordinate field so that configuration space | ||
392 | * access will work in pci_scan_bridge and friends. | ||
393 | */ | ||
394 | max = pci_max_busnr(); | ||
395 | bus->subordinate = max + 1; | ||
396 | pci_write_config_byte(bus->self, PCI_SUBORDINATE_BUS, max + 1); | ||
397 | |||
398 | /* Scan behind bridge */ | ||
399 | n = pci_scan_bridge(bus, dev, max, 2); | ||
400 | child = pci_find_bus(0, max + 1); | ||
401 | if (!child) | ||
402 | return -ENODEV; | ||
403 | pci_proc_attach_bus(child); | ||
404 | |||
405 | /* | ||
406 | * Update parent bridge's subordinate field if there were more bridges | ||
407 | * behind the bridge that was scanned. | ||
408 | */ | ||
409 | if(n > max) { | ||
410 | bus->subordinate = n; | ||
411 | pci_write_config_byte(bus->self, PCI_SUBORDINATE_BUS, n); | ||
412 | } | ||
413 | |||
414 | /* | ||
415 | * Update the bridge resources of the bridge to accommodate devices | ||
416 | * behind it. | ||
417 | */ | ||
418 | pci_bus_size_bridges(child); | ||
419 | pci_bus_assign_resources(child); | ||
420 | |||
421 | /* Enable resource mapping via command register */ | ||
422 | command = PCI_COMMAND_MASTER | PCI_COMMAND_INVALIDATE | PCI_COMMAND_PARITY | PCI_COMMAND_SERR; | ||
423 | r = child->resource[0]; | ||
424 | if(r && r->start) { | ||
425 | command |= PCI_COMMAND_IO; | ||
426 | } | ||
427 | r = child->resource[1]; | ||
428 | if(r && r->start) { | ||
429 | command |= PCI_COMMAND_MEMORY; | ||
430 | } | ||
431 | r = child->resource[2]; | ||
432 | if(r && r->start) { | ||
433 | command |= PCI_COMMAND_MEMORY; | ||
434 | } | ||
435 | rc = pci_write_config_word(dev, PCI_COMMAND, command); | ||
436 | if(rc) { | ||
437 | err("Error setting command register"); | ||
438 | return rc; | ||
439 | } | ||
440 | |||
441 | /* Set bridge control register */ | ||
442 | command = PCI_BRIDGE_CTL_PARITY | PCI_BRIDGE_CTL_SERR | PCI_BRIDGE_CTL_NO_ISA; | ||
443 | rc = pci_write_config_word(dev, PCI_BRIDGE_CONTROL, command); | ||
444 | if(rc) { | ||
445 | err("Error setting bridge control register"); | ||
446 | return rc; | ||
447 | } | ||
448 | dbg("%s - exit", __FUNCTION__); | ||
449 | return 0; | ||
450 | } | ||
451 | |||
452 | static int configure_visit_pci_dev(struct pci_dev_wrapped *wrapped_dev, | ||
453 | struct pci_bus_wrapped *wrapped_bus) | ||
454 | { | ||
455 | int rc; | ||
456 | struct pci_dev *dev = wrapped_dev->dev; | ||
457 | struct pci_bus *bus = wrapped_bus->bus; | ||
458 | struct slot* slot; | ||
459 | |||
460 | dbg("%s - enter", __FUNCTION__); | ||
461 | |||
462 | /* | ||
463 | * We need to fix up the hotplug representation with the Linux | ||
464 | * representation. | ||
465 | */ | ||
466 | if(wrapped_dev->data) { | ||
467 | slot = (struct slot*) wrapped_dev->data; | ||
468 | slot->dev = dev; | ||
469 | } | ||
470 | |||
471 | /* If it's a bridge, scan behind it for devices */ | ||
472 | if(dev->hdr_type == PCI_HEADER_TYPE_BRIDGE) { | 282 | if(dev->hdr_type == PCI_HEADER_TYPE_BRIDGE) { |
473 | rc = cpci_configure_bridge(bus, dev); | 283 | bus = dev->subordinate; |
474 | if(rc) | 284 | list_for_each_entry(dev, &bus->devices, bus_list) { |
475 | return rc; | 285 | cpci_enable_device(dev); |
476 | } | ||
477 | |||
478 | /* Actually configure device */ | ||
479 | if(dev) { | ||
480 | rc = cpci_configure_dev(bus, dev); | ||
481 | if(rc) | ||
482 | return rc; | ||
483 | } | ||
484 | dbg("%s - exit", __FUNCTION__); | ||
485 | return 0; | ||
486 | } | ||
487 | |||
488 | static int unconfigure_visit_pci_dev_phase2(struct pci_dev_wrapped *wrapped_dev, | ||
489 | struct pci_bus_wrapped *wrapped_bus) | ||
490 | { | ||
491 | struct pci_dev *dev = wrapped_dev->dev; | ||
492 | struct slot* slot; | ||
493 | |||
494 | dbg("%s - enter", __FUNCTION__); | ||
495 | if(!dev) | ||
496 | return -ENODEV; | ||
497 | |||
498 | /* Remove the Linux representation */ | ||
499 | if(pci_remove_device_safe(dev)) { | ||
500 | err("Could not remove device\n"); | ||
501 | return -1; | ||
502 | } | ||
503 | |||
504 | /* | ||
505 | * Now remove the hotplug representation. | ||
506 | */ | ||
507 | if(wrapped_dev->data) { | ||
508 | slot = (struct slot*) wrapped_dev->data; | ||
509 | slot->dev = NULL; | ||
510 | } else { | ||
511 | dbg("No hotplug representation for %02x:%02x.%x", | ||
512 | dev->bus->number, PCI_SLOT(dev->devfn), PCI_FUNC(dev->devfn)); | ||
513 | } | ||
514 | dbg("%s - exit", __FUNCTION__); | ||
515 | return 0; | ||
516 | } | ||
517 | |||
518 | static int unconfigure_visit_pci_bus_phase2(struct pci_bus_wrapped *wrapped_bus, | ||
519 | struct pci_dev_wrapped *wrapped_dev) | ||
520 | { | ||
521 | struct pci_bus *bus = wrapped_bus->bus; | ||
522 | struct pci_bus *parent = bus->self->bus; | ||
523 | |||
524 | dbg("%s - enter", __FUNCTION__); | ||
525 | |||
526 | /* The cleanup code for proc entries regarding buses should be in the kernel... */ | ||
527 | if(bus->procdir) | ||
528 | dbg("detach_pci_bus %s", bus->procdir->name); | ||
529 | pci_proc_detach_bus(bus); | ||
530 | |||
531 | /* The cleanup code should live in the kernel... */ | ||
532 | bus->self->subordinate = NULL; | ||
533 | |||
534 | /* unlink from parent bus */ | ||
535 | list_del(&bus->node); | ||
536 | |||
537 | /* Now, remove */ | ||
538 | if(bus) | ||
539 | kfree(bus); | ||
540 | |||
541 | /* Update parent's subordinate field */ | ||
542 | if(parent) { | ||
543 | u8 n = pci_bus_max_busnr(parent); | ||
544 | if(n < parent->subordinate) { | ||
545 | parent->subordinate = n; | ||
546 | pci_write_config_byte(parent->self, PCI_SUBORDINATE_BUS, n); | ||
547 | } | 286 | } |
548 | } | 287 | } |
549 | dbg("%s - exit", __FUNCTION__); | ||
550 | return 0; | ||
551 | } | 288 | } |
552 | 289 | ||
553 | static struct pci_visit configure_functions = { | ||
554 | .visit_pci_dev = configure_visit_pci_dev, | ||
555 | }; | ||
556 | |||
557 | static struct pci_visit unconfigure_functions_phase2 = { | ||
558 | .post_visit_pci_bus = unconfigure_visit_pci_bus_phase2, | ||
559 | .post_visit_pci_dev = unconfigure_visit_pci_dev_phase2 | ||
560 | }; | ||
561 | |||
562 | |||
563 | int cpci_configure_slot(struct slot* slot) | 290 | int cpci_configure_slot(struct slot* slot) |
564 | { | 291 | { |
565 | int rc = 0; | 292 | unsigned char busnr; |
293 | struct pci_bus *child; | ||
566 | 294 | ||
567 | dbg("%s - enter", __FUNCTION__); | 295 | dbg("%s - enter", __FUNCTION__); |
568 | 296 | ||
@@ -588,74 +316,44 @@ int cpci_configure_slot(struct slot* slot) | |||
588 | slot->dev = pci_find_slot(slot->bus->number, slot->devfn); | 316 | slot->dev = pci_find_slot(slot->bus->number, slot->devfn); |
589 | if(slot->dev == NULL) { | 317 | if(slot->dev == NULL) { |
590 | err("Could not find PCI device for slot %02x", slot->number); | 318 | err("Could not find PCI device for slot %02x", slot->number); |
591 | return 0; | 319 | return 1; |
592 | } | 320 | } |
593 | } | 321 | } |
594 | dbg("slot->dev = %p", slot->dev); | 322 | |
595 | if(slot->dev) { | 323 | if (slot->dev->hdr_type == PCI_HEADER_TYPE_BRIDGE) { |
596 | struct pci_dev *dev; | 324 | pci_read_config_byte(slot->dev, PCI_SECONDARY_BUS, &busnr); |
597 | struct pci_dev_wrapped wrapped_dev; | 325 | child = pci_add_new_bus(slot->dev->bus, slot->dev, busnr); |
598 | struct pci_bus_wrapped wrapped_bus; | 326 | pci_do_scan_bus(child); |
599 | int i; | 327 | pci_bus_size_bridges(child); |
600 | |||
601 | memset(&wrapped_dev, 0, sizeof (struct pci_dev_wrapped)); | ||
602 | memset(&wrapped_bus, 0, sizeof (struct pci_bus_wrapped)); | ||
603 | |||
604 | for (i = 0; i < 8; i++) { | ||
605 | dev = pci_find_slot(slot->bus->number, | ||
606 | PCI_DEVFN(PCI_SLOT(slot->dev->devfn), i)); | ||
607 | if(!dev) | ||
608 | continue; | ||
609 | wrapped_dev.dev = dev; | ||
610 | wrapped_bus.bus = slot->dev->bus; | ||
611 | if(i) | ||
612 | wrapped_dev.data = NULL; | ||
613 | else | ||
614 | wrapped_dev.data = (void*) slot; | ||
615 | rc = pci_visit_dev(&configure_functions, &wrapped_dev, &wrapped_bus); | ||
616 | } | ||
617 | } | 328 | } |
618 | 329 | ||
619 | dbg("%s - exit, rc = %d", __FUNCTION__, rc); | 330 | pci_bus_assign_resources(slot->dev->bus); |
620 | return rc; | 331 | |
332 | cpci_enable_device(slot->dev); | ||
333 | |||
334 | dbg("%s - exit", __FUNCTION__); | ||
335 | return 0; | ||
621 | } | 336 | } |
622 | 337 | ||
623 | int cpci_unconfigure_slot(struct slot* slot) | 338 | int cpci_unconfigure_slot(struct slot* slot) |
624 | { | 339 | { |
625 | int rc = 0; | ||
626 | int i; | 340 | int i; |
627 | struct pci_dev_wrapped wrapped_dev; | ||
628 | struct pci_bus_wrapped wrapped_bus; | ||
629 | struct pci_dev *dev; | 341 | struct pci_dev *dev; |
630 | 342 | ||
631 | dbg("%s - enter", __FUNCTION__); | 343 | dbg("%s - enter", __FUNCTION__); |
632 | |||
633 | if(!slot->dev) { | 344 | if(!slot->dev) { |
634 | err("No device for slot %02x\n", slot->number); | 345 | err("No device for slot %02x\n", slot->number); |
635 | return -ENODEV; | 346 | return -ENODEV; |
636 | } | 347 | } |
637 | 348 | ||
638 | memset(&wrapped_dev, 0, sizeof (struct pci_dev_wrapped)); | ||
639 | memset(&wrapped_bus, 0, sizeof (struct pci_bus_wrapped)); | ||
640 | |||
641 | for (i = 0; i < 8; i++) { | 349 | for (i = 0; i < 8; i++) { |
642 | dev = pci_find_slot(slot->bus->number, | 350 | dev = pci_find_slot(slot->bus->number, |
643 | PCI_DEVFN(PCI_SLOT(slot->devfn), i)); | 351 | PCI_DEVFN(PCI_SLOT(slot->devfn), i)); |
644 | if(dev) { | 352 | if(dev) { |
645 | wrapped_dev.dev = dev; | 353 | pci_remove_bus_device(dev); |
646 | wrapped_bus.bus = dev->bus; | 354 | slot->dev = NULL; |
647 | if(i) | ||
648 | wrapped_dev.data = NULL; | ||
649 | else | ||
650 | wrapped_dev.data = (void*) slot; | ||
651 | dbg("%s - unconfigure phase 2", __FUNCTION__); | ||
652 | rc = pci_visit_dev(&unconfigure_functions_phase2, | ||
653 | &wrapped_dev, | ||
654 | &wrapped_bus); | ||
655 | if(rc) | ||
656 | break; | ||
657 | } | 355 | } |
658 | } | 356 | } |
659 | dbg("%s - exit, rc = %d", __FUNCTION__, rc); | 357 | dbg("%s - exit", __FUNCTION__); |
660 | return rc; | 358 | return 0; |
661 | } | 359 | } |
diff --git a/drivers/pci/hotplug/pciehp.h b/drivers/pci/hotplug/pciehp.h index f313121d5141..46b294a12418 100644 --- a/drivers/pci/hotplug/pciehp.h +++ b/drivers/pci/hotplug/pciehp.h | |||
@@ -130,6 +130,7 @@ struct controller { | |||
130 | u8 slot_bus; /* Bus where the slots handled by this controller sit */ | 130 | u8 slot_bus; /* Bus where the slots handled by this controller sit */ |
131 | u8 ctrlcap; | 131 | u8 ctrlcap; |
132 | u16 vendor_id; | 132 | u16 vendor_id; |
133 | u8 cap_base; | ||
133 | }; | 134 | }; |
134 | 135 | ||
135 | struct irq_mapping { | 136 | struct irq_mapping { |
diff --git a/drivers/pci/hotplug/pciehp_core.c b/drivers/pci/hotplug/pciehp_core.c index ed1fd8d6178d..df4915dbc321 100644 --- a/drivers/pci/hotplug/pciehp_core.c +++ b/drivers/pci/hotplug/pciehp_core.c | |||
@@ -607,7 +607,7 @@ static int pciehp_resume (struct pcie_device *dev) | |||
607 | static struct pcie_port_service_id port_pci_ids[] = { { | 607 | static struct pcie_port_service_id port_pci_ids[] = { { |
608 | .vendor = PCI_ANY_ID, | 608 | .vendor = PCI_ANY_ID, |
609 | .device = PCI_ANY_ID, | 609 | .device = PCI_ANY_ID, |
610 | .port_type = PCIE_RC_PORT, | 610 | .port_type = PCIE_ANY_PORT, |
611 | .service_type = PCIE_PORT_SERVICE_HP, | 611 | .service_type = PCIE_PORT_SERVICE_HP, |
612 | .driver_data = 0, | 612 | .driver_data = 0, |
613 | }, { /* end: all zeroes */ } | 613 | }, { /* end: all zeroes */ } |
diff --git a/drivers/pci/hotplug/pciehp_hpc.c b/drivers/pci/hotplug/pciehp_hpc.c index 9e70c4681f77..1cda30bd6e47 100644 --- a/drivers/pci/hotplug/pciehp_hpc.c +++ b/drivers/pci/hotplug/pciehp_hpc.c | |||
@@ -109,20 +109,20 @@ enum ctrl_offsets { | |||
109 | }; | 109 | }; |
110 | static int pcie_cap_base = 0; /* Base of the PCI Express capability item structure */ | 110 | static int pcie_cap_base = 0; /* Base of the PCI Express capability item structure */ |
111 | 111 | ||
112 | #define PCIE_CAP_ID ( pcie_cap_base + PCIECAPID ) | 112 | #define PCIE_CAP_ID(cb) ( cb + PCIECAPID ) |
113 | #define NXT_CAP_PTR ( pcie_cap_base + NXTCAPPTR ) | 113 | #define NXT_CAP_PTR(cb) ( cb + NXTCAPPTR ) |
114 | #define CAP_REG ( pcie_cap_base + CAPREG ) | 114 | #define CAP_REG(cb) ( cb + CAPREG ) |
115 | #define DEV_CAP ( pcie_cap_base + DEVCAP ) | 115 | #define DEV_CAP(cb) ( cb + DEVCAP ) |
116 | #define DEV_CTRL ( pcie_cap_base + DEVCTRL ) | 116 | #define DEV_CTRL(cb) ( cb + DEVCTRL ) |
117 | #define DEV_STATUS ( pcie_cap_base + DEVSTATUS ) | 117 | #define DEV_STATUS(cb) ( cb + DEVSTATUS ) |
118 | #define LNK_CAP ( pcie_cap_base + LNKCAP ) | 118 | #define LNK_CAP(cb) ( cb + LNKCAP ) |
119 | #define LNK_CTRL ( pcie_cap_base + LNKCTRL ) | 119 | #define LNK_CTRL(cb) ( cb + LNKCTRL ) |
120 | #define LNK_STATUS ( pcie_cap_base + LNKSTATUS ) | 120 | #define LNK_STATUS(cb) ( cb + LNKSTATUS ) |
121 | #define SLOT_CAP ( pcie_cap_base + SLOTCAP ) | 121 | #define SLOT_CAP(cb) ( cb + SLOTCAP ) |
122 | #define SLOT_CTRL ( pcie_cap_base + SLOTCTRL ) | 122 | #define SLOT_CTRL(cb) ( cb + SLOTCTRL ) |
123 | #define SLOT_STATUS ( pcie_cap_base + SLOTSTATUS ) | 123 | #define SLOT_STATUS(cb) ( cb + SLOTSTATUS ) |
124 | #define ROOT_CTRL ( pcie_cap_base + ROOTCTRL ) | 124 | #define ROOT_CTRL(cb) ( cb + ROOTCTRL ) |
125 | #define ROOT_STATUS ( pcie_cap_base + ROOTSTATUS ) | 125 | #define ROOT_STATUS(cb) ( cb + ROOTSTATUS ) |
126 | 126 | ||
127 | #define hp_register_read_word(pdev, reg , value) \ | 127 | #define hp_register_read_word(pdev, reg , value) \ |
128 | pci_read_config_word(pdev, reg, &value) | 128 | pci_read_config_word(pdev, reg, &value) |
@@ -303,7 +303,7 @@ static int pcie_write_cmd(struct slot *slot, u16 cmd) | |||
303 | return -1; | 303 | return -1; |
304 | } | 304 | } |
305 | 305 | ||
306 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS, slot_status); | 306 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS(slot->ctrl->cap_base), slot_status); |
307 | if (retval) { | 307 | if (retval) { |
308 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); | 308 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); |
309 | return retval; | 309 | return retval; |
@@ -317,7 +317,7 @@ static int pcie_write_cmd(struct slot *slot, u16 cmd) | |||
317 | } | 317 | } |
318 | 318 | ||
319 | dbg("%s: Before hp_register_write_word SLOT_CTRL %x\n", __FUNCTION__, cmd); | 319 | dbg("%s: Before hp_register_write_word SLOT_CTRL %x\n", __FUNCTION__, cmd); |
320 | retval = hp_register_write_word(php_ctlr->pci_dev, SLOT_CTRL, cmd | CMD_CMPL_INTR_ENABLE); | 320 | retval = hp_register_write_word(php_ctlr->pci_dev, SLOT_CTRL(slot->ctrl->cap_base), cmd | CMD_CMPL_INTR_ENABLE); |
321 | if (retval) { | 321 | if (retval) { |
322 | err("%s : hp_register_write_word SLOT_CTRL failed\n", __FUNCTION__); | 322 | err("%s : hp_register_write_word SLOT_CTRL failed\n", __FUNCTION__); |
323 | return retval; | 323 | return retval; |
@@ -342,7 +342,7 @@ static int hpc_check_lnk_status(struct controller *ctrl) | |||
342 | return -1; | 342 | return -1; |
343 | } | 343 | } |
344 | 344 | ||
345 | retval = hp_register_read_word(php_ctlr->pci_dev, LNK_STATUS, lnk_status); | 345 | retval = hp_register_read_word(php_ctlr->pci_dev, LNK_STATUS(ctrl->cap_base), lnk_status); |
346 | 346 | ||
347 | if (retval) { | 347 | if (retval) { |
348 | err("%s : hp_register_read_word LNK_STATUS failed\n", __FUNCTION__); | 348 | err("%s : hp_register_read_word LNK_STATUS failed\n", __FUNCTION__); |
@@ -376,14 +376,14 @@ static int hpc_get_attention_status(struct slot *slot, u8 *status) | |||
376 | return -1; | 376 | return -1; |
377 | } | 377 | } |
378 | 378 | ||
379 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL, slot_ctrl); | 379 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL(slot->ctrl->cap_base), slot_ctrl); |
380 | 380 | ||
381 | if (retval) { | 381 | if (retval) { |
382 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); | 382 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); |
383 | return retval; | 383 | return retval; |
384 | } | 384 | } |
385 | 385 | ||
386 | dbg("%s: SLOT_CTRL %x, value read %x\n", __FUNCTION__,SLOT_CTRL, slot_ctrl); | 386 | dbg("%s: SLOT_CTRL %x, value read %x\n", __FUNCTION__,SLOT_CTRL(slot->ctrl->cap_base), slot_ctrl); |
387 | 387 | ||
388 | atten_led_state = (slot_ctrl & ATTN_LED_CTRL) >> 6; | 388 | atten_led_state = (slot_ctrl & ATTN_LED_CTRL) >> 6; |
389 | 389 | ||
@@ -423,13 +423,13 @@ static int hpc_get_power_status(struct slot * slot, u8 *status) | |||
423 | return -1; | 423 | return -1; |
424 | } | 424 | } |
425 | 425 | ||
426 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL, slot_ctrl); | 426 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL(slot->ctrl->cap_base), slot_ctrl); |
427 | 427 | ||
428 | if (retval) { | 428 | if (retval) { |
429 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); | 429 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); |
430 | return retval; | 430 | return retval; |
431 | } | 431 | } |
432 | dbg("%s: SLOT_CTRL %x value read %x\n", __FUNCTION__, SLOT_CTRL, slot_ctrl); | 432 | dbg("%s: SLOT_CTRL %x value read %x\n", __FUNCTION__, SLOT_CTRL(slot->ctrl->cap_base), slot_ctrl); |
433 | 433 | ||
434 | pwr_state = (slot_ctrl & PWR_CTRL) >> 10; | 434 | pwr_state = (slot_ctrl & PWR_CTRL) >> 10; |
435 | 435 | ||
@@ -463,7 +463,7 @@ static int hpc_get_latch_status(struct slot *slot, u8 *status) | |||
463 | return -1; | 463 | return -1; |
464 | } | 464 | } |
465 | 465 | ||
466 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS, slot_status); | 466 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS(slot->ctrl->cap_base), slot_status); |
467 | 467 | ||
468 | if (retval) { | 468 | if (retval) { |
469 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); | 469 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); |
@@ -490,7 +490,7 @@ static int hpc_get_adapter_status(struct slot *slot, u8 *status) | |||
490 | return -1; | 490 | return -1; |
491 | } | 491 | } |
492 | 492 | ||
493 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS, slot_status); | 493 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS(slot->ctrl->cap_base), slot_status); |
494 | 494 | ||
495 | if (retval) { | 495 | if (retval) { |
496 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); | 496 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); |
@@ -518,7 +518,7 @@ static int hpc_query_power_fault(struct slot * slot) | |||
518 | return -1; | 518 | return -1; |
519 | } | 519 | } |
520 | 520 | ||
521 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS, slot_status); | 521 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS(slot->ctrl->cap_base), slot_status); |
522 | 522 | ||
523 | if (retval) { | 523 | if (retval) { |
524 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); | 524 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); |
@@ -549,7 +549,7 @@ static int hpc_set_attention_status(struct slot *slot, u8 value) | |||
549 | err("%s: Invalid HPC slot number!\n", __FUNCTION__); | 549 | err("%s: Invalid HPC slot number!\n", __FUNCTION__); |
550 | return -1; | 550 | return -1; |
551 | } | 551 | } |
552 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL, slot_ctrl); | 552 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL(slot->ctrl->cap_base), slot_ctrl); |
553 | 553 | ||
554 | if (rc) { | 554 | if (rc) { |
555 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); | 555 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); |
@@ -574,7 +574,7 @@ static int hpc_set_attention_status(struct slot *slot, u8 value) | |||
574 | slot_cmd = slot_cmd | HP_INTR_ENABLE; | 574 | slot_cmd = slot_cmd | HP_INTR_ENABLE; |
575 | 575 | ||
576 | pcie_write_cmd(slot, slot_cmd); | 576 | pcie_write_cmd(slot, slot_cmd); |
577 | dbg("%s: SLOT_CTRL %x write cmd %x\n", __FUNCTION__, SLOT_CTRL, slot_cmd); | 577 | dbg("%s: SLOT_CTRL %x write cmd %x\n", __FUNCTION__, SLOT_CTRL(slot->ctrl->cap_base), slot_cmd); |
578 | 578 | ||
579 | return rc; | 579 | return rc; |
580 | } | 580 | } |
@@ -598,7 +598,7 @@ static void hpc_set_green_led_on(struct slot *slot) | |||
598 | return ; | 598 | return ; |
599 | } | 599 | } |
600 | 600 | ||
601 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL, slot_ctrl); | 601 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL(slot->ctrl->cap_base), slot_ctrl); |
602 | 602 | ||
603 | if (rc) { | 603 | if (rc) { |
604 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); | 604 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); |
@@ -611,7 +611,7 @@ static void hpc_set_green_led_on(struct slot *slot) | |||
611 | 611 | ||
612 | pcie_write_cmd(slot, slot_cmd); | 612 | pcie_write_cmd(slot, slot_cmd); |
613 | 613 | ||
614 | dbg("%s: SLOT_CTRL %x write cmd %x\n",__FUNCTION__, SLOT_CTRL, slot_cmd); | 614 | dbg("%s: SLOT_CTRL %x write cmd %x\n",__FUNCTION__, SLOT_CTRL(slot->ctrl->cap_base), slot_cmd); |
615 | return; | 615 | return; |
616 | } | 616 | } |
617 | 617 | ||
@@ -633,7 +633,7 @@ static void hpc_set_green_led_off(struct slot *slot) | |||
633 | return ; | 633 | return ; |
634 | } | 634 | } |
635 | 635 | ||
636 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL, slot_ctrl); | 636 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL(slot->ctrl->cap_base), slot_ctrl); |
637 | 637 | ||
638 | if (rc) { | 638 | if (rc) { |
639 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); | 639 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); |
@@ -646,7 +646,7 @@ static void hpc_set_green_led_off(struct slot *slot) | |||
646 | if (!pciehp_poll_mode) | 646 | if (!pciehp_poll_mode) |
647 | slot_cmd = slot_cmd | HP_INTR_ENABLE; | 647 | slot_cmd = slot_cmd | HP_INTR_ENABLE; |
648 | pcie_write_cmd(slot, slot_cmd); | 648 | pcie_write_cmd(slot, slot_cmd); |
649 | dbg("%s: SLOT_CTRL %x write cmd %x\n", __FUNCTION__, SLOT_CTRL, slot_cmd); | 649 | dbg("%s: SLOT_CTRL %x write cmd %x\n", __FUNCTION__, SLOT_CTRL(slot->ctrl->cap_base), slot_cmd); |
650 | 650 | ||
651 | return; | 651 | return; |
652 | } | 652 | } |
@@ -669,7 +669,7 @@ static void hpc_set_green_led_blink(struct slot *slot) | |||
669 | return ; | 669 | return ; |
670 | } | 670 | } |
671 | 671 | ||
672 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL, slot_ctrl); | 672 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL(slot->ctrl->cap_base), slot_ctrl); |
673 | 673 | ||
674 | if (rc) { | 674 | if (rc) { |
675 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); | 675 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); |
@@ -683,7 +683,7 @@ static void hpc_set_green_led_blink(struct slot *slot) | |||
683 | slot_cmd = slot_cmd | HP_INTR_ENABLE; | 683 | slot_cmd = slot_cmd | HP_INTR_ENABLE; |
684 | pcie_write_cmd(slot, slot_cmd); | 684 | pcie_write_cmd(slot, slot_cmd); |
685 | 685 | ||
686 | dbg("%s: SLOT_CTRL %x write cmd %x\n",__FUNCTION__, SLOT_CTRL, slot_cmd); | 686 | dbg("%s: SLOT_CTRL %x write cmd %x\n",__FUNCTION__, SLOT_CTRL(slot->ctrl->cap_base), slot_cmd); |
687 | return; | 687 | return; |
688 | } | 688 | } |
689 | 689 | ||
@@ -707,7 +707,7 @@ int pcie_get_ctlr_slot_config(struct controller *ctrl, | |||
707 | *first_device_num = 0; | 707 | *first_device_num = 0; |
708 | *num_ctlr_slots = 1; | 708 | *num_ctlr_slots = 1; |
709 | 709 | ||
710 | rc = hp_register_read_dword(php_ctlr->pci_dev, SLOT_CAP, slot_cap); | 710 | rc = hp_register_read_dword(php_ctlr->pci_dev, SLOT_CAP(ctrl->cap_base), slot_cap); |
711 | 711 | ||
712 | if (rc) { | 712 | if (rc) { |
713 | err("%s : hp_register_read_dword SLOT_CAP failed\n", __FUNCTION__); | 713 | err("%s : hp_register_read_dword SLOT_CAP failed\n", __FUNCTION__); |
@@ -793,13 +793,13 @@ static int hpc_power_on_slot(struct slot * slot) | |||
793 | return -1; | 793 | return -1; |
794 | } | 794 | } |
795 | 795 | ||
796 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL, slot_ctrl); | 796 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL(slot->ctrl->cap_base), slot_ctrl); |
797 | 797 | ||
798 | if (retval) { | 798 | if (retval) { |
799 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); | 799 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); |
800 | return retval; | 800 | return retval; |
801 | } | 801 | } |
802 | dbg("%s: SLOT_CTRL %x, value read %xn", __FUNCTION__, SLOT_CTRL, | 802 | dbg("%s: SLOT_CTRL %x, value read %xn", __FUNCTION__, SLOT_CTRL(slot->ctrl->cap_base), |
803 | slot_ctrl); | 803 | slot_ctrl); |
804 | 804 | ||
805 | slot_cmd = (slot_ctrl & ~PWR_CTRL) | POWER_ON; | 805 | slot_cmd = (slot_ctrl & ~PWR_CTRL) | POWER_ON; |
@@ -813,7 +813,7 @@ static int hpc_power_on_slot(struct slot * slot) | |||
813 | err("%s: Write %x command failed!\n", __FUNCTION__, slot_cmd); | 813 | err("%s: Write %x command failed!\n", __FUNCTION__, slot_cmd); |
814 | return -1; | 814 | return -1; |
815 | } | 815 | } |
816 | dbg("%s: SLOT_CTRL %x write cmd %x\n",__FUNCTION__, SLOT_CTRL, slot_cmd); | 816 | dbg("%s: SLOT_CTRL %x write cmd %x\n",__FUNCTION__, SLOT_CTRL(slot->ctrl->cap_base), slot_cmd); |
817 | 817 | ||
818 | DBG_LEAVE_ROUTINE | 818 | DBG_LEAVE_ROUTINE |
819 | 819 | ||
@@ -842,13 +842,13 @@ static int hpc_power_off_slot(struct slot * slot) | |||
842 | err("%s: Invalid HPC slot number!\n", __FUNCTION__); | 842 | err("%s: Invalid HPC slot number!\n", __FUNCTION__); |
843 | return -1; | 843 | return -1; |
844 | } | 844 | } |
845 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL, slot_ctrl); | 845 | retval = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL(slot->ctrl->cap_base), slot_ctrl); |
846 | 846 | ||
847 | if (retval) { | 847 | if (retval) { |
848 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); | 848 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); |
849 | return retval; | 849 | return retval; |
850 | } | 850 | } |
851 | dbg("%s: SLOT_CTRL %x, value read %x\n", __FUNCTION__, SLOT_CTRL, | 851 | dbg("%s: SLOT_CTRL %x, value read %x\n", __FUNCTION__, SLOT_CTRL(slot->ctrl->cap_base), |
852 | slot_ctrl); | 852 | slot_ctrl); |
853 | 853 | ||
854 | slot_cmd = (slot_ctrl & ~PWR_CTRL) | POWER_OFF; | 854 | slot_cmd = (slot_ctrl & ~PWR_CTRL) | POWER_OFF; |
@@ -862,7 +862,7 @@ static int hpc_power_off_slot(struct slot * slot) | |||
862 | err("%s: Write command failed!\n", __FUNCTION__); | 862 | err("%s: Write command failed!\n", __FUNCTION__); |
863 | return -1; | 863 | return -1; |
864 | } | 864 | } |
865 | dbg("%s: SLOT_CTRL %x write cmd %x\n",__FUNCTION__, SLOT_CTRL, slot_cmd); | 865 | dbg("%s: SLOT_CTRL %x write cmd %x\n",__FUNCTION__, SLOT_CTRL(slot->ctrl->cap_base), slot_cmd); |
866 | 866 | ||
867 | DBG_LEAVE_ROUTINE | 867 | DBG_LEAVE_ROUTINE |
868 | 868 | ||
@@ -900,7 +900,7 @@ static irqreturn_t pcie_isr(int IRQ, void *dev_id, struct pt_regs *regs) | |||
900 | return IRQ_NONE; | 900 | return IRQ_NONE; |
901 | } | 901 | } |
902 | 902 | ||
903 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS, slot_status); | 903 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS(ctrl->cap_base), slot_status); |
904 | if (rc) { | 904 | if (rc) { |
905 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); | 905 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); |
906 | return IRQ_NONE; | 906 | return IRQ_NONE; |
@@ -918,7 +918,7 @@ static irqreturn_t pcie_isr(int IRQ, void *dev_id, struct pt_regs *regs) | |||
918 | dbg("%s: intr_loc %x\n", __FUNCTION__, intr_loc); | 918 | dbg("%s: intr_loc %x\n", __FUNCTION__, intr_loc); |
919 | /* Mask Hot-plug Interrupt Enable */ | 919 | /* Mask Hot-plug Interrupt Enable */ |
920 | if (!pciehp_poll_mode) { | 920 | if (!pciehp_poll_mode) { |
921 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL, temp_word); | 921 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL(ctrl->cap_base), temp_word); |
922 | if (rc) { | 922 | if (rc) { |
923 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); | 923 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); |
924 | return IRQ_NONE; | 924 | return IRQ_NONE; |
@@ -928,14 +928,14 @@ static irqreturn_t pcie_isr(int IRQ, void *dev_id, struct pt_regs *regs) | |||
928 | dbg("%s: hp_register_read_word SLOT_CTRL with value %x\n", __FUNCTION__, temp_word); | 928 | dbg("%s: hp_register_read_word SLOT_CTRL with value %x\n", __FUNCTION__, temp_word); |
929 | temp_word = (temp_word & ~HP_INTR_ENABLE & ~CMD_CMPL_INTR_ENABLE) | 0x00; | 929 | temp_word = (temp_word & ~HP_INTR_ENABLE & ~CMD_CMPL_INTR_ENABLE) | 0x00; |
930 | 930 | ||
931 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_CTRL, temp_word); | 931 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_CTRL(ctrl->cap_base), temp_word); |
932 | if (rc) { | 932 | if (rc) { |
933 | err("%s : hp_register_write_word SLOT_CTRL failed\n", __FUNCTION__); | 933 | err("%s : hp_register_write_word SLOT_CTRL failed\n", __FUNCTION__); |
934 | return IRQ_NONE; | 934 | return IRQ_NONE; |
935 | } | 935 | } |
936 | dbg("%s: hp_register_write_word SLOT_CTRL with value %x\n", __FUNCTION__, temp_word); | 936 | dbg("%s: hp_register_write_word SLOT_CTRL with value %x\n", __FUNCTION__, temp_word); |
937 | 937 | ||
938 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS, slot_status); | 938 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS(ctrl->cap_base), slot_status); |
939 | if (rc) { | 939 | if (rc) { |
940 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); | 940 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); |
941 | return IRQ_NONE; | 941 | return IRQ_NONE; |
@@ -944,7 +944,7 @@ static irqreturn_t pcie_isr(int IRQ, void *dev_id, struct pt_regs *regs) | |||
944 | 944 | ||
945 | /* Clear command complete interrupt caused by this write */ | 945 | /* Clear command complete interrupt caused by this write */ |
946 | temp_word = 0x1f; | 946 | temp_word = 0x1f; |
947 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_STATUS, temp_word); | 947 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_STATUS(ctrl->cap_base), temp_word); |
948 | if (rc) { | 948 | if (rc) { |
949 | err("%s : hp_register_write_word SLOT_STATUS failed\n", __FUNCTION__); | 949 | err("%s : hp_register_write_word SLOT_STATUS failed\n", __FUNCTION__); |
950 | return IRQ_NONE; | 950 | return IRQ_NONE; |
@@ -975,14 +975,14 @@ static irqreturn_t pcie_isr(int IRQ, void *dev_id, struct pt_regs *regs) | |||
975 | 975 | ||
976 | /* Clear all events after serving them */ | 976 | /* Clear all events after serving them */ |
977 | temp_word = 0x1F; | 977 | temp_word = 0x1F; |
978 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_STATUS, temp_word); | 978 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_STATUS(ctrl->cap_base), temp_word); |
979 | if (rc) { | 979 | if (rc) { |
980 | err("%s : hp_register_write_word SLOT_STATUS failed\n", __FUNCTION__); | 980 | err("%s : hp_register_write_word SLOT_STATUS failed\n", __FUNCTION__); |
981 | return IRQ_NONE; | 981 | return IRQ_NONE; |
982 | } | 982 | } |
983 | /* Unmask Hot-plug Interrupt Enable */ | 983 | /* Unmask Hot-plug Interrupt Enable */ |
984 | if (!pciehp_poll_mode) { | 984 | if (!pciehp_poll_mode) { |
985 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL, temp_word); | 985 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL(ctrl->cap_base), temp_word); |
986 | if (rc) { | 986 | if (rc) { |
987 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); | 987 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); |
988 | return IRQ_NONE; | 988 | return IRQ_NONE; |
@@ -992,14 +992,14 @@ static irqreturn_t pcie_isr(int IRQ, void *dev_id, struct pt_regs *regs) | |||
992 | dbg("%s: hp_register_read_word SLOT_CTRL with value %x\n", __FUNCTION__, temp_word); | 992 | dbg("%s: hp_register_read_word SLOT_CTRL with value %x\n", __FUNCTION__, temp_word); |
993 | temp_word = (temp_word & ~HP_INTR_ENABLE) | HP_INTR_ENABLE; | 993 | temp_word = (temp_word & ~HP_INTR_ENABLE) | HP_INTR_ENABLE; |
994 | 994 | ||
995 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_CTRL, temp_word); | 995 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_CTRL(ctrl->cap_base), temp_word); |
996 | if (rc) { | 996 | if (rc) { |
997 | err("%s : hp_register_write_word SLOT_CTRL failed\n", __FUNCTION__); | 997 | err("%s : hp_register_write_word SLOT_CTRL failed\n", __FUNCTION__); |
998 | return IRQ_NONE; | 998 | return IRQ_NONE; |
999 | } | 999 | } |
1000 | dbg("%s: hp_register_write_word SLOT_CTRL with value %x\n", __FUNCTION__, temp_word); | 1000 | dbg("%s: hp_register_write_word SLOT_CTRL with value %x\n", __FUNCTION__, temp_word); |
1001 | 1001 | ||
1002 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS, slot_status); | 1002 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS(ctrl->cap_base), slot_status); |
1003 | if (rc) { | 1003 | if (rc) { |
1004 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); | 1004 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); |
1005 | return IRQ_NONE; | 1005 | return IRQ_NONE; |
@@ -1008,7 +1008,7 @@ static irqreturn_t pcie_isr(int IRQ, void *dev_id, struct pt_regs *regs) | |||
1008 | 1008 | ||
1009 | /* Clear command complete interrupt caused by this write */ | 1009 | /* Clear command complete interrupt caused by this write */ |
1010 | temp_word = 0x1F; | 1010 | temp_word = 0x1F; |
1011 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_STATUS, temp_word); | 1011 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_STATUS(ctrl->cap_base), temp_word); |
1012 | if (rc) { | 1012 | if (rc) { |
1013 | err("%s : hp_register_write_word SLOT_STATUS failed\n", __FUNCTION__); | 1013 | err("%s : hp_register_write_word SLOT_STATUS failed\n", __FUNCTION__); |
1014 | return IRQ_NONE; | 1014 | return IRQ_NONE; |
@@ -1038,7 +1038,7 @@ static int hpc_get_max_lnk_speed (struct slot *slot, enum pci_bus_speed *value) | |||
1038 | return -1; | 1038 | return -1; |
1039 | } | 1039 | } |
1040 | 1040 | ||
1041 | retval = hp_register_read_dword(php_ctlr->pci_dev, LNK_CAP, lnk_cap); | 1041 | retval = hp_register_read_dword(php_ctlr->pci_dev, LNK_CAP(slot->ctrl->cap_base), lnk_cap); |
1042 | 1042 | ||
1043 | if (retval) { | 1043 | if (retval) { |
1044 | err("%s : hp_register_read_dword LNK_CAP failed\n", __FUNCTION__); | 1044 | err("%s : hp_register_read_dword LNK_CAP failed\n", __FUNCTION__); |
@@ -1079,7 +1079,7 @@ static int hpc_get_max_lnk_width (struct slot *slot, enum pcie_link_width *value | |||
1079 | return -1; | 1079 | return -1; |
1080 | } | 1080 | } |
1081 | 1081 | ||
1082 | retval = hp_register_read_dword(php_ctlr->pci_dev, LNK_CAP, lnk_cap); | 1082 | retval = hp_register_read_dword(php_ctlr->pci_dev, LNK_CAP(slot->ctrl->cap_base), lnk_cap); |
1083 | 1083 | ||
1084 | if (retval) { | 1084 | if (retval) { |
1085 | err("%s : hp_register_read_dword LNK_CAP failed\n", __FUNCTION__); | 1085 | err("%s : hp_register_read_dword LNK_CAP failed\n", __FUNCTION__); |
@@ -1141,7 +1141,7 @@ static int hpc_get_cur_lnk_speed (struct slot *slot, enum pci_bus_speed *value) | |||
1141 | return -1; | 1141 | return -1; |
1142 | } | 1142 | } |
1143 | 1143 | ||
1144 | retval = hp_register_read_word(php_ctlr->pci_dev, LNK_STATUS, lnk_status); | 1144 | retval = hp_register_read_word(php_ctlr->pci_dev, LNK_STATUS(slot->ctrl->cap_base), lnk_status); |
1145 | 1145 | ||
1146 | if (retval) { | 1146 | if (retval) { |
1147 | err("%s : hp_register_read_word LNK_STATUS failed\n", __FUNCTION__); | 1147 | err("%s : hp_register_read_word LNK_STATUS failed\n", __FUNCTION__); |
@@ -1182,7 +1182,7 @@ static int hpc_get_cur_lnk_width (struct slot *slot, enum pcie_link_width *value | |||
1182 | return -1; | 1182 | return -1; |
1183 | } | 1183 | } |
1184 | 1184 | ||
1185 | retval = hp_register_read_word(php_ctlr->pci_dev, LNK_STATUS, lnk_status); | 1185 | retval = hp_register_read_word(php_ctlr->pci_dev, LNK_STATUS(slot->ctrl->cap_base), lnk_status); |
1186 | 1186 | ||
1187 | if (retval) { | 1187 | if (retval) { |
1188 | err("%s : hp_register_read_word LNK_STATUS failed\n", __FUNCTION__); | 1188 | err("%s : hp_register_read_word LNK_STATUS failed\n", __FUNCTION__); |
@@ -1292,47 +1292,48 @@ int pcie_init(struct controller * ctrl, | |||
1292 | goto abort_free_ctlr; | 1292 | goto abort_free_ctlr; |
1293 | } | 1293 | } |
1294 | 1294 | ||
1295 | pcie_cap_base = cap_base; | 1295 | ctrl->cap_base = cap_base; |
1296 | 1296 | ||
1297 | dbg("%s: pcie_cap_base %x\n", __FUNCTION__, pcie_cap_base); | 1297 | dbg("%s: pcie_cap_base %x\n", __FUNCTION__, pcie_cap_base); |
1298 | 1298 | ||
1299 | rc = hp_register_read_word(pdev, CAP_REG, cap_reg); | 1299 | rc = hp_register_read_word(pdev, CAP_REG(ctrl->cap_base), cap_reg); |
1300 | if (rc) { | 1300 | if (rc) { |
1301 | err("%s : hp_register_read_word CAP_REG failed\n", __FUNCTION__); | 1301 | err("%s : hp_register_read_word CAP_REG failed\n", __FUNCTION__); |
1302 | goto abort_free_ctlr; | 1302 | goto abort_free_ctlr; |
1303 | } | 1303 | } |
1304 | dbg("%s: CAP_REG offset %x cap_reg %x\n", __FUNCTION__, CAP_REG, cap_reg); | 1304 | dbg("%s: CAP_REG offset %x cap_reg %x\n", __FUNCTION__, CAP_REG(ctrl->cap_base), cap_reg); |
1305 | 1305 | ||
1306 | if (((cap_reg & SLOT_IMPL) == 0) || ((cap_reg & DEV_PORT_TYPE) != 0x0040)){ | 1306 | if (((cap_reg & SLOT_IMPL) == 0) || (((cap_reg & DEV_PORT_TYPE) != 0x0040) |
1307 | && ((cap_reg & DEV_PORT_TYPE) != 0x0060))) { | ||
1307 | dbg("%s : This is not a root port or the port is not connected to a slot\n", __FUNCTION__); | 1308 | dbg("%s : This is not a root port or the port is not connected to a slot\n", __FUNCTION__); |
1308 | goto abort_free_ctlr; | 1309 | goto abort_free_ctlr; |
1309 | } | 1310 | } |
1310 | 1311 | ||
1311 | rc = hp_register_read_dword(php_ctlr->pci_dev, SLOT_CAP, slot_cap); | 1312 | rc = hp_register_read_dword(php_ctlr->pci_dev, SLOT_CAP(ctrl->cap_base), slot_cap); |
1312 | if (rc) { | 1313 | if (rc) { |
1313 | err("%s : hp_register_read_word CAP_REG failed\n", __FUNCTION__); | 1314 | err("%s : hp_register_read_word CAP_REG failed\n", __FUNCTION__); |
1314 | goto abort_free_ctlr; | 1315 | goto abort_free_ctlr; |
1315 | } | 1316 | } |
1316 | dbg("%s: SLOT_CAP offset %x slot_cap %x\n", __FUNCTION__, SLOT_CAP, slot_cap); | 1317 | dbg("%s: SLOT_CAP offset %x slot_cap %x\n", __FUNCTION__, SLOT_CAP(ctrl->cap_base), slot_cap); |
1317 | 1318 | ||
1318 | if (!(slot_cap & HP_CAP)) { | 1319 | if (!(slot_cap & HP_CAP)) { |
1319 | dbg("%s : This slot is not hot-plug capable\n", __FUNCTION__); | 1320 | dbg("%s : This slot is not hot-plug capable\n", __FUNCTION__); |
1320 | goto abort_free_ctlr; | 1321 | goto abort_free_ctlr; |
1321 | } | 1322 | } |
1322 | /* For debugging purpose */ | 1323 | /* For debugging purpose */ |
1323 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS, slot_status); | 1324 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS(ctrl->cap_base), slot_status); |
1324 | if (rc) { | 1325 | if (rc) { |
1325 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); | 1326 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); |
1326 | goto abort_free_ctlr; | 1327 | goto abort_free_ctlr; |
1327 | } | 1328 | } |
1328 | dbg("%s: SLOT_STATUS offset %x slot_status %x\n", __FUNCTION__, SLOT_STATUS, slot_status); | 1329 | dbg("%s: SLOT_STATUS offset %x slot_status %x\n", __FUNCTION__, SLOT_STATUS(ctrl->cap_base), slot_status); |
1329 | 1330 | ||
1330 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL, slot_ctrl); | 1331 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_CTRL(ctrl->cap_base), slot_ctrl); |
1331 | if (rc) { | 1332 | if (rc) { |
1332 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); | 1333 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); |
1333 | goto abort_free_ctlr; | 1334 | goto abort_free_ctlr; |
1334 | } | 1335 | } |
1335 | dbg("%s: SLOT_CTRL offset %x slot_ctrl %x\n", __FUNCTION__, SLOT_CTRL, slot_ctrl); | 1336 | dbg("%s: SLOT_CTRL offset %x slot_ctrl %x\n", __FUNCTION__, SLOT_CTRL(ctrl->cap_base), slot_ctrl); |
1336 | 1337 | ||
1337 | if (first) { | 1338 | if (first) { |
1338 | spin_lock_init(&hpc_event_lock); | 1339 | spin_lock_init(&hpc_event_lock); |
@@ -1372,36 +1373,37 @@ int pcie_init(struct controller * ctrl, | |||
1372 | php_ctlr->num_slots = 1; | 1373 | php_ctlr->num_slots = 1; |
1373 | 1374 | ||
1374 | /* Mask Hot-plug Interrupt Enable */ | 1375 | /* Mask Hot-plug Interrupt Enable */ |
1375 | rc = hp_register_read_word(pdev, SLOT_CTRL, temp_word); | 1376 | rc = hp_register_read_word(pdev, SLOT_CTRL(ctrl->cap_base), temp_word); |
1376 | if (rc) { | 1377 | if (rc) { |
1377 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); | 1378 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); |
1378 | goto abort_free_ctlr; | 1379 | goto abort_free_ctlr; |
1379 | } | 1380 | } |
1380 | 1381 | ||
1381 | dbg("%s: SLOT_CTRL %x value read %x\n", __FUNCTION__, SLOT_CTRL, temp_word); | 1382 | dbg("%s: SLOT_CTRL %x value read %x\n", __FUNCTION__, SLOT_CTRL(ctrl->cap_base), temp_word); |
1382 | temp_word = (temp_word & ~HP_INTR_ENABLE & ~CMD_CMPL_INTR_ENABLE) | 0x00; | 1383 | temp_word = (temp_word & ~HP_INTR_ENABLE & ~CMD_CMPL_INTR_ENABLE) | 0x00; |
1383 | 1384 | ||
1384 | rc = hp_register_write_word(pdev, SLOT_CTRL, temp_word); | 1385 | rc = hp_register_write_word(pdev, SLOT_CTRL(ctrl->cap_base), temp_word); |
1385 | if (rc) { | 1386 | if (rc) { |
1386 | err("%s : hp_register_write_word SLOT_CTRL failed\n", __FUNCTION__); | 1387 | err("%s : hp_register_write_word SLOT_CTRL failed\n", __FUNCTION__); |
1387 | goto abort_free_ctlr; | 1388 | goto abort_free_ctlr; |
1388 | } | 1389 | } |
1389 | dbg("%s : Mask HPIE hp_register_write_word SLOT_CTRL %x\n", __FUNCTION__, temp_word); | 1390 | dbg("%s : Mask HPIE hp_register_write_word SLOT_CTRL %x\n", __FUNCTION__, temp_word); |
1390 | 1391 | ||
1391 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS, slot_status); | 1392 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS(ctrl->cap_base), slot_status); |
1392 | if (rc) { | 1393 | if (rc) { |
1393 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); | 1394 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); |
1394 | goto abort_free_ctlr; | 1395 | goto abort_free_ctlr; |
1395 | } | 1396 | } |
1396 | dbg("%s: Mask HPIE SLOT_STATUS offset %x reads slot_status %x\n", __FUNCTION__, SLOT_STATUS, slot_status); | 1397 | dbg("%s: Mask HPIE SLOT_STATUS offset %x reads slot_status %x\n", __FUNCTION__, SLOT_STATUS(ctrl->cap_base) |
1398 | , slot_status); | ||
1397 | 1399 | ||
1398 | temp_word = 0x1F; /* Clear all events */ | 1400 | temp_word = 0x1F; /* Clear all events */ |
1399 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_STATUS, temp_word); | 1401 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_STATUS(ctrl->cap_base), temp_word); |
1400 | if (rc) { | 1402 | if (rc) { |
1401 | err("%s : hp_register_write_word SLOT_STATUS failed\n", __FUNCTION__); | 1403 | err("%s : hp_register_write_word SLOT_STATUS failed\n", __FUNCTION__); |
1402 | goto abort_free_ctlr; | 1404 | goto abort_free_ctlr; |
1403 | } | 1405 | } |
1404 | dbg("%s: SLOT_STATUS offset %x writes slot_status %x\n", __FUNCTION__, SLOT_STATUS, temp_word); | 1406 | dbg("%s: SLOT_STATUS offset %x writes slot_status %x\n", __FUNCTION__, SLOT_STATUS(ctrl->cap_base), temp_word); |
1405 | 1407 | ||
1406 | if (pciehp_poll_mode) {/* Install interrupt polling code */ | 1408 | if (pciehp_poll_mode) {/* Install interrupt polling code */ |
1407 | /* Install and start the interrupt polling timer */ | 1409 | /* Install and start the interrupt polling timer */ |
@@ -1417,12 +1419,12 @@ int pcie_init(struct controller * ctrl, | |||
1417 | } | 1419 | } |
1418 | } | 1420 | } |
1419 | 1421 | ||
1420 | rc = hp_register_read_word(pdev, SLOT_CTRL, temp_word); | 1422 | rc = hp_register_read_word(pdev, SLOT_CTRL(ctrl->cap_base), temp_word); |
1421 | if (rc) { | 1423 | if (rc) { |
1422 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); | 1424 | err("%s : hp_register_read_word SLOT_CTRL failed\n", __FUNCTION__); |
1423 | goto abort_free_ctlr; | 1425 | goto abort_free_ctlr; |
1424 | } | 1426 | } |
1425 | dbg("%s: SLOT_CTRL %x value read %x\n", __FUNCTION__, SLOT_CTRL, temp_word); | 1427 | dbg("%s: SLOT_CTRL %x value read %x\n", __FUNCTION__, SLOT_CTRL(ctrl->cap_base), temp_word); |
1426 | dbg("%s: slot_cap %x\n", __FUNCTION__, slot_cap); | 1428 | dbg("%s: slot_cap %x\n", __FUNCTION__, slot_cap); |
1427 | 1429 | ||
1428 | intr_enable = intr_enable | PRSN_DETECT_ENABLE; | 1430 | intr_enable = intr_enable | PRSN_DETECT_ENABLE; |
@@ -1446,27 +1448,27 @@ int pcie_init(struct controller * ctrl, | |||
1446 | dbg("%s: temp_word %x\n", __FUNCTION__, temp_word); | 1448 | dbg("%s: temp_word %x\n", __FUNCTION__, temp_word); |
1447 | 1449 | ||
1448 | /* Unmask Hot-plug Interrupt Enable for the interrupt notification mechanism case */ | 1450 | /* Unmask Hot-plug Interrupt Enable for the interrupt notification mechanism case */ |
1449 | rc = hp_register_write_word(pdev, SLOT_CTRL, temp_word); | 1451 | rc = hp_register_write_word(pdev, SLOT_CTRL(ctrl->cap_base), temp_word); |
1450 | if (rc) { | 1452 | if (rc) { |
1451 | err("%s : hp_register_write_word SLOT_CTRL failed\n", __FUNCTION__); | 1453 | err("%s : hp_register_write_word SLOT_CTRL failed\n", __FUNCTION__); |
1452 | goto abort_free_ctlr; | 1454 | goto abort_free_ctlr; |
1453 | } | 1455 | } |
1454 | dbg("%s : Unmask HPIE hp_register_write_word SLOT_CTRL with %x\n", __FUNCTION__, temp_word); | 1456 | dbg("%s : Unmask HPIE hp_register_write_word SLOT_CTRL with %x\n", __FUNCTION__, temp_word); |
1455 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS, slot_status); | 1457 | rc = hp_register_read_word(php_ctlr->pci_dev, SLOT_STATUS(ctrl->cap_base), slot_status); |
1456 | if (rc) { | 1458 | if (rc) { |
1457 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); | 1459 | err("%s : hp_register_read_word SLOT_STATUS failed\n", __FUNCTION__); |
1458 | goto abort_free_ctlr; | 1460 | goto abort_free_ctlr; |
1459 | } | 1461 | } |
1460 | dbg("%s: Unmask HPIE SLOT_STATUS offset %x reads slot_status %x\n", __FUNCTION__, | 1462 | dbg("%s: Unmask HPIE SLOT_STATUS offset %x reads slot_status %x\n", __FUNCTION__, |
1461 | SLOT_STATUS, slot_status); | 1463 | SLOT_STATUS(ctrl->cap_base), slot_status); |
1462 | 1464 | ||
1463 | temp_word = 0x1F; /* Clear all events */ | 1465 | temp_word = 0x1F; /* Clear all events */ |
1464 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_STATUS, temp_word); | 1466 | rc = hp_register_write_word(php_ctlr->pci_dev, SLOT_STATUS(ctrl->cap_base), temp_word); |
1465 | if (rc) { | 1467 | if (rc) { |
1466 | err("%s : hp_register_write_word SLOT_STATUS failed\n", __FUNCTION__); | 1468 | err("%s : hp_register_write_word SLOT_STATUS failed\n", __FUNCTION__); |
1467 | goto abort_free_ctlr; | 1469 | goto abort_free_ctlr; |
1468 | } | 1470 | } |
1469 | dbg("%s: SLOT_STATUS offset %x writes slot_status %x\n", __FUNCTION__, SLOT_STATUS, temp_word); | 1471 | dbg("%s: SLOT_STATUS offset %x writes slot_status %x\n", __FUNCTION__, SLOT_STATUS(ctrl->cap_base), temp_word); |
1470 | 1472 | ||
1471 | /* Add this HPC instance into the HPC list */ | 1473 | /* Add this HPC instance into the HPC list */ |
1472 | spin_lock(&list_lock); | 1474 | spin_lock(&list_lock); |
diff --git a/drivers/pci/hotplug/shpchp_core.c b/drivers/pci/hotplug/shpchp_core.c index f0c53f850aed..a70a5c5705f2 100644 --- a/drivers/pci/hotplug/shpchp_core.c +++ b/drivers/pci/hotplug/shpchp_core.c | |||
@@ -95,7 +95,7 @@ static struct hotplug_slot_ops shpchp_hotplug_slot_ops = { | |||
95 | */ | 95 | */ |
96 | static void release_slot(struct hotplug_slot *hotplug_slot) | 96 | static void release_slot(struct hotplug_slot *hotplug_slot) |
97 | { | 97 | { |
98 | struct slot *slot = (struct slot *)hotplug_slot->private; | 98 | struct slot *slot = hotplug_slot->private; |
99 | 99 | ||
100 | dbg("%s - physical_slot = %s\n", __FUNCTION__, hotplug_slot->name); | 100 | dbg("%s - physical_slot = %s\n", __FUNCTION__, hotplug_slot->name); |
101 | 101 | ||
diff --git a/drivers/pci/hotplug/shpchp_ctrl.c b/drivers/pci/hotplug/shpchp_ctrl.c index 9f90eb8e6ecd..490a9553a062 100644 --- a/drivers/pci/hotplug/shpchp_ctrl.c +++ b/drivers/pci/hotplug/shpchp_ctrl.c | |||
@@ -1885,7 +1885,7 @@ int shpchp_enable_slot (struct slot *p_slot) | |||
1885 | func = shpchp_slot_find(p_slot->bus, p_slot->device, 0); | 1885 | func = shpchp_slot_find(p_slot->bus, p_slot->device, 0); |
1886 | if (!func) { | 1886 | if (!func) { |
1887 | dbg("%s: Error! slot NULL\n", __FUNCTION__); | 1887 | dbg("%s: Error! slot NULL\n", __FUNCTION__); |
1888 | return 1; | 1888 | return -ENODEV; |
1889 | } | 1889 | } |
1890 | 1890 | ||
1891 | /* Check to see if (latch closed, card present, power off) */ | 1891 | /* Check to see if (latch closed, card present, power off) */ |
@@ -1894,19 +1894,19 @@ int shpchp_enable_slot (struct slot *p_slot) | |||
1894 | if (rc || !getstatus) { | 1894 | if (rc || !getstatus) { |
1895 | info("%s: no adapter on slot(%x)\n", __FUNCTION__, p_slot->number); | 1895 | info("%s: no adapter on slot(%x)\n", __FUNCTION__, p_slot->number); |
1896 | up(&p_slot->ctrl->crit_sect); | 1896 | up(&p_slot->ctrl->crit_sect); |
1897 | return 1; | 1897 | return -ENODEV; |
1898 | } | 1898 | } |
1899 | rc = p_slot->hpc_ops->get_latch_status(p_slot, &getstatus); | 1899 | rc = p_slot->hpc_ops->get_latch_status(p_slot, &getstatus); |
1900 | if (rc || getstatus) { | 1900 | if (rc || getstatus) { |
1901 | info("%s: latch open on slot(%x)\n", __FUNCTION__, p_slot->number); | 1901 | info("%s: latch open on slot(%x)\n", __FUNCTION__, p_slot->number); |
1902 | up(&p_slot->ctrl->crit_sect); | 1902 | up(&p_slot->ctrl->crit_sect); |
1903 | return 1; | 1903 | return -ENODEV; |
1904 | } | 1904 | } |
1905 | rc = p_slot->hpc_ops->get_power_status(p_slot, &getstatus); | 1905 | rc = p_slot->hpc_ops->get_power_status(p_slot, &getstatus); |
1906 | if (rc || getstatus) { | 1906 | if (rc || getstatus) { |
1907 | info("%s: already enabled on slot(%x)\n", __FUNCTION__, p_slot->number); | 1907 | info("%s: already enabled on slot(%x)\n", __FUNCTION__, p_slot->number); |
1908 | up(&p_slot->ctrl->crit_sect); | 1908 | up(&p_slot->ctrl->crit_sect); |
1909 | return 1; | 1909 | return -ENODEV; |
1910 | } | 1910 | } |
1911 | up(&p_slot->ctrl->crit_sect); | 1911 | up(&p_slot->ctrl->crit_sect); |
1912 | 1912 | ||
@@ -1914,7 +1914,7 @@ int shpchp_enable_slot (struct slot *p_slot) | |||
1914 | 1914 | ||
1915 | func = shpchp_slot_create(p_slot->bus); | 1915 | func = shpchp_slot_create(p_slot->bus); |
1916 | if (func == NULL) | 1916 | if (func == NULL) |
1917 | return 1; | 1917 | return -ENOMEM; |
1918 | 1918 | ||
1919 | func->bus = p_slot->bus; | 1919 | func->bus = p_slot->bus; |
1920 | func->device = p_slot->device; | 1920 | func->device = p_slot->device; |
@@ -1939,7 +1939,7 @@ int shpchp_enable_slot (struct slot *p_slot) | |||
1939 | /* Setup slot structure with entry for empty slot */ | 1939 | /* Setup slot structure with entry for empty slot */ |
1940 | func = shpchp_slot_create(p_slot->bus); | 1940 | func = shpchp_slot_create(p_slot->bus); |
1941 | if (func == NULL) | 1941 | if (func == NULL) |
1942 | return (1); /* Out of memory */ | 1942 | return -ENOMEM; /* Out of memory */ |
1943 | 1943 | ||
1944 | func->bus = p_slot->bus; | 1944 | func->bus = p_slot->bus; |
1945 | func->device = p_slot->device; | 1945 | func->device = p_slot->device; |
@@ -1972,7 +1972,7 @@ int shpchp_disable_slot (struct slot *p_slot) | |||
1972 | struct pci_func *func; | 1972 | struct pci_func *func; |
1973 | 1973 | ||
1974 | if (!p_slot->ctrl) | 1974 | if (!p_slot->ctrl) |
1975 | return 1; | 1975 | return -ENODEV; |
1976 | 1976 | ||
1977 | pci_bus = p_slot->ctrl->pci_dev->subordinate; | 1977 | pci_bus = p_slot->ctrl->pci_dev->subordinate; |
1978 | 1978 | ||
@@ -1983,19 +1983,19 @@ int shpchp_disable_slot (struct slot *p_slot) | |||
1983 | if (ret || !getstatus) { | 1983 | if (ret || !getstatus) { |
1984 | info("%s: no adapter on slot(%x)\n", __FUNCTION__, p_slot->number); | 1984 | info("%s: no adapter on slot(%x)\n", __FUNCTION__, p_slot->number); |
1985 | up(&p_slot->ctrl->crit_sect); | 1985 | up(&p_slot->ctrl->crit_sect); |
1986 | return 1; | 1986 | return -ENODEV; |
1987 | } | 1987 | } |
1988 | ret = p_slot->hpc_ops->get_latch_status(p_slot, &getstatus); | 1988 | ret = p_slot->hpc_ops->get_latch_status(p_slot, &getstatus); |
1989 | if (ret || getstatus) { | 1989 | if (ret || getstatus) { |
1990 | info("%s: latch open on slot(%x)\n", __FUNCTION__, p_slot->number); | 1990 | info("%s: latch open on slot(%x)\n", __FUNCTION__, p_slot->number); |
1991 | up(&p_slot->ctrl->crit_sect); | 1991 | up(&p_slot->ctrl->crit_sect); |
1992 | return 1; | 1992 | return -ENODEV; |
1993 | } | 1993 | } |
1994 | ret = p_slot->hpc_ops->get_power_status(p_slot, &getstatus); | 1994 | ret = p_slot->hpc_ops->get_power_status(p_slot, &getstatus); |
1995 | if (ret || !getstatus) { | 1995 | if (ret || !getstatus) { |
1996 | info("%s: already disabled slot(%x)\n", __FUNCTION__, p_slot->number); | 1996 | info("%s: already disabled slot(%x)\n", __FUNCTION__, p_slot->number); |
1997 | up(&p_slot->ctrl->crit_sect); | 1997 | up(&p_slot->ctrl->crit_sect); |
1998 | return 1; | 1998 | return -ENODEV; |
1999 | } | 1999 | } |
2000 | up(&p_slot->ctrl->crit_sect); | 2000 | up(&p_slot->ctrl->crit_sect); |
2001 | 2001 | ||
@@ -2011,7 +2011,7 @@ int shpchp_disable_slot (struct slot *p_slot) | |||
2011 | /* Check the Class Code */ | 2011 | /* Check the Class Code */ |
2012 | rc = pci_bus_read_config_byte (pci_bus, devfn, 0x0B, &class_code); | 2012 | rc = pci_bus_read_config_byte (pci_bus, devfn, 0x0B, &class_code); |
2013 | if (rc) | 2013 | if (rc) |
2014 | return rc; | 2014 | return -ENODEV; |
2015 | 2015 | ||
2016 | if (class_code == PCI_BASE_CLASS_DISPLAY) { | 2016 | if (class_code == PCI_BASE_CLASS_DISPLAY) { |
2017 | /* Display/Video adapter (not supported) */ | 2017 | /* Display/Video adapter (not supported) */ |
@@ -2020,13 +2020,13 @@ int shpchp_disable_slot (struct slot *p_slot) | |||
2020 | /* See if it's a bridge */ | 2020 | /* See if it's a bridge */ |
2021 | rc = pci_bus_read_config_byte (pci_bus, devfn, PCI_HEADER_TYPE, &header_type); | 2021 | rc = pci_bus_read_config_byte (pci_bus, devfn, PCI_HEADER_TYPE, &header_type); |
2022 | if (rc) | 2022 | if (rc) |
2023 | return rc; | 2023 | return -ENODEV; |
2024 | 2024 | ||
2025 | /* If it's a bridge, check the VGA Enable bit */ | 2025 | /* If it's a bridge, check the VGA Enable bit */ |
2026 | if ((header_type & 0x7F) == PCI_HEADER_TYPE_BRIDGE) { | 2026 | if ((header_type & 0x7F) == PCI_HEADER_TYPE_BRIDGE) { |
2027 | rc = pci_bus_read_config_byte (pci_bus, devfn, PCI_BRIDGE_CONTROL, &BCR); | 2027 | rc = pci_bus_read_config_byte (pci_bus, devfn, PCI_BRIDGE_CONTROL, &BCR); |
2028 | if (rc) | 2028 | if (rc) |
2029 | return rc; | 2029 | return -ENODEV; |
2030 | 2030 | ||
2031 | /* If the VGA Enable bit is set, remove isn't supported */ | 2031 | /* If the VGA Enable bit is set, remove isn't supported */ |
2032 | if (BCR & PCI_BRIDGE_CTL_VGA) { | 2032 | if (BCR & PCI_BRIDGE_CTL_VGA) { |
@@ -2042,12 +2042,12 @@ int shpchp_disable_slot (struct slot *p_slot) | |||
2042 | if ((func != NULL) && !rc) { | 2042 | if ((func != NULL) && !rc) { |
2043 | rc = remove_board(func, p_slot->ctrl); | 2043 | rc = remove_board(func, p_slot->ctrl); |
2044 | } else if (!rc) | 2044 | } else if (!rc) |
2045 | rc = 1; | 2045 | rc = -ENODEV; |
2046 | 2046 | ||
2047 | if (p_slot) | 2047 | if (p_slot) |
2048 | update_slot_info(p_slot); | 2048 | update_slot_info(p_slot); |
2049 | 2049 | ||
2050 | return(rc); | 2050 | return rc; |
2051 | } | 2051 | } |
2052 | 2052 | ||
2053 | 2053 | ||
diff --git a/drivers/pci/pci-sysfs.c b/drivers/pci/pci-sysfs.c index 8568b207f189..6ca0061137a6 100644 --- a/drivers/pci/pci-sysfs.c +++ b/drivers/pci/pci-sysfs.c | |||
@@ -73,6 +73,17 @@ resource_show(struct device * dev, char * buf) | |||
73 | return (str - buf); | 73 | return (str - buf); |
74 | } | 74 | } |
75 | 75 | ||
76 | static ssize_t modalias_show(struct device *dev, char *buf) | ||
77 | { | ||
78 | struct pci_dev *pci_dev = to_pci_dev(dev); | ||
79 | |||
80 | return sprintf(buf, "pci:v%08Xd%08Xsv%08Xsd%08Xbc%02Xsc%02Xi%02x\n", | ||
81 | pci_dev->vendor, pci_dev->device, | ||
82 | pci_dev->subsystem_vendor, pci_dev->subsystem_device, | ||
83 | (u8)(pci_dev->class >> 16), (u8)(pci_dev->class >> 8), | ||
84 | (u8)(pci_dev->class)); | ||
85 | } | ||
86 | |||
76 | struct device_attribute pci_dev_attrs[] = { | 87 | struct device_attribute pci_dev_attrs[] = { |
77 | __ATTR_RO(resource), | 88 | __ATTR_RO(resource), |
78 | __ATTR_RO(vendor), | 89 | __ATTR_RO(vendor), |
@@ -82,6 +93,7 @@ struct device_attribute pci_dev_attrs[] = { | |||
82 | __ATTR_RO(class), | 93 | __ATTR_RO(class), |
83 | __ATTR_RO(irq), | 94 | __ATTR_RO(irq), |
84 | __ATTR_RO(local_cpus), | 95 | __ATTR_RO(local_cpus), |
96 | __ATTR_RO(modalias), | ||
85 | __ATTR_NULL, | 97 | __ATTR_NULL, |
86 | }; | 98 | }; |
87 | 99 | ||
diff --git a/drivers/pci/pci.h b/drivers/pci/pci.h index 79cdc16c52c8..744da0d4ae5f 100644 --- a/drivers/pci/pci.h +++ b/drivers/pci/pci.h | |||
@@ -32,33 +32,6 @@ extern unsigned char pci_max_busnr(void); | |||
32 | extern unsigned char pci_bus_max_busnr(struct pci_bus *bus); | 32 | extern unsigned char pci_bus_max_busnr(struct pci_bus *bus); |
33 | extern int pci_bus_find_capability (struct pci_bus *bus, unsigned int devfn, int cap); | 33 | extern int pci_bus_find_capability (struct pci_bus *bus, unsigned int devfn, int cap); |
34 | 34 | ||
35 | struct pci_dev_wrapped { | ||
36 | struct pci_dev *dev; | ||
37 | void *data; | ||
38 | }; | ||
39 | |||
40 | struct pci_bus_wrapped { | ||
41 | struct pci_bus *bus; | ||
42 | void *data; | ||
43 | }; | ||
44 | |||
45 | struct pci_visit { | ||
46 | int (* pre_visit_pci_bus) (struct pci_bus_wrapped *, | ||
47 | struct pci_dev_wrapped *); | ||
48 | int (* post_visit_pci_bus) (struct pci_bus_wrapped *, | ||
49 | struct pci_dev_wrapped *); | ||
50 | |||
51 | int (* pre_visit_pci_dev) (struct pci_dev_wrapped *, | ||
52 | struct pci_bus_wrapped *); | ||
53 | int (* visit_pci_dev) (struct pci_dev_wrapped *, | ||
54 | struct pci_bus_wrapped *); | ||
55 | int (* post_visit_pci_dev) (struct pci_dev_wrapped *, | ||
56 | struct pci_bus_wrapped *); | ||
57 | }; | ||
58 | |||
59 | extern int pci_visit_dev(struct pci_visit *fn, | ||
60 | struct pci_dev_wrapped *wrapped_dev, | ||
61 | struct pci_bus_wrapped *wrapped_parent); | ||
62 | extern void pci_remove_legacy_files(struct pci_bus *bus); | 35 | extern void pci_remove_legacy_files(struct pci_bus *bus); |
63 | 36 | ||
64 | /* Lock for read/write access to pci device and bus lists */ | 37 | /* Lock for read/write access to pci device and bus lists */ |
diff --git a/drivers/pci/pcie/portdrv_bus.c b/drivers/pci/pcie/portdrv_bus.c index 4037a3e568de..3e84b501e6a4 100644 --- a/drivers/pci/pcie/portdrv_bus.c +++ b/drivers/pci/pcie/portdrv_bus.c | |||
@@ -39,7 +39,8 @@ static int pcie_port_bus_match(struct device *dev, struct device_driver *drv) | |||
39 | driver->id_table->vendor != pciedev->id.vendor) || | 39 | driver->id_table->vendor != pciedev->id.vendor) || |
40 | (driver->id_table->device != PCI_ANY_ID && | 40 | (driver->id_table->device != PCI_ANY_ID && |
41 | driver->id_table->device != pciedev->id.device) || | 41 | driver->id_table->device != pciedev->id.device) || |
42 | driver->id_table->port_type != pciedev->id.port_type || | 42 | (driver->id_table->port_type != PCIE_ANY_PORT && |
43 | driver->id_table->port_type != pciedev->id.port_type) || | ||
43 | driver->id_table->service_type != pciedev->id.service_type ) | 44 | driver->id_table->service_type != pciedev->id.service_type ) |
44 | return 0; | 45 | return 0; |
45 | 46 | ||
diff --git a/drivers/pcmcia/ds.c b/drivers/pcmcia/ds.c index 66150d08b5c7..c4ade288c5da 100644 --- a/drivers/pcmcia/ds.c +++ b/drivers/pcmcia/ds.c | |||
@@ -1592,9 +1592,9 @@ static int __init init_pcmcia_bus(void) | |||
1592 | 1592 | ||
1593 | /* Set up character device for user mode clients */ | 1593 | /* Set up character device for user mode clients */ |
1594 | i = register_chrdev(0, "pcmcia", &ds_fops); | 1594 | i = register_chrdev(0, "pcmcia", &ds_fops); |
1595 | if (i == -EBUSY) | 1595 | if (i < 0) |
1596 | printk(KERN_NOTICE "unable to find a free device # for " | 1596 | printk(KERN_NOTICE "unable to find a free device # for " |
1597 | "Driver Services\n"); | 1597 | "Driver Services (error=%d)\n", i); |
1598 | else | 1598 | else |
1599 | major_dev = i; | 1599 | major_dev = i; |
1600 | 1600 | ||
diff --git a/drivers/s390/block/dasd.c b/drivers/s390/block/dasd.c index 02cfe244e069..ceeb3cf64a16 100644 --- a/drivers/s390/block/dasd.c +++ b/drivers/s390/block/dasd.c | |||
@@ -7,7 +7,7 @@ | |||
7 | * Bugreports.to..: <Linux390@de.ibm.com> | 7 | * Bugreports.to..: <Linux390@de.ibm.com> |
8 | * (C) IBM Corporation, IBM Deutschland Entwicklung GmbH, 1999-2001 | 8 | * (C) IBM Corporation, IBM Deutschland Entwicklung GmbH, 1999-2001 |
9 | * | 9 | * |
10 | * $Revision: 1.161 $ | 10 | * $Revision: 1.164 $ |
11 | */ | 11 | */ |
12 | 12 | ||
13 | #include <linux/config.h> | 13 | #include <linux/config.h> |
@@ -1766,10 +1766,10 @@ dasd_generic_probe (struct ccw_device *cdev, | |||
1766 | printk(KERN_WARNING | 1766 | printk(KERN_WARNING |
1767 | "dasd_generic_probe: could not add sysfs entries " | 1767 | "dasd_generic_probe: could not add sysfs entries " |
1768 | "for %s\n", cdev->dev.bus_id); | 1768 | "for %s\n", cdev->dev.bus_id); |
1769 | } else { | ||
1770 | cdev->handler = &dasd_int_handler; | ||
1769 | } | 1771 | } |
1770 | 1772 | ||
1771 | cdev->handler = &dasd_int_handler; | ||
1772 | |||
1773 | return ret; | 1773 | return ret; |
1774 | } | 1774 | } |
1775 | 1775 | ||
@@ -1780,6 +1780,8 @@ dasd_generic_remove (struct ccw_device *cdev) | |||
1780 | { | 1780 | { |
1781 | struct dasd_device *device; | 1781 | struct dasd_device *device; |
1782 | 1782 | ||
1783 | cdev->handler = NULL; | ||
1784 | |||
1783 | dasd_remove_sysfs_files(cdev); | 1785 | dasd_remove_sysfs_files(cdev); |
1784 | device = dasd_device_from_cdev(cdev); | 1786 | device = dasd_device_from_cdev(cdev); |
1785 | if (IS_ERR(device)) | 1787 | if (IS_ERR(device)) |
@@ -1810,14 +1812,14 @@ dasd_generic_set_online (struct ccw_device *cdev, | |||
1810 | struct dasd_device *device; | 1812 | struct dasd_device *device; |
1811 | int feature_diag, rc; | 1813 | int feature_diag, rc; |
1812 | 1814 | ||
1813 | feature_diag = dasd_get_feature(cdev, DASD_FEATURE_USEDIAG); | ||
1814 | if (feature_diag < 0) | ||
1815 | return feature_diag; | ||
1816 | |||
1817 | device = dasd_create_device(cdev); | 1815 | device = dasd_create_device(cdev); |
1818 | if (IS_ERR(device)) | 1816 | if (IS_ERR(device)) |
1819 | return PTR_ERR(device); | 1817 | return PTR_ERR(device); |
1820 | 1818 | ||
1819 | feature_diag = dasd_get_feature(cdev, DASD_FEATURE_USEDIAG); | ||
1820 | if (feature_diag < 0) | ||
1821 | return feature_diag; | ||
1822 | |||
1821 | if (feature_diag) { | 1823 | if (feature_diag) { |
1822 | if (!dasd_diag_discipline_pointer) { | 1824 | if (!dasd_diag_discipline_pointer) { |
1823 | printk (KERN_WARNING | 1825 | printk (KERN_WARNING |
diff --git a/drivers/scsi/libata-core.c b/drivers/scsi/libata-core.c index 0b5d3a5b7eda..ee9b96da841e 100644 --- a/drivers/scsi/libata-core.c +++ b/drivers/scsi/libata-core.c | |||
@@ -1253,11 +1253,11 @@ void __sata_phy_reset(struct ata_port *ap) | |||
1253 | unsigned long timeout = jiffies + (HZ * 5); | 1253 | unsigned long timeout = jiffies + (HZ * 5); |
1254 | 1254 | ||
1255 | if (ap->flags & ATA_FLAG_SATA_RESET) { | 1255 | if (ap->flags & ATA_FLAG_SATA_RESET) { |
1256 | scr_write(ap, SCR_CONTROL, 0x301); /* issue phy wake/reset */ | 1256 | /* issue phy wake/reset */ |
1257 | scr_read(ap, SCR_STATUS); /* dummy read; flush */ | 1257 | scr_write_flush(ap, SCR_CONTROL, 0x301); |
1258 | udelay(400); /* FIXME: a guess */ | 1258 | udelay(400); /* FIXME: a guess */ |
1259 | } | 1259 | } |
1260 | scr_write(ap, SCR_CONTROL, 0x300); /* issue phy wake/clear reset */ | 1260 | scr_write_flush(ap, SCR_CONTROL, 0x300); /* phy wake/clear reset */ |
1261 | 1261 | ||
1262 | /* wait for phy to become ready, if necessary */ | 1262 | /* wait for phy to become ready, if necessary */ |
1263 | do { | 1263 | do { |
@@ -2539,7 +2539,7 @@ static void atapi_request_sense(struct ata_port *ap, struct ata_device *dev, | |||
2539 | ata_sg_init_one(qc, cmd->sense_buffer, sizeof(cmd->sense_buffer)); | 2539 | ata_sg_init_one(qc, cmd->sense_buffer, sizeof(cmd->sense_buffer)); |
2540 | qc->dma_dir = DMA_FROM_DEVICE; | 2540 | qc->dma_dir = DMA_FROM_DEVICE; |
2541 | 2541 | ||
2542 | memset(&qc->cdb, 0, sizeof(ap->cdb_len)); | 2542 | memset(&qc->cdb, 0, ap->cdb_len); |
2543 | qc->cdb[0] = REQUEST_SENSE; | 2543 | qc->cdb[0] = REQUEST_SENSE; |
2544 | qc->cdb[4] = SCSI_SENSE_BUFFERSIZE; | 2544 | qc->cdb[4] = SCSI_SENSE_BUFFERSIZE; |
2545 | 2545 | ||
@@ -2811,6 +2811,7 @@ void ata_qc_complete(struct ata_queued_cmd *qc, u8 drv_stat) | |||
2811 | 2811 | ||
2812 | /* call completion callback */ | 2812 | /* call completion callback */ |
2813 | rc = qc->complete_fn(qc, drv_stat); | 2813 | rc = qc->complete_fn(qc, drv_stat); |
2814 | qc->flags &= ~ATA_QCFLAG_ACTIVE; | ||
2814 | 2815 | ||
2815 | /* if callback indicates not to complete command (non-zero), | 2816 | /* if callback indicates not to complete command (non-zero), |
2816 | * return immediately | 2817 | * return immediately |
@@ -3229,7 +3230,8 @@ irqreturn_t ata_interrupt (int irq, void *dev_instance, struct pt_regs *regs) | |||
3229 | struct ata_queued_cmd *qc; | 3230 | struct ata_queued_cmd *qc; |
3230 | 3231 | ||
3231 | qc = ata_qc_from_tag(ap, ap->active_tag); | 3232 | qc = ata_qc_from_tag(ap, ap->active_tag); |
3232 | if (qc && (!(qc->tf.ctl & ATA_NIEN))) | 3233 | if (qc && (!(qc->tf.ctl & ATA_NIEN)) && |
3234 | (qc->flags & ATA_QCFLAG_ACTIVE)) | ||
3233 | handled |= ata_host_intr(ap, qc); | 3235 | handled |= ata_host_intr(ap, qc); |
3234 | } | 3236 | } |
3235 | } | 3237 | } |
diff --git a/drivers/scsi/libata-scsi.c b/drivers/scsi/libata-scsi.c index 4c96df060c3b..416ba67ba9ee 100644 --- a/drivers/scsi/libata-scsi.c +++ b/drivers/scsi/libata-scsi.c | |||
@@ -347,7 +347,10 @@ int ata_scsi_slave_config(struct scsi_device *sdev) | |||
347 | */ | 347 | */ |
348 | if ((dev->flags & ATA_DFLAG_LBA48) && | 348 | if ((dev->flags & ATA_DFLAG_LBA48) && |
349 | ((dev->flags & ATA_DFLAG_LOCK_SECTORS) == 0)) { | 349 | ((dev->flags & ATA_DFLAG_LOCK_SECTORS) == 0)) { |
350 | sdev->host->max_sectors = 2048; | 350 | /* |
351 | * do not overwrite sdev->host->max_sectors, since | ||
352 | * other drives on this host may not support LBA48 | ||
353 | */ | ||
351 | blk_queue_max_sectors(sdev->request_queue, 2048); | 354 | blk_queue_max_sectors(sdev->request_queue, 2048); |
352 | } | 355 | } |
353 | } | 356 | } |
diff --git a/drivers/scsi/sata_svw.c b/drivers/scsi/sata_svw.c index 8d1a5d25c053..05075bd3a893 100644 --- a/drivers/scsi/sata_svw.c +++ b/drivers/scsi/sata_svw.c | |||
@@ -395,7 +395,7 @@ static int k2_sata_init_one (struct pci_dev *pdev, const struct pci_device_id *e | |||
395 | 395 | ||
396 | /* Clear a magic bit in SCR1 according to Darwin, those help | 396 | /* Clear a magic bit in SCR1 according to Darwin, those help |
397 | * some funky seagate drives (though so far, those were already | 397 | * some funky seagate drives (though so far, those were already |
398 | * set by the firmware on the machines I had access to | 398 | * set by the firmware on the machines I had access to) |
399 | */ | 399 | */ |
400 | writel(readl(mmio_base + K2_SATA_SICR1_OFFSET) & ~0x00040000, | 400 | writel(readl(mmio_base + K2_SATA_SICR1_OFFSET) & ~0x00040000, |
401 | mmio_base + K2_SATA_SICR1_OFFSET); | 401 | mmio_base + K2_SATA_SICR1_OFFSET); |
diff --git a/drivers/serial/serial_cs.c b/drivers/serial/serial_cs.c index 6eeb48f6a482..0d7b65f93e8d 100644 --- a/drivers/serial/serial_cs.c +++ b/drivers/serial/serial_cs.c | |||
@@ -661,10 +661,10 @@ void serial_config(dev_link_t * link) | |||
661 | /* Is this a multiport card? */ | 661 | /* Is this a multiport card? */ |
662 | tuple->DesiredTuple = CISTPL_MANFID; | 662 | tuple->DesiredTuple = CISTPL_MANFID; |
663 | if (first_tuple(handle, tuple, parse) == CS_SUCCESS) { | 663 | if (first_tuple(handle, tuple, parse) == CS_SUCCESS) { |
664 | info->manfid = le16_to_cpu(buf[0]); | 664 | info->manfid = parse->manfid.manf; |
665 | for (i = 0; i < MULTI_COUNT; i++) | 665 | for (i = 0; i < MULTI_COUNT; i++) |
666 | if ((info->manfid == multi_id[i].manfid) && | 666 | if ((info->manfid == multi_id[i].manfid) && |
667 | (le16_to_cpu(buf[1]) == multi_id[i].prodid)) | 667 | (parse->manfid.card == multi_id[i].prodid)) |
668 | break; | 668 | break; |
669 | if (i < MULTI_COUNT) | 669 | if (i < MULTI_COUNT) |
670 | info->multi = multi_id[i].multi; | 670 | info->multi = multi_id[i].multi; |
diff --git a/drivers/usb/core/sysfs.c b/drivers/usb/core/sysfs.c index ec9b3bde8ae5..4ab50009291d 100644 --- a/drivers/usb/core/sysfs.c +++ b/drivers/usb/core/sysfs.c | |||
@@ -286,6 +286,39 @@ static ssize_t show_interface_string(struct device *dev, char *buf) | |||
286 | } | 286 | } |
287 | static DEVICE_ATTR(interface, S_IRUGO, show_interface_string, NULL); | 287 | static DEVICE_ATTR(interface, S_IRUGO, show_interface_string, NULL); |
288 | 288 | ||
289 | static ssize_t show_modalias(struct device *dev, char *buf) | ||
290 | { | ||
291 | struct usb_interface *intf; | ||
292 | struct usb_device *udev; | ||
293 | |||
294 | intf = to_usb_interface(dev); | ||
295 | udev = interface_to_usbdev(intf); | ||
296 | if (udev->descriptor.bDeviceClass == 0) { | ||
297 | struct usb_host_interface *alt = intf->cur_altsetting; | ||
298 | |||
299 | return sprintf(buf, "usb:v%04Xp%04Xd%04Xdc%02Xdsc%02Xdp%02Xic%02Xisc%02Xip%02X\n", | ||
300 | le16_to_cpu(udev->descriptor.idVendor), | ||
301 | le16_to_cpu(udev->descriptor.idProduct), | ||
302 | le16_to_cpu(udev->descriptor.bcdDevice), | ||
303 | udev->descriptor.bDeviceClass, | ||
304 | udev->descriptor.bDeviceSubClass, | ||
305 | udev->descriptor.bDeviceProtocol, | ||
306 | alt->desc.bInterfaceClass, | ||
307 | alt->desc.bInterfaceSubClass, | ||
308 | alt->desc.bInterfaceProtocol); | ||
309 | } else { | ||
310 | return sprintf(buf, "usb:v%04Xp%04Xd%04Xdc%02Xdsc%02Xdp%02Xic*isc*ip*\n", | ||
311 | le16_to_cpu(udev->descriptor.idVendor), | ||
312 | le16_to_cpu(udev->descriptor.idProduct), | ||
313 | le16_to_cpu(udev->descriptor.bcdDevice), | ||
314 | udev->descriptor.bDeviceClass, | ||
315 | udev->descriptor.bDeviceSubClass, | ||
316 | udev->descriptor.bDeviceProtocol); | ||
317 | } | ||
318 | |||
319 | } | ||
320 | static DEVICE_ATTR(modalias, S_IRUGO, show_modalias, NULL); | ||
321 | |||
289 | static struct attribute *intf_attrs[] = { | 322 | static struct attribute *intf_attrs[] = { |
290 | &dev_attr_bInterfaceNumber.attr, | 323 | &dev_attr_bInterfaceNumber.attr, |
291 | &dev_attr_bAlternateSetting.attr, | 324 | &dev_attr_bAlternateSetting.attr, |
@@ -293,6 +326,7 @@ static struct attribute *intf_attrs[] = { | |||
293 | &dev_attr_bInterfaceClass.attr, | 326 | &dev_attr_bInterfaceClass.attr, |
294 | &dev_attr_bInterfaceSubClass.attr, | 327 | &dev_attr_bInterfaceSubClass.attr, |
295 | &dev_attr_bInterfaceProtocol.attr, | 328 | &dev_attr_bInterfaceProtocol.attr, |
329 | &dev_attr_modalias.attr, | ||
296 | NULL, | 330 | NULL, |
297 | }; | 331 | }; |
298 | static struct attribute_group intf_attr_grp = { | 332 | static struct attribute_group intf_attr_grp = { |
diff --git a/drivers/usb/host/ehci-hub.c b/drivers/usb/host/ehci-hub.c index 02fefab3501e..429330bc38de 100644 --- a/drivers/usb/host/ehci-hub.c +++ b/drivers/usb/host/ehci-hub.c | |||
@@ -72,6 +72,7 @@ static int ehci_hub_suspend (struct usb_hcd *hcd) | |||
72 | } | 72 | } |
73 | 73 | ||
74 | /* turn off now-idle HC */ | 74 | /* turn off now-idle HC */ |
75 | del_timer_sync (&ehci->watchdog); | ||
75 | ehci_halt (ehci); | 76 | ehci_halt (ehci); |
76 | hcd->state = HC_STATE_SUSPENDED; | 77 | hcd->state = HC_STATE_SUSPENDED; |
77 | 78 | ||
diff --git a/drivers/usb/net/Kconfig b/drivers/usb/net/Kconfig index db64c908d4a7..b104430e2c6a 100644 --- a/drivers/usb/net/Kconfig +++ b/drivers/usb/net/Kconfig | |||
@@ -219,17 +219,21 @@ config USB_EPSON2888 | |||
219 | by some sample firmware from Epson. | 219 | by some sample firmware from Epson. |
220 | 220 | ||
221 | config USB_ZAURUS | 221 | config USB_ZAURUS |
222 | boolean "Sharp Zaurus (stock ROMs)" | 222 | boolean "Sharp Zaurus (stock ROMs) and compatible" |
223 | depends on USB_USBNET | 223 | depends on USB_USBNET |
224 | select CRC32 | 224 | select CRC32 |
225 | default y | 225 | default y |
226 | help | 226 | help |
227 | Choose this option to support the usb networking links used by | 227 | Choose this option to support the usb networking links used by |
228 | Zaurus models like the SL-5000D, SL-5500, SL-5600, A-300, B-500. | 228 | Zaurus models like the SL-5000D, SL-5500, SL-5600, A-300, B-500. |
229 | 229 | This also supports some related device firmware, as used in some | |
230 | If you install an alternate ROM image, you may no longer need | 230 | PDAs from Olympus and some cell phones from Motorola. |
231 | to support this protocol. Only the "eth-fd" driver really needs | 231 | |
232 | this non-conformant variant of CDC Ethernet protocol. | 232 | If you install an alternate ROM image, such as the Linux 2.6 based |
233 | versions of OpenZaurus, you should no longer need to support this | ||
234 | protocol. Only the "eth-fd" or "net_fd" drivers in these devices | ||
235 | really need this non-conformant variant of CDC Ethernet (or in | ||
236 | some cases CDC MDLM) protocol, not "g_ether". | ||
233 | 237 | ||
234 | config USB_CDCETHER | 238 | config USB_CDCETHER |
235 | boolean "CDC Ethernet support (smart devices such as cable modems)" | 239 | boolean "CDC Ethernet support (smart devices such as cable modems)" |
diff --git a/drivers/usb/net/usbnet.c b/drivers/usb/net/usbnet.c index f6bc6b3b333c..85476e76b244 100644 --- a/drivers/usb/net/usbnet.c +++ b/drivers/usb/net/usbnet.c | |||
@@ -1517,6 +1517,26 @@ static void cdc_unbind (struct usbnet *dev, struct usb_interface *intf) | |||
1517 | } | 1517 | } |
1518 | } | 1518 | } |
1519 | 1519 | ||
1520 | #endif /* NEED_GENERIC_CDC */ | ||
1521 | |||
1522 | |||
1523 | #ifdef CONFIG_USB_CDCETHER | ||
1524 | #define HAVE_HARDWARE | ||
1525 | |||
1526 | /*------------------------------------------------------------------------- | ||
1527 | * | ||
1528 | * Communications Device Class, Ethernet Control model | ||
1529 | * | ||
1530 | * Takes two interfaces. The DATA interface is inactive till an altsetting | ||
1531 | * is selected. Configuration data includes class descriptors. | ||
1532 | * | ||
1533 | * This should interop with whatever the 2.4 "CDCEther.c" driver | ||
1534 | * (by Brad Hards) talked with. | ||
1535 | * | ||
1536 | *-------------------------------------------------------------------------*/ | ||
1537 | |||
1538 | #include <linux/ctype.h> | ||
1539 | |||
1520 | 1540 | ||
1521 | static void dumpspeed (struct usbnet *dev, __le32 *speeds) | 1541 | static void dumpspeed (struct usbnet *dev, __le32 *speeds) |
1522 | { | 1542 | { |
@@ -1567,26 +1587,6 @@ static void cdc_status (struct usbnet *dev, struct urb *urb) | |||
1567 | } | 1587 | } |
1568 | } | 1588 | } |
1569 | 1589 | ||
1570 | #endif /* NEED_GENERIC_CDC */ | ||
1571 | |||
1572 | |||
1573 | #ifdef CONFIG_USB_CDCETHER | ||
1574 | #define HAVE_HARDWARE | ||
1575 | |||
1576 | /*------------------------------------------------------------------------- | ||
1577 | * | ||
1578 | * Communications Device Class, Ethernet Control model | ||
1579 | * | ||
1580 | * Takes two interfaces. The DATA interface is inactive till an altsetting | ||
1581 | * is selected. Configuration data includes class descriptors. | ||
1582 | * | ||
1583 | * This should interop with whatever the 2.4 "CDCEther.c" driver | ||
1584 | * (by Brad Hards) talked with. | ||
1585 | * | ||
1586 | *-------------------------------------------------------------------------*/ | ||
1587 | |||
1588 | #include <linux/ctype.h> | ||
1589 | |||
1590 | static u8 nibble (unsigned char c) | 1590 | static u8 nibble (unsigned char c) |
1591 | { | 1591 | { |
1592 | if (likely (isdigit (c))) | 1592 | if (likely (isdigit (c))) |
@@ -2765,7 +2765,7 @@ static int blan_mdlm_bind (struct usbnet *dev, struct usb_interface *intf) | |||
2765 | } | 2765 | } |
2766 | /* expect bcdVersion 1.0, ignore */ | 2766 | /* expect bcdVersion 1.0, ignore */ |
2767 | if (memcmp(&desc->bGUID, blan_guid, 16) | 2767 | if (memcmp(&desc->bGUID, blan_guid, 16) |
2768 | || memcmp(&desc->bGUID, blan_guid, 16) ) { | 2768 | && memcmp(&desc->bGUID, blan_guid, 16) ) { |
2769 | /* hey, this one might _really_ be MDLM! */ | 2769 | /* hey, this one might _really_ be MDLM! */ |
2770 | dev_dbg (&intf->dev, "MDLM guid\n"); | 2770 | dev_dbg (&intf->dev, "MDLM guid\n"); |
2771 | goto bad_desc; | 2771 | goto bad_desc; |
@@ -2797,11 +2797,13 @@ static int blan_mdlm_bind (struct usbnet *dev, struct usb_interface *intf) | |||
2797 | * - bPad (ignored, for PADAFTER -- BLAN-only) | 2797 | * - bPad (ignored, for PADAFTER -- BLAN-only) |
2798 | * bits are: | 2798 | * bits are: |
2799 | * - 0x01 -- Zaurus framing (add CRC) | 2799 | * - 0x01 -- Zaurus framing (add CRC) |
2800 | * - 0x02 -- PADBEFORE | 2800 | * - 0x02 -- PADBEFORE (CRC includes some padding) |
2801 | * - 0x04 -- PADAFTER | 2801 | * - 0x04 -- PADAFTER (some padding after CRC) |
2802 | * - 0x08 -- "fermat" packet mangling (for hw bugs) | 2802 | * - 0x08 -- "fermat" packet mangling (for hw bugs) |
2803 | * the PADBEFORE appears not to matter; we interop | ||
2804 | * with devices that use it and those that don't. | ||
2803 | */ | 2805 | */ |
2804 | if (detail->bDetailData[1] != 0x01) { | 2806 | if ((detail->bDetailData[1] & ~02) != 0x01) { |
2805 | /* bmDataCapabilites == 0 would be fine too, | 2807 | /* bmDataCapabilites == 0 would be fine too, |
2806 | * but framing is minidriver-coupled for now. | 2808 | * but framing is minidriver-coupled for now. |
2807 | */ | 2809 | */ |
@@ -4071,9 +4073,6 @@ static const struct usb_device_id products [] = { | |||
4071 | USB_DEVICE (0x8086, 0x07d3), // "blob" bootloader | 4073 | USB_DEVICE (0x8086, 0x07d3), // "blob" bootloader |
4072 | .driver_info = (unsigned long) &blob_info, | 4074 | .driver_info = (unsigned long) &blob_info, |
4073 | }, { | 4075 | }, { |
4074 | USB_DEVICE (0x22b8, 0x600c), // USBNET Motorola E680 | ||
4075 | .driver_info = (unsigned long) &linuxdev_info, | ||
4076 | }, { | ||
4077 | // Linux Ethernet/RNDIS gadget on pxa210/25x/26x | 4076 | // Linux Ethernet/RNDIS gadget on pxa210/25x/26x |
4078 | // e.g. Gumstix, current OpenZaurus, ... | 4077 | // e.g. Gumstix, current OpenZaurus, ... |
4079 | USB_DEVICE_VER (0x0525, 0xa4a2, 0x0203, 0x0203), | 4078 | USB_DEVICE_VER (0x0525, 0xa4a2, 0x0203, 0x0203), |
diff --git a/drivers/usb/serial/cypress_m8.c b/drivers/usb/serial/cypress_m8.c index f34a9bb6a219..012e63e05806 100644 --- a/drivers/usb/serial/cypress_m8.c +++ b/drivers/usb/serial/cypress_m8.c | |||
@@ -89,6 +89,7 @@ static int interval; | |||
89 | 89 | ||
90 | static struct usb_device_id id_table_earthmate [] = { | 90 | static struct usb_device_id id_table_earthmate [] = { |
91 | { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB) }, | 91 | { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB) }, |
92 | { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB_LT20) }, | ||
92 | { } /* Terminating entry */ | 93 | { } /* Terminating entry */ |
93 | }; | 94 | }; |
94 | 95 | ||
@@ -99,6 +100,7 @@ static struct usb_device_id id_table_cyphidcomrs232 [] = { | |||
99 | 100 | ||
100 | static struct usb_device_id id_table_combined [] = { | 101 | static struct usb_device_id id_table_combined [] = { |
101 | { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB) }, | 102 | { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB) }, |
103 | { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB_LT20) }, | ||
102 | { USB_DEVICE(VENDOR_ID_CYPRESS, PRODUCT_ID_CYPHIDCOM) }, | 104 | { USB_DEVICE(VENDOR_ID_CYPRESS, PRODUCT_ID_CYPHIDCOM) }, |
103 | { } /* Terminating entry */ | 105 | { } /* Terminating entry */ |
104 | }; | 106 | }; |
diff --git a/drivers/usb/serial/cypress_m8.h b/drivers/usb/serial/cypress_m8.h index 1012ee6b19ce..1fa119efe41a 100644 --- a/drivers/usb/serial/cypress_m8.h +++ b/drivers/usb/serial/cypress_m8.h | |||
@@ -13,6 +13,7 @@ | |||
13 | /* DeLorme Earthmate USB - a GPS device */ | 13 | /* DeLorme Earthmate USB - a GPS device */ |
14 | #define VENDOR_ID_DELORME 0x1163 | 14 | #define VENDOR_ID_DELORME 0x1163 |
15 | #define PRODUCT_ID_EARTHMATEUSB 0x0100 | 15 | #define PRODUCT_ID_EARTHMATEUSB 0x0100 |
16 | #define PRODUCT_ID_EARTHMATEUSB_LT20 0x0200 | ||
16 | 17 | ||
17 | /* Cypress HID->COM RS232 Adapter */ | 18 | /* Cypress HID->COM RS232 Adapter */ |
18 | #define VENDOR_ID_CYPRESS 0x04b4 | 19 | #define VENDOR_ID_CYPRESS 0x04b4 |
diff --git a/fs/buffer.c b/fs/buffer.c index 6f88dcc6d002..7e9e409feaa7 100644 --- a/fs/buffer.c +++ b/fs/buffer.c | |||
@@ -2094,9 +2094,12 @@ int block_read_full_page(struct page *page, get_block_t *get_block) | |||
2094 | continue; | 2094 | continue; |
2095 | 2095 | ||
2096 | if (!buffer_mapped(bh)) { | 2096 | if (!buffer_mapped(bh)) { |
2097 | int err = 0; | ||
2098 | |||
2097 | fully_mapped = 0; | 2099 | fully_mapped = 0; |
2098 | if (iblock < lblock) { | 2100 | if (iblock < lblock) { |
2099 | if (get_block(inode, iblock, bh, 0)) | 2101 | err = get_block(inode, iblock, bh, 0); |
2102 | if (err) | ||
2100 | SetPageError(page); | 2103 | SetPageError(page); |
2101 | } | 2104 | } |
2102 | if (!buffer_mapped(bh)) { | 2105 | if (!buffer_mapped(bh)) { |
@@ -2104,7 +2107,8 @@ int block_read_full_page(struct page *page, get_block_t *get_block) | |||
2104 | memset(kaddr + i * blocksize, 0, blocksize); | 2107 | memset(kaddr + i * blocksize, 0, blocksize); |
2105 | flush_dcache_page(page); | 2108 | flush_dcache_page(page); |
2106 | kunmap_atomic(kaddr, KM_USER0); | 2109 | kunmap_atomic(kaddr, KM_USER0); |
2107 | set_buffer_uptodate(bh); | 2110 | if (!err) |
2111 | set_buffer_uptodate(bh); | ||
2108 | continue; | 2112 | continue; |
2109 | } | 2113 | } |
2110 | /* | 2114 | /* |
diff --git a/fs/ext3/super.c b/fs/ext3/super.c index 545b440a2d2f..981ccb233ef5 100644 --- a/fs/ext3/super.c +++ b/fs/ext3/super.c | |||
@@ -225,8 +225,16 @@ void __ext3_std_error (struct super_block * sb, const char * function, | |||
225 | int errno) | 225 | int errno) |
226 | { | 226 | { |
227 | char nbuf[16]; | 227 | char nbuf[16]; |
228 | const char *errstr = ext3_decode_error(sb, errno, nbuf); | 228 | const char *errstr; |
229 | |||
230 | /* Special case: if the error is EROFS, and we're not already | ||
231 | * inside a transaction, then there's really no point in logging | ||
232 | * an error. */ | ||
233 | if (errno == -EROFS && journal_current_handle() == NULL && | ||
234 | (sb->s_flags & MS_RDONLY)) | ||
235 | return; | ||
229 | 236 | ||
237 | errstr = ext3_decode_error(sb, errno, nbuf); | ||
230 | printk (KERN_CRIT "EXT3-fs error (device %s) in %s: %s\n", | 238 | printk (KERN_CRIT "EXT3-fs error (device %s) in %s: %s\n", |
231 | sb->s_id, function, errstr); | 239 | sb->s_id, function, errstr); |
232 | 240 | ||
diff --git a/fs/proc/mmu.c b/fs/proc/mmu.c index a7041038ad56..25d2d9c6e329 100644 --- a/fs/proc/mmu.c +++ b/fs/proc/mmu.c | |||
@@ -50,13 +50,23 @@ void get_vmalloc_info(struct vmalloc_info *vmi) | |||
50 | read_lock(&vmlist_lock); | 50 | read_lock(&vmlist_lock); |
51 | 51 | ||
52 | for (vma = vmlist; vma; vma = vma->next) { | 52 | for (vma = vmlist; vma; vma = vma->next) { |
53 | unsigned long addr = (unsigned long) vma->addr; | ||
54 | |||
55 | /* | ||
56 | * Some archs keep another range for modules in vmlist | ||
57 | */ | ||
58 | if (addr < VMALLOC_START) | ||
59 | continue; | ||
60 | if (addr >= VMALLOC_END) | ||
61 | break; | ||
62 | |||
53 | vmi->used += vma->size; | 63 | vmi->used += vma->size; |
54 | 64 | ||
55 | free_area_size = (unsigned long) vma->addr - prev_end; | 65 | free_area_size = addr - prev_end; |
56 | if (vmi->largest_chunk < free_area_size) | 66 | if (vmi->largest_chunk < free_area_size) |
57 | vmi->largest_chunk = free_area_size; | 67 | vmi->largest_chunk = free_area_size; |
58 | 68 | ||
59 | prev_end = vma->size + (unsigned long) vma->addr; | 69 | prev_end = vma->size + addr; |
60 | } | 70 | } |
61 | 71 | ||
62 | if (VMALLOC_END - prev_end > vmi->largest_chunk) | 72 | if (VMALLOC_END - prev_end > vmi->largest_chunk) |
diff --git a/include/asm-ia64/ioctl32.h b/include/asm-ia64/ioctl32.h index d0d227f45e05..e69de29bb2d1 100644 --- a/include/asm-ia64/ioctl32.h +++ b/include/asm-ia64/ioctl32.h | |||
@@ -1 +0,0 @@ | |||
1 | #include <linux/ioctl32.h> | ||
diff --git a/include/asm-um/elf.h b/include/asm-um/elf.h deleted file mode 100644 index e69de29bb2d1..000000000000 --- a/include/asm-um/elf.h +++ /dev/null | |||
diff --git a/include/asm-x86_64/apicdef.h b/include/asm-x86_64/apicdef.h index 3d7627ffe67d..bfebdb690654 100644 --- a/include/asm-x86_64/apicdef.h +++ b/include/asm-x86_64/apicdef.h | |||
@@ -112,7 +112,7 @@ | |||
112 | 112 | ||
113 | #define APIC_BASE (fix_to_virt(FIX_APIC_BASE)) | 113 | #define APIC_BASE (fix_to_virt(FIX_APIC_BASE)) |
114 | 114 | ||
115 | #define MAX_IO_APICS 32 | 115 | #define MAX_IO_APICS 128 |
116 | 116 | ||
117 | /* | 117 | /* |
118 | * All x86-64 systems are xAPIC compatible. | 118 | * All x86-64 systems are xAPIC compatible. |
diff --git a/include/asm-x86_64/io_apic.h b/include/asm-x86_64/io_apic.h index 7efc932e8f0b..32573749004c 100644 --- a/include/asm-x86_64/io_apic.h +++ b/include/asm-x86_64/io_apic.h | |||
@@ -202,7 +202,6 @@ extern int skip_ioapic_setup; | |||
202 | #define io_apic_assign_pci_irqs (mp_irq_entries && !skip_ioapic_setup && io_apic_irqs) | 202 | #define io_apic_assign_pci_irqs (mp_irq_entries && !skip_ioapic_setup && io_apic_irqs) |
203 | 203 | ||
204 | #ifdef CONFIG_ACPI_BOOT | 204 | #ifdef CONFIG_ACPI_BOOT |
205 | extern int io_apic_get_unique_id (int ioapic, int apic_id); | ||
206 | extern int io_apic_get_version (int ioapic); | 205 | extern int io_apic_get_version (int ioapic); |
207 | extern int io_apic_get_redir_entries (int ioapic); | 206 | extern int io_apic_get_redir_entries (int ioapic); |
208 | extern int io_apic_set_pci_routing (int ioapic, int pin, int irq, int, int); | 207 | extern int io_apic_set_pci_routing (int ioapic, int pin, int irq, int, int); |
diff --git a/include/asm-x86_64/ioctl32.h b/include/asm-x86_64/ioctl32.h index d0d227f45e05..e69de29bb2d1 100644 --- a/include/asm-x86_64/ioctl32.h +++ b/include/asm-x86_64/ioctl32.h | |||
@@ -1 +0,0 @@ | |||
1 | #include <linux/ioctl32.h> | ||
diff --git a/include/asm-x86_64/nmi.h b/include/asm-x86_64/nmi.h index 21d56b086b9d..d3abfc6a8fd5 100644 --- a/include/asm-x86_64/nmi.h +++ b/include/asm-x86_64/nmi.h | |||
@@ -53,5 +53,7 @@ extern void die_nmi(char *str, struct pt_regs *regs); | |||
53 | 53 | ||
54 | extern int panic_on_timeout; | 54 | extern int panic_on_timeout; |
55 | extern int unknown_nmi_panic; | 55 | extern int unknown_nmi_panic; |
56 | |||
57 | extern int check_nmi_watchdog(void); | ||
56 | 58 | ||
57 | #endif /* ASM_NMI_H */ | 59 | #endif /* ASM_NMI_H */ |
diff --git a/include/asm-x86_64/processor.h b/include/asm-x86_64/processor.h index f0581c35628e..d641b19f6da5 100644 --- a/include/asm-x86_64/processor.h +++ b/include/asm-x86_64/processor.h | |||
@@ -62,7 +62,6 @@ struct cpuinfo_x86 { | |||
62 | int x86_tlbsize; /* number of 4K pages in DTLB/ITLB combined(in pages)*/ | 62 | int x86_tlbsize; /* number of 4K pages in DTLB/ITLB combined(in pages)*/ |
63 | __u8 x86_virt_bits, x86_phys_bits; | 63 | __u8 x86_virt_bits, x86_phys_bits; |
64 | __u8 x86_num_cores; | 64 | __u8 x86_num_cores; |
65 | __u8 x86_apicid; | ||
66 | __u32 x86_power; | 65 | __u32 x86_power; |
67 | __u32 extended_cpuid_level; /* Max extended CPUID function supported */ | 66 | __u32 extended_cpuid_level; /* Max extended CPUID function supported */ |
68 | unsigned long loops_per_jiffy; | 67 | unsigned long loops_per_jiffy; |
@@ -159,9 +158,9 @@ static inline void clear_in_cr4 (unsigned long mask) | |||
159 | 158 | ||
160 | 159 | ||
161 | /* | 160 | /* |
162 | * User space process size. 47bits. | 161 | * User space process size. 47bits minus one guard page. |
163 | */ | 162 | */ |
164 | #define TASK_SIZE (0x800000000000UL) | 163 | #define TASK_SIZE (0x800000000000UL - 4096) |
165 | 164 | ||
166 | /* This decides where the kernel will search for a free chunk of vm | 165 | /* This decides where the kernel will search for a free chunk of vm |
167 | * space during mmap's. | 166 | * space during mmap's. |
diff --git a/include/asm-x86_64/proto.h b/include/asm-x86_64/proto.h index d0f8f8b4c394..f2f073642d62 100644 --- a/include/asm-x86_64/proto.h +++ b/include/asm-x86_64/proto.h | |||
@@ -30,6 +30,11 @@ extern void ia32_syscall(void); | |||
30 | extern void iommu_hole_init(void); | 30 | extern void iommu_hole_init(void); |
31 | 31 | ||
32 | extern void time_init_gtod(void); | 32 | extern void time_init_gtod(void); |
33 | extern int pmtimer_mark_offset(void); | ||
34 | extern unsigned int do_gettimeoffset_pm(void); | ||
35 | extern u32 pmtmr_ioport; | ||
36 | extern unsigned long long monotonic_base; | ||
37 | extern int sysctl_vsyscall; | ||
33 | 38 | ||
34 | extern void do_softirq_thunk(void); | 39 | extern void do_softirq_thunk(void); |
35 | 40 | ||
diff --git a/include/asm-x86_64/vsyscall.h b/include/asm-x86_64/vsyscall.h index b0c8d4339906..2872da23fc7e 100644 --- a/include/asm-x86_64/vsyscall.h +++ b/include/asm-x86_64/vsyscall.h | |||
@@ -25,6 +25,7 @@ enum vsyscall_num { | |||
25 | 25 | ||
26 | #define VXTIME_TSC 1 | 26 | #define VXTIME_TSC 1 |
27 | #define VXTIME_HPET 2 | 27 | #define VXTIME_HPET 2 |
28 | #define VXTIME_PMTMR 3 | ||
28 | 29 | ||
29 | struct vxtime_data { | 30 | struct vxtime_data { |
30 | long hpet_address; /* HPET base address */ | 31 | long hpet_address; /* HPET base address */ |
@@ -54,6 +55,8 @@ extern struct timezone sys_tz; | |||
54 | extern int sysctl_vsyscall; | 55 | extern int sysctl_vsyscall; |
55 | extern seqlock_t xtime_lock; | 56 | extern seqlock_t xtime_lock; |
56 | 57 | ||
58 | extern int sysctl_vsyscall; | ||
59 | |||
57 | #define ARCH_HAVE_XTIME_LOCK 1 | 60 | #define ARCH_HAVE_XTIME_LOCK 1 |
58 | 61 | ||
59 | #endif /* __KERNEL__ */ | 62 | #endif /* __KERNEL__ */ |
diff --git a/include/linux/device.h b/include/linux/device.h index cf470459fa69..df94c0de53f2 100644 --- a/include/linux/device.h +++ b/include/linux/device.h | |||
@@ -273,9 +273,6 @@ struct device { | |||
273 | BIOS data relevant to device) */ | 273 | BIOS data relevant to device) */ |
274 | struct dev_pm_info power; | 274 | struct dev_pm_info power; |
275 | 275 | ||
276 | u32 detach_state; /* State to enter when device is | ||
277 | detached from its driver. */ | ||
278 | |||
279 | u64 *dma_mask; /* dma mask (if dma'able device) */ | 276 | u64 *dma_mask; /* dma mask (if dma'able device) */ |
280 | u64 coherent_dma_mask;/* Like dma_mask, but for | 277 | u64 coherent_dma_mask;/* Like dma_mask, but for |
281 | alloc_coherent mappings as | 278 | alloc_coherent mappings as |
diff --git a/include/linux/libata.h b/include/linux/libata.h index 505160ab472b..1f7e2039a04e 100644 --- a/include/linux/libata.h +++ b/include/linux/libata.h | |||
@@ -584,6 +584,13 @@ static inline void scr_write(struct ata_port *ap, unsigned int reg, u32 val) | |||
584 | ap->ops->scr_write(ap, reg, val); | 584 | ap->ops->scr_write(ap, reg, val); |
585 | } | 585 | } |
586 | 586 | ||
587 | static inline void scr_write_flush(struct ata_port *ap, unsigned int reg, | ||
588 | u32 val) | ||
589 | { | ||
590 | ap->ops->scr_write(ap, reg, val); | ||
591 | (void) ap->ops->scr_read(ap, reg); | ||
592 | } | ||
593 | |||
587 | static inline unsigned int sata_dev_present(struct ata_port *ap) | 594 | static inline unsigned int sata_dev_present(struct ata_port *ap) |
588 | { | 595 | { |
589 | return ((scr_read(ap, SCR_STATUS) & 0xf) == 0x3) ? 1 : 0; | 596 | return ((scr_read(ap, SCR_STATUS) & 0xf) == 0x3) ? 1 : 0; |
diff --git a/include/media/video-buf-dvb.h b/include/media/video-buf-dvb.h index 94bd33619aa5..ad0a07a3a895 100644 --- a/include/media/video-buf-dvb.h +++ b/include/media/video-buf-dvb.h | |||
@@ -16,7 +16,7 @@ struct videobuf_dvb { | |||
16 | int nfeeds; | 16 | int nfeeds; |
17 | 17 | ||
18 | /* videobuf_dvb_(un)register manges this */ | 18 | /* videobuf_dvb_(un)register manges this */ |
19 | struct dvb_adapter *adapter; | 19 | struct dvb_adapter adapter; |
20 | struct dvb_demux demux; | 20 | struct dvb_demux demux; |
21 | struct dmxdev dmxdev; | 21 | struct dmxdev dmxdev; |
22 | struct dmx_frontend fe_hw; | 22 | struct dmx_frontend fe_hw; |
diff --git a/kernel/irq/handle.c b/kernel/irq/handle.c index 2fb0e46e11f3..06b5a6323998 100644 --- a/kernel/irq/handle.c +++ b/kernel/irq/handle.c | |||
@@ -30,6 +30,7 @@ | |||
30 | */ | 30 | */ |
31 | irq_desc_t irq_desc[NR_IRQS] __cacheline_aligned = { | 31 | irq_desc_t irq_desc[NR_IRQS] __cacheline_aligned = { |
32 | [0 ... NR_IRQS-1] = { | 32 | [0 ... NR_IRQS-1] = { |
33 | .status = IRQ_DISABLED, | ||
33 | .handler = &no_irq_type, | 34 | .handler = &no_irq_type, |
34 | .lock = SPIN_LOCK_UNLOCKED | 35 | .lock = SPIN_LOCK_UNLOCKED |
35 | } | 36 | } |
diff --git a/kernel/power/main.c b/kernel/power/main.c index 7960ddf04a57..4cdebc972ff2 100644 --- a/kernel/power/main.c +++ b/kernel/power/main.c | |||
@@ -156,14 +156,14 @@ static int enter_state(suspend_state_t state) | |||
156 | goto Unlock; | 156 | goto Unlock; |
157 | } | 157 | } |
158 | 158 | ||
159 | pr_debug("PM: Preparing system for suspend\n"); | 159 | pr_debug("PM: Preparing system for %s sleep\n", pm_states[state]); |
160 | if ((error = suspend_prepare(state))) | 160 | if ((error = suspend_prepare(state))) |
161 | goto Unlock; | 161 | goto Unlock; |
162 | 162 | ||
163 | pr_debug("PM: Entering state.\n"); | 163 | pr_debug("PM: Entering %s sleep\n", pm_states[state]); |
164 | error = suspend_enter(state); | 164 | error = suspend_enter(state); |
165 | 165 | ||
166 | pr_debug("PM: Finishing up.\n"); | 166 | pr_debug("PM: Finishing wakeup.\n"); |
167 | suspend_finish(state); | 167 | suspend_finish(state); |
168 | Unlock: | 168 | Unlock: |
169 | up(&pm_sem); | 169 | up(&pm_sem); |
diff --git a/kernel/printk.c b/kernel/printk.c index 290a07ce2c8a..01b58d7d17ff 100644 --- a/kernel/printk.c +++ b/kernel/printk.c | |||
@@ -160,42 +160,6 @@ static int __init console_setup(char *str) | |||
160 | 160 | ||
161 | __setup("console=", console_setup); | 161 | __setup("console=", console_setup); |
162 | 162 | ||
163 | /** | ||
164 | * add_preferred_console - add a device to the list of preferred consoles. | ||
165 | * | ||
166 | * The last preferred console added will be used for kernel messages | ||
167 | * and stdin/out/err for init. Normally this is used by console_setup | ||
168 | * above to handle user-supplied console arguments; however it can also | ||
169 | * be used by arch-specific code either to override the user or more | ||
170 | * commonly to provide a default console (ie from PROM variables) when | ||
171 | * the user has not supplied one. | ||
172 | */ | ||
173 | int __init add_preferred_console(char *name, int idx, char *options) | ||
174 | { | ||
175 | struct console_cmdline *c; | ||
176 | int i; | ||
177 | |||
178 | /* | ||
179 | * See if this tty is not yet registered, and | ||
180 | * if we have a slot free. | ||
181 | */ | ||
182 | for(i = 0; i < MAX_CMDLINECONSOLES && console_cmdline[i].name[0]; i++) | ||
183 | if (strcmp(console_cmdline[i].name, name) == 0 && | ||
184 | console_cmdline[i].index == idx) { | ||
185 | selected_console = i; | ||
186 | return 0; | ||
187 | } | ||
188 | if (i == MAX_CMDLINECONSOLES) | ||
189 | return -E2BIG; | ||
190 | selected_console = i; | ||
191 | c = &console_cmdline[i]; | ||
192 | memcpy(c->name, name, sizeof(c->name)); | ||
193 | c->name[sizeof(c->name) - 1] = 0; | ||
194 | c->options = options; | ||
195 | c->index = idx; | ||
196 | return 0; | ||
197 | } | ||
198 | |||
199 | static int __init log_buf_len_setup(char *str) | 163 | static int __init log_buf_len_setup(char *str) |
200 | { | 164 | { |
201 | unsigned long size = memparse(str, &str); | 165 | unsigned long size = memparse(str, &str); |
@@ -671,6 +635,42 @@ static void call_console_drivers(unsigned long start, unsigned long end) {} | |||
671 | #endif | 635 | #endif |
672 | 636 | ||
673 | /** | 637 | /** |
638 | * add_preferred_console - add a device to the list of preferred consoles. | ||
639 | * | ||
640 | * The last preferred console added will be used for kernel messages | ||
641 | * and stdin/out/err for init. Normally this is used by console_setup | ||
642 | * above to handle user-supplied console arguments; however it can also | ||
643 | * be used by arch-specific code either to override the user or more | ||
644 | * commonly to provide a default console (ie from PROM variables) when | ||
645 | * the user has not supplied one. | ||
646 | */ | ||
647 | int __init add_preferred_console(char *name, int idx, char *options) | ||
648 | { | ||
649 | struct console_cmdline *c; | ||
650 | int i; | ||
651 | |||
652 | /* | ||
653 | * See if this tty is not yet registered, and | ||
654 | * if we have a slot free. | ||
655 | */ | ||
656 | for(i = 0; i < MAX_CMDLINECONSOLES && console_cmdline[i].name[0]; i++) | ||
657 | if (strcmp(console_cmdline[i].name, name) == 0 && | ||
658 | console_cmdline[i].index == idx) { | ||
659 | selected_console = i; | ||
660 | return 0; | ||
661 | } | ||
662 | if (i == MAX_CMDLINECONSOLES) | ||
663 | return -E2BIG; | ||
664 | selected_console = i; | ||
665 | c = &console_cmdline[i]; | ||
666 | memcpy(c->name, name, sizeof(c->name)); | ||
667 | c->name[sizeof(c->name) - 1] = 0; | ||
668 | c->options = options; | ||
669 | c->index = idx; | ||
670 | return 0; | ||
671 | } | ||
672 | |||
673 | /** | ||
674 | * acquire_console_sem - lock the console system for exclusive use. | 674 | * acquire_console_sem - lock the console system for exclusive use. |
675 | * | 675 | * |
676 | * Acquires a semaphore which guarantees that the caller has | 676 | * Acquires a semaphore which guarantees that the caller has |
diff --git a/kernel/profile.c b/kernel/profile.c index 0221a50ca867..ad8cbb75ffa2 100644 --- a/kernel/profile.c +++ b/kernel/profile.c | |||
@@ -49,15 +49,19 @@ static DECLARE_MUTEX(profile_flip_mutex); | |||
49 | 49 | ||
50 | static int __init profile_setup(char * str) | 50 | static int __init profile_setup(char * str) |
51 | { | 51 | { |
52 | static char __initdata schedstr[] = "schedule"; | ||
52 | int par; | 53 | int par; |
53 | 54 | ||
54 | if (!strncmp(str, "schedule", 8)) { | 55 | if (!strncmp(str, schedstr, strlen(schedstr))) { |
55 | prof_on = SCHED_PROFILING; | 56 | prof_on = SCHED_PROFILING; |
56 | printk(KERN_INFO "kernel schedule profiling enabled\n"); | 57 | if (str[strlen(schedstr)] == ',') |
57 | if (str[7] == ',') | 58 | str += strlen(schedstr) + 1; |
58 | str += 8; | 59 | if (get_option(&str, &par)) |
59 | } | 60 | prof_shift = par; |
60 | if (get_option(&str,&par)) { | 61 | printk(KERN_INFO |
62 | "kernel schedule profiling enabled (shift: %ld)\n", | ||
63 | prof_shift); | ||
64 | } else if (get_option(&str, &par)) { | ||
61 | prof_shift = par; | 65 | prof_shift = par; |
62 | prof_on = CPU_PROFILING; | 66 | prof_on = CPU_PROFILING; |
63 | printk(KERN_INFO "kernel profiling enabled (shift: %ld)\n", | 67 | printk(KERN_INFO "kernel profiling enabled (shift: %ld)\n", |
diff --git a/mm/memory.c b/mm/memory.c index 6bad4c4064e7..d209f745db7f 100644 --- a/mm/memory.c +++ b/mm/memory.c | |||
@@ -1701,12 +1701,13 @@ static int do_swap_page(struct mm_struct * mm, | |||
1701 | spin_lock(&mm->page_table_lock); | 1701 | spin_lock(&mm->page_table_lock); |
1702 | page_table = pte_offset_map(pmd, address); | 1702 | page_table = pte_offset_map(pmd, address); |
1703 | if (unlikely(!pte_same(*page_table, orig_pte))) { | 1703 | if (unlikely(!pte_same(*page_table, orig_pte))) { |
1704 | pte_unmap(page_table); | ||
1705 | spin_unlock(&mm->page_table_lock); | ||
1706 | unlock_page(page); | ||
1707 | page_cache_release(page); | ||
1708 | ret = VM_FAULT_MINOR; | 1704 | ret = VM_FAULT_MINOR; |
1709 | goto out; | 1705 | goto out_nomap; |
1706 | } | ||
1707 | |||
1708 | if (unlikely(!PageUptodate(page))) { | ||
1709 | ret = VM_FAULT_SIGBUS; | ||
1710 | goto out_nomap; | ||
1710 | } | 1711 | } |
1711 | 1712 | ||
1712 | /* The page isn't present yet, go ahead with the fault. */ | 1713 | /* The page isn't present yet, go ahead with the fault. */ |
@@ -1741,6 +1742,12 @@ static int do_swap_page(struct mm_struct * mm, | |||
1741 | spin_unlock(&mm->page_table_lock); | 1742 | spin_unlock(&mm->page_table_lock); |
1742 | out: | 1743 | out: |
1743 | return ret; | 1744 | return ret; |
1745 | out_nomap: | ||
1746 | pte_unmap(page_table); | ||
1747 | spin_unlock(&mm->page_table_lock); | ||
1748 | unlock_page(page); | ||
1749 | page_cache_release(page); | ||
1750 | goto out; | ||
1744 | } | 1751 | } |
1745 | 1752 | ||
1746 | /* | 1753 | /* |
diff --git a/mm/mremap.c b/mm/mremap.c index 0dd7ace94e51..ec7238a78f36 100644 --- a/mm/mremap.c +++ b/mm/mremap.c | |||
@@ -224,6 +224,12 @@ static unsigned long move_vma(struct vm_area_struct *vma, | |||
224 | split = 1; | 224 | split = 1; |
225 | } | 225 | } |
226 | 226 | ||
227 | /* | ||
228 | * if we failed to move page tables we still do total_vm increment | ||
229 | * since do_munmap() will decrement it by old_len == new_len | ||
230 | */ | ||
231 | mm->total_vm += new_len >> PAGE_SHIFT; | ||
232 | |||
227 | if (do_munmap(mm, old_addr, old_len) < 0) { | 233 | if (do_munmap(mm, old_addr, old_len) < 0) { |
228 | /* OOM: unable to split vma, just get accounts right */ | 234 | /* OOM: unable to split vma, just get accounts right */ |
229 | vm_unacct_memory(excess >> PAGE_SHIFT); | 235 | vm_unacct_memory(excess >> PAGE_SHIFT); |
@@ -237,7 +243,6 @@ static unsigned long move_vma(struct vm_area_struct *vma, | |||
237 | vma->vm_next->vm_flags |= VM_ACCOUNT; | 243 | vma->vm_next->vm_flags |= VM_ACCOUNT; |
238 | } | 244 | } |
239 | 245 | ||
240 | mm->total_vm += new_len >> PAGE_SHIFT; | ||
241 | __vm_stat_account(mm, vma->vm_flags, vma->vm_file, new_len>>PAGE_SHIFT); | 246 | __vm_stat_account(mm, vma->vm_flags, vma->vm_file, new_len>>PAGE_SHIFT); |
242 | if (vm_flags & VM_LOCKED) { | 247 | if (vm_flags & VM_LOCKED) { |
243 | mm->locked_vm += new_len >> PAGE_SHIFT; | 248 | mm->locked_vm += new_len >> PAGE_SHIFT; |
diff --git a/mm/nommu.c b/mm/nommu.c index b293ec1cc4e6..c53e9c8f6b4a 100644 --- a/mm/nommu.c +++ b/mm/nommu.c | |||
@@ -150,7 +150,8 @@ void vfree(void *addr) | |||
150 | kfree(addr); | 150 | kfree(addr); |
151 | } | 151 | } |
152 | 152 | ||
153 | void *__vmalloc(unsigned long size, int gfp_mask, pgprot_t prot) | 153 | void *__vmalloc(unsigned long size, unsigned int __nocast gfp_mask, |
154 | pgprot_t prot) | ||
154 | { | 155 | { |
155 | /* | 156 | /* |
156 | * kmalloc doesn't like __GFP_HIGHMEM for some reason | 157 | * kmalloc doesn't like __GFP_HIGHMEM for some reason |
@@ -586,7 +586,7 @@ static int try_to_unmap_one(struct page *page, struct vm_area_struct *vma) | |||
586 | dec_mm_counter(mm, anon_rss); | 586 | dec_mm_counter(mm, anon_rss); |
587 | } | 587 | } |
588 | 588 | ||
589 | inc_mm_counter(mm, rss); | 589 | dec_mm_counter(mm, rss); |
590 | page_remove_rmap(page); | 590 | page_remove_rmap(page); |
591 | page_cache_release(page); | 591 | page_cache_release(page); |
592 | 592 | ||
diff --git a/mm/swapfile.c b/mm/swapfile.c index a60e0075d55b..da48405cd9a3 100644 --- a/mm/swapfile.c +++ b/mm/swapfile.c | |||
@@ -79,7 +79,7 @@ void swap_unplug_io_fn(struct backing_dev_info *unused_bdi, struct page *page) | |||
79 | WARN_ON(page_count(page) <= 1); | 79 | WARN_ON(page_count(page) <= 1); |
80 | 80 | ||
81 | bdi = bdev->bd_inode->i_mapping->backing_dev_info; | 81 | bdi = bdev->bd_inode->i_mapping->backing_dev_info; |
82 | bdi->unplug_io_fn(bdi, page); | 82 | blk_run_backing_dev(bdi, page); |
83 | } | 83 | } |
84 | up_read(&swap_unplug_sem); | 84 | up_read(&swap_unplug_sem); |
85 | } | 85 | } |
diff --git a/security/selinux/ss/services.c b/security/selinux/ss/services.c index 07fdf6ee6148..b6149147d5cb 100644 --- a/security/selinux/ss/services.c +++ b/security/selinux/ss/services.c | |||
@@ -476,8 +476,8 @@ int security_compute_av(u32 ssid, | |||
476 | int rc = 0; | 476 | int rc = 0; |
477 | 477 | ||
478 | if (!ss_initialized) { | 478 | if (!ss_initialized) { |
479 | avd->allowed = requested; | 479 | avd->allowed = 0xffffffff; |
480 | avd->decided = requested; | 480 | avd->decided = 0xffffffff; |
481 | avd->auditallow = 0; | 481 | avd->auditallow = 0; |
482 | avd->auditdeny = 0xffffffff; | 482 | avd->auditdeny = 0xffffffff; |
483 | avd->seqno = latest_granting; | 483 | avd->seqno = latest_granting; |
@@ -1196,9 +1196,11 @@ int security_load_policy(void *data, size_t len) | |||
1196 | } | 1196 | } |
1197 | policydb_loaded_version = policydb.policyvers; | 1197 | policydb_loaded_version = policydb.policyvers; |
1198 | ss_initialized = 1; | 1198 | ss_initialized = 1; |
1199 | 1199 | seqno = ++latest_granting; | |
1200 | LOAD_UNLOCK; | 1200 | LOAD_UNLOCK; |
1201 | selinux_complete_init(); | 1201 | selinux_complete_init(); |
1202 | avc_ss_reset(seqno); | ||
1203 | selnl_notify_policyload(seqno); | ||
1202 | return 0; | 1204 | return 0; |
1203 | } | 1205 | } |
1204 | 1206 | ||