dvb_net.c 42 KB

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