Path: blob/master/drivers/media/dvb/dvb-core/dvb_net.c
15112 views
/*1* dvb_net.c2*3* Copyright (C) 2001 Convergence integrated media GmbH4* Ralph Metzler <[email protected]>5* Copyright (C) 2002 Ralph Metzler <[email protected]>6*7* ULE Decapsulation code:8* Copyright (C) 2003, 2004 gcs - Global Communication & Services GmbH.9* and Department of Scientific Computing10* Paris Lodron University of Salzburg.11* Hilmar Linder <[email protected]>12* and Wolfram Stering <[email protected]>13*14* ULE Decaps according to RFC 4326.15*16* This program is free software; you can redistribute it and/or17* modify it under the terms of the GNU General Public License18* as published by the Free Software Foundation; either version 219* of the License, or (at your option) any later version.20*21* This program is distributed in the hope that it will be useful,22* but WITHOUT ANY WARRANTY; without even the implied warranty of23* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the24* GNU General Public License for more details.25*26* You should have received a copy of the GNU General Public License27* along with this program; if not, write to the Free Software28* Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.29* Or, point your browser to http://www.gnu.org/copyleft/gpl.html30*/3132/*33* ULE ChangeLog:34* Feb 2004: hl/ws v1: Implementing draft-fair-ipdvb-ule-01.txt35*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 Systems40* 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) by45* Christian Praehauser <[email protected]>,46* Paris Lodron University of Salzburg.47*/4849/*50* FIXME / TODO (dvb_net.c):51*52* Unloading does not work for 2.6.9 kernels: a refcount doesn't go to zero.53*54*/5556#include <linux/module.h>57#include <linux/kernel.h>58#include <linux/netdevice.h>59#include <linux/etherdevice.h>60#include <linux/dvb/net.h>61#include <linux/uio.h>62#include <asm/uaccess.h>63#include <linux/crc32.h>64#include <linux/mutex.h>65#include <linux/sched.h>6667#include "dvb_demux.h"68#include "dvb_net.h"6970static int dvb_net_debug;71module_param(dvb_net_debug, int, 0444);72MODULE_PARM_DESC(dvb_net_debug, "enable debug messages");7374#define dprintk(x...) do { if (dvb_net_debug) printk(x); } while (0)757677static inline __u32 iov_crc32( __u32 c, struct kvec *iov, unsigned int cnt )78{79unsigned int j;80for (j = 0; j < cnt; j++)81c = crc32_be( c, iov[j].iov_base, iov[j].iov_len );82return c;83}848586#define DVB_NET_MULTICAST_MAX 108788#undef ULE_DEBUG8990#ifdef ULE_DEBUG9192#define MAC_ADDR_PRINTFMT "%.2x:%.2x:%.2x:%.2x:%.2x:%.2x"93#define MAX_ADDR_PRINTFMT_ARGS(macap) (macap)[0],(macap)[1],(macap)[2],(macap)[3],(macap)[4],(macap)[5]9495#define isprint(c) ((c >= 'a' && c <= 'z') || (c >= 'A' && c <= 'Z') || (c >= '0' && c <= '9'))9697static void hexdump( const unsigned char *buf, unsigned short len )98{99char str[80], octet[10];100int ofs, i, l;101102for (ofs = 0; ofs < len; ofs += 16) {103sprintf( str, "%03d: ", ofs );104105for (i = 0; i < 16; i++) {106if ((i + ofs) < len)107sprintf( octet, "%02x ", buf[ofs + i] );108else109strcpy( octet, " " );110111strcat( str, octet );112}113strcat( str, " " );114l = strlen( str );115116for (i = 0; (i < 16) && ((i + ofs) < len); i++)117str[l++] = isprint( buf[ofs + i] ) ? buf[ofs + i] : '.';118119str[l] = '\0';120printk( KERN_WARNING "%s\n", str );121}122}123124#endif125126struct dvb_net_priv {127int in_use;128u16 pid;129struct net_device *net;130struct dvb_net *host;131struct dmx_demux *demux;132struct dmx_section_feed *secfeed;133struct dmx_section_filter *secfilter;134struct dmx_ts_feed *tsfeed;135int multi_num;136struct dmx_section_filter *multi_secfilter[DVB_NET_MULTICAST_MAX];137unsigned char multi_macs[DVB_NET_MULTICAST_MAX][6];138int rx_mode;139#define RX_MODE_UNI 0140#define RX_MODE_MULTI 1141#define RX_MODE_ALL_MULTI 2142#define RX_MODE_PROMISC 3143struct work_struct set_multicast_list_wq;144struct work_struct restart_net_feed_wq;145unsigned char feedtype; /* Either FEED_TYPE_ or FEED_TYPE_ULE */146int need_pusi; /* Set to 1, if synchronization on PUSI required. */147unsigned char tscc; /* TS continuity counter after sync on PUSI. */148struct sk_buff *ule_skb; /* ULE SNDU decodes into this buffer. */149unsigned char *ule_next_hdr; /* Pointer into skb to next ULE extension header. */150unsigned short ule_sndu_len; /* ULE SNDU length in bytes, w/o D-Bit. */151unsigned short ule_sndu_type; /* ULE SNDU type field, complete. */152unsigned char ule_sndu_type_1; /* ULE SNDU type field, if split across 2 TS cells. */153unsigned char ule_dbit; /* Whether the DestMAC address present154* or not (bit is set). */155unsigned char ule_bridged; /* Whether the ULE_BRIDGED extension header was found. */156int ule_sndu_remain; /* Nr. of bytes still required for current ULE SNDU. */157unsigned long ts_count; /* Current ts cell counter. */158struct mutex mutex;159};160161162/**163* Determine the packet's protocol ID. The rule here is that we164* assume 802.3 if the type field is short enough to be a length.165* This is normal practice and works for any 'now in use' protocol.166*167* stolen from eth.c out of the linux kernel, hacked for dvb-device168* by Michael Holzt <[email protected]>169*/170static __be16 dvb_net_eth_type_trans(struct sk_buff *skb,171struct net_device *dev)172{173struct ethhdr *eth;174unsigned char *rawp;175176skb_reset_mac_header(skb);177skb_pull(skb,dev->hard_header_len);178eth = eth_hdr(skb);179180if (*eth->h_dest & 1) {181if(memcmp(eth->h_dest,dev->broadcast, ETH_ALEN)==0)182skb->pkt_type=PACKET_BROADCAST;183else184skb->pkt_type=PACKET_MULTICAST;185}186187if (ntohs(eth->h_proto) >= 1536)188return eth->h_proto;189190rawp = skb->data;191192/**193* This is a magic hack to spot IPX packets. Older Novell breaks194* the protocol design and runs IPX over 802.3 without an 802.2 LLC195* layer. We look for FFFF which isn't a used 802.2 SSAP/DSAP. This196* won't work for fault tolerant netware but does for the rest.197*/198if (*(unsigned short *)rawp == 0xFFFF)199return htons(ETH_P_802_3);200201/**202* Real 802.2 LLC203*/204return htons(ETH_P_802_2);205}206207#define TS_SZ 188208#define TS_SYNC 0x47209#define TS_TEI 0x80210#define TS_SC 0xC0211#define TS_PUSI 0x40212#define TS_AF_A 0x20213#define TS_AF_D 0x10214215/* ULE Extension Header handlers. */216217#define ULE_TEST 0218#define ULE_BRIDGED 1219220#define ULE_OPTEXTHDR_PADDING 0221222static int ule_test_sndu( struct dvb_net_priv *p )223{224return -1;225}226227static int ule_bridged_sndu( struct dvb_net_priv *p )228{229struct ethhdr *hdr = (struct ethhdr*) p->ule_next_hdr;230if(ntohs(hdr->h_proto) < 1536) {231int framelen = p->ule_sndu_len - ((p->ule_next_hdr+sizeof(struct ethhdr)) - p->ule_skb->data);232/* A frame Type < 1536 for a bridged frame, introduces a LLC Length field. */233if(framelen != ntohs(hdr->h_proto)) {234return -1;235}236}237/* Note:238* From RFC4326:239* "A bridged SNDU is a Mandatory Extension Header of Type 1.240* It must be the final (or only) extension header specified in the header chain of a SNDU."241* The 'ule_bridged' flag will cause the extension header processing loop to terminate.242*/243p->ule_bridged = 1;244return 0;245}246247static int ule_exthdr_padding(struct dvb_net_priv *p)248{249return 0;250}251252/** Handle ULE extension headers.253* Function is called after a successful CRC32 verification of an ULE SNDU to complete its decoding.254* Returns: >= 0: nr. of bytes consumed by next extension header255* -1: Mandatory extension header that is not recognized or TEST SNDU; discard.256*/257static int handle_one_ule_extension( struct dvb_net_priv *p )258{259/* Table of mandatory extension header handlers. The header type is the index. */260static int (*ule_mandatory_ext_handlers[255])( struct dvb_net_priv *p ) =261{ [0] = ule_test_sndu, [1] = ule_bridged_sndu, [2] = NULL, };262263/* Table of optional extension header handlers. The header type is the index. */264static int (*ule_optional_ext_handlers[255])( struct dvb_net_priv *p ) =265{ [0] = ule_exthdr_padding, [1] = NULL, };266267int ext_len = 0;268unsigned char hlen = (p->ule_sndu_type & 0x0700) >> 8;269unsigned char htype = p->ule_sndu_type & 0x00FF;270271/* Discriminate mandatory and optional extension headers. */272if (hlen == 0) {273/* Mandatory extension header */274if (ule_mandatory_ext_handlers[htype]) {275ext_len = ule_mandatory_ext_handlers[htype]( p );276if(ext_len >= 0) {277p->ule_next_hdr += ext_len;278if (!p->ule_bridged) {279p->ule_sndu_type = ntohs(*(__be16 *)p->ule_next_hdr);280p->ule_next_hdr += 2;281} else {282p->ule_sndu_type = ntohs(*(__be16 *)(p->ule_next_hdr + ((p->ule_dbit ? 2 : 3) * ETH_ALEN)));283/* This assures the extension handling loop will terminate. */284}285}286// else: extension handler failed or SNDU should be discarded287} else288ext_len = -1; /* SNDU has to be discarded. */289} else {290/* Optional extension header. Calculate the length. */291ext_len = hlen << 1;292/* Process the optional extension header according to its type. */293if (ule_optional_ext_handlers[htype])294(void)ule_optional_ext_handlers[htype]( p );295p->ule_next_hdr += ext_len;296p->ule_sndu_type = ntohs( *(__be16 *)(p->ule_next_hdr-2) );297/*298* note: the length of the next header type is included in the299* length of THIS optional extension header300*/301}302303return ext_len;304}305306static int handle_ule_extensions( struct dvb_net_priv *p )307{308int total_ext_len = 0, l;309310p->ule_next_hdr = p->ule_skb->data;311do {312l = handle_one_ule_extension( p );313if (l < 0)314return l; /* Stop extension header processing and discard SNDU. */315total_ext_len += l;316#ifdef ULE_DEBUG317dprintk("handle_ule_extensions: ule_next_hdr=%p, ule_sndu_type=%i, "318"l=%i, total_ext_len=%i\n", p->ule_next_hdr,319(int) p->ule_sndu_type, l, total_ext_len);320#endif321322} while (p->ule_sndu_type < 1536);323324return total_ext_len;325}326327328/** Prepare for a new ULE SNDU: reset the decoder state. */329static inline void reset_ule( struct dvb_net_priv *p )330{331p->ule_skb = NULL;332p->ule_next_hdr = NULL;333p->ule_sndu_len = 0;334p->ule_sndu_type = 0;335p->ule_sndu_type_1 = 0;336p->ule_sndu_remain = 0;337p->ule_dbit = 0xFF;338p->ule_bridged = 0;339}340341/**342* Decode ULE SNDUs according to draft-ietf-ipdvb-ule-03.txt from a sequence of343* TS cells of a single PID.344*/345static void dvb_net_ule( struct net_device *dev, const u8 *buf, size_t buf_len )346{347struct dvb_net_priv *priv = netdev_priv(dev);348unsigned long skipped = 0L;349const u8 *ts, *ts_end, *from_where = NULL;350u8 ts_remain = 0, how_much = 0, new_ts = 1;351struct ethhdr *ethh = NULL;352bool error = false;353354#ifdef ULE_DEBUG355/* The code inside ULE_DEBUG keeps a history of the last 100 TS cells processed. */356static unsigned char ule_hist[100*TS_SZ];357static unsigned char *ule_where = ule_hist, ule_dump;358#endif359360/* For all TS cells in current buffer.361* Appearently, we are called for every single TS cell.362*/363for (ts = buf, ts_end = buf + buf_len; ts < ts_end; /* no default incr. */ ) {364365if (new_ts) {366/* We are about to process a new TS cell. */367368#ifdef ULE_DEBUG369if (ule_where >= &ule_hist[100*TS_SZ]) ule_where = ule_hist;370memcpy( ule_where, ts, TS_SZ );371if (ule_dump) {372hexdump( ule_where, TS_SZ );373ule_dump = 0;374}375ule_where += TS_SZ;376#endif377378/* Check TS error conditions: sync_byte, transport_error_indicator, scrambling_control . */379if ((ts[0] != TS_SYNC) || (ts[1] & TS_TEI) || ((ts[3] & TS_SC) != 0)) {380printk(KERN_WARNING "%lu: Invalid TS cell: SYNC %#x, TEI %u, SC %#x.\n",381priv->ts_count, ts[0], ts[1] & TS_TEI >> 7, ts[3] & 0xC0 >> 6);382383/* Drop partly decoded SNDU, reset state, resync on PUSI. */384if (priv->ule_skb) {385dev_kfree_skb( priv->ule_skb );386/* Prepare for next SNDU. */387dev->stats.rx_errors++;388dev->stats.rx_frame_errors++;389}390reset_ule(priv);391priv->need_pusi = 1;392393/* Continue with next TS cell. */394ts += TS_SZ;395priv->ts_count++;396continue;397}398399ts_remain = 184;400from_where = ts + 4;401}402/* Synchronize on PUSI, if required. */403if (priv->need_pusi) {404if (ts[1] & TS_PUSI) {405/* Find beginning of first ULE SNDU in current TS cell. */406/* Synchronize continuity counter. */407priv->tscc = ts[3] & 0x0F;408/* There is a pointer field here. */409if (ts[4] > ts_remain) {410printk(KERN_ERR "%lu: Invalid ULE packet "411"(pointer field %d)\n", priv->ts_count, ts[4]);412ts += TS_SZ;413priv->ts_count++;414continue;415}416/* Skip to destination of pointer field. */417from_where = &ts[5] + ts[4];418ts_remain -= 1 + ts[4];419skipped = 0;420} else {421skipped++;422ts += TS_SZ;423priv->ts_count++;424continue;425}426}427428if (new_ts) {429/* Check continuity counter. */430if ((ts[3] & 0x0F) == priv->tscc)431priv->tscc = (priv->tscc + 1) & 0x0F;432else {433/* TS discontinuity handling: */434printk(KERN_WARNING "%lu: TS discontinuity: got %#x, "435"expected %#x.\n", priv->ts_count, ts[3] & 0x0F, priv->tscc);436/* Drop partly decoded SNDU, reset state, resync on PUSI. */437if (priv->ule_skb) {438dev_kfree_skb( priv->ule_skb );439/* Prepare for next SNDU. */440// reset_ule(priv); moved to below.441dev->stats.rx_errors++;442dev->stats.rx_frame_errors++;443}444reset_ule(priv);445/* skip to next PUSI. */446priv->need_pusi = 1;447continue;448}449/* If we still have an incomplete payload, but PUSI is450* set; some TS cells are missing.451* This is only possible here, if we missed exactly 16 TS452* cells (continuity counter wrap). */453if (ts[1] & TS_PUSI) {454if (! priv->need_pusi) {455if (!(*from_where < (ts_remain-1)) || *from_where != priv->ule_sndu_remain) {456/* Pointer field is invalid. Drop this TS cell and any started ULE SNDU. */457printk(KERN_WARNING "%lu: Invalid pointer "458"field: %u.\n", priv->ts_count, *from_where);459460/* Drop partly decoded SNDU, reset state, resync on PUSI. */461if (priv->ule_skb) {462error = true;463dev_kfree_skb(priv->ule_skb);464}465466if (error || priv->ule_sndu_remain) {467dev->stats.rx_errors++;468dev->stats.rx_frame_errors++;469error = false;470}471472reset_ule(priv);473priv->need_pusi = 1;474continue;475}476/* Skip pointer field (we're processing a477* packed payload). */478from_where += 1;479ts_remain -= 1;480} else481priv->need_pusi = 0;482483if (priv->ule_sndu_remain > 183) {484/* Current SNDU lacks more data than there could be available in the485* current TS cell. */486dev->stats.rx_errors++;487dev->stats.rx_length_errors++;488printk(KERN_WARNING "%lu: Expected %d more SNDU bytes, but "489"got PUSI (pf %d, ts_remain %d). Flushing incomplete payload.\n",490priv->ts_count, priv->ule_sndu_remain, ts[4], ts_remain);491dev_kfree_skb(priv->ule_skb);492/* Prepare for next SNDU. */493reset_ule(priv);494/* Resync: go to where pointer field points to: start of next ULE SNDU. */495from_where += ts[4];496ts_remain -= ts[4];497}498}499}500501/* Check if new payload needs to be started. */502if (priv->ule_skb == NULL) {503/* Start a new payload with skb.504* Find ULE header. It is only guaranteed that the505* length field (2 bytes) is contained in the current506* TS.507* Check ts_remain has to be >= 2 here. */508if (ts_remain < 2) {509printk(KERN_WARNING "Invalid payload packing: only %d "510"bytes left in TS. Resyncing.\n", ts_remain);511priv->ule_sndu_len = 0;512priv->need_pusi = 1;513ts += TS_SZ;514continue;515}516517if (! priv->ule_sndu_len) {518/* Got at least two bytes, thus extrace the SNDU length. */519priv->ule_sndu_len = from_where[0] << 8 | from_where[1];520if (priv->ule_sndu_len & 0x8000) {521/* D-Bit is set: no dest mac present. */522priv->ule_sndu_len &= 0x7FFF;523priv->ule_dbit = 1;524} else525priv->ule_dbit = 0;526527if (priv->ule_sndu_len < 5) {528printk(KERN_WARNING "%lu: Invalid ULE SNDU length %u. "529"Resyncing.\n", priv->ts_count, priv->ule_sndu_len);530dev->stats.rx_errors++;531dev->stats.rx_length_errors++;532priv->ule_sndu_len = 0;533priv->need_pusi = 1;534new_ts = 1;535ts += TS_SZ;536priv->ts_count++;537continue;538}539ts_remain -= 2; /* consume the 2 bytes SNDU length. */540from_where += 2;541}542543priv->ule_sndu_remain = priv->ule_sndu_len + 2;544/*545* State of current TS:546* ts_remain (remaining bytes in the current TS cell)547* 0 ule_type is not available now, we need the next TS cell548* 1 the first byte of the ule_type is present549* >=2 full ULE header present, maybe some payload data as well.550*/551switch (ts_remain) {552case 1:553priv->ule_sndu_remain--;554priv->ule_sndu_type = from_where[0] << 8;555priv->ule_sndu_type_1 = 1; /* first byte of ule_type is set. */556ts_remain -= 1; from_where += 1;557/* Continue w/ next TS. */558case 0:559new_ts = 1;560ts += TS_SZ;561priv->ts_count++;562continue;563564default: /* complete ULE header is present in current TS. */565/* Extract ULE type field. */566if (priv->ule_sndu_type_1) {567priv->ule_sndu_type_1 = 0;568priv->ule_sndu_type |= from_where[0];569from_where += 1; /* points to payload start. */570ts_remain -= 1;571} else {572/* Complete type is present in new TS. */573priv->ule_sndu_type = from_where[0] << 8 | from_where[1];574from_where += 2; /* points to payload start. */575ts_remain -= 2;576}577break;578}579580/* Allocate the skb (decoder target buffer) with the correct size, as follows:581* prepare for the largest case: bridged SNDU with MAC address (dbit = 0). */582priv->ule_skb = dev_alloc_skb( priv->ule_sndu_len + ETH_HLEN + ETH_ALEN );583if (priv->ule_skb == NULL) {584printk(KERN_NOTICE "%s: Memory squeeze, dropping packet.\n",585dev->name);586dev->stats.rx_dropped++;587return;588}589590/* This includes the CRC32 _and_ dest mac, if !dbit. */591priv->ule_sndu_remain = priv->ule_sndu_len;592priv->ule_skb->dev = dev;593/* Leave space for Ethernet or bridged SNDU header (eth hdr plus one MAC addr). */594skb_reserve( priv->ule_skb, ETH_HLEN + ETH_ALEN );595}596597/* Copy data into our current skb. */598how_much = min(priv->ule_sndu_remain, (int)ts_remain);599memcpy(skb_put(priv->ule_skb, how_much), from_where, how_much);600priv->ule_sndu_remain -= how_much;601ts_remain -= how_much;602from_where += how_much;603604/* Check for complete payload. */605if (priv->ule_sndu_remain <= 0) {606/* Check CRC32, we've got it in our skb already. */607__be16 ulen = htons(priv->ule_sndu_len);608__be16 utype = htons(priv->ule_sndu_type);609const u8 *tail;610struct kvec iov[3] = {611{ &ulen, sizeof ulen },612{ &utype, sizeof utype },613{ priv->ule_skb->data, priv->ule_skb->len - 4 }614};615u32 ule_crc = ~0L, expected_crc;616if (priv->ule_dbit) {617/* Set D-bit for CRC32 verification,618* if it was set originally. */619ulen |= htons(0x8000);620}621622ule_crc = iov_crc32(ule_crc, iov, 3);623tail = skb_tail_pointer(priv->ule_skb);624expected_crc = *(tail - 4) << 24 |625*(tail - 3) << 16 |626*(tail - 2) << 8 |627*(tail - 1);628if (ule_crc != expected_crc) {629printk(KERN_WARNING "%lu: CRC32 check FAILED: %08x / %08x, SNDU len %d type %#x, ts_remain %d, next 2: %x.\n",630priv->ts_count, ule_crc, expected_crc, priv->ule_sndu_len, priv->ule_sndu_type, ts_remain, ts_remain > 2 ? *(unsigned short *)from_where : 0);631632#ifdef ULE_DEBUG633hexdump( iov[0].iov_base, iov[0].iov_len );634hexdump( iov[1].iov_base, iov[1].iov_len );635hexdump( iov[2].iov_base, iov[2].iov_len );636637if (ule_where == ule_hist) {638hexdump( &ule_hist[98*TS_SZ], TS_SZ );639hexdump( &ule_hist[99*TS_SZ], TS_SZ );640} else if (ule_where == &ule_hist[TS_SZ]) {641hexdump( &ule_hist[99*TS_SZ], TS_SZ );642hexdump( ule_hist, TS_SZ );643} else {644hexdump( ule_where - TS_SZ - TS_SZ, TS_SZ );645hexdump( ule_where - TS_SZ, TS_SZ );646}647ule_dump = 1;648#endif649650dev->stats.rx_errors++;651dev->stats.rx_crc_errors++;652dev_kfree_skb(priv->ule_skb);653} else {654/* CRC32 verified OK. */655u8 dest_addr[ETH_ALEN];656static const u8 bc_addr[ETH_ALEN] =657{ [ 0 ... ETH_ALEN-1] = 0xff };658659/* CRC32 was OK. Remove it from skb. */660priv->ule_skb->tail -= 4;661priv->ule_skb->len -= 4;662663if (!priv->ule_dbit) {664/*665* The destination MAC address is the666* next data in the skb. It comes667* before any extension headers.668*669* Check if the payload of this SNDU670* should be passed up the stack.671*/672register int drop = 0;673if (priv->rx_mode != RX_MODE_PROMISC) {674if (priv->ule_skb->data[0] & 0x01) {675/* multicast or broadcast */676if (memcmp(priv->ule_skb->data, bc_addr, ETH_ALEN)) {677/* multicast */678if (priv->rx_mode == RX_MODE_MULTI) {679int i;680for(i = 0; i < priv->multi_num && memcmp(priv->ule_skb->data, priv->multi_macs[i], ETH_ALEN); i++)681;682if (i == priv->multi_num)683drop = 1;684} else if (priv->rx_mode != RX_MODE_ALL_MULTI)685drop = 1; /* no broadcast; */686/* else: all multicast mode: accept all multicast packets */687}688/* else: broadcast */689}690else if (memcmp(priv->ule_skb->data, dev->dev_addr, ETH_ALEN))691drop = 1;692/* else: destination address matches the MAC address of our receiver device */693}694/* else: promiscuous mode; pass everything up the stack */695696if (drop) {697#ifdef ULE_DEBUG698dprintk("Dropping SNDU: MAC destination address does not match: dest addr: "MAC_ADDR_PRINTFMT", dev addr: "MAC_ADDR_PRINTFMT"\n",699MAX_ADDR_PRINTFMT_ARGS(priv->ule_skb->data), MAX_ADDR_PRINTFMT_ARGS(dev->dev_addr));700#endif701dev_kfree_skb(priv->ule_skb);702goto sndu_done;703}704else705{706skb_copy_from_linear_data(priv->ule_skb,707dest_addr,708ETH_ALEN);709skb_pull(priv->ule_skb, ETH_ALEN);710}711}712713/* Handle ULE Extension Headers. */714if (priv->ule_sndu_type < 1536) {715/* There is an extension header. Handle it accordingly. */716int l = handle_ule_extensions(priv);717if (l < 0) {718/* Mandatory extension header unknown or TEST SNDU. Drop it. */719// printk( KERN_WARNING "Dropping SNDU, extension headers.\n" );720dev_kfree_skb(priv->ule_skb);721goto sndu_done;722}723skb_pull(priv->ule_skb, l);724}725726/*727* Construct/assure correct ethernet header.728* Note: in bridged mode (priv->ule_bridged !=729* 0) we already have the (original) ethernet730* header at the start of the payload (after731* optional dest. address and any extension732* headers).733*/734735if (!priv->ule_bridged) {736skb_push(priv->ule_skb, ETH_HLEN);737ethh = (struct ethhdr *)priv->ule_skb->data;738if (!priv->ule_dbit) {739/* dest_addr buffer is only valid if priv->ule_dbit == 0 */740memcpy(ethh->h_dest, dest_addr, ETH_ALEN);741memset(ethh->h_source, 0, ETH_ALEN);742}743else /* zeroize source and dest */744memset( ethh, 0, ETH_ALEN*2 );745746ethh->h_proto = htons(priv->ule_sndu_type);747}748/* else: skb is in correct state; nothing to do. */749priv->ule_bridged = 0;750751/* Stuff into kernel's protocol stack. */752priv->ule_skb->protocol = dvb_net_eth_type_trans(priv->ule_skb, dev);753/* If D-bit is set (i.e. destination MAC address not present),754* receive the packet anyhow. */755/* if (priv->ule_dbit && skb->pkt_type == PACKET_OTHERHOST)756priv->ule_skb->pkt_type = PACKET_HOST; */757dev->stats.rx_packets++;758dev->stats.rx_bytes += priv->ule_skb->len;759netif_rx(priv->ule_skb);760}761sndu_done:762/* Prepare for next SNDU. */763reset_ule(priv);764}765766/* More data in current TS (look at the bytes following the CRC32)? */767if (ts_remain >= 2 && *((unsigned short *)from_where) != 0xFFFF) {768/* Next ULE SNDU starts right there. */769new_ts = 0;770priv->ule_skb = NULL;771priv->ule_sndu_type_1 = 0;772priv->ule_sndu_len = 0;773// printk(KERN_WARNING "More data in current TS: [%#x %#x %#x %#x]\n",774// *(from_where + 0), *(from_where + 1),775// *(from_where + 2), *(from_where + 3));776// printk(KERN_WARNING "ts @ %p, stopped @ %p:\n", ts, from_where + 0);777// hexdump(ts, 188);778} else {779new_ts = 1;780ts += TS_SZ;781priv->ts_count++;782if (priv->ule_skb == NULL) {783priv->need_pusi = 1;784priv->ule_sndu_type_1 = 0;785priv->ule_sndu_len = 0;786}787}788} /* for all available TS cells */789}790791static int dvb_net_ts_callback(const u8 *buffer1, size_t buffer1_len,792const u8 *buffer2, size_t buffer2_len,793struct dmx_ts_feed *feed, enum dmx_success success)794{795struct net_device *dev = feed->priv;796797if (buffer2)798printk(KERN_WARNING "buffer2 not NULL: %p.\n", buffer2);799if (buffer1_len > 32768)800printk(KERN_WARNING "length > 32k: %zu.\n", buffer1_len);801/* printk("TS callback: %u bytes, %u TS cells @ %p.\n",802buffer1_len, buffer1_len / TS_SZ, buffer1); */803dvb_net_ule(dev, buffer1, buffer1_len);804return 0;805}806807808static void dvb_net_sec(struct net_device *dev,809const u8 *pkt, int pkt_len)810{811u8 *eth;812struct sk_buff *skb;813struct net_device_stats *stats = &dev->stats;814int snap = 0;815816/* note: pkt_len includes a 32bit checksum */817if (pkt_len < 16) {818printk("%s: IP/MPE packet length = %d too small.\n",819dev->name, pkt_len);820stats->rx_errors++;821stats->rx_length_errors++;822return;823}824/* it seems some ISPs manage to screw up here, so we have to825* relax the error checks... */826#if 0827if ((pkt[5] & 0xfd) != 0xc1) {828/* drop scrambled or broken packets */829#else830if ((pkt[5] & 0x3c) != 0x00) {831/* drop scrambled */832#endif833stats->rx_errors++;834stats->rx_crc_errors++;835return;836}837if (pkt[5] & 0x02) {838/* handle LLC/SNAP, see rfc-1042 */839if (pkt_len < 24 || memcmp(&pkt[12], "\xaa\xaa\x03\0\0\0", 6)) {840stats->rx_dropped++;841return;842}843snap = 8;844}845if (pkt[7]) {846/* FIXME: assemble datagram from multiple sections */847stats->rx_errors++;848stats->rx_frame_errors++;849return;850}851852/* we have 14 byte ethernet header (ip header follows);853* 12 byte MPE header; 4 byte checksum; + 2 byte alignment, 8 byte LLC/SNAP854*/855if (!(skb = dev_alloc_skb(pkt_len - 4 - 12 + 14 + 2 - snap))) {856//printk(KERN_NOTICE "%s: Memory squeeze, dropping packet.\n", dev->name);857stats->rx_dropped++;858return;859}860skb_reserve(skb, 2); /* longword align L3 header */861skb->dev = dev;862863/* copy L3 payload */864eth = (u8 *) skb_put(skb, pkt_len - 12 - 4 + 14 - snap);865memcpy(eth + 14, pkt + 12 + snap, pkt_len - 12 - 4 - snap);866867/* create ethernet header: */868eth[0]=pkt[0x0b];869eth[1]=pkt[0x0a];870eth[2]=pkt[0x09];871eth[3]=pkt[0x08];872eth[4]=pkt[0x04];873eth[5]=pkt[0x03];874875eth[6]=eth[7]=eth[8]=eth[9]=eth[10]=eth[11]=0;876877if (snap) {878eth[12] = pkt[18];879eth[13] = pkt[19];880} else {881/* protocol numbers are from rfc-1700 or882* http://www.iana.org/assignments/ethernet-numbers883*/884if (pkt[12] >> 4 == 6) { /* version field from IP header */885eth[12] = 0x86; /* IPv6 */886eth[13] = 0xdd;887} else {888eth[12] = 0x08; /* IPv4 */889eth[13] = 0x00;890}891}892893skb->protocol = dvb_net_eth_type_trans(skb, dev);894895stats->rx_packets++;896stats->rx_bytes+=skb->len;897netif_rx(skb);898}899900static int dvb_net_sec_callback(const u8 *buffer1, size_t buffer1_len,901const u8 *buffer2, size_t buffer2_len,902struct dmx_section_filter *filter,903enum dmx_success success)904{905struct net_device *dev = filter->priv;906907/**908* we rely on the DVB API definition where exactly one complete909* section is delivered in buffer1910*/911dvb_net_sec (dev, buffer1, buffer1_len);912return 0;913}914915static int dvb_net_tx(struct sk_buff *skb, struct net_device *dev)916{917dev_kfree_skb(skb);918return NETDEV_TX_OK;919}920921static u8 mask_normal[6]={0xff, 0xff, 0xff, 0xff, 0xff, 0xff};922static u8 mask_allmulti[6]={0xff, 0xff, 0xff, 0x00, 0x00, 0x00};923static u8 mac_allmulti[6]={0x01, 0x00, 0x5e, 0x00, 0x00, 0x00};924static u8 mask_promisc[6]={0x00, 0x00, 0x00, 0x00, 0x00, 0x00};925926static int dvb_net_filter_sec_set(struct net_device *dev,927struct dmx_section_filter **secfilter,928u8 *mac, u8 *mac_mask)929{930struct dvb_net_priv *priv = netdev_priv(dev);931int ret;932933*secfilter=NULL;934ret = priv->secfeed->allocate_filter(priv->secfeed, secfilter);935if (ret<0) {936printk("%s: could not get filter\n", dev->name);937return ret;938}939940(*secfilter)->priv=(void *) dev;941942memset((*secfilter)->filter_value, 0x00, DMX_MAX_FILTER_SIZE);943memset((*secfilter)->filter_mask, 0x00, DMX_MAX_FILTER_SIZE);944memset((*secfilter)->filter_mode, 0xff, DMX_MAX_FILTER_SIZE);945946(*secfilter)->filter_value[0]=0x3e;947(*secfilter)->filter_value[3]=mac[5];948(*secfilter)->filter_value[4]=mac[4];949(*secfilter)->filter_value[8]=mac[3];950(*secfilter)->filter_value[9]=mac[2];951(*secfilter)->filter_value[10]=mac[1];952(*secfilter)->filter_value[11]=mac[0];953954(*secfilter)->filter_mask[0] = 0xff;955(*secfilter)->filter_mask[3] = mac_mask[5];956(*secfilter)->filter_mask[4] = mac_mask[4];957(*secfilter)->filter_mask[8] = mac_mask[3];958(*secfilter)->filter_mask[9] = mac_mask[2];959(*secfilter)->filter_mask[10] = mac_mask[1];960(*secfilter)->filter_mask[11]=mac_mask[0];961962dprintk("%s: filter mac=%pM\n", dev->name, mac);963dprintk("%s: filter mask=%pM\n", dev->name, mac_mask);964965return 0;966}967968static int dvb_net_feed_start(struct net_device *dev)969{970int ret = 0, i;971struct dvb_net_priv *priv = netdev_priv(dev);972struct dmx_demux *demux = priv->demux;973unsigned char *mac = (unsigned char *) dev->dev_addr;974975dprintk("%s: rx_mode %i\n", __func__, priv->rx_mode);976mutex_lock(&priv->mutex);977if (priv->tsfeed || priv->secfeed || priv->secfilter || priv->multi_secfilter[0])978printk("%s: BUG %d\n", __func__, __LINE__);979980priv->secfeed=NULL;981priv->secfilter=NULL;982priv->tsfeed = NULL;983984if (priv->feedtype == DVB_NET_FEEDTYPE_MPE) {985dprintk("%s: alloc secfeed\n", __func__);986ret=demux->allocate_section_feed(demux, &priv->secfeed,987dvb_net_sec_callback);988if (ret<0) {989printk("%s: could not allocate section feed\n", dev->name);990goto error;991}992993ret = priv->secfeed->set(priv->secfeed, priv->pid, 32768, 1);994995if (ret<0) {996printk("%s: could not set section feed\n", dev->name);997priv->demux->release_section_feed(priv->demux, priv->secfeed);998priv->secfeed=NULL;999goto error;1000}10011002if (priv->rx_mode != RX_MODE_PROMISC) {1003dprintk("%s: set secfilter\n", __func__);1004dvb_net_filter_sec_set(dev, &priv->secfilter, mac, mask_normal);1005}10061007switch (priv->rx_mode) {1008case RX_MODE_MULTI:1009for (i = 0; i < priv->multi_num; i++) {1010dprintk("%s: set multi_secfilter[%d]\n", __func__, i);1011dvb_net_filter_sec_set(dev, &priv->multi_secfilter[i],1012priv->multi_macs[i], mask_normal);1013}1014break;1015case RX_MODE_ALL_MULTI:1016priv->multi_num=1;1017dprintk("%s: set multi_secfilter[0]\n", __func__);1018dvb_net_filter_sec_set(dev, &priv->multi_secfilter[0],1019mac_allmulti, mask_allmulti);1020break;1021case RX_MODE_PROMISC:1022priv->multi_num=0;1023dprintk("%s: set secfilter\n", __func__);1024dvb_net_filter_sec_set(dev, &priv->secfilter, mac, mask_promisc);1025break;1026}10271028dprintk("%s: start filtering\n", __func__);1029priv->secfeed->start_filtering(priv->secfeed);1030} else if (priv->feedtype == DVB_NET_FEEDTYPE_ULE) {1031struct timespec timeout = { 0, 10000000 }; // 10 msec10321033/* we have payloads encapsulated in TS */1034dprintk("%s: alloc tsfeed\n", __func__);1035ret = demux->allocate_ts_feed(demux, &priv->tsfeed, dvb_net_ts_callback);1036if (ret < 0) {1037printk("%s: could not allocate ts feed\n", dev->name);1038goto error;1039}10401041/* Set netdevice pointer for ts decaps callback. */1042priv->tsfeed->priv = (void *)dev;1043ret = priv->tsfeed->set(priv->tsfeed,1044priv->pid, /* pid */1045TS_PACKET, /* type */1046DMX_TS_PES_OTHER, /* pes type */104732768, /* circular buffer size */1048timeout /* timeout */1049);10501051if (ret < 0) {1052printk("%s: could not set ts feed\n", dev->name);1053priv->demux->release_ts_feed(priv->demux, priv->tsfeed);1054priv->tsfeed = NULL;1055goto error;1056}10571058dprintk("%s: start filtering\n", __func__);1059priv->tsfeed->start_filtering(priv->tsfeed);1060} else1061ret = -EINVAL;10621063error:1064mutex_unlock(&priv->mutex);1065return ret;1066}10671068static int dvb_net_feed_stop(struct net_device *dev)1069{1070struct dvb_net_priv *priv = netdev_priv(dev);1071int i, ret = 0;10721073dprintk("%s\n", __func__);1074mutex_lock(&priv->mutex);1075if (priv->feedtype == DVB_NET_FEEDTYPE_MPE) {1076if (priv->secfeed) {1077if (priv->secfeed->is_filtering) {1078dprintk("%s: stop secfeed\n", __func__);1079priv->secfeed->stop_filtering(priv->secfeed);1080}10811082if (priv->secfilter) {1083dprintk("%s: release secfilter\n", __func__);1084priv->secfeed->release_filter(priv->secfeed,1085priv->secfilter);1086priv->secfilter=NULL;1087}10881089for (i=0; i<priv->multi_num; i++) {1090if (priv->multi_secfilter[i]) {1091dprintk("%s: release multi_filter[%d]\n",1092__func__, i);1093priv->secfeed->release_filter(priv->secfeed,1094priv->multi_secfilter[i]);1095priv->multi_secfilter[i] = NULL;1096}1097}10981099priv->demux->release_section_feed(priv->demux, priv->secfeed);1100priv->secfeed = NULL;1101} else1102printk("%s: no feed to stop\n", dev->name);1103} else if (priv->feedtype == DVB_NET_FEEDTYPE_ULE) {1104if (priv->tsfeed) {1105if (priv->tsfeed->is_filtering) {1106dprintk("%s: stop tsfeed\n", __func__);1107priv->tsfeed->stop_filtering(priv->tsfeed);1108}1109priv->demux->release_ts_feed(priv->demux, priv->tsfeed);1110priv->tsfeed = NULL;1111}1112else1113printk("%s: no ts feed to stop\n", dev->name);1114} else1115ret = -EINVAL;1116mutex_unlock(&priv->mutex);1117return ret;1118}111911201121static int dvb_set_mc_filter(struct net_device *dev, unsigned char *addr)1122{1123struct dvb_net_priv *priv = netdev_priv(dev);11241125if (priv->multi_num == DVB_NET_MULTICAST_MAX)1126return -ENOMEM;11271128memcpy(priv->multi_macs[priv->multi_num], addr, ETH_ALEN);11291130priv->multi_num++;1131return 0;1132}113311341135static void wq_set_multicast_list (struct work_struct *work)1136{1137struct dvb_net_priv *priv =1138container_of(work, struct dvb_net_priv, set_multicast_list_wq);1139struct net_device *dev = priv->net;11401141dvb_net_feed_stop(dev);1142priv->rx_mode = RX_MODE_UNI;1143netif_addr_lock_bh(dev);11441145if (dev->flags & IFF_PROMISC) {1146dprintk("%s: promiscuous mode\n", dev->name);1147priv->rx_mode = RX_MODE_PROMISC;1148} else if ((dev->flags & IFF_ALLMULTI)) {1149dprintk("%s: allmulti mode\n", dev->name);1150priv->rx_mode = RX_MODE_ALL_MULTI;1151} else if (!netdev_mc_empty(dev)) {1152struct netdev_hw_addr *ha;11531154dprintk("%s: set_mc_list, %d entries\n",1155dev->name, netdev_mc_count(dev));11561157priv->rx_mode = RX_MODE_MULTI;1158priv->multi_num = 0;11591160netdev_for_each_mc_addr(ha, dev)1161dvb_set_mc_filter(dev, ha->addr);1162}11631164netif_addr_unlock_bh(dev);1165dvb_net_feed_start(dev);1166}116711681169static void dvb_net_set_multicast_list (struct net_device *dev)1170{1171struct dvb_net_priv *priv = netdev_priv(dev);1172schedule_work(&priv->set_multicast_list_wq);1173}117411751176static void wq_restart_net_feed (struct work_struct *work)1177{1178struct dvb_net_priv *priv =1179container_of(work, struct dvb_net_priv, restart_net_feed_wq);1180struct net_device *dev = priv->net;11811182if (netif_running(dev)) {1183dvb_net_feed_stop(dev);1184dvb_net_feed_start(dev);1185}1186}118711881189static int dvb_net_set_mac (struct net_device *dev, void *p)1190{1191struct dvb_net_priv *priv = netdev_priv(dev);1192struct sockaddr *addr=p;11931194memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);11951196if (netif_running(dev))1197schedule_work(&priv->restart_net_feed_wq);11981199return 0;1200}120112021203static int dvb_net_open(struct net_device *dev)1204{1205struct dvb_net_priv *priv = netdev_priv(dev);12061207priv->in_use++;1208dvb_net_feed_start(dev);1209return 0;1210}121112121213static int dvb_net_stop(struct net_device *dev)1214{1215struct dvb_net_priv *priv = netdev_priv(dev);12161217priv->in_use--;1218return dvb_net_feed_stop(dev);1219}12201221static const struct header_ops dvb_header_ops = {1222.create = eth_header,1223.parse = eth_header_parse,1224.rebuild = eth_rebuild_header,1225};122612271228static const struct net_device_ops dvb_netdev_ops = {1229.ndo_open = dvb_net_open,1230.ndo_stop = dvb_net_stop,1231.ndo_start_xmit = dvb_net_tx,1232.ndo_set_multicast_list = dvb_net_set_multicast_list,1233.ndo_set_mac_address = dvb_net_set_mac,1234.ndo_change_mtu = eth_change_mtu,1235.ndo_validate_addr = eth_validate_addr,1236};12371238static void dvb_net_setup(struct net_device *dev)1239{1240ether_setup(dev);12411242dev->header_ops = &dvb_header_ops;1243dev->netdev_ops = &dvb_netdev_ops;1244dev->mtu = 4096;12451246dev->flags |= IFF_NOARP;1247}12481249static int get_if(struct dvb_net *dvbnet)1250{1251int i;12521253for (i=0; i<DVB_NET_DEVICES_MAX; i++)1254if (!dvbnet->state[i])1255break;12561257if (i == DVB_NET_DEVICES_MAX)1258return -1;12591260dvbnet->state[i]=1;1261return i;1262}12631264static int dvb_net_add_if(struct dvb_net *dvbnet, u16 pid, u8 feedtype)1265{1266struct net_device *net;1267struct dvb_net_priv *priv;1268int result;1269int if_num;12701271if (feedtype != DVB_NET_FEEDTYPE_MPE && feedtype != DVB_NET_FEEDTYPE_ULE)1272return -EINVAL;1273if ((if_num = get_if(dvbnet)) < 0)1274return -EINVAL;12751276net = alloc_netdev(sizeof(struct dvb_net_priv), "dvb", dvb_net_setup);1277if (!net)1278return -ENOMEM;12791280if (dvbnet->dvbdev->id)1281snprintf(net->name, IFNAMSIZ, "dvb%d%u%d",1282dvbnet->dvbdev->adapter->num, dvbnet->dvbdev->id, if_num);1283else1284/* compatibility fix to keep dvb0_0 format */1285snprintf(net->name, IFNAMSIZ, "dvb%d_%d",1286dvbnet->dvbdev->adapter->num, if_num);12871288net->addr_len = 6;1289memcpy(net->dev_addr, dvbnet->dvbdev->adapter->proposed_mac, 6);12901291dvbnet->device[if_num] = net;12921293priv = netdev_priv(net);1294priv->net = net;1295priv->demux = dvbnet->demux;1296priv->pid = pid;1297priv->rx_mode = RX_MODE_UNI;1298priv->need_pusi = 1;1299priv->tscc = 0;1300priv->feedtype = feedtype;1301reset_ule(priv);13021303INIT_WORK(&priv->set_multicast_list_wq, wq_set_multicast_list);1304INIT_WORK(&priv->restart_net_feed_wq, wq_restart_net_feed);1305mutex_init(&priv->mutex);13061307net->base_addr = pid;13081309if ((result = register_netdev(net)) < 0) {1310dvbnet->device[if_num] = NULL;1311free_netdev(net);1312return result;1313}1314printk("dvb_net: created network interface %s\n", net->name);13151316return if_num;1317}13181319static int dvb_net_remove_if(struct dvb_net *dvbnet, unsigned long num)1320{1321struct net_device *net = dvbnet->device[num];1322struct dvb_net_priv *priv;13231324if (!dvbnet->state[num])1325return -EINVAL;1326priv = netdev_priv(net);1327if (priv->in_use)1328return -EBUSY;13291330dvb_net_stop(net);1331flush_work_sync(&priv->set_multicast_list_wq);1332flush_work_sync(&priv->restart_net_feed_wq);1333printk("dvb_net: removed network interface %s\n", net->name);1334unregister_netdev(net);1335dvbnet->state[num]=0;1336dvbnet->device[num] = NULL;1337free_netdev(net);13381339return 0;1340}13411342static int dvb_net_do_ioctl(struct file *file,1343unsigned int cmd, void *parg)1344{1345struct dvb_device *dvbdev = file->private_data;1346struct dvb_net *dvbnet = dvbdev->priv;13471348if (((file->f_flags&O_ACCMODE)==O_RDONLY))1349return -EPERM;13501351switch (cmd) {1352case NET_ADD_IF:1353{1354struct dvb_net_if *dvbnetif = parg;1355int result;13561357if (!capable(CAP_SYS_ADMIN))1358return -EPERM;13591360if (!try_module_get(dvbdev->adapter->module))1361return -EPERM;13621363result=dvb_net_add_if(dvbnet, dvbnetif->pid, dvbnetif->feedtype);1364if (result<0) {1365module_put(dvbdev->adapter->module);1366return result;1367}1368dvbnetif->if_num=result;1369break;1370}1371case NET_GET_IF:1372{1373struct net_device *netdev;1374struct dvb_net_priv *priv_data;1375struct dvb_net_if *dvbnetif = parg;13761377if (dvbnetif->if_num >= DVB_NET_DEVICES_MAX ||1378!dvbnet->state[dvbnetif->if_num])1379return -EINVAL;13801381netdev = dvbnet->device[dvbnetif->if_num];13821383priv_data = netdev_priv(netdev);1384dvbnetif->pid=priv_data->pid;1385dvbnetif->feedtype=priv_data->feedtype;1386break;1387}1388case NET_REMOVE_IF:1389{1390int ret;13911392if (!capable(CAP_SYS_ADMIN))1393return -EPERM;1394if ((unsigned long) parg >= DVB_NET_DEVICES_MAX)1395return -EINVAL;1396ret = dvb_net_remove_if(dvbnet, (unsigned long) parg);1397if (!ret)1398module_put(dvbdev->adapter->module);1399return ret;1400}14011402/* binary compatibility cruft */1403case __NET_ADD_IF_OLD:1404{1405struct __dvb_net_if_old *dvbnetif = parg;1406int result;14071408if (!capable(CAP_SYS_ADMIN))1409return -EPERM;14101411if (!try_module_get(dvbdev->adapter->module))1412return -EPERM;14131414result=dvb_net_add_if(dvbnet, dvbnetif->pid, DVB_NET_FEEDTYPE_MPE);1415if (result<0) {1416module_put(dvbdev->adapter->module);1417return result;1418}1419dvbnetif->if_num=result;1420break;1421}1422case __NET_GET_IF_OLD:1423{1424struct net_device *netdev;1425struct dvb_net_priv *priv_data;1426struct __dvb_net_if_old *dvbnetif = parg;14271428if (dvbnetif->if_num >= DVB_NET_DEVICES_MAX ||1429!dvbnet->state[dvbnetif->if_num])1430return -EINVAL;14311432netdev = dvbnet->device[dvbnetif->if_num];14331434priv_data = netdev_priv(netdev);1435dvbnetif->pid=priv_data->pid;1436break;1437}1438default:1439return -ENOTTY;1440}1441return 0;1442}14431444static long dvb_net_ioctl(struct file *file,1445unsigned int cmd, unsigned long arg)1446{1447return dvb_usercopy(file, cmd, arg, dvb_net_do_ioctl);1448}14491450static int dvb_net_close(struct inode *inode, struct file *file)1451{1452struct dvb_device *dvbdev = file->private_data;1453struct dvb_net *dvbnet = dvbdev->priv;14541455dvb_generic_release(inode, file);14561457if(dvbdev->users == 1 && dvbnet->exit == 1) {1458fops_put(file->f_op);1459file->f_op = NULL;1460wake_up(&dvbdev->wait_queue);1461}1462return 0;1463}146414651466static const struct file_operations dvb_net_fops = {1467.owner = THIS_MODULE,1468.unlocked_ioctl = dvb_net_ioctl,1469.open = dvb_generic_open,1470.release = dvb_net_close,1471.llseek = noop_llseek,1472};14731474static struct dvb_device dvbdev_net = {1475.priv = NULL,1476.users = 1,1477.writers = 1,1478.fops = &dvb_net_fops,1479};148014811482void dvb_net_release (struct dvb_net *dvbnet)1483{1484int i;14851486dvbnet->exit = 1;1487if (dvbnet->dvbdev->users < 1)1488wait_event(dvbnet->dvbdev->wait_queue,1489dvbnet->dvbdev->users==1);14901491dvb_unregister_device(dvbnet->dvbdev);14921493for (i=0; i<DVB_NET_DEVICES_MAX; i++) {1494if (!dvbnet->state[i])1495continue;1496dvb_net_remove_if(dvbnet, i);1497}1498}1499EXPORT_SYMBOL(dvb_net_release);150015011502int dvb_net_init (struct dvb_adapter *adap, struct dvb_net *dvbnet,1503struct dmx_demux *dmx)1504{1505int i;15061507dvbnet->demux = dmx;15081509for (i=0; i<DVB_NET_DEVICES_MAX; i++)1510dvbnet->state[i] = 0;15111512dvb_register_device (adap, &dvbnet->dvbdev, &dvbdev_net,1513dvbnet, DVB_DEVICE_NET);15141515return 0;1516}1517EXPORT_SYMBOL(dvb_net_init);151815191520