dvb_net.c 39 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400
  1. /*
  2. * dvb_net.c
  3. *
  4. * Copyright (C) 2001 Convergence integrated media GmbH
  5. * Ralph Metzler <ralph@convergence.de>
  6. * Copyright (C) 2002 Ralph Metzler <rjkm@metzlerbros.de>
  7. *
  8. * ULE Decapsulation code:
  9. * Copyright (C) 2003, 2004 gcs - Global Communication & Services GmbH.
  10. * and Department of Scientific Computing
  11. * Paris Lodron University of Salzburg.
  12. * Hilmar Linder <hlinder@cosy.sbg.ac.at>
  13. * and Wolfram Stering <wstering@cosy.sbg.ac.at>
  14. *
  15. * ULE Decaps according to draft-ietf-ipdvb-ule-03.txt.
  16. *
  17. * This program is free software; you can redistribute it and/or
  18. * modify it under the terms of the GNU General Public License
  19. * as published by the Free Software Foundation; either version 2
  20. * of the License, or (at your option) any later version.
  21. *
  22. * This program is distributed in the hope that it will be useful,
  23. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  24. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  25. * GNU General Public License for more details.
  26. *
  27. * You should have received a copy of the GNU General Public License
  28. * along with this program; if not, write to the Free Software
  29. * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  30. * Or, point your browser to http://www.gnu.org/copyleft/gpl.html
  31. */
  32. /*
  33. * ULE ChangeLog:
  34. * Feb 2004: hl/ws v1: Implementing draft-fair-ipdvb-ule-01.txt
  35. *
  36. * Dec 2004: hl/ws v2: Implementing draft-ietf-ipdvb-ule-03.txt:
  37. * ULE Extension header handling.
  38. * Bugreports by Moritz Vieth and Hanno Tersteegen,
  39. * Fraunhofer Institute for Open Communication Systems
  40. * Competence Center for Advanced Satellite Communications.
  41. * Bugfixes and robustness improvements.
  42. * Filtering on dest MAC addresses, if present (D-Bit = 0)
  43. * ULE_DEBUG compile-time option.
  44. */
  45. /*
  46. * FIXME / TODO (dvb_net.c):
  47. *
  48. * Unloading does not work for 2.6.9 kernels: a refcount doesn't go to zero.
  49. *
  50. * TS_FEED callback is called once for every single TS cell although it is
  51. * registered (in dvb_net_feed_start()) for 100 TS cells (used for dvb_net_ule()).
  52. *
  53. */
  54. #include <linux/module.h>
  55. #include <linux/kernel.h>
  56. #include <linux/netdevice.h>
  57. #include <linux/etherdevice.h>
  58. #include <linux/dvb/net.h>
  59. #include <linux/uio.h>
  60. #include <asm/uaccess.h>
  61. #include <linux/crc32.h>
  62. #include <linux/mutex.h>
  63. #include "dvb_demux.h"
  64. #include "dvb_net.h"
  65. static int dvb_net_debug;
  66. module_param(dvb_net_debug, int, 0444);
  67. MODULE_PARM_DESC(dvb_net_debug, "enable debug messages");
  68. #define dprintk(x...) do { if (dvb_net_debug) printk(x); } while (0)
  69. static inline __u32 iov_crc32( __u32 c, struct kvec *iov, unsigned int cnt )
  70. {
  71. unsigned int j;
  72. for (j = 0; j < cnt; j++)
  73. c = crc32_be( c, iov[j].iov_base, iov[j].iov_len );
  74. return c;
  75. }
  76. #define DVB_NET_MULTICAST_MAX 10
  77. #undef ULE_DEBUG
  78. #ifdef ULE_DEBUG
  79. #define isprint(c) ((c >= 'a' && c <= 'z') || (c >= 'A' && c <= 'Z') || (c >= '0' && c <= '9'))
  80. static void hexdump( const unsigned char *buf, unsigned short len )
  81. {
  82. char str[80], octet[10];
  83. int ofs, i, l;
  84. for (ofs = 0; ofs < len; ofs += 16) {
  85. sprintf( str, "%03d: ", ofs );
  86. for (i = 0; i < 16; i++) {
  87. if ((i + ofs) < len)
  88. sprintf( octet, "%02x ", buf[ofs + i] );
  89. else
  90. strcpy( octet, " " );
  91. strcat( str, octet );
  92. }
  93. strcat( str, " " );
  94. l = strlen( str );
  95. for (i = 0; (i < 16) && ((i + ofs) < len); i++)
  96. str[l++] = isprint( buf[ofs + i] ) ? buf[ofs + i] : '.';
  97. str[l] = '\0';
  98. printk( KERN_WARNING "%s\n", str );
  99. }
  100. }
  101. #endif
  102. struct dvb_net_priv {
  103. int in_use;
  104. struct net_device_stats stats;
  105. u16 pid;
  106. struct dvb_net *host;
  107. struct dmx_demux *demux;
  108. struct dmx_section_feed *secfeed;
  109. struct dmx_section_filter *secfilter;
  110. struct dmx_ts_feed *tsfeed;
  111. int multi_num;
  112. struct dmx_section_filter *multi_secfilter[DVB_NET_MULTICAST_MAX];
  113. unsigned char multi_macs[DVB_NET_MULTICAST_MAX][6];
  114. int rx_mode;
  115. #define RX_MODE_UNI 0
  116. #define RX_MODE_MULTI 1
  117. #define RX_MODE_ALL_MULTI 2
  118. #define RX_MODE_PROMISC 3
  119. struct work_struct set_multicast_list_wq;
  120. struct work_struct restart_net_feed_wq;
  121. unsigned char feedtype; /* Either FEED_TYPE_ or FEED_TYPE_ULE */
  122. int need_pusi; /* Set to 1, if synchronization on PUSI required. */
  123. unsigned char tscc; /* TS continuity counter after sync on PUSI. */
  124. struct sk_buff *ule_skb; /* ULE SNDU decodes into this buffer. */
  125. unsigned char *ule_next_hdr; /* Pointer into skb to next ULE extension header. */
  126. unsigned short ule_sndu_len; /* ULE SNDU length in bytes, w/o D-Bit. */
  127. unsigned short ule_sndu_type; /* ULE SNDU type field, complete. */
  128. unsigned char ule_sndu_type_1; /* ULE SNDU type field, if split across 2 TS cells. */
  129. unsigned char ule_dbit; /* Whether the DestMAC address present
  130. * or not (bit is set). */
  131. unsigned char ule_bridged; /* Whether the ULE_BRIDGED extension header was found. */
  132. int ule_sndu_remain; /* Nr. of bytes still required for current ULE SNDU. */
  133. unsigned long ts_count; /* Current ts cell counter. */
  134. struct mutex mutex;
  135. };
  136. /**
  137. * Determine the packet's protocol ID. The rule here is that we
  138. * assume 802.3 if the type field is short enough to be a length.
  139. * This is normal practice and works for any 'now in use' protocol.
  140. *
  141. * stolen from eth.c out of the linux kernel, hacked for dvb-device
  142. * by Michael Holzt <kju@debian.org>
  143. */
  144. static unsigned short dvb_net_eth_type_trans(struct sk_buff *skb,
  145. struct net_device *dev)
  146. {
  147. struct ethhdr *eth;
  148. unsigned char *rawp;
  149. skb->mac.raw=skb->data;
  150. skb_pull(skb,dev->hard_header_len);
  151. eth = eth_hdr(skb);
  152. if (*eth->h_dest & 1) {
  153. if(memcmp(eth->h_dest,dev->broadcast, ETH_ALEN)==0)
  154. skb->pkt_type=PACKET_BROADCAST;
  155. else
  156. skb->pkt_type=PACKET_MULTICAST;
  157. }
  158. if (ntohs(eth->h_proto) >= 1536)
  159. return eth->h_proto;
  160. rawp = skb->data;
  161. /**
  162. * This is a magic hack to spot IPX packets. Older Novell breaks
  163. * the protocol design and runs IPX over 802.3 without an 802.2 LLC
  164. * layer. We look for FFFF which isn't a used 802.2 SSAP/DSAP. This
  165. * won't work for fault tolerant netware but does for the rest.
  166. */
  167. if (*(unsigned short *)rawp == 0xFFFF)
  168. return htons(ETH_P_802_3);
  169. /**
  170. * Real 802.2 LLC
  171. */
  172. return htons(ETH_P_802_2);
  173. }
  174. #define TS_SZ 188
  175. #define TS_SYNC 0x47
  176. #define TS_TEI 0x80
  177. #define TS_SC 0xC0
  178. #define TS_PUSI 0x40
  179. #define TS_AF_A 0x20
  180. #define TS_AF_D 0x10
  181. /* ULE Extension Header handlers. */
  182. #define ULE_TEST 0
  183. #define ULE_BRIDGED 1
  184. static int ule_test_sndu( struct dvb_net_priv *p )
  185. {
  186. return -1;
  187. }
  188. static int ule_bridged_sndu( struct dvb_net_priv *p )
  189. {
  190. /* BRIDGE SNDU handling sucks in draft-ietf-ipdvb-ule-03.txt.
  191. * This has to be the last extension header, otherwise it won't work.
  192. * Blame the authors!
  193. */
  194. p->ule_bridged = 1;
  195. return 0;
  196. }
  197. /** Handle ULE extension headers.
  198. * Function is called after a successful CRC32 verification of an ULE SNDU to complete its decoding.
  199. * Returns: >= 0: nr. of bytes consumed by next extension header
  200. * -1: Mandatory extension header that is not recognized or TEST SNDU; discard.
  201. */
  202. static int handle_one_ule_extension( struct dvb_net_priv *p )
  203. {
  204. /* Table of mandatory extension header handlers. The header type is the index. */
  205. static int (*ule_mandatory_ext_handlers[255])( struct dvb_net_priv *p ) =
  206. { [0] = ule_test_sndu, [1] = ule_bridged_sndu, [2] = NULL, };
  207. /* Table of optional extension header handlers. The header type is the index. */
  208. static int (*ule_optional_ext_handlers[255])( struct dvb_net_priv *p ) = { NULL, };
  209. int ext_len = 0;
  210. unsigned char hlen = (p->ule_sndu_type & 0x0700) >> 8;
  211. unsigned char htype = p->ule_sndu_type & 0x00FF;
  212. /* Discriminate mandatory and optional extension headers. */
  213. if (hlen == 0) {
  214. /* Mandatory extension header */
  215. if (ule_mandatory_ext_handlers[htype]) {
  216. ext_len = ule_mandatory_ext_handlers[htype]( p );
  217. p->ule_next_hdr += ext_len;
  218. if (! p->ule_bridged) {
  219. p->ule_sndu_type = ntohs( *(unsigned short *)p->ule_next_hdr );
  220. p->ule_next_hdr += 2;
  221. } else {
  222. p->ule_sndu_type = ntohs( *(unsigned short *)(p->ule_next_hdr + ((p->ule_dbit ? 2 : 3) * ETH_ALEN)) );
  223. /* This assures the extension handling loop will terminate. */
  224. }
  225. } else
  226. ext_len = -1; /* SNDU has to be discarded. */
  227. } else {
  228. /* Optional extension header. Calculate the length. */
  229. ext_len = hlen << 2;
  230. /* Process the optional extension header according to its type. */
  231. if (ule_optional_ext_handlers[htype])
  232. (void)ule_optional_ext_handlers[htype]( p );
  233. p->ule_next_hdr += ext_len;
  234. p->ule_sndu_type = ntohs( *(unsigned short *)p->ule_next_hdr );
  235. p->ule_next_hdr += 2;
  236. }
  237. return ext_len;
  238. }
  239. static int handle_ule_extensions( struct dvb_net_priv *p )
  240. {
  241. int total_ext_len = 0, l;
  242. p->ule_next_hdr = p->ule_skb->data;
  243. do {
  244. l = handle_one_ule_extension( p );
  245. if (l == -1) return -1; /* Stop extension header processing and discard SNDU. */
  246. total_ext_len += l;
  247. } while (p->ule_sndu_type < 1536);
  248. return total_ext_len;
  249. }
  250. /** Prepare for a new ULE SNDU: reset the decoder state. */
  251. static inline void reset_ule( struct dvb_net_priv *p )
  252. {
  253. p->ule_skb = NULL;
  254. p->ule_next_hdr = NULL;
  255. p->ule_sndu_len = 0;
  256. p->ule_sndu_type = 0;
  257. p->ule_sndu_type_1 = 0;
  258. p->ule_sndu_remain = 0;
  259. p->ule_dbit = 0xFF;
  260. p->ule_bridged = 0;
  261. }
  262. /**
  263. * Decode ULE SNDUs according to draft-ietf-ipdvb-ule-03.txt from a sequence of
  264. * TS cells of a single PID.
  265. */
  266. static void dvb_net_ule( struct net_device *dev, const u8 *buf, size_t buf_len )
  267. {
  268. struct dvb_net_priv *priv = dev->priv;
  269. unsigned long skipped = 0L;
  270. u8 *ts, *ts_end, *from_where = NULL, ts_remain = 0, how_much = 0, new_ts = 1;
  271. struct ethhdr *ethh = NULL;
  272. #ifdef ULE_DEBUG
  273. /* The code inside ULE_DEBUG keeps a history of the last 100 TS cells processed. */
  274. static unsigned char ule_hist[100*TS_SZ];
  275. static unsigned char *ule_where = ule_hist, ule_dump = 0;
  276. #endif
  277. if (dev == NULL) {
  278. printk( KERN_ERR "NO netdev struct!\n" );
  279. return;
  280. }
  281. /* For all TS cells in current buffer.
  282. * Appearently, we are called for every single TS cell.
  283. */
  284. for (ts = (char *)buf, ts_end = (char *)buf + buf_len; ts < ts_end; /* no default incr. */ ) {
  285. if (new_ts) {
  286. /* We are about to process a new TS cell. */
  287. #ifdef ULE_DEBUG
  288. if (ule_where >= &ule_hist[100*TS_SZ]) ule_where = ule_hist;
  289. memcpy( ule_where, ts, TS_SZ );
  290. if (ule_dump) {
  291. hexdump( ule_where, TS_SZ );
  292. ule_dump = 0;
  293. }
  294. ule_where += TS_SZ;
  295. #endif
  296. /* Check TS error conditions: sync_byte, transport_error_indicator, scrambling_control . */
  297. if ((ts[0] != TS_SYNC) || (ts[1] & TS_TEI) || ((ts[3] & TS_SC) != 0)) {
  298. printk(KERN_WARNING "%lu: Invalid TS cell: SYNC %#x, TEI %u, SC %#x.\n",
  299. priv->ts_count, ts[0], ts[1] & TS_TEI >> 7, ts[3] & 0xC0 >> 6);
  300. /* Drop partly decoded SNDU, reset state, resync on PUSI. */
  301. if (priv->ule_skb) {
  302. dev_kfree_skb( priv->ule_skb );
  303. /* Prepare for next SNDU. */
  304. ((struct dvb_net_priv *) dev->priv)->stats.rx_errors++;
  305. ((struct dvb_net_priv *) dev->priv)->stats.rx_frame_errors++;
  306. }
  307. reset_ule(priv);
  308. priv->need_pusi = 1;
  309. /* Continue with next TS cell. */
  310. ts += TS_SZ;
  311. priv->ts_count++;
  312. continue;
  313. }
  314. ts_remain = 184;
  315. from_where = ts + 4;
  316. }
  317. /* Synchronize on PUSI, if required. */
  318. if (priv->need_pusi) {
  319. if (ts[1] & TS_PUSI) {
  320. /* Find beginning of first ULE SNDU in current TS cell. */
  321. /* Synchronize continuity counter. */
  322. priv->tscc = ts[3] & 0x0F;
  323. /* There is a pointer field here. */
  324. if (ts[4] > ts_remain) {
  325. printk(KERN_ERR "%lu: Invalid ULE packet "
  326. "(pointer field %d)\n", priv->ts_count, ts[4]);
  327. ts += TS_SZ;
  328. priv->ts_count++;
  329. continue;
  330. }
  331. /* Skip to destination of pointer field. */
  332. from_where = &ts[5] + ts[4];
  333. ts_remain -= 1 + ts[4];
  334. skipped = 0;
  335. } else {
  336. skipped++;
  337. ts += TS_SZ;
  338. priv->ts_count++;
  339. continue;
  340. }
  341. }
  342. /* Check continuity counter. */
  343. if (new_ts) {
  344. if ((ts[3] & 0x0F) == priv->tscc)
  345. priv->tscc = (priv->tscc + 1) & 0x0F;
  346. else {
  347. /* TS discontinuity handling: */
  348. printk(KERN_WARNING "%lu: TS discontinuity: got %#x, "
  349. "exptected %#x.\n", priv->ts_count, ts[3] & 0x0F, priv->tscc);
  350. /* Drop partly decoded SNDU, reset state, resync on PUSI. */
  351. if (priv->ule_skb) {
  352. dev_kfree_skb( priv->ule_skb );
  353. /* Prepare for next SNDU. */
  354. // reset_ule(priv); moved to below.
  355. ((struct dvb_net_priv *) dev->priv)->stats.rx_errors++;
  356. ((struct dvb_net_priv *) dev->priv)->stats.rx_frame_errors++;
  357. }
  358. reset_ule(priv);
  359. /* skip to next PUSI. */
  360. priv->need_pusi = 1;
  361. ts += TS_SZ;
  362. priv->ts_count++;
  363. continue;
  364. }
  365. /* If we still have an incomplete payload, but PUSI is
  366. * set; some TS cells are missing.
  367. * This is only possible here, if we missed exactly 16 TS
  368. * cells (continuity counter wrap). */
  369. if (ts[1] & TS_PUSI) {
  370. if (! priv->need_pusi) {
  371. if (*from_where > 181) {
  372. /* Pointer field is invalid. Drop this TS cell and any started ULE SNDU. */
  373. printk(KERN_WARNING "%lu: Invalid pointer "
  374. "field: %u.\n", priv->ts_count, *from_where);
  375. /* Drop partly decoded SNDU, reset state, resync on PUSI. */
  376. if (priv->ule_skb) {
  377. dev_kfree_skb( priv->ule_skb );
  378. ((struct dvb_net_priv *) dev->priv)->stats.rx_errors++;
  379. ((struct dvb_net_priv *) dev->priv)->stats.rx_frame_errors++;
  380. }
  381. reset_ule(priv);
  382. priv->need_pusi = 1;
  383. ts += TS_SZ;
  384. priv->ts_count++;
  385. continue;
  386. }
  387. /* Skip pointer field (we're processing a
  388. * packed payload). */
  389. from_where += 1;
  390. ts_remain -= 1;
  391. } else
  392. priv->need_pusi = 0;
  393. if (priv->ule_sndu_remain > 183) {
  394. /* Current SNDU lacks more data than there could be available in the
  395. * current TS cell. */
  396. ((struct dvb_net_priv *) dev->priv)->stats.rx_errors++;
  397. ((struct dvb_net_priv *) dev->priv)->stats.rx_length_errors++;
  398. printk(KERN_WARNING "%lu: Expected %d more SNDU bytes, but "
  399. "got PUSI (pf %d, ts_remain %d). Flushing incomplete payload.\n",
  400. priv->ts_count, priv->ule_sndu_remain, ts[4], ts_remain);
  401. dev_kfree_skb(priv->ule_skb);
  402. /* Prepare for next SNDU. */
  403. reset_ule(priv);
  404. /* Resync: go to where pointer field points to: start of next ULE SNDU. */
  405. from_where += ts[4];
  406. ts_remain -= ts[4];
  407. }
  408. }
  409. }
  410. /* Check if new payload needs to be started. */
  411. if (priv->ule_skb == NULL) {
  412. /* Start a new payload with skb.
  413. * Find ULE header. It is only guaranteed that the
  414. * length field (2 bytes) is contained in the current
  415. * TS.
  416. * Check ts_remain has to be >= 2 here. */
  417. if (ts_remain < 2) {
  418. printk(KERN_WARNING "Invalid payload packing: only %d "
  419. "bytes left in TS. Resyncing.\n", ts_remain);
  420. priv->ule_sndu_len = 0;
  421. priv->need_pusi = 1;
  422. continue;
  423. }
  424. if (! priv->ule_sndu_len) {
  425. /* Got at least two bytes, thus extrace the SNDU length. */
  426. priv->ule_sndu_len = from_where[0] << 8 | from_where[1];
  427. if (priv->ule_sndu_len & 0x8000) {
  428. /* D-Bit is set: no dest mac present. */
  429. priv->ule_sndu_len &= 0x7FFF;
  430. priv->ule_dbit = 1;
  431. } else
  432. priv->ule_dbit = 0;
  433. if (priv->ule_sndu_len > 32763) {
  434. printk(KERN_WARNING "%lu: Invalid ULE SNDU length %u. "
  435. "Resyncing.\n", priv->ts_count, priv->ule_sndu_len);
  436. priv->ule_sndu_len = 0;
  437. priv->need_pusi = 1;
  438. new_ts = 1;
  439. ts += TS_SZ;
  440. priv->ts_count++;
  441. continue;
  442. }
  443. ts_remain -= 2; /* consume the 2 bytes SNDU length. */
  444. from_where += 2;
  445. }
  446. /*
  447. * State of current TS:
  448. * ts_remain (remaining bytes in the current TS cell)
  449. * 0 ule_type is not available now, we need the next TS cell
  450. * 1 the first byte of the ule_type is present
  451. * >=2 full ULE header present, maybe some payload data as well.
  452. */
  453. switch (ts_remain) {
  454. case 1:
  455. priv->ule_sndu_type = from_where[0] << 8;
  456. priv->ule_sndu_type_1 = 1; /* first byte of ule_type is set. */
  457. ts_remain -= 1; from_where += 1;
  458. /* Continue w/ next TS. */
  459. case 0:
  460. new_ts = 1;
  461. ts += TS_SZ;
  462. priv->ts_count++;
  463. continue;
  464. default: /* complete ULE header is present in current TS. */
  465. /* Extract ULE type field. */
  466. if (priv->ule_sndu_type_1) {
  467. priv->ule_sndu_type |= from_where[0];
  468. from_where += 1; /* points to payload start. */
  469. ts_remain -= 1;
  470. } else {
  471. /* Complete type is present in new TS. */
  472. priv->ule_sndu_type = from_where[0] << 8 | from_where[1];
  473. from_where += 2; /* points to payload start. */
  474. ts_remain -= 2;
  475. }
  476. break;
  477. }
  478. /* Allocate the skb (decoder target buffer) with the correct size, as follows:
  479. * prepare for the largest case: bridged SNDU with MAC address (dbit = 0). */
  480. priv->ule_skb = dev_alloc_skb( priv->ule_sndu_len + ETH_HLEN + ETH_ALEN );
  481. if (priv->ule_skb == NULL) {
  482. printk(KERN_NOTICE "%s: Memory squeeze, dropping packet.\n",
  483. dev->name);
  484. ((struct dvb_net_priv *)dev->priv)->stats.rx_dropped++;
  485. return;
  486. }
  487. /* This includes the CRC32 _and_ dest mac, if !dbit. */
  488. priv->ule_sndu_remain = priv->ule_sndu_len;
  489. priv->ule_skb->dev = dev;
  490. /* Leave space for Ethernet or bridged SNDU header (eth hdr plus one MAC addr). */
  491. skb_reserve( priv->ule_skb, ETH_HLEN + ETH_ALEN );
  492. }
  493. /* Copy data into our current skb. */
  494. how_much = min(priv->ule_sndu_remain, (int)ts_remain);
  495. memcpy(skb_put(priv->ule_skb, how_much), from_where, how_much);
  496. priv->ule_sndu_remain -= how_much;
  497. ts_remain -= how_much;
  498. from_where += how_much;
  499. /* Check for complete payload. */
  500. if (priv->ule_sndu_remain <= 0) {
  501. /* Check CRC32, we've got it in our skb already. */
  502. unsigned short ulen = htons(priv->ule_sndu_len);
  503. unsigned short utype = htons(priv->ule_sndu_type);
  504. struct kvec iov[3] = {
  505. { &ulen, sizeof ulen },
  506. { &utype, sizeof utype },
  507. { priv->ule_skb->data, priv->ule_skb->len - 4 }
  508. };
  509. unsigned long ule_crc = ~0L, expected_crc;
  510. if (priv->ule_dbit) {
  511. /* Set D-bit for CRC32 verification,
  512. * if it was set originally. */
  513. ulen |= 0x0080;
  514. }
  515. ule_crc = iov_crc32(ule_crc, iov, 3);
  516. expected_crc = *((u8 *)priv->ule_skb->tail - 4) << 24 |
  517. *((u8 *)priv->ule_skb->tail - 3) << 16 |
  518. *((u8 *)priv->ule_skb->tail - 2) << 8 |
  519. *((u8 *)priv->ule_skb->tail - 1);
  520. if (ule_crc != expected_crc) {
  521. printk(KERN_WARNING "%lu: CRC32 check FAILED: %#lx / %#lx, SNDU len %d type %#x, ts_remain %d, next 2: %x.\n",
  522. priv->ts_count, ule_crc, expected_crc, priv->ule_sndu_len, priv->ule_sndu_type, ts_remain, ts_remain > 2 ? *(unsigned short *)from_where : 0);
  523. #ifdef ULE_DEBUG
  524. hexdump( iov[0].iov_base, iov[0].iov_len );
  525. hexdump( iov[1].iov_base, iov[1].iov_len );
  526. hexdump( iov[2].iov_base, iov[2].iov_len );
  527. if (ule_where == ule_hist) {
  528. hexdump( &ule_hist[98*TS_SZ], TS_SZ );
  529. hexdump( &ule_hist[99*TS_SZ], TS_SZ );
  530. } else if (ule_where == &ule_hist[TS_SZ]) {
  531. hexdump( &ule_hist[99*TS_SZ], TS_SZ );
  532. hexdump( ule_hist, TS_SZ );
  533. } else {
  534. hexdump( ule_where - TS_SZ - TS_SZ, TS_SZ );
  535. hexdump( ule_where - TS_SZ, TS_SZ );
  536. }
  537. ule_dump = 1;
  538. #endif
  539. ((struct dvb_net_priv *) dev->priv)->stats.rx_errors++;
  540. ((struct dvb_net_priv *) dev->priv)->stats.rx_crc_errors++;
  541. dev_kfree_skb(priv->ule_skb);
  542. } else {
  543. /* CRC32 verified OK. */
  544. /* Handle ULE Extension Headers. */
  545. if (priv->ule_sndu_type < 1536) {
  546. /* There is an extension header. Handle it accordingly. */
  547. int l = handle_ule_extensions( priv );
  548. if (l < 0) {
  549. /* Mandatory extension header unknown or TEST SNDU. Drop it. */
  550. // printk( KERN_WARNING "Dropping SNDU, extension headers.\n" );
  551. dev_kfree_skb( priv->ule_skb );
  552. goto sndu_done;
  553. }
  554. skb_pull( priv->ule_skb, l );
  555. }
  556. /* CRC32 was OK. Remove it from skb. */
  557. priv->ule_skb->tail -= 4;
  558. priv->ule_skb->len -= 4;
  559. /* Filter on receiver's destination MAC address, if present. */
  560. if (!priv->ule_dbit) {
  561. /* The destination MAC address is the next data in the skb. */
  562. if (memcmp( priv->ule_skb->data, dev->dev_addr, ETH_ALEN )) {
  563. /* MAC addresses don't match. Drop SNDU. */
  564. // printk( KERN_WARNING "Dropping SNDU, MAC address.\n" );
  565. dev_kfree_skb( priv->ule_skb );
  566. goto sndu_done;
  567. }
  568. if (! priv->ule_bridged) {
  569. skb_push( priv->ule_skb, ETH_ALEN + 2 );
  570. ethh = (struct ethhdr *)priv->ule_skb->data;
  571. memcpy( ethh->h_dest, ethh->h_source, ETH_ALEN );
  572. memset( ethh->h_source, 0, ETH_ALEN );
  573. ethh->h_proto = htons( priv->ule_sndu_type );
  574. } else {
  575. /* Skip the Receiver destination MAC address. */
  576. skb_pull( priv->ule_skb, ETH_ALEN );
  577. }
  578. } else {
  579. if (! priv->ule_bridged) {
  580. skb_push( priv->ule_skb, ETH_HLEN );
  581. ethh = (struct ethhdr *)priv->ule_skb->data;
  582. memcpy( ethh->h_dest, dev->dev_addr, ETH_ALEN );
  583. memset( ethh->h_source, 0, ETH_ALEN );
  584. ethh->h_proto = htons( priv->ule_sndu_type );
  585. } else {
  586. /* skb is in correct state; nothing to do. */
  587. }
  588. }
  589. priv->ule_bridged = 0;
  590. /* Stuff into kernel's protocol stack. */
  591. priv->ule_skb->protocol = dvb_net_eth_type_trans(priv->ule_skb, dev);
  592. /* If D-bit is set (i.e. destination MAC address not present),
  593. * receive the packet anyhow. */
  594. /* if (priv->ule_dbit && skb->pkt_type == PACKET_OTHERHOST)
  595. priv->ule_skb->pkt_type = PACKET_HOST; */
  596. ((struct dvb_net_priv *) dev->priv)->stats.rx_packets++;
  597. ((struct dvb_net_priv *) dev->priv)->stats.rx_bytes += priv->ule_skb->len;
  598. netif_rx(priv->ule_skb);
  599. }
  600. sndu_done:
  601. /* Prepare for next SNDU. */
  602. reset_ule(priv);
  603. }
  604. /* More data in current TS (look at the bytes following the CRC32)? */
  605. if (ts_remain >= 2 && *((unsigned short *)from_where) != 0xFFFF) {
  606. /* Next ULE SNDU starts right there. */
  607. new_ts = 0;
  608. priv->ule_skb = NULL;
  609. priv->ule_sndu_type_1 = 0;
  610. priv->ule_sndu_len = 0;
  611. // printk(KERN_WARNING "More data in current TS: [%#x %#x %#x %#x]\n",
  612. // *(from_where + 0), *(from_where + 1),
  613. // *(from_where + 2), *(from_where + 3));
  614. // printk(KERN_WARNING "ts @ %p, stopped @ %p:\n", ts, from_where + 0);
  615. // hexdump(ts, 188);
  616. } else {
  617. new_ts = 1;
  618. ts += TS_SZ;
  619. priv->ts_count++;
  620. if (priv->ule_skb == NULL) {
  621. priv->need_pusi = 1;
  622. priv->ule_sndu_type_1 = 0;
  623. priv->ule_sndu_len = 0;
  624. }
  625. }
  626. } /* for all available TS cells */
  627. }
  628. static int dvb_net_ts_callback(const u8 *buffer1, size_t buffer1_len,
  629. const u8 *buffer2, size_t buffer2_len,
  630. struct dmx_ts_feed *feed, enum dmx_success success)
  631. {
  632. struct net_device *dev = feed->priv;
  633. if (buffer2 != 0)
  634. printk(KERN_WARNING "buffer2 not 0: %p.\n", buffer2);
  635. if (buffer1_len > 32768)
  636. printk(KERN_WARNING "length > 32k: %zu.\n", buffer1_len);
  637. /* printk("TS callback: %u bytes, %u TS cells @ %p.\n",
  638. buffer1_len, buffer1_len / TS_SZ, buffer1); */
  639. dvb_net_ule(dev, buffer1, buffer1_len);
  640. return 0;
  641. }
  642. static void dvb_net_sec(struct net_device *dev, u8 *pkt, int pkt_len)
  643. {
  644. u8 *eth;
  645. struct sk_buff *skb;
  646. struct net_device_stats *stats = &(((struct dvb_net_priv *) dev->priv)->stats);
  647. int snap = 0;
  648. /* note: pkt_len includes a 32bit checksum */
  649. if (pkt_len < 16) {
  650. printk("%s: IP/MPE packet length = %d too small.\n",
  651. dev->name, pkt_len);
  652. stats->rx_errors++;
  653. stats->rx_length_errors++;
  654. return;
  655. }
  656. /* it seems some ISPs manage to screw up here, so we have to
  657. * relax the error checks... */
  658. #if 0
  659. if ((pkt[5] & 0xfd) != 0xc1) {
  660. /* drop scrambled or broken packets */
  661. #else
  662. if ((pkt[5] & 0x3c) != 0x00) {
  663. /* drop scrambled */
  664. #endif
  665. stats->rx_errors++;
  666. stats->rx_crc_errors++;
  667. return;
  668. }
  669. if (pkt[5] & 0x02) {
  670. /* handle LLC/SNAP, see rfc-1042 */
  671. if (pkt_len < 24 || memcmp(&pkt[12], "\xaa\xaa\x03\0\0\0", 6)) {
  672. stats->rx_dropped++;
  673. return;
  674. }
  675. snap = 8;
  676. }
  677. if (pkt[7]) {
  678. /* FIXME: assemble datagram from multiple sections */
  679. stats->rx_errors++;
  680. stats->rx_frame_errors++;
  681. return;
  682. }
  683. /* we have 14 byte ethernet header (ip header follows);
  684. * 12 byte MPE header; 4 byte checksum; + 2 byte alignment, 8 byte LLC/SNAP
  685. */
  686. if (!(skb = dev_alloc_skb(pkt_len - 4 - 12 + 14 + 2 - snap))) {
  687. //printk(KERN_NOTICE "%s: Memory squeeze, dropping packet.\n", dev->name);
  688. stats->rx_dropped++;
  689. return;
  690. }
  691. skb_reserve(skb, 2); /* longword align L3 header */
  692. skb->dev = dev;
  693. /* copy L3 payload */
  694. eth = (u8 *) skb_put(skb, pkt_len - 12 - 4 + 14 - snap);
  695. memcpy(eth + 14, pkt + 12 + snap, pkt_len - 12 - 4 - snap);
  696. /* create ethernet header: */
  697. eth[0]=pkt[0x0b];
  698. eth[1]=pkt[0x0a];
  699. eth[2]=pkt[0x09];
  700. eth[3]=pkt[0x08];
  701. eth[4]=pkt[0x04];
  702. eth[5]=pkt[0x03];
  703. eth[6]=eth[7]=eth[8]=eth[9]=eth[10]=eth[11]=0;
  704. if (snap) {
  705. eth[12] = pkt[18];
  706. eth[13] = pkt[19];
  707. } else {
  708. /* protocol numbers are from rfc-1700 or
  709. * http://www.iana.org/assignments/ethernet-numbers
  710. */
  711. if (pkt[12] >> 4 == 6) { /* version field from IP header */
  712. eth[12] = 0x86; /* IPv6 */
  713. eth[13] = 0xdd;
  714. } else {
  715. eth[12] = 0x08; /* IPv4 */
  716. eth[13] = 0x00;
  717. }
  718. }
  719. skb->protocol = dvb_net_eth_type_trans(skb, dev);
  720. stats->rx_packets++;
  721. stats->rx_bytes+=skb->len;
  722. netif_rx(skb);
  723. }
  724. static int dvb_net_sec_callback(const u8 *buffer1, size_t buffer1_len,
  725. const u8 *buffer2, size_t buffer2_len,
  726. struct dmx_section_filter *filter,
  727. enum dmx_success success)
  728. {
  729. struct net_device *dev = filter->priv;
  730. /**
  731. * we rely on the DVB API definition where exactly one complete
  732. * section is delivered in buffer1
  733. */
  734. dvb_net_sec (dev, (u8*) buffer1, buffer1_len);
  735. return 0;
  736. }
  737. static int dvb_net_tx(struct sk_buff *skb, struct net_device *dev)
  738. {
  739. dev_kfree_skb(skb);
  740. return 0;
  741. }
  742. static u8 mask_normal[6]={0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
  743. static u8 mask_allmulti[6]={0xff, 0xff, 0xff, 0x00, 0x00, 0x00};
  744. static u8 mac_allmulti[6]={0x01, 0x00, 0x5e, 0x00, 0x00, 0x00};
  745. static u8 mask_promisc[6]={0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
  746. static int dvb_net_filter_sec_set(struct net_device *dev,
  747. struct dmx_section_filter **secfilter,
  748. u8 *mac, u8 *mac_mask)
  749. {
  750. struct dvb_net_priv *priv = dev->priv;
  751. int ret;
  752. *secfilter=NULL;
  753. ret = priv->secfeed->allocate_filter(priv->secfeed, secfilter);
  754. if (ret<0) {
  755. printk("%s: could not get filter\n", dev->name);
  756. return ret;
  757. }
  758. (*secfilter)->priv=(void *) dev;
  759. memset((*secfilter)->filter_value, 0x00, DMX_MAX_FILTER_SIZE);
  760. memset((*secfilter)->filter_mask, 0x00, DMX_MAX_FILTER_SIZE);
  761. memset((*secfilter)->filter_mode, 0xff, DMX_MAX_FILTER_SIZE);
  762. (*secfilter)->filter_value[0]=0x3e;
  763. (*secfilter)->filter_value[3]=mac[5];
  764. (*secfilter)->filter_value[4]=mac[4];
  765. (*secfilter)->filter_value[8]=mac[3];
  766. (*secfilter)->filter_value[9]=mac[2];
  767. (*secfilter)->filter_value[10]=mac[1];
  768. (*secfilter)->filter_value[11]=mac[0];
  769. (*secfilter)->filter_mask[0] = 0xff;
  770. (*secfilter)->filter_mask[3] = mac_mask[5];
  771. (*secfilter)->filter_mask[4] = mac_mask[4];
  772. (*secfilter)->filter_mask[8] = mac_mask[3];
  773. (*secfilter)->filter_mask[9] = mac_mask[2];
  774. (*secfilter)->filter_mask[10] = mac_mask[1];
  775. (*secfilter)->filter_mask[11]=mac_mask[0];
  776. dprintk("%s: filter mac=%02x %02x %02x %02x %02x %02x\n",
  777. dev->name, mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
  778. dprintk("%s: filter mask=%02x %02x %02x %02x %02x %02x\n",
  779. dev->name, mac_mask[0], mac_mask[1], mac_mask[2],
  780. mac_mask[3], mac_mask[4], mac_mask[5]);
  781. return 0;
  782. }
  783. static int dvb_net_feed_start(struct net_device *dev)
  784. {
  785. int ret = 0, i;
  786. struct dvb_net_priv *priv = dev->priv;
  787. struct dmx_demux *demux = priv->demux;
  788. unsigned char *mac = (unsigned char *) dev->dev_addr;
  789. dprintk("%s: rx_mode %i\n", __FUNCTION__, priv->rx_mode);
  790. mutex_lock(&priv->mutex);
  791. if (priv->tsfeed || priv->secfeed || priv->secfilter || priv->multi_secfilter[0])
  792. printk("%s: BUG %d\n", __FUNCTION__, __LINE__);
  793. priv->secfeed=NULL;
  794. priv->secfilter=NULL;
  795. priv->tsfeed = NULL;
  796. if (priv->feedtype == DVB_NET_FEEDTYPE_MPE) {
  797. dprintk("%s: alloc secfeed\n", __FUNCTION__);
  798. ret=demux->allocate_section_feed(demux, &priv->secfeed,
  799. dvb_net_sec_callback);
  800. if (ret<0) {
  801. printk("%s: could not allocate section feed\n", dev->name);
  802. goto error;
  803. }
  804. ret = priv->secfeed->set(priv->secfeed, priv->pid, 32768, 1);
  805. if (ret<0) {
  806. printk("%s: could not set section feed\n", dev->name);
  807. priv->demux->release_section_feed(priv->demux, priv->secfeed);
  808. priv->secfeed=NULL;
  809. goto error;
  810. }
  811. if (priv->rx_mode != RX_MODE_PROMISC) {
  812. dprintk("%s: set secfilter\n", __FUNCTION__);
  813. dvb_net_filter_sec_set(dev, &priv->secfilter, mac, mask_normal);
  814. }
  815. switch (priv->rx_mode) {
  816. case RX_MODE_MULTI:
  817. for (i = 0; i < priv->multi_num; i++) {
  818. dprintk("%s: set multi_secfilter[%d]\n", __FUNCTION__, i);
  819. dvb_net_filter_sec_set(dev, &priv->multi_secfilter[i],
  820. priv->multi_macs[i], mask_normal);
  821. }
  822. break;
  823. case RX_MODE_ALL_MULTI:
  824. priv->multi_num=1;
  825. dprintk("%s: set multi_secfilter[0]\n", __FUNCTION__);
  826. dvb_net_filter_sec_set(dev, &priv->multi_secfilter[0],
  827. mac_allmulti, mask_allmulti);
  828. break;
  829. case RX_MODE_PROMISC:
  830. priv->multi_num=0;
  831. dprintk("%s: set secfilter\n", __FUNCTION__);
  832. dvb_net_filter_sec_set(dev, &priv->secfilter, mac, mask_promisc);
  833. break;
  834. }
  835. dprintk("%s: start filtering\n", __FUNCTION__);
  836. priv->secfeed->start_filtering(priv->secfeed);
  837. } else if (priv->feedtype == DVB_NET_FEEDTYPE_ULE) {
  838. struct timespec timeout = { 0, 30000000 }; // 30 msec
  839. /* we have payloads encapsulated in TS */
  840. dprintk("%s: alloc tsfeed\n", __FUNCTION__);
  841. ret = demux->allocate_ts_feed(demux, &priv->tsfeed, dvb_net_ts_callback);
  842. if (ret < 0) {
  843. printk("%s: could not allocate ts feed\n", dev->name);
  844. goto error;
  845. }
  846. /* Set netdevice pointer for ts decaps callback. */
  847. priv->tsfeed->priv = (void *)dev;
  848. ret = priv->tsfeed->set(priv->tsfeed, priv->pid,
  849. TS_PACKET, DMX_TS_PES_OTHER,
  850. 32768, /* circular buffer size */
  851. timeout);
  852. if (ret < 0) {
  853. printk("%s: could not set ts feed\n", dev->name);
  854. priv->demux->release_ts_feed(priv->demux, priv->tsfeed);
  855. priv->tsfeed = NULL;
  856. goto error;
  857. }
  858. dprintk("%s: start filtering\n", __FUNCTION__);
  859. priv->tsfeed->start_filtering(priv->tsfeed);
  860. } else
  861. ret = -EINVAL;
  862. error:
  863. mutex_unlock(&priv->mutex);
  864. return ret;
  865. }
  866. static int dvb_net_feed_stop(struct net_device *dev)
  867. {
  868. struct dvb_net_priv *priv = dev->priv;
  869. int i, ret = 0;
  870. dprintk("%s\n", __FUNCTION__);
  871. mutex_lock(&priv->mutex);
  872. if (priv->feedtype == DVB_NET_FEEDTYPE_MPE) {
  873. if (priv->secfeed) {
  874. if (priv->secfeed->is_filtering) {
  875. dprintk("%s: stop secfeed\n", __FUNCTION__);
  876. priv->secfeed->stop_filtering(priv->secfeed);
  877. }
  878. if (priv->secfilter) {
  879. dprintk("%s: release secfilter\n", __FUNCTION__);
  880. priv->secfeed->release_filter(priv->secfeed,
  881. priv->secfilter);
  882. priv->secfilter=NULL;
  883. }
  884. for (i=0; i<priv->multi_num; i++) {
  885. if (priv->multi_secfilter[i]) {
  886. dprintk("%s: release multi_filter[%d]\n",
  887. __FUNCTION__, i);
  888. priv->secfeed->release_filter(priv->secfeed,
  889. priv->multi_secfilter[i]);
  890. priv->multi_secfilter[i] = NULL;
  891. }
  892. }
  893. priv->demux->release_section_feed(priv->demux, priv->secfeed);
  894. priv->secfeed = NULL;
  895. } else
  896. printk("%s: no feed to stop\n", dev->name);
  897. } else if (priv->feedtype == DVB_NET_FEEDTYPE_ULE) {
  898. if (priv->tsfeed) {
  899. if (priv->tsfeed->is_filtering) {
  900. dprintk("%s: stop tsfeed\n", __FUNCTION__);
  901. priv->tsfeed->stop_filtering(priv->tsfeed);
  902. }
  903. priv->demux->release_ts_feed(priv->demux, priv->tsfeed);
  904. priv->tsfeed = NULL;
  905. }
  906. else
  907. printk("%s: no ts feed to stop\n", dev->name);
  908. } else
  909. ret = -EINVAL;
  910. mutex_unlock(&priv->mutex);
  911. return ret;
  912. }
  913. static int dvb_set_mc_filter (struct net_device *dev, struct dev_mc_list *mc)
  914. {
  915. struct dvb_net_priv *priv = dev->priv;
  916. if (priv->multi_num == DVB_NET_MULTICAST_MAX)
  917. return -ENOMEM;
  918. memcpy(priv->multi_macs[priv->multi_num], mc->dmi_addr, 6);
  919. priv->multi_num++;
  920. return 0;
  921. }
  922. static void wq_set_multicast_list (void *data)
  923. {
  924. struct net_device *dev = data;
  925. struct dvb_net_priv *priv = dev->priv;
  926. dvb_net_feed_stop(dev);
  927. priv->rx_mode = RX_MODE_UNI;
  928. spin_lock_bh(&dev->xmit_lock);
  929. if (dev->flags & IFF_PROMISC) {
  930. dprintk("%s: promiscuous mode\n", dev->name);
  931. priv->rx_mode = RX_MODE_PROMISC;
  932. } else if ((dev->flags & IFF_ALLMULTI)) {
  933. dprintk("%s: allmulti mode\n", dev->name);
  934. priv->rx_mode = RX_MODE_ALL_MULTI;
  935. } else if (dev->mc_count) {
  936. int mci;
  937. struct dev_mc_list *mc;
  938. dprintk("%s: set_mc_list, %d entries\n",
  939. dev->name, dev->mc_count);
  940. priv->rx_mode = RX_MODE_MULTI;
  941. priv->multi_num = 0;
  942. for (mci = 0, mc=dev->mc_list;
  943. mci < dev->mc_count;
  944. mc = mc->next, mci++) {
  945. dvb_set_mc_filter(dev, mc);
  946. }
  947. }
  948. spin_unlock_bh(&dev->xmit_lock);
  949. dvb_net_feed_start(dev);
  950. }
  951. static void dvb_net_set_multicast_list (struct net_device *dev)
  952. {
  953. struct dvb_net_priv *priv = dev->priv;
  954. schedule_work(&priv->set_multicast_list_wq);
  955. }
  956. static void wq_restart_net_feed (void *data)
  957. {
  958. struct net_device *dev = data;
  959. if (netif_running(dev)) {
  960. dvb_net_feed_stop(dev);
  961. dvb_net_feed_start(dev);
  962. }
  963. }
  964. static int dvb_net_set_mac (struct net_device *dev, void *p)
  965. {
  966. struct dvb_net_priv *priv = dev->priv;
  967. struct sockaddr *addr=p;
  968. memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
  969. if (netif_running(dev))
  970. schedule_work(&priv->restart_net_feed_wq);
  971. return 0;
  972. }
  973. static int dvb_net_open(struct net_device *dev)
  974. {
  975. struct dvb_net_priv *priv = dev->priv;
  976. priv->in_use++;
  977. dvb_net_feed_start(dev);
  978. return 0;
  979. }
  980. static int dvb_net_stop(struct net_device *dev)
  981. {
  982. struct dvb_net_priv *priv = dev->priv;
  983. priv->in_use--;
  984. return dvb_net_feed_stop(dev);
  985. }
  986. static struct net_device_stats * dvb_net_get_stats(struct net_device *dev)
  987. {
  988. return &((struct dvb_net_priv*) dev->priv)->stats;
  989. }
  990. static void dvb_net_setup(struct net_device *dev)
  991. {
  992. ether_setup(dev);
  993. dev->open = dvb_net_open;
  994. dev->stop = dvb_net_stop;
  995. dev->hard_start_xmit = dvb_net_tx;
  996. dev->get_stats = dvb_net_get_stats;
  997. dev->set_multicast_list = dvb_net_set_multicast_list;
  998. dev->set_mac_address = dvb_net_set_mac;
  999. dev->mtu = 4096;
  1000. dev->mc_count = 0;
  1001. dev->hard_header_cache = NULL;
  1002. dev->flags |= IFF_NOARP;
  1003. }
  1004. static int get_if(struct dvb_net *dvbnet)
  1005. {
  1006. int i;
  1007. for (i=0; i<DVB_NET_DEVICES_MAX; i++)
  1008. if (!dvbnet->state[i])
  1009. break;
  1010. if (i == DVB_NET_DEVICES_MAX)
  1011. return -1;
  1012. dvbnet->state[i]=1;
  1013. return i;
  1014. }
  1015. static int dvb_net_add_if(struct dvb_net *dvbnet, u16 pid, u8 feedtype)
  1016. {
  1017. struct net_device *net;
  1018. struct dvb_net_priv *priv;
  1019. int result;
  1020. int if_num;
  1021. if (feedtype != DVB_NET_FEEDTYPE_MPE && feedtype != DVB_NET_FEEDTYPE_ULE)
  1022. return -EINVAL;
  1023. if ((if_num = get_if(dvbnet)) < 0)
  1024. return -EINVAL;
  1025. net = alloc_netdev(sizeof(struct dvb_net_priv), "dvb", dvb_net_setup);
  1026. if (!net)
  1027. return -ENOMEM;
  1028. if (dvbnet->dvbdev->id)
  1029. snprintf(net->name, IFNAMSIZ, "dvb%d%u%d",
  1030. dvbnet->dvbdev->adapter->num, dvbnet->dvbdev->id, if_num);
  1031. else
  1032. /* compatibility fix to keep dvb0_0 format */
  1033. snprintf(net->name, IFNAMSIZ, "dvb%d_%d",
  1034. dvbnet->dvbdev->adapter->num, if_num);
  1035. net->addr_len = 6;
  1036. memcpy(net->dev_addr, dvbnet->dvbdev->adapter->proposed_mac, 6);
  1037. dvbnet->device[if_num] = net;
  1038. priv = net->priv;
  1039. priv->demux = dvbnet->demux;
  1040. priv->pid = pid;
  1041. priv->rx_mode = RX_MODE_UNI;
  1042. priv->need_pusi = 1;
  1043. priv->tscc = 0;
  1044. priv->feedtype = feedtype;
  1045. reset_ule(priv);
  1046. INIT_WORK(&priv->set_multicast_list_wq, wq_set_multicast_list, net);
  1047. INIT_WORK(&priv->restart_net_feed_wq, wq_restart_net_feed, net);
  1048. mutex_init(&priv->mutex);
  1049. net->base_addr = pid;
  1050. if ((result = register_netdev(net)) < 0) {
  1051. dvbnet->device[if_num] = NULL;
  1052. free_netdev(net);
  1053. return result;
  1054. }
  1055. printk("dvb_net: created network interface %s\n", net->name);
  1056. return if_num;
  1057. }
  1058. static int dvb_net_remove_if(struct dvb_net *dvbnet, unsigned long num)
  1059. {
  1060. struct net_device *net = dvbnet->device[num];
  1061. struct dvb_net_priv *priv;
  1062. if (!dvbnet->state[num])
  1063. return -EINVAL;
  1064. priv = net->priv;
  1065. if (priv->in_use)
  1066. return -EBUSY;
  1067. dvb_net_stop(net);
  1068. flush_scheduled_work();
  1069. printk("dvb_net: removed network interface %s\n", net->name);
  1070. unregister_netdev(net);
  1071. dvbnet->state[num]=0;
  1072. dvbnet->device[num] = NULL;
  1073. free_netdev(net);
  1074. return 0;
  1075. }
  1076. static int dvb_net_do_ioctl(struct inode *inode, struct file *file,
  1077. unsigned int cmd, void *parg)
  1078. {
  1079. struct dvb_device *dvbdev = file->private_data;
  1080. struct dvb_net *dvbnet = dvbdev->priv;
  1081. if (((file->f_flags&O_ACCMODE)==O_RDONLY))
  1082. return -EPERM;
  1083. switch (cmd) {
  1084. case NET_ADD_IF:
  1085. {
  1086. struct dvb_net_if *dvbnetif = parg;
  1087. int result;
  1088. if (!capable(CAP_SYS_ADMIN))
  1089. return -EPERM;
  1090. if (!try_module_get(dvbdev->adapter->module))
  1091. return -EPERM;
  1092. result=dvb_net_add_if(dvbnet, dvbnetif->pid, dvbnetif->feedtype);
  1093. if (result<0) {
  1094. module_put(dvbdev->adapter->module);
  1095. return result;
  1096. }
  1097. dvbnetif->if_num=result;
  1098. break;
  1099. }
  1100. case NET_GET_IF:
  1101. {
  1102. struct net_device *netdev;
  1103. struct dvb_net_priv *priv_data;
  1104. struct dvb_net_if *dvbnetif = parg;
  1105. if (dvbnetif->if_num >= DVB_NET_DEVICES_MAX ||
  1106. !dvbnet->state[dvbnetif->if_num])
  1107. return -EINVAL;
  1108. netdev = dvbnet->device[dvbnetif->if_num];
  1109. priv_data = netdev->priv;
  1110. dvbnetif->pid=priv_data->pid;
  1111. dvbnetif->feedtype=priv_data->feedtype;
  1112. break;
  1113. }
  1114. case NET_REMOVE_IF:
  1115. {
  1116. int ret;
  1117. if (!capable(CAP_SYS_ADMIN))
  1118. return -EPERM;
  1119. if ((unsigned long) parg >= DVB_NET_DEVICES_MAX)
  1120. return -EINVAL;
  1121. ret = dvb_net_remove_if(dvbnet, (unsigned long) parg);
  1122. if (!ret)
  1123. module_put(dvbdev->adapter->module);
  1124. return ret;
  1125. }
  1126. /* binary compatiblity cruft */
  1127. case __NET_ADD_IF_OLD:
  1128. {
  1129. struct __dvb_net_if_old *dvbnetif = parg;
  1130. int result;
  1131. if (!capable(CAP_SYS_ADMIN))
  1132. return -EPERM;
  1133. if (!try_module_get(dvbdev->adapter->module))
  1134. return -EPERM;
  1135. result=dvb_net_add_if(dvbnet, dvbnetif->pid, DVB_NET_FEEDTYPE_MPE);
  1136. if (result<0) {
  1137. module_put(dvbdev->adapter->module);
  1138. return result;
  1139. }
  1140. dvbnetif->if_num=result;
  1141. break;
  1142. }
  1143. case __NET_GET_IF_OLD:
  1144. {
  1145. struct net_device *netdev;
  1146. struct dvb_net_priv *priv_data;
  1147. struct __dvb_net_if_old *dvbnetif = parg;
  1148. if (dvbnetif->if_num >= DVB_NET_DEVICES_MAX ||
  1149. !dvbnet->state[dvbnetif->if_num])
  1150. return -EINVAL;
  1151. netdev = dvbnet->device[dvbnetif->if_num];
  1152. priv_data = netdev->priv;
  1153. dvbnetif->pid=priv_data->pid;
  1154. break;
  1155. }
  1156. default:
  1157. return -ENOTTY;
  1158. }
  1159. return 0;
  1160. }
  1161. static int dvb_net_ioctl(struct inode *inode, struct file *file,
  1162. unsigned int cmd, unsigned long arg)
  1163. {
  1164. return dvb_usercopy(inode, file, cmd, arg, dvb_net_do_ioctl);
  1165. }
  1166. static struct file_operations dvb_net_fops = {
  1167. .owner = THIS_MODULE,
  1168. .ioctl = dvb_net_ioctl,
  1169. .open = dvb_generic_open,
  1170. .release = dvb_generic_release,
  1171. };
  1172. static struct dvb_device dvbdev_net = {
  1173. .priv = NULL,
  1174. .users = 1,
  1175. .writers = 1,
  1176. .fops = &dvb_net_fops,
  1177. };
  1178. void dvb_net_release (struct dvb_net *dvbnet)
  1179. {
  1180. int i;
  1181. dvb_unregister_device(dvbnet->dvbdev);
  1182. for (i=0; i<DVB_NET_DEVICES_MAX; i++) {
  1183. if (!dvbnet->state[i])
  1184. continue;
  1185. dvb_net_remove_if(dvbnet, i);
  1186. }
  1187. }
  1188. EXPORT_SYMBOL(dvb_net_release);
  1189. int dvb_net_init (struct dvb_adapter *adap, struct dvb_net *dvbnet,
  1190. struct dmx_demux *dmx)
  1191. {
  1192. int i;
  1193. dvbnet->demux = dmx;
  1194. for (i=0; i<DVB_NET_DEVICES_MAX; i++)
  1195. dvbnet->state[i] = 0;
  1196. dvb_register_device (adap, &dvbnet->dvbdev, &dvbdev_net,
  1197. dvbnet, DVB_DEVICE_NET);
  1198. return 0;
  1199. }
  1200. EXPORT_SYMBOL(dvb_net_init);