dvb_net.c 39 KB

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