dvb_net.c 39 KB

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