dvb_net.c 42 KB

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