dvb_net.c 39 KB

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