1a0c7056fSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
23d6c2bc0SMauro Carvalho Chehab /*
33d6c2bc0SMauro Carvalho Chehab * dvb_net.c
43d6c2bc0SMauro Carvalho Chehab *
53d6c2bc0SMauro Carvalho Chehab * Copyright (C) 2001 Convergence integrated media GmbH
63d6c2bc0SMauro Carvalho Chehab * Ralph Metzler <ralph@convergence.de>
73d6c2bc0SMauro Carvalho Chehab * Copyright (C) 2002 Ralph Metzler <rjkm@metzlerbros.de>
83d6c2bc0SMauro Carvalho Chehab *
93d6c2bc0SMauro Carvalho Chehab * ULE Decapsulation code:
103d6c2bc0SMauro Carvalho Chehab * Copyright (C) 2003, 2004 gcs - Global Communication & Services GmbH.
113d6c2bc0SMauro Carvalho Chehab * and Department of Scientific Computing
123d6c2bc0SMauro Carvalho Chehab * Paris Lodron University of Salzburg.
133d6c2bc0SMauro Carvalho Chehab * Hilmar Linder <hlinder@cosy.sbg.ac.at>
143d6c2bc0SMauro Carvalho Chehab * and Wolfram Stering <wstering@cosy.sbg.ac.at>
153d6c2bc0SMauro Carvalho Chehab *
163d6c2bc0SMauro Carvalho Chehab * ULE Decaps according to RFC 4326.
173d6c2bc0SMauro Carvalho Chehab */
183d6c2bc0SMauro Carvalho Chehab
193d6c2bc0SMauro Carvalho Chehab /*
203d6c2bc0SMauro Carvalho Chehab * ULE ChangeLog:
213d6c2bc0SMauro Carvalho Chehab * Feb 2004: hl/ws v1: Implementing draft-fair-ipdvb-ule-01.txt
223d6c2bc0SMauro Carvalho Chehab *
233d6c2bc0SMauro Carvalho Chehab * Dec 2004: hl/ws v2: Implementing draft-ietf-ipdvb-ule-03.txt:
243d6c2bc0SMauro Carvalho Chehab * ULE Extension header handling.
253d6c2bc0SMauro Carvalho Chehab * Bugreports by Moritz Vieth and Hanno Tersteegen,
263d6c2bc0SMauro Carvalho Chehab * Fraunhofer Institute for Open Communication Systems
273d6c2bc0SMauro Carvalho Chehab * Competence Center for Advanced Satellite Communications.
283d6c2bc0SMauro Carvalho Chehab * Bugfixes and robustness improvements.
293d6c2bc0SMauro Carvalho Chehab * Filtering on dest MAC addresses, if present (D-Bit = 0)
30ba711e1cSMauro Carvalho Chehab * DVB_ULE_DEBUG compile-time option.
313d6c2bc0SMauro Carvalho Chehab * Apr 2006: cp v3: Bugfixes and compliency with RFC 4326 (ULE) by
323d6c2bc0SMauro Carvalho Chehab * Christian Praehauser <cpraehaus@cosy.sbg.ac.at>,
333d6c2bc0SMauro Carvalho Chehab * Paris Lodron University of Salzburg.
343d6c2bc0SMauro Carvalho Chehab */
353d6c2bc0SMauro Carvalho Chehab
363d6c2bc0SMauro Carvalho Chehab /*
373d6c2bc0SMauro Carvalho Chehab * FIXME / TODO (dvb_net.c):
383d6c2bc0SMauro Carvalho Chehab *
393d6c2bc0SMauro Carvalho Chehab * Unloading does not work for 2.6.9 kernels: a refcount doesn't go to zero.
403d6c2bc0SMauro Carvalho Chehab *
413d6c2bc0SMauro Carvalho Chehab */
423d6c2bc0SMauro Carvalho Chehab
43b3ad24d2SMauro Carvalho Chehab #define pr_fmt(fmt) "dvb_net: " fmt
44b3ad24d2SMauro Carvalho Chehab
453d6c2bc0SMauro Carvalho Chehab #include <linux/module.h>
463d6c2bc0SMauro Carvalho Chehab #include <linux/kernel.h>
473d6c2bc0SMauro Carvalho Chehab #include <linux/netdevice.h>
48abc0226dSMauro Carvalho Chehab #include <linux/nospec.h>
493d6c2bc0SMauro Carvalho Chehab #include <linux/etherdevice.h>
503d6c2bc0SMauro Carvalho Chehab #include <linux/dvb/net.h>
513d6c2bc0SMauro Carvalho Chehab #include <linux/uio.h>
527c0f6ba6SLinus Torvalds #include <linux/uaccess.h>
533d6c2bc0SMauro Carvalho Chehab #include <linux/crc32.h>
543d6c2bc0SMauro Carvalho Chehab #include <linux/mutex.h>
553d6c2bc0SMauro Carvalho Chehab #include <linux/sched.h>
563d6c2bc0SMauro Carvalho Chehab
57fada1935SMauro Carvalho Chehab #include <media/dvb_demux.h>
58fada1935SMauro Carvalho Chehab #include <media/dvb_net.h>
593d6c2bc0SMauro Carvalho Chehab
iov_crc32(__u32 c,struct kvec * iov,unsigned int cnt)603d6c2bc0SMauro Carvalho Chehab static inline __u32 iov_crc32( __u32 c, struct kvec *iov, unsigned int cnt )
613d6c2bc0SMauro Carvalho Chehab {
623d6c2bc0SMauro Carvalho Chehab unsigned int j;
633d6c2bc0SMauro Carvalho Chehab for (j = 0; j < cnt; j++)
643d6c2bc0SMauro Carvalho Chehab c = crc32_be( c, iov[j].iov_base, iov[j].iov_len );
653d6c2bc0SMauro Carvalho Chehab return c;
663d6c2bc0SMauro Carvalho Chehab }
673d6c2bc0SMauro Carvalho Chehab
683d6c2bc0SMauro Carvalho Chehab
693d6c2bc0SMauro Carvalho Chehab #define DVB_NET_MULTICAST_MAX 10
703d6c2bc0SMauro Carvalho Chehab
71ba711e1cSMauro Carvalho Chehab #ifdef DVB_ULE_DEBUG
72b93a25e1SMauro Carvalho Chehab /*
73ba711e1cSMauro Carvalho Chehab * The code inside DVB_ULE_DEBUG keeps a history of the
74b93a25e1SMauro Carvalho Chehab * last 100 TS cells processed.
75b93a25e1SMauro Carvalho Chehab */
76b93a25e1SMauro Carvalho Chehab static unsigned char ule_hist[100*TS_SZ] = { 0 };
77b93a25e1SMauro Carvalho Chehab static unsigned char *ule_where = ule_hist, ule_dump;
78b93a25e1SMauro Carvalho Chehab
hexdump(const unsigned char * buf,unsigned short len)793d6c2bc0SMauro Carvalho Chehab static void hexdump(const unsigned char *buf, unsigned short len)
803d6c2bc0SMauro Carvalho Chehab {
814bad5d2dSJoe Perches print_hex_dump_debug("", DUMP_PREFIX_OFFSET, 16, 1, buf, len, true);
823d6c2bc0SMauro Carvalho Chehab }
833d6c2bc0SMauro Carvalho Chehab #endif
843d6c2bc0SMauro Carvalho Chehab
853d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv {
863d6c2bc0SMauro Carvalho Chehab int in_use;
873d6c2bc0SMauro Carvalho Chehab u16 pid;
883d6c2bc0SMauro Carvalho Chehab struct net_device *net;
893d6c2bc0SMauro Carvalho Chehab struct dvb_net *host;
903d6c2bc0SMauro Carvalho Chehab struct dmx_demux *demux;
913d6c2bc0SMauro Carvalho Chehab struct dmx_section_feed *secfeed;
923d6c2bc0SMauro Carvalho Chehab struct dmx_section_filter *secfilter;
933d6c2bc0SMauro Carvalho Chehab struct dmx_ts_feed *tsfeed;
943d6c2bc0SMauro Carvalho Chehab int multi_num;
953d6c2bc0SMauro Carvalho Chehab struct dmx_section_filter *multi_secfilter[DVB_NET_MULTICAST_MAX];
963d6c2bc0SMauro Carvalho Chehab unsigned char multi_macs[DVB_NET_MULTICAST_MAX][6];
973d6c2bc0SMauro Carvalho Chehab int rx_mode;
983d6c2bc0SMauro Carvalho Chehab #define RX_MODE_UNI 0
993d6c2bc0SMauro Carvalho Chehab #define RX_MODE_MULTI 1
1003d6c2bc0SMauro Carvalho Chehab #define RX_MODE_ALL_MULTI 2
1013d6c2bc0SMauro Carvalho Chehab #define RX_MODE_PROMISC 3
1023d6c2bc0SMauro Carvalho Chehab struct work_struct set_multicast_list_wq;
1033d6c2bc0SMauro Carvalho Chehab struct work_struct restart_net_feed_wq;
1043d6c2bc0SMauro Carvalho Chehab unsigned char feedtype; /* Either FEED_TYPE_ or FEED_TYPE_ULE */
1053d6c2bc0SMauro Carvalho Chehab int need_pusi; /* Set to 1, if synchronization on PUSI required. */
1063d6c2bc0SMauro Carvalho Chehab unsigned char tscc; /* TS continuity counter after sync on PUSI. */
1073d6c2bc0SMauro Carvalho Chehab struct sk_buff *ule_skb; /* ULE SNDU decodes into this buffer. */
1083d6c2bc0SMauro Carvalho Chehab unsigned char *ule_next_hdr; /* Pointer into skb to next ULE extension header. */
1093d6c2bc0SMauro Carvalho Chehab unsigned short ule_sndu_len; /* ULE SNDU length in bytes, w/o D-Bit. */
1103d6c2bc0SMauro Carvalho Chehab unsigned short ule_sndu_type; /* ULE SNDU type field, complete. */
1113d6c2bc0SMauro Carvalho Chehab unsigned char ule_sndu_type_1; /* ULE SNDU type field, if split across 2 TS cells. */
1123d6c2bc0SMauro Carvalho Chehab unsigned char ule_dbit; /* Whether the DestMAC address present
1133d6c2bc0SMauro Carvalho Chehab * or not (bit is set). */
1143d6c2bc0SMauro Carvalho Chehab unsigned char ule_bridged; /* Whether the ULE_BRIDGED extension header was found. */
1153d6c2bc0SMauro Carvalho Chehab int ule_sndu_remain; /* Nr. of bytes still required for current ULE SNDU. */
1163d6c2bc0SMauro Carvalho Chehab unsigned long ts_count; /* Current ts cell counter. */
1173d6c2bc0SMauro Carvalho Chehab struct mutex mutex;
1183d6c2bc0SMauro Carvalho Chehab };
1193d6c2bc0SMauro Carvalho Chehab
1203d6c2bc0SMauro Carvalho Chehab
121461afb27SMauro Carvalho Chehab /*
1223d6c2bc0SMauro Carvalho Chehab * Determine the packet's protocol ID. The rule here is that we
1233d6c2bc0SMauro Carvalho Chehab * assume 802.3 if the type field is short enough to be a length.
1243d6c2bc0SMauro Carvalho Chehab * This is normal practice and works for any 'now in use' protocol.
1253d6c2bc0SMauro Carvalho Chehab *
1263d6c2bc0SMauro Carvalho Chehab * stolen from eth.c out of the linux kernel, hacked for dvb-device
1273d6c2bc0SMauro Carvalho Chehab * by Michael Holzt <kju@debian.org>
1283d6c2bc0SMauro Carvalho Chehab */
dvb_net_eth_type_trans(struct sk_buff * skb,struct net_device * dev)1293d6c2bc0SMauro Carvalho Chehab static __be16 dvb_net_eth_type_trans(struct sk_buff *skb,
1303d6c2bc0SMauro Carvalho Chehab struct net_device *dev)
1313d6c2bc0SMauro Carvalho Chehab {
1323d6c2bc0SMauro Carvalho Chehab struct ethhdr *eth;
1333d6c2bc0SMauro Carvalho Chehab unsigned char *rawp;
1343d6c2bc0SMauro Carvalho Chehab
1353d6c2bc0SMauro Carvalho Chehab skb_reset_mac_header(skb);
1363d6c2bc0SMauro Carvalho Chehab skb_pull(skb,dev->hard_header_len);
1373d6c2bc0SMauro Carvalho Chehab eth = eth_hdr(skb);
1383d6c2bc0SMauro Carvalho Chehab
1393d6c2bc0SMauro Carvalho Chehab if (*eth->h_dest & 1) {
1405e231c2cSdingtianhong if(ether_addr_equal(eth->h_dest,dev->broadcast))
1413d6c2bc0SMauro Carvalho Chehab skb->pkt_type=PACKET_BROADCAST;
1423d6c2bc0SMauro Carvalho Chehab else
1433d6c2bc0SMauro Carvalho Chehab skb->pkt_type=PACKET_MULTICAST;
1443d6c2bc0SMauro Carvalho Chehab }
1453d6c2bc0SMauro Carvalho Chehab
146e5c5d22eSSimon Horman if (ntohs(eth->h_proto) >= ETH_P_802_3_MIN)
1473d6c2bc0SMauro Carvalho Chehab return eth->h_proto;
1483d6c2bc0SMauro Carvalho Chehab
1493d6c2bc0SMauro Carvalho Chehab rawp = skb->data;
1503d6c2bc0SMauro Carvalho Chehab
151461afb27SMauro Carvalho Chehab /*
1523d6c2bc0SMauro Carvalho Chehab * This is a magic hack to spot IPX packets. Older Novell breaks
1533d6c2bc0SMauro Carvalho Chehab * the protocol design and runs IPX over 802.3 without an 802.2 LLC
1543d6c2bc0SMauro Carvalho Chehab * layer. We look for FFFF which isn't a used 802.2 SSAP/DSAP. This
1553d6c2bc0SMauro Carvalho Chehab * won't work for fault tolerant netware but does for the rest.
1563d6c2bc0SMauro Carvalho Chehab */
1573d6c2bc0SMauro Carvalho Chehab if (*(unsigned short *)rawp == 0xFFFF)
1583d6c2bc0SMauro Carvalho Chehab return htons(ETH_P_802_3);
1593d6c2bc0SMauro Carvalho Chehab
160461afb27SMauro Carvalho Chehab /*
1613d6c2bc0SMauro Carvalho Chehab * Real 802.2 LLC
1623d6c2bc0SMauro Carvalho Chehab */
1633d6c2bc0SMauro Carvalho Chehab return htons(ETH_P_802_2);
1643d6c2bc0SMauro Carvalho Chehab }
1653d6c2bc0SMauro Carvalho Chehab
1663d6c2bc0SMauro Carvalho Chehab #define TS_SZ 188
1673d6c2bc0SMauro Carvalho Chehab #define TS_SYNC 0x47
1683d6c2bc0SMauro Carvalho Chehab #define TS_TEI 0x80
1693d6c2bc0SMauro Carvalho Chehab #define TS_SC 0xC0
1703d6c2bc0SMauro Carvalho Chehab #define TS_PUSI 0x40
1713d6c2bc0SMauro Carvalho Chehab #define TS_AF_A 0x20
1723d6c2bc0SMauro Carvalho Chehab #define TS_AF_D 0x10
1733d6c2bc0SMauro Carvalho Chehab
1743d6c2bc0SMauro Carvalho Chehab /* ULE Extension Header handlers. */
1753d6c2bc0SMauro Carvalho Chehab
1763d6c2bc0SMauro Carvalho Chehab #define ULE_TEST 0
1773d6c2bc0SMauro Carvalho Chehab #define ULE_BRIDGED 1
1783d6c2bc0SMauro Carvalho Chehab
1793d6c2bc0SMauro Carvalho Chehab #define ULE_OPTEXTHDR_PADDING 0
1803d6c2bc0SMauro Carvalho Chehab
ule_test_sndu(struct dvb_net_priv * p)1813d6c2bc0SMauro Carvalho Chehab static int ule_test_sndu( struct dvb_net_priv *p )
1823d6c2bc0SMauro Carvalho Chehab {
1833d6c2bc0SMauro Carvalho Chehab return -1;
1843d6c2bc0SMauro Carvalho Chehab }
1853d6c2bc0SMauro Carvalho Chehab
ule_bridged_sndu(struct dvb_net_priv * p)1863d6c2bc0SMauro Carvalho Chehab static int ule_bridged_sndu( struct dvb_net_priv *p )
1873d6c2bc0SMauro Carvalho Chehab {
1883d6c2bc0SMauro Carvalho Chehab struct ethhdr *hdr = (struct ethhdr*) p->ule_next_hdr;
189e5c5d22eSSimon Horman if(ntohs(hdr->h_proto) < ETH_P_802_3_MIN) {
1903d6c2bc0SMauro Carvalho Chehab int framelen = p->ule_sndu_len - ((p->ule_next_hdr+sizeof(struct ethhdr)) - p->ule_skb->data);
191e5c5d22eSSimon Horman /* A frame Type < ETH_P_802_3_MIN for a bridged frame, introduces a LLC Length field. */
1923d6c2bc0SMauro Carvalho Chehab if(framelen != ntohs(hdr->h_proto)) {
1933d6c2bc0SMauro Carvalho Chehab return -1;
1943d6c2bc0SMauro Carvalho Chehab }
1953d6c2bc0SMauro Carvalho Chehab }
1963d6c2bc0SMauro Carvalho Chehab /* Note:
1973d6c2bc0SMauro Carvalho Chehab * From RFC4326:
1983d6c2bc0SMauro Carvalho Chehab * "A bridged SNDU is a Mandatory Extension Header of Type 1.
1993d6c2bc0SMauro Carvalho Chehab * It must be the final (or only) extension header specified in the header chain of a SNDU."
2003d6c2bc0SMauro Carvalho Chehab * The 'ule_bridged' flag will cause the extension header processing loop to terminate.
2013d6c2bc0SMauro Carvalho Chehab */
2023d6c2bc0SMauro Carvalho Chehab p->ule_bridged = 1;
2033d6c2bc0SMauro Carvalho Chehab return 0;
2043d6c2bc0SMauro Carvalho Chehab }
2053d6c2bc0SMauro Carvalho Chehab
ule_exthdr_padding(struct dvb_net_priv * p)2063d6c2bc0SMauro Carvalho Chehab static int ule_exthdr_padding(struct dvb_net_priv *p)
2073d6c2bc0SMauro Carvalho Chehab {
2083d6c2bc0SMauro Carvalho Chehab return 0;
2093d6c2bc0SMauro Carvalho Chehab }
2103d6c2bc0SMauro Carvalho Chehab
211461afb27SMauro Carvalho Chehab /*
212461afb27SMauro Carvalho Chehab * Handle ULE extension headers.
2133d6c2bc0SMauro Carvalho Chehab * Function is called after a successful CRC32 verification of an ULE SNDU to complete its decoding.
2143d6c2bc0SMauro Carvalho Chehab * Returns: >= 0: nr. of bytes consumed by next extension header
2153d6c2bc0SMauro Carvalho Chehab * -1: Mandatory extension header that is not recognized or TEST SNDU; discard.
2163d6c2bc0SMauro Carvalho Chehab */
handle_one_ule_extension(struct dvb_net_priv * p)2173d6c2bc0SMauro Carvalho Chehab static int handle_one_ule_extension( struct dvb_net_priv *p )
2183d6c2bc0SMauro Carvalho Chehab {
2193d6c2bc0SMauro Carvalho Chehab /* Table of mandatory extension header handlers. The header type is the index. */
2203d6c2bc0SMauro Carvalho Chehab static int (*ule_mandatory_ext_handlers[255])( struct dvb_net_priv *p ) =
2213d6c2bc0SMauro Carvalho Chehab { [0] = ule_test_sndu, [1] = ule_bridged_sndu, [2] = NULL, };
2223d6c2bc0SMauro Carvalho Chehab
2233d6c2bc0SMauro Carvalho Chehab /* Table of optional extension header handlers. The header type is the index. */
2243d6c2bc0SMauro Carvalho Chehab static int (*ule_optional_ext_handlers[255])( struct dvb_net_priv *p ) =
2253d6c2bc0SMauro Carvalho Chehab { [0] = ule_exthdr_padding, [1] = NULL, };
2263d6c2bc0SMauro Carvalho Chehab
2273d6c2bc0SMauro Carvalho Chehab int ext_len = 0;
2283d6c2bc0SMauro Carvalho Chehab unsigned char hlen = (p->ule_sndu_type & 0x0700) >> 8;
2293d6c2bc0SMauro Carvalho Chehab unsigned char htype = p->ule_sndu_type & 0x00FF;
2303d6c2bc0SMauro Carvalho Chehab
2313d6c2bc0SMauro Carvalho Chehab /* Discriminate mandatory and optional extension headers. */
2323d6c2bc0SMauro Carvalho Chehab if (hlen == 0) {
2333d6c2bc0SMauro Carvalho Chehab /* Mandatory extension header */
2343d6c2bc0SMauro Carvalho Chehab if (ule_mandatory_ext_handlers[htype]) {
2353d6c2bc0SMauro Carvalho Chehab ext_len = ule_mandatory_ext_handlers[htype]( p );
2363d6c2bc0SMauro Carvalho Chehab if(ext_len >= 0) {
2373d6c2bc0SMauro Carvalho Chehab p->ule_next_hdr += ext_len;
2383d6c2bc0SMauro Carvalho Chehab if (!p->ule_bridged) {
2393d6c2bc0SMauro Carvalho Chehab p->ule_sndu_type = ntohs(*(__be16 *)p->ule_next_hdr);
2403d6c2bc0SMauro Carvalho Chehab p->ule_next_hdr += 2;
2413d6c2bc0SMauro Carvalho Chehab } else {
2423d6c2bc0SMauro Carvalho Chehab p->ule_sndu_type = ntohs(*(__be16 *)(p->ule_next_hdr + ((p->ule_dbit ? 2 : 3) * ETH_ALEN)));
2433d6c2bc0SMauro Carvalho Chehab /* This assures the extension handling loop will terminate. */
2443d6c2bc0SMauro Carvalho Chehab }
2453d6c2bc0SMauro Carvalho Chehab }
2463d6c2bc0SMauro Carvalho Chehab // else: extension handler failed or SNDU should be discarded
2473d6c2bc0SMauro Carvalho Chehab } else
2483d6c2bc0SMauro Carvalho Chehab ext_len = -1; /* SNDU has to be discarded. */
2493d6c2bc0SMauro Carvalho Chehab } else {
2503d6c2bc0SMauro Carvalho Chehab /* Optional extension header. Calculate the length. */
2513d6c2bc0SMauro Carvalho Chehab ext_len = hlen << 1;
2523d6c2bc0SMauro Carvalho Chehab /* Process the optional extension header according to its type. */
2533d6c2bc0SMauro Carvalho Chehab if (ule_optional_ext_handlers[htype])
2543d6c2bc0SMauro Carvalho Chehab (void)ule_optional_ext_handlers[htype]( p );
2553d6c2bc0SMauro Carvalho Chehab p->ule_next_hdr += ext_len;
2563d6c2bc0SMauro Carvalho Chehab p->ule_sndu_type = ntohs( *(__be16 *)(p->ule_next_hdr-2) );
2573d6c2bc0SMauro Carvalho Chehab /*
2583d6c2bc0SMauro Carvalho Chehab * note: the length of the next header type is included in the
2593d6c2bc0SMauro Carvalho Chehab * length of THIS optional extension header
2603d6c2bc0SMauro Carvalho Chehab */
2613d6c2bc0SMauro Carvalho Chehab }
2623d6c2bc0SMauro Carvalho Chehab
2633d6c2bc0SMauro Carvalho Chehab return ext_len;
2643d6c2bc0SMauro Carvalho Chehab }
2653d6c2bc0SMauro Carvalho Chehab
handle_ule_extensions(struct dvb_net_priv * p)2663d6c2bc0SMauro Carvalho Chehab static int handle_ule_extensions( struct dvb_net_priv *p )
2673d6c2bc0SMauro Carvalho Chehab {
2683d6c2bc0SMauro Carvalho Chehab int total_ext_len = 0, l;
2693d6c2bc0SMauro Carvalho Chehab
2703d6c2bc0SMauro Carvalho Chehab p->ule_next_hdr = p->ule_skb->data;
2713d6c2bc0SMauro Carvalho Chehab do {
2723d6c2bc0SMauro Carvalho Chehab l = handle_one_ule_extension( p );
2733d6c2bc0SMauro Carvalho Chehab if (l < 0)
2743d6c2bc0SMauro Carvalho Chehab return l; /* Stop extension header processing and discard SNDU. */
2753d6c2bc0SMauro Carvalho Chehab total_ext_len += l;
2765c7c0ca0SJoe Perches pr_debug("ule_next_hdr=%p, ule_sndu_type=%i, l=%i, total_ext_len=%i\n",
2775c7c0ca0SJoe Perches p->ule_next_hdr, (int)p->ule_sndu_type,
2785c7c0ca0SJoe Perches l, total_ext_len);
2793d6c2bc0SMauro Carvalho Chehab
280e5c5d22eSSimon Horman } while (p->ule_sndu_type < ETH_P_802_3_MIN);
2813d6c2bc0SMauro Carvalho Chehab
2823d6c2bc0SMauro Carvalho Chehab return total_ext_len;
2833d6c2bc0SMauro Carvalho Chehab }
2843d6c2bc0SMauro Carvalho Chehab
2853d6c2bc0SMauro Carvalho Chehab
286461afb27SMauro Carvalho Chehab /* Prepare for a new ULE SNDU: reset the decoder state. */
reset_ule(struct dvb_net_priv * p)2873d6c2bc0SMauro Carvalho Chehab static inline void reset_ule( struct dvb_net_priv *p )
2883d6c2bc0SMauro Carvalho Chehab {
2893d6c2bc0SMauro Carvalho Chehab p->ule_skb = NULL;
2903d6c2bc0SMauro Carvalho Chehab p->ule_next_hdr = NULL;
2913d6c2bc0SMauro Carvalho Chehab p->ule_sndu_len = 0;
2923d6c2bc0SMauro Carvalho Chehab p->ule_sndu_type = 0;
2933d6c2bc0SMauro Carvalho Chehab p->ule_sndu_type_1 = 0;
2943d6c2bc0SMauro Carvalho Chehab p->ule_sndu_remain = 0;
2953d6c2bc0SMauro Carvalho Chehab p->ule_dbit = 0xFF;
2963d6c2bc0SMauro Carvalho Chehab p->ule_bridged = 0;
2973d6c2bc0SMauro Carvalho Chehab }
2983d6c2bc0SMauro Carvalho Chehab
299461afb27SMauro Carvalho Chehab /*
3003d6c2bc0SMauro Carvalho Chehab * Decode ULE SNDUs according to draft-ietf-ipdvb-ule-03.txt from a sequence of
3013d6c2bc0SMauro Carvalho Chehab * TS cells of a single PID.
3023d6c2bc0SMauro Carvalho Chehab */
3033d6c2bc0SMauro Carvalho Chehab
304efb9ab67SMauro Carvalho Chehab struct dvb_net_ule_handle {
305efb9ab67SMauro Carvalho Chehab struct net_device *dev;
306efb9ab67SMauro Carvalho Chehab struct dvb_net_priv *priv;
307efb9ab67SMauro Carvalho Chehab struct ethhdr *ethh;
308efb9ab67SMauro Carvalho Chehab const u8 *buf;
309efb9ab67SMauro Carvalho Chehab size_t buf_len;
310efb9ab67SMauro Carvalho Chehab unsigned long skipped;
311efb9ab67SMauro Carvalho Chehab const u8 *ts, *ts_end, *from_where;
312efb9ab67SMauro Carvalho Chehab u8 ts_remain, how_much, new_ts;
313efb9ab67SMauro Carvalho Chehab bool error;
314efb9ab67SMauro Carvalho Chehab };
315efb9ab67SMauro Carvalho Chehab
dvb_net_ule_new_ts_cell(struct dvb_net_ule_handle * h)3168b0041dbSMauro Carvalho Chehab static int dvb_net_ule_new_ts_cell(struct dvb_net_ule_handle *h)
3178b0041dbSMauro Carvalho Chehab {
3188b0041dbSMauro Carvalho Chehab /* We are about to process a new TS cell. */
3198b0041dbSMauro Carvalho Chehab
320ba711e1cSMauro Carvalho Chehab #ifdef DVB_ULE_DEBUG
321b93a25e1SMauro Carvalho Chehab if (ule_where >= &ule_hist[100*TS_SZ])
322b93a25e1SMauro Carvalho Chehab ule_where = ule_hist;
323b93a25e1SMauro Carvalho Chehab memcpy(ule_where, h->ts, TS_SZ);
324b93a25e1SMauro Carvalho Chehab if (ule_dump) {
325b93a25e1SMauro Carvalho Chehab hexdump(ule_where, TS_SZ);
326b93a25e1SMauro Carvalho Chehab ule_dump = 0;
3278b0041dbSMauro Carvalho Chehab }
328b93a25e1SMauro Carvalho Chehab ule_where += TS_SZ;
3298b0041dbSMauro Carvalho Chehab #endif
3308b0041dbSMauro Carvalho Chehab
3318b0041dbSMauro Carvalho Chehab /*
3328b0041dbSMauro Carvalho Chehab * Check TS h->error conditions: sync_byte, transport_error_indicator,
3338b0041dbSMauro Carvalho Chehab * scrambling_control .
3348b0041dbSMauro Carvalho Chehab */
3358b0041dbSMauro Carvalho Chehab if ((h->ts[0] != TS_SYNC) || (h->ts[1] & TS_TEI) ||
3368b0041dbSMauro Carvalho Chehab ((h->ts[3] & TS_SC) != 0)) {
3378b0041dbSMauro Carvalho Chehab pr_warn("%lu: Invalid TS cell: SYNC %#x, TEI %u, SC %#x.\n",
3388b0041dbSMauro Carvalho Chehab h->priv->ts_count, h->ts[0],
3398b0041dbSMauro Carvalho Chehab (h->ts[1] & TS_TEI) >> 7,
3408b0041dbSMauro Carvalho Chehab (h->ts[3] & TS_SC) >> 6);
3418b0041dbSMauro Carvalho Chehab
3428b0041dbSMauro Carvalho Chehab /* Drop partly decoded SNDU, reset state, resync on PUSI. */
3438b0041dbSMauro Carvalho Chehab if (h->priv->ule_skb) {
3448b0041dbSMauro Carvalho Chehab dev_kfree_skb(h->priv->ule_skb);
3458b0041dbSMauro Carvalho Chehab /* Prepare for next SNDU. */
3468b0041dbSMauro Carvalho Chehab h->dev->stats.rx_errors++;
3478b0041dbSMauro Carvalho Chehab h->dev->stats.rx_frame_errors++;
3488b0041dbSMauro Carvalho Chehab }
3498b0041dbSMauro Carvalho Chehab reset_ule(h->priv);
3508b0041dbSMauro Carvalho Chehab h->priv->need_pusi = 1;
3518b0041dbSMauro Carvalho Chehab
3528b0041dbSMauro Carvalho Chehab /* Continue with next TS cell. */
3538b0041dbSMauro Carvalho Chehab h->ts += TS_SZ;
3548b0041dbSMauro Carvalho Chehab h->priv->ts_count++;
3558b0041dbSMauro Carvalho Chehab return 1;
3568b0041dbSMauro Carvalho Chehab }
3578b0041dbSMauro Carvalho Chehab
3588b0041dbSMauro Carvalho Chehab h->ts_remain = 184;
3598b0041dbSMauro Carvalho Chehab h->from_where = h->ts + 4;
3608b0041dbSMauro Carvalho Chehab
3618b0041dbSMauro Carvalho Chehab return 0;
3628b0041dbSMauro Carvalho Chehab }
3638b0041dbSMauro Carvalho Chehab
dvb_net_ule_ts_pusi(struct dvb_net_ule_handle * h)3648b0041dbSMauro Carvalho Chehab static int dvb_net_ule_ts_pusi(struct dvb_net_ule_handle *h)
3658b0041dbSMauro Carvalho Chehab {
3668b0041dbSMauro Carvalho Chehab if (h->ts[1] & TS_PUSI) {
3678b0041dbSMauro Carvalho Chehab /* Find beginning of first ULE SNDU in current TS cell. */
3688b0041dbSMauro Carvalho Chehab /* Synchronize continuity counter. */
3698b0041dbSMauro Carvalho Chehab h->priv->tscc = h->ts[3] & 0x0F;
3708b0041dbSMauro Carvalho Chehab /* There is a pointer field here. */
3718b0041dbSMauro Carvalho Chehab if (h->ts[4] > h->ts_remain) {
3728b0041dbSMauro Carvalho Chehab pr_err("%lu: Invalid ULE packet (pointer field %d)\n",
3738b0041dbSMauro Carvalho Chehab h->priv->ts_count, h->ts[4]);
3748b0041dbSMauro Carvalho Chehab h->ts += TS_SZ;
3758b0041dbSMauro Carvalho Chehab h->priv->ts_count++;
3768b0041dbSMauro Carvalho Chehab return 1;
3778b0041dbSMauro Carvalho Chehab }
3788b0041dbSMauro Carvalho Chehab /* Skip to destination of pointer field. */
3798b0041dbSMauro Carvalho Chehab h->from_where = &h->ts[5] + h->ts[4];
3808b0041dbSMauro Carvalho Chehab h->ts_remain -= 1 + h->ts[4];
3818b0041dbSMauro Carvalho Chehab h->skipped = 0;
3828b0041dbSMauro Carvalho Chehab } else {
3838b0041dbSMauro Carvalho Chehab h->skipped++;
3848b0041dbSMauro Carvalho Chehab h->ts += TS_SZ;
3858b0041dbSMauro Carvalho Chehab h->priv->ts_count++;
3868b0041dbSMauro Carvalho Chehab return 1;
3878b0041dbSMauro Carvalho Chehab }
3888b0041dbSMauro Carvalho Chehab
3898b0041dbSMauro Carvalho Chehab return 0;
3908b0041dbSMauro Carvalho Chehab }
3918b0041dbSMauro Carvalho Chehab
dvb_net_ule_new_ts(struct dvb_net_ule_handle * h)3928b0041dbSMauro Carvalho Chehab static int dvb_net_ule_new_ts(struct dvb_net_ule_handle *h)
3938b0041dbSMauro Carvalho Chehab {
3948b0041dbSMauro Carvalho Chehab /* Check continuity counter. */
3958b0041dbSMauro Carvalho Chehab if ((h->ts[3] & 0x0F) == h->priv->tscc)
3968b0041dbSMauro Carvalho Chehab h->priv->tscc = (h->priv->tscc + 1) & 0x0F;
3978b0041dbSMauro Carvalho Chehab else {
3988b0041dbSMauro Carvalho Chehab /* TS discontinuity handling: */
3998b0041dbSMauro Carvalho Chehab pr_warn("%lu: TS discontinuity: got %#x, expected %#x.\n",
4008b0041dbSMauro Carvalho Chehab h->priv->ts_count, h->ts[3] & 0x0F,
4018b0041dbSMauro Carvalho Chehab h->priv->tscc);
4028b0041dbSMauro Carvalho Chehab /* Drop partly decoded SNDU, reset state, resync on PUSI. */
4038b0041dbSMauro Carvalho Chehab if (h->priv->ule_skb) {
4048b0041dbSMauro Carvalho Chehab dev_kfree_skb(h->priv->ule_skb);
4058b0041dbSMauro Carvalho Chehab /* Prepare for next SNDU. */
4068b0041dbSMauro Carvalho Chehab // reset_ule(h->priv); moved to below.
4078b0041dbSMauro Carvalho Chehab h->dev->stats.rx_errors++;
4088b0041dbSMauro Carvalho Chehab h->dev->stats.rx_frame_errors++;
4098b0041dbSMauro Carvalho Chehab }
4108b0041dbSMauro Carvalho Chehab reset_ule(h->priv);
4118b0041dbSMauro Carvalho Chehab /* skip to next PUSI. */
4128b0041dbSMauro Carvalho Chehab h->priv->need_pusi = 1;
4138b0041dbSMauro Carvalho Chehab return 1;
4148b0041dbSMauro Carvalho Chehab }
4158b0041dbSMauro Carvalho Chehab /*
4168b0041dbSMauro Carvalho Chehab * If we still have an incomplete payload, but PUSI is
4178b0041dbSMauro Carvalho Chehab * set; some TS cells are missing.
4188b0041dbSMauro Carvalho Chehab * This is only possible here, if we missed exactly 16 TS
4198b0041dbSMauro Carvalho Chehab * cells (continuity counter wrap).
4208b0041dbSMauro Carvalho Chehab */
4218b0041dbSMauro Carvalho Chehab if (h->ts[1] & TS_PUSI) {
4228b0041dbSMauro Carvalho Chehab if (!h->priv->need_pusi) {
4238b0041dbSMauro Carvalho Chehab if (!(*h->from_where < (h->ts_remain-1)) ||
4248b0041dbSMauro Carvalho Chehab *h->from_where != h->priv->ule_sndu_remain) {
4258b0041dbSMauro Carvalho Chehab /*
4268b0041dbSMauro Carvalho Chehab * Pointer field is invalid.
4278b0041dbSMauro Carvalho Chehab * Drop this TS cell and any started ULE SNDU.
4288b0041dbSMauro Carvalho Chehab */
4298b0041dbSMauro Carvalho Chehab pr_warn("%lu: Invalid pointer field: %u.\n",
4308b0041dbSMauro Carvalho Chehab h->priv->ts_count,
4318b0041dbSMauro Carvalho Chehab *h->from_where);
4328b0041dbSMauro Carvalho Chehab
4338b0041dbSMauro Carvalho Chehab /*
4348b0041dbSMauro Carvalho Chehab * Drop partly decoded SNDU, reset state,
4358b0041dbSMauro Carvalho Chehab * resync on PUSI.
4368b0041dbSMauro Carvalho Chehab */
4378b0041dbSMauro Carvalho Chehab if (h->priv->ule_skb) {
4388b0041dbSMauro Carvalho Chehab h->error = true;
4398b0041dbSMauro Carvalho Chehab dev_kfree_skb(h->priv->ule_skb);
4408b0041dbSMauro Carvalho Chehab }
4418b0041dbSMauro Carvalho Chehab
4428b0041dbSMauro Carvalho Chehab if (h->error || h->priv->ule_sndu_remain) {
4438b0041dbSMauro Carvalho Chehab h->dev->stats.rx_errors++;
4448b0041dbSMauro Carvalho Chehab h->dev->stats.rx_frame_errors++;
4458b0041dbSMauro Carvalho Chehab h->error = false;
4468b0041dbSMauro Carvalho Chehab }
4478b0041dbSMauro Carvalho Chehab
4488b0041dbSMauro Carvalho Chehab reset_ule(h->priv);
4498b0041dbSMauro Carvalho Chehab h->priv->need_pusi = 1;
4508b0041dbSMauro Carvalho Chehab return 1;
4518b0041dbSMauro Carvalho Chehab }
4528b0041dbSMauro Carvalho Chehab /*
4538b0041dbSMauro Carvalho Chehab * Skip pointer field (we're processing a
4548b0041dbSMauro Carvalho Chehab * packed payload).
4558b0041dbSMauro Carvalho Chehab */
4568b0041dbSMauro Carvalho Chehab h->from_where += 1;
4578b0041dbSMauro Carvalho Chehab h->ts_remain -= 1;
4588b0041dbSMauro Carvalho Chehab } else
4598b0041dbSMauro Carvalho Chehab h->priv->need_pusi = 0;
4608b0041dbSMauro Carvalho Chehab
4618b0041dbSMauro Carvalho Chehab if (h->priv->ule_sndu_remain > 183) {
4628b0041dbSMauro Carvalho Chehab /*
4638b0041dbSMauro Carvalho Chehab * Current SNDU lacks more data than there
4648b0041dbSMauro Carvalho Chehab * could be available in the current TS cell.
4658b0041dbSMauro Carvalho Chehab */
4668b0041dbSMauro Carvalho Chehab h->dev->stats.rx_errors++;
4678b0041dbSMauro Carvalho Chehab h->dev->stats.rx_length_errors++;
4688b0041dbSMauro Carvalho Chehab pr_warn("%lu: Expected %d more SNDU bytes, but got PUSI (pf %d, h->ts_remain %d). Flushing incomplete payload.\n",
4698b0041dbSMauro Carvalho Chehab h->priv->ts_count,
4708b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_remain,
4718b0041dbSMauro Carvalho Chehab h->ts[4], h->ts_remain);
4728b0041dbSMauro Carvalho Chehab dev_kfree_skb(h->priv->ule_skb);
4738b0041dbSMauro Carvalho Chehab /* Prepare for next SNDU. */
4748b0041dbSMauro Carvalho Chehab reset_ule(h->priv);
4758b0041dbSMauro Carvalho Chehab /*
4768b0041dbSMauro Carvalho Chehab * Resync: go to where pointer field points to:
4778b0041dbSMauro Carvalho Chehab * start of next ULE SNDU.
4788b0041dbSMauro Carvalho Chehab */
4798b0041dbSMauro Carvalho Chehab h->from_where += h->ts[4];
4808b0041dbSMauro Carvalho Chehab h->ts_remain -= h->ts[4];
4818b0041dbSMauro Carvalho Chehab }
4828b0041dbSMauro Carvalho Chehab }
4838b0041dbSMauro Carvalho Chehab return 0;
4848b0041dbSMauro Carvalho Chehab }
4858b0041dbSMauro Carvalho Chehab
4868b0041dbSMauro Carvalho Chehab
4878b0041dbSMauro Carvalho Chehab /*
4888b0041dbSMauro Carvalho Chehab * Start a new payload with skb.
4898b0041dbSMauro Carvalho Chehab * Find ULE header. It is only guaranteed that the
4908b0041dbSMauro Carvalho Chehab * length field (2 bytes) is contained in the current
4918b0041dbSMauro Carvalho Chehab * TS.
4928b0041dbSMauro Carvalho Chehab * Check h.ts_remain has to be >= 2 here.
4938b0041dbSMauro Carvalho Chehab */
dvb_net_ule_new_payload(struct dvb_net_ule_handle * h)4948b0041dbSMauro Carvalho Chehab static int dvb_net_ule_new_payload(struct dvb_net_ule_handle *h)
4958b0041dbSMauro Carvalho Chehab {
4968b0041dbSMauro Carvalho Chehab if (h->ts_remain < 2) {
4978b0041dbSMauro Carvalho Chehab pr_warn("Invalid payload packing: only %d bytes left in TS. Resyncing.\n",
4988b0041dbSMauro Carvalho Chehab h->ts_remain);
4998b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_len = 0;
5008b0041dbSMauro Carvalho Chehab h->priv->need_pusi = 1;
5018b0041dbSMauro Carvalho Chehab h->ts += TS_SZ;
5028b0041dbSMauro Carvalho Chehab return 1;
5038b0041dbSMauro Carvalho Chehab }
5048b0041dbSMauro Carvalho Chehab
5058b0041dbSMauro Carvalho Chehab if (!h->priv->ule_sndu_len) {
5068b0041dbSMauro Carvalho Chehab /* Got at least two bytes, thus extrace the SNDU length. */
5078b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_len = h->from_where[0] << 8 |
5088b0041dbSMauro Carvalho Chehab h->from_where[1];
5098b0041dbSMauro Carvalho Chehab if (h->priv->ule_sndu_len & 0x8000) {
5108b0041dbSMauro Carvalho Chehab /* D-Bit is set: no dest mac present. */
5118b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_len &= 0x7FFF;
5128b0041dbSMauro Carvalho Chehab h->priv->ule_dbit = 1;
5138b0041dbSMauro Carvalho Chehab } else
5148b0041dbSMauro Carvalho Chehab h->priv->ule_dbit = 0;
5158b0041dbSMauro Carvalho Chehab
5168b0041dbSMauro Carvalho Chehab if (h->priv->ule_sndu_len < 5) {
5178b0041dbSMauro Carvalho Chehab pr_warn("%lu: Invalid ULE SNDU length %u. Resyncing.\n",
5188b0041dbSMauro Carvalho Chehab h->priv->ts_count,
5198b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_len);
5208b0041dbSMauro Carvalho Chehab h->dev->stats.rx_errors++;
5218b0041dbSMauro Carvalho Chehab h->dev->stats.rx_length_errors++;
5228b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_len = 0;
5238b0041dbSMauro Carvalho Chehab h->priv->need_pusi = 1;
5248b0041dbSMauro Carvalho Chehab h->new_ts = 1;
5258b0041dbSMauro Carvalho Chehab h->ts += TS_SZ;
5268b0041dbSMauro Carvalho Chehab h->priv->ts_count++;
5278b0041dbSMauro Carvalho Chehab return 1;
5288b0041dbSMauro Carvalho Chehab }
5298b0041dbSMauro Carvalho Chehab h->ts_remain -= 2; /* consume the 2 bytes SNDU length. */
5308b0041dbSMauro Carvalho Chehab h->from_where += 2;
5318b0041dbSMauro Carvalho Chehab }
5328b0041dbSMauro Carvalho Chehab
5338b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_remain = h->priv->ule_sndu_len + 2;
5348b0041dbSMauro Carvalho Chehab /*
5358b0041dbSMauro Carvalho Chehab * State of current TS:
5368b0041dbSMauro Carvalho Chehab * h->ts_remain (remaining bytes in the current TS cell)
5378b0041dbSMauro Carvalho Chehab * 0 ule_type is not available now, we need the next TS cell
5388b0041dbSMauro Carvalho Chehab * 1 the first byte of the ule_type is present
5398b0041dbSMauro Carvalho Chehab * >=2 full ULE header present, maybe some payload data as well.
5408b0041dbSMauro Carvalho Chehab */
5418b0041dbSMauro Carvalho Chehab switch (h->ts_remain) {
5428b0041dbSMauro Carvalho Chehab case 1:
5438b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_remain--;
5448b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_type = h->from_where[0] << 8;
5458b0041dbSMauro Carvalho Chehab
5468b0041dbSMauro Carvalho Chehab /* first byte of ule_type is set. */
5478b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_type_1 = 1;
5488b0041dbSMauro Carvalho Chehab h->ts_remain -= 1;
5498b0041dbSMauro Carvalho Chehab h->from_where += 1;
550df561f66SGustavo A. R. Silva fallthrough;
5518b0041dbSMauro Carvalho Chehab case 0:
5528b0041dbSMauro Carvalho Chehab h->new_ts = 1;
5538b0041dbSMauro Carvalho Chehab h->ts += TS_SZ;
5548b0041dbSMauro Carvalho Chehab h->priv->ts_count++;
5558b0041dbSMauro Carvalho Chehab return 1;
5568b0041dbSMauro Carvalho Chehab
5578b0041dbSMauro Carvalho Chehab default: /* complete ULE header is present in current TS. */
5588b0041dbSMauro Carvalho Chehab /* Extract ULE type field. */
5598b0041dbSMauro Carvalho Chehab if (h->priv->ule_sndu_type_1) {
5608b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_type_1 = 0;
5618b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_type |= h->from_where[0];
5628b0041dbSMauro Carvalho Chehab h->from_where += 1; /* points to payload start. */
5638b0041dbSMauro Carvalho Chehab h->ts_remain -= 1;
5648b0041dbSMauro Carvalho Chehab } else {
5658b0041dbSMauro Carvalho Chehab /* Complete type is present in new TS. */
5668b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_type = h->from_where[0] << 8 |
5678b0041dbSMauro Carvalho Chehab h->from_where[1];
5688b0041dbSMauro Carvalho Chehab h->from_where += 2; /* points to payload start. */
5698b0041dbSMauro Carvalho Chehab h->ts_remain -= 2;
5708b0041dbSMauro Carvalho Chehab }
5718b0041dbSMauro Carvalho Chehab break;
5728b0041dbSMauro Carvalho Chehab }
5738b0041dbSMauro Carvalho Chehab
5748b0041dbSMauro Carvalho Chehab /*
5758b0041dbSMauro Carvalho Chehab * Allocate the skb (decoder target buffer) with the correct size,
5768b0041dbSMauro Carvalho Chehab * as follows:
5778b0041dbSMauro Carvalho Chehab *
5788b0041dbSMauro Carvalho Chehab * prepare for the largest case: bridged SNDU with MAC address
5798b0041dbSMauro Carvalho Chehab * (dbit = 0).
5808b0041dbSMauro Carvalho Chehab */
5818b0041dbSMauro Carvalho Chehab h->priv->ule_skb = dev_alloc_skb(h->priv->ule_sndu_len +
5828b0041dbSMauro Carvalho Chehab ETH_HLEN + ETH_ALEN);
5838b0041dbSMauro Carvalho Chehab if (!h->priv->ule_skb) {
5848b0041dbSMauro Carvalho Chehab pr_notice("%s: Memory squeeze, dropping packet.\n",
5858b0041dbSMauro Carvalho Chehab h->dev->name);
5868b0041dbSMauro Carvalho Chehab h->dev->stats.rx_dropped++;
5878b0041dbSMauro Carvalho Chehab return -1;
5888b0041dbSMauro Carvalho Chehab }
5898b0041dbSMauro Carvalho Chehab
5908b0041dbSMauro Carvalho Chehab /* This includes the CRC32 _and_ dest mac, if !dbit. */
5918b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_remain = h->priv->ule_sndu_len;
5928b0041dbSMauro Carvalho Chehab h->priv->ule_skb->dev = h->dev;
5938b0041dbSMauro Carvalho Chehab /*
5948b0041dbSMauro Carvalho Chehab * Leave space for Ethernet or bridged SNDU header
5958b0041dbSMauro Carvalho Chehab * (eth hdr plus one MAC addr).
5968b0041dbSMauro Carvalho Chehab */
5978b0041dbSMauro Carvalho Chehab skb_reserve(h->priv->ule_skb, ETH_HLEN + ETH_ALEN);
5988b0041dbSMauro Carvalho Chehab
5998b0041dbSMauro Carvalho Chehab return 0;
6008b0041dbSMauro Carvalho Chehab }
6018b0041dbSMauro Carvalho Chehab
6028b0041dbSMauro Carvalho Chehab
dvb_net_ule_should_drop(struct dvb_net_ule_handle * h)6038b0041dbSMauro Carvalho Chehab static int dvb_net_ule_should_drop(struct dvb_net_ule_handle *h)
6048b0041dbSMauro Carvalho Chehab {
6058b0041dbSMauro Carvalho Chehab static const u8 bc_addr[ETH_ALEN] = { [0 ... ETH_ALEN - 1] = 0xff };
6068b0041dbSMauro Carvalho Chehab
6078b0041dbSMauro Carvalho Chehab /*
6088b0041dbSMauro Carvalho Chehab * The destination MAC address is the next data in the skb. It comes
6098b0041dbSMauro Carvalho Chehab * before any extension headers.
6108b0041dbSMauro Carvalho Chehab *
6118b0041dbSMauro Carvalho Chehab * Check if the payload of this SNDU should be passed up the stack.
6128b0041dbSMauro Carvalho Chehab */
6138b0041dbSMauro Carvalho Chehab if (h->priv->rx_mode == RX_MODE_PROMISC)
6148b0041dbSMauro Carvalho Chehab return 0;
6158b0041dbSMauro Carvalho Chehab
6168b0041dbSMauro Carvalho Chehab if (h->priv->ule_skb->data[0] & 0x01) {
6178b0041dbSMauro Carvalho Chehab /* multicast or broadcast */
6188b0041dbSMauro Carvalho Chehab if (!ether_addr_equal(h->priv->ule_skb->data, bc_addr)) {
6198b0041dbSMauro Carvalho Chehab /* multicast */
6208b0041dbSMauro Carvalho Chehab if (h->priv->rx_mode == RX_MODE_MULTI) {
6218b0041dbSMauro Carvalho Chehab int i;
6228b0041dbSMauro Carvalho Chehab
6238b0041dbSMauro Carvalho Chehab for (i = 0; i < h->priv->multi_num &&
6248b0041dbSMauro Carvalho Chehab !ether_addr_equal(h->priv->ule_skb->data,
6258b0041dbSMauro Carvalho Chehab h->priv->multi_macs[i]);
6268b0041dbSMauro Carvalho Chehab i++)
6278b0041dbSMauro Carvalho Chehab ;
6288b0041dbSMauro Carvalho Chehab if (i == h->priv->multi_num)
6298b0041dbSMauro Carvalho Chehab return 1;
6308b0041dbSMauro Carvalho Chehab } else if (h->priv->rx_mode != RX_MODE_ALL_MULTI)
6318b0041dbSMauro Carvalho Chehab return 1; /* no broadcast; */
6328b0041dbSMauro Carvalho Chehab /*
6338b0041dbSMauro Carvalho Chehab * else:
6348b0041dbSMauro Carvalho Chehab * all multicast mode: accept all multicast packets
6358b0041dbSMauro Carvalho Chehab */
6368b0041dbSMauro Carvalho Chehab }
6378b0041dbSMauro Carvalho Chehab /* else: broadcast */
6388b0041dbSMauro Carvalho Chehab } else if (!ether_addr_equal(h->priv->ule_skb->data, h->dev->dev_addr))
6398b0041dbSMauro Carvalho Chehab return 1;
6408b0041dbSMauro Carvalho Chehab
6418b0041dbSMauro Carvalho Chehab return 0;
6428b0041dbSMauro Carvalho Chehab }
6438b0041dbSMauro Carvalho Chehab
6448b0041dbSMauro Carvalho Chehab
dvb_net_ule_check_crc(struct dvb_net_ule_handle * h,struct kvec iov[3],u32 ule_crc,u32 expected_crc)6458b0041dbSMauro Carvalho Chehab static void dvb_net_ule_check_crc(struct dvb_net_ule_handle *h,
646b93a25e1SMauro Carvalho Chehab struct kvec iov[3],
6478b0041dbSMauro Carvalho Chehab u32 ule_crc, u32 expected_crc)
6488b0041dbSMauro Carvalho Chehab {
6498b0041dbSMauro Carvalho Chehab u8 dest_addr[ETH_ALEN];
6508b0041dbSMauro Carvalho Chehab
6518b0041dbSMauro Carvalho Chehab if (ule_crc != expected_crc) {
6528b0041dbSMauro Carvalho Chehab pr_warn("%lu: CRC32 check FAILED: %08x / %08x, SNDU len %d type %#x, ts_remain %d, next 2: %x.\n",
6538b0041dbSMauro Carvalho Chehab h->priv->ts_count, ule_crc, expected_crc,
6548b0041dbSMauro Carvalho Chehab h->priv->ule_sndu_len, h->priv->ule_sndu_type,
6558b0041dbSMauro Carvalho Chehab h->ts_remain,
6568b0041dbSMauro Carvalho Chehab h->ts_remain > 2 ?
6578b0041dbSMauro Carvalho Chehab *(unsigned short *)h->from_where : 0);
6588b0041dbSMauro Carvalho Chehab
659ba711e1cSMauro Carvalho Chehab #ifdef DVB_ULE_DEBUG
6608b0041dbSMauro Carvalho Chehab hexdump(iov[0].iov_base, iov[0].iov_len);
6618b0041dbSMauro Carvalho Chehab hexdump(iov[1].iov_base, iov[1].iov_len);
6628b0041dbSMauro Carvalho Chehab hexdump(iov[2].iov_base, iov[2].iov_len);
6638b0041dbSMauro Carvalho Chehab
664b93a25e1SMauro Carvalho Chehab if (ule_where == ule_hist) {
665b93a25e1SMauro Carvalho Chehab hexdump(&ule_hist[98*TS_SZ], TS_SZ);
666b93a25e1SMauro Carvalho Chehab hexdump(&ule_hist[99*TS_SZ], TS_SZ);
667b93a25e1SMauro Carvalho Chehab } else if (ule_where == &ule_hist[TS_SZ]) {
668b93a25e1SMauro Carvalho Chehab hexdump(&ule_hist[99*TS_SZ], TS_SZ);
669b93a25e1SMauro Carvalho Chehab hexdump(ule_hist, TS_SZ);
6708b0041dbSMauro Carvalho Chehab } else {
671b93a25e1SMauro Carvalho Chehab hexdump(ule_where - TS_SZ - TS_SZ, TS_SZ);
672b93a25e1SMauro Carvalho Chehab hexdump(ule_where - TS_SZ, TS_SZ);
6738b0041dbSMauro Carvalho Chehab }
674b93a25e1SMauro Carvalho Chehab ule_dump = 1;
6758b0041dbSMauro Carvalho Chehab #endif
6768b0041dbSMauro Carvalho Chehab
6778b0041dbSMauro Carvalho Chehab h->dev->stats.rx_errors++;
6788b0041dbSMauro Carvalho Chehab h->dev->stats.rx_crc_errors++;
6798b0041dbSMauro Carvalho Chehab dev_kfree_skb(h->priv->ule_skb);
6808b0041dbSMauro Carvalho Chehab
6818b0041dbSMauro Carvalho Chehab return;
6828b0041dbSMauro Carvalho Chehab }
6838b0041dbSMauro Carvalho Chehab
6848b0041dbSMauro Carvalho Chehab /* CRC32 verified OK. */
6858b0041dbSMauro Carvalho Chehab
6868b0041dbSMauro Carvalho Chehab /* CRC32 was OK, so remove it from skb. */
6878b0041dbSMauro Carvalho Chehab h->priv->ule_skb->tail -= 4;
6888b0041dbSMauro Carvalho Chehab h->priv->ule_skb->len -= 4;
6898b0041dbSMauro Carvalho Chehab
6908b0041dbSMauro Carvalho Chehab if (!h->priv->ule_dbit) {
6918b0041dbSMauro Carvalho Chehab if (dvb_net_ule_should_drop(h)) {
6928b0041dbSMauro Carvalho Chehab netdev_dbg(h->dev,
6938b0041dbSMauro Carvalho Chehab "Dropping SNDU: MAC destination address does not match: dest addr: %pM, h->dev addr: %pM\n",
6948b0041dbSMauro Carvalho Chehab h->priv->ule_skb->data, h->dev->dev_addr);
6958b0041dbSMauro Carvalho Chehab dev_kfree_skb(h->priv->ule_skb);
6968b0041dbSMauro Carvalho Chehab return;
6978b0041dbSMauro Carvalho Chehab }
6988b0041dbSMauro Carvalho Chehab
6998b0041dbSMauro Carvalho Chehab skb_copy_from_linear_data(h->priv->ule_skb, dest_addr,
7008b0041dbSMauro Carvalho Chehab ETH_ALEN);
7018b0041dbSMauro Carvalho Chehab skb_pull(h->priv->ule_skb, ETH_ALEN);
7024dd19196SArnd Bergmann } else {
7034dd19196SArnd Bergmann /* dest_addr buffer is only valid if h->priv->ule_dbit == 0 */
7044dd19196SArnd Bergmann eth_zero_addr(dest_addr);
7058b0041dbSMauro Carvalho Chehab }
7068b0041dbSMauro Carvalho Chehab
7078b0041dbSMauro Carvalho Chehab /* Handle ULE Extension Headers. */
7088b0041dbSMauro Carvalho Chehab if (h->priv->ule_sndu_type < ETH_P_802_3_MIN) {
7098b0041dbSMauro Carvalho Chehab /* There is an extension header. Handle it accordingly. */
7108b0041dbSMauro Carvalho Chehab int l = handle_ule_extensions(h->priv);
7118b0041dbSMauro Carvalho Chehab
7128b0041dbSMauro Carvalho Chehab if (l < 0) {
7138b0041dbSMauro Carvalho Chehab /*
7148b0041dbSMauro Carvalho Chehab * Mandatory extension header unknown or TEST SNDU.
7158b0041dbSMauro Carvalho Chehab * Drop it.
7168b0041dbSMauro Carvalho Chehab */
7178b0041dbSMauro Carvalho Chehab
7188b0041dbSMauro Carvalho Chehab // pr_warn("Dropping SNDU, extension headers.\n" );
7198b0041dbSMauro Carvalho Chehab dev_kfree_skb(h->priv->ule_skb);
7208b0041dbSMauro Carvalho Chehab return;
7218b0041dbSMauro Carvalho Chehab }
7228b0041dbSMauro Carvalho Chehab skb_pull(h->priv->ule_skb, l);
7238b0041dbSMauro Carvalho Chehab }
7248b0041dbSMauro Carvalho Chehab
7258b0041dbSMauro Carvalho Chehab /*
7268b0041dbSMauro Carvalho Chehab * Construct/assure correct ethernet header.
7278b0041dbSMauro Carvalho Chehab * Note: in bridged mode (h->priv->ule_bridged != 0)
7288b0041dbSMauro Carvalho Chehab * we already have the (original) ethernet
7298b0041dbSMauro Carvalho Chehab * header at the start of the payload (after
7308b0041dbSMauro Carvalho Chehab * optional dest. address and any extension
7318b0041dbSMauro Carvalho Chehab * headers).
7328b0041dbSMauro Carvalho Chehab */
7338b0041dbSMauro Carvalho Chehab if (!h->priv->ule_bridged) {
7348b0041dbSMauro Carvalho Chehab skb_push(h->priv->ule_skb, ETH_HLEN);
7358b0041dbSMauro Carvalho Chehab h->ethh = (struct ethhdr *)h->priv->ule_skb->data;
7368b0041dbSMauro Carvalho Chehab memcpy(h->ethh->h_dest, dest_addr, ETH_ALEN);
7378b0041dbSMauro Carvalho Chehab eth_zero_addr(h->ethh->h_source);
7388b0041dbSMauro Carvalho Chehab h->ethh->h_proto = htons(h->priv->ule_sndu_type);
7398b0041dbSMauro Carvalho Chehab }
7408b0041dbSMauro Carvalho Chehab /* else: skb is in correct state; nothing to do. */
7418b0041dbSMauro Carvalho Chehab h->priv->ule_bridged = 0;
7428b0041dbSMauro Carvalho Chehab
7438b0041dbSMauro Carvalho Chehab /* Stuff into kernel's protocol stack. */
7448b0041dbSMauro Carvalho Chehab h->priv->ule_skb->protocol = dvb_net_eth_type_trans(h->priv->ule_skb,
7458b0041dbSMauro Carvalho Chehab h->dev);
7468b0041dbSMauro Carvalho Chehab /*
7478b0041dbSMauro Carvalho Chehab * If D-bit is set (i.e. destination MAC address not present),
7488b0041dbSMauro Carvalho Chehab * receive the packet anyhow.
7498b0041dbSMauro Carvalho Chehab */
7508b0041dbSMauro Carvalho Chehab #if 0
7518b0041dbSMauro Carvalho Chehab if (h->priv->ule_dbit && skb->pkt_type == PACKET_OTHERHOST)
7528b0041dbSMauro Carvalho Chehab h->priv->ule_skb->pkt_type = PACKET_HOST;
7538b0041dbSMauro Carvalho Chehab #endif
7548b0041dbSMauro Carvalho Chehab h->dev->stats.rx_packets++;
7558b0041dbSMauro Carvalho Chehab h->dev->stats.rx_bytes += h->priv->ule_skb->len;
7568b0041dbSMauro Carvalho Chehab netif_rx(h->priv->ule_skb);
7578b0041dbSMauro Carvalho Chehab }
7588b0041dbSMauro Carvalho Chehab
dvb_net_ule(struct net_device * dev,const u8 * buf,size_t buf_len)759efb9ab67SMauro Carvalho Chehab static void dvb_net_ule(struct net_device *dev, const u8 *buf, size_t buf_len)
760efb9ab67SMauro Carvalho Chehab {
7618b0041dbSMauro Carvalho Chehab int ret;
762efb9ab67SMauro Carvalho Chehab struct dvb_net_ule_handle h = {
763efb9ab67SMauro Carvalho Chehab .dev = dev,
764b93a25e1SMauro Carvalho Chehab .priv = netdev_priv(dev),
765b93a25e1SMauro Carvalho Chehab .ethh = NULL,
766efb9ab67SMauro Carvalho Chehab .buf = buf,
767efb9ab67SMauro Carvalho Chehab .buf_len = buf_len,
768efb9ab67SMauro Carvalho Chehab .skipped = 0L,
769efb9ab67SMauro Carvalho Chehab .ts = NULL,
770efb9ab67SMauro Carvalho Chehab .ts_end = NULL,
771efb9ab67SMauro Carvalho Chehab .from_where = NULL,
772efb9ab67SMauro Carvalho Chehab .ts_remain = 0,
773efb9ab67SMauro Carvalho Chehab .how_much = 0,
774efb9ab67SMauro Carvalho Chehab .new_ts = 1,
775efb9ab67SMauro Carvalho Chehab .error = false,
776efb9ab67SMauro Carvalho Chehab };
7773d6c2bc0SMauro Carvalho Chehab
7788b0041dbSMauro Carvalho Chehab /*
7798b0041dbSMauro Carvalho Chehab * For all TS cells in current buffer.
7803d6c2bc0SMauro Carvalho Chehab * Appearently, we are called for every single TS cell.
7813d6c2bc0SMauro Carvalho Chehab */
7828b0041dbSMauro Carvalho Chehab for (h.ts = h.buf, h.ts_end = h.buf + h.buf_len;
7838b0041dbSMauro Carvalho Chehab h.ts < h.ts_end; /* no incr. */) {
784efb9ab67SMauro Carvalho Chehab if (h.new_ts) {
7853d6c2bc0SMauro Carvalho Chehab /* We are about to process a new TS cell. */
7868b0041dbSMauro Carvalho Chehab if (dvb_net_ule_new_ts_cell(&h))
7873d6c2bc0SMauro Carvalho Chehab continue;
7883d6c2bc0SMauro Carvalho Chehab }
7893d6c2bc0SMauro Carvalho Chehab
7903d6c2bc0SMauro Carvalho Chehab /* Synchronize on PUSI, if required. */
791efb9ab67SMauro Carvalho Chehab if (h.priv->need_pusi) {
7928b0041dbSMauro Carvalho Chehab if (dvb_net_ule_ts_pusi(&h))
7933d6c2bc0SMauro Carvalho Chehab continue;
7943d6c2bc0SMauro Carvalho Chehab }
7953d6c2bc0SMauro Carvalho Chehab
796efb9ab67SMauro Carvalho Chehab if (h.new_ts) {
7978b0041dbSMauro Carvalho Chehab if (dvb_net_ule_new_ts(&h))
7983d6c2bc0SMauro Carvalho Chehab continue;
7993d6c2bc0SMauro Carvalho Chehab }
8003d6c2bc0SMauro Carvalho Chehab
8013d6c2bc0SMauro Carvalho Chehab /* Check if new payload needs to be started. */
802efb9ab67SMauro Carvalho Chehab if (h.priv->ule_skb == NULL) {
8038b0041dbSMauro Carvalho Chehab ret = dvb_net_ule_new_payload(&h);
8048b0041dbSMauro Carvalho Chehab if (ret < 0)
8053d6c2bc0SMauro Carvalho Chehab return;
8068b0041dbSMauro Carvalho Chehab if (ret)
8078b0041dbSMauro Carvalho Chehab continue;
8083d6c2bc0SMauro Carvalho Chehab }
8093d6c2bc0SMauro Carvalho Chehab
8103d6c2bc0SMauro Carvalho Chehab /* Copy data into our current skb. */
811efb9ab67SMauro Carvalho Chehab h.how_much = min(h.priv->ule_sndu_remain, (int)h.ts_remain);
81259ae1d12SJohannes Berg skb_put_data(h.priv->ule_skb, h.from_where, h.how_much);
813efb9ab67SMauro Carvalho Chehab h.priv->ule_sndu_remain -= h.how_much;
814efb9ab67SMauro Carvalho Chehab h.ts_remain -= h.how_much;
815efb9ab67SMauro Carvalho Chehab h.from_where += h.how_much;
8163d6c2bc0SMauro Carvalho Chehab
8173d6c2bc0SMauro Carvalho Chehab /* Check for complete payload. */
818efb9ab67SMauro Carvalho Chehab if (h.priv->ule_sndu_remain <= 0) {
8193d6c2bc0SMauro Carvalho Chehab /* Check CRC32, we've got it in our skb already. */
820efb9ab67SMauro Carvalho Chehab __be16 ulen = htons(h.priv->ule_sndu_len);
821efb9ab67SMauro Carvalho Chehab __be16 utype = htons(h.priv->ule_sndu_type);
8223d6c2bc0SMauro Carvalho Chehab const u8 *tail;
8233d6c2bc0SMauro Carvalho Chehab struct kvec iov[3] = {
8243d6c2bc0SMauro Carvalho Chehab { &ulen, sizeof ulen },
8253d6c2bc0SMauro Carvalho Chehab { &utype, sizeof utype },
8268b0041dbSMauro Carvalho Chehab { h.priv->ule_skb->data,
8278b0041dbSMauro Carvalho Chehab h.priv->ule_skb->len - 4 }
8283d6c2bc0SMauro Carvalho Chehab };
8293d6c2bc0SMauro Carvalho Chehab u32 ule_crc = ~0L, expected_crc;
830efb9ab67SMauro Carvalho Chehab if (h.priv->ule_dbit) {
8313d6c2bc0SMauro Carvalho Chehab /* Set D-bit for CRC32 verification,
8323d6c2bc0SMauro Carvalho Chehab * if it was set originally. */
8333d6c2bc0SMauro Carvalho Chehab ulen |= htons(0x8000);
8343d6c2bc0SMauro Carvalho Chehab }
8353d6c2bc0SMauro Carvalho Chehab
8363d6c2bc0SMauro Carvalho Chehab ule_crc = iov_crc32(ule_crc, iov, 3);
837efb9ab67SMauro Carvalho Chehab tail = skb_tail_pointer(h.priv->ule_skb);
8383d6c2bc0SMauro Carvalho Chehab expected_crc = *(tail - 4) << 24 |
8393d6c2bc0SMauro Carvalho Chehab *(tail - 3) << 16 |
8403d6c2bc0SMauro Carvalho Chehab *(tail - 2) << 8 |
8413d6c2bc0SMauro Carvalho Chehab *(tail - 1);
8423d6c2bc0SMauro Carvalho Chehab
843b93a25e1SMauro Carvalho Chehab dvb_net_ule_check_crc(&h, iov, ule_crc, expected_crc);
8443d6c2bc0SMauro Carvalho Chehab
8453d6c2bc0SMauro Carvalho Chehab /* Prepare for next SNDU. */
846efb9ab67SMauro Carvalho Chehab reset_ule(h.priv);
8473d6c2bc0SMauro Carvalho Chehab }
8483d6c2bc0SMauro Carvalho Chehab
8493d6c2bc0SMauro Carvalho Chehab /* More data in current TS (look at the bytes following the CRC32)? */
850efb9ab67SMauro Carvalho Chehab if (h.ts_remain >= 2 && *((unsigned short *)h.from_where) != 0xFFFF) {
8513d6c2bc0SMauro Carvalho Chehab /* Next ULE SNDU starts right there. */
852efb9ab67SMauro Carvalho Chehab h.new_ts = 0;
853efb9ab67SMauro Carvalho Chehab h.priv->ule_skb = NULL;
854efb9ab67SMauro Carvalho Chehab h.priv->ule_sndu_type_1 = 0;
855efb9ab67SMauro Carvalho Chehab h.priv->ule_sndu_len = 0;
856b3ad24d2SMauro Carvalho Chehab // pr_warn("More data in current TS: [%#x %#x %#x %#x]\n",
857efb9ab67SMauro Carvalho Chehab // *(h.from_where + 0), *(h.from_where + 1),
858efb9ab67SMauro Carvalho Chehab // *(h.from_where + 2), *(h.from_where + 3));
859efb9ab67SMauro Carvalho Chehab // pr_warn("h.ts @ %p, stopped @ %p:\n", h.ts, h.from_where + 0);
860efb9ab67SMauro Carvalho Chehab // hexdump(h.ts, 188);
8613d6c2bc0SMauro Carvalho Chehab } else {
862efb9ab67SMauro Carvalho Chehab h.new_ts = 1;
863efb9ab67SMauro Carvalho Chehab h.ts += TS_SZ;
864efb9ab67SMauro Carvalho Chehab h.priv->ts_count++;
865efb9ab67SMauro Carvalho Chehab if (h.priv->ule_skb == NULL) {
866efb9ab67SMauro Carvalho Chehab h.priv->need_pusi = 1;
867efb9ab67SMauro Carvalho Chehab h.priv->ule_sndu_type_1 = 0;
868efb9ab67SMauro Carvalho Chehab h.priv->ule_sndu_len = 0;
8693d6c2bc0SMauro Carvalho Chehab }
8703d6c2bc0SMauro Carvalho Chehab }
8713d6c2bc0SMauro Carvalho Chehab } /* for all available TS cells */
8723d6c2bc0SMauro Carvalho Chehab }
8733d6c2bc0SMauro Carvalho Chehab
dvb_net_ts_callback(const u8 * buffer1,size_t buffer1_len,const u8 * buffer2,size_t buffer2_len,struct dmx_ts_feed * feed,u32 * buffer_flags)8743d6c2bc0SMauro Carvalho Chehab static int dvb_net_ts_callback(const u8 *buffer1, size_t buffer1_len,
8753d6c2bc0SMauro Carvalho Chehab const u8 *buffer2, size_t buffer2_len,
876fdbeb962SMauro Carvalho Chehab struct dmx_ts_feed *feed,
877fdbeb962SMauro Carvalho Chehab u32 *buffer_flags)
8783d6c2bc0SMauro Carvalho Chehab {
8793d6c2bc0SMauro Carvalho Chehab struct net_device *dev = feed->priv;
8803d6c2bc0SMauro Carvalho Chehab
8813d6c2bc0SMauro Carvalho Chehab if (buffer2)
882b3ad24d2SMauro Carvalho Chehab pr_warn("buffer2 not NULL: %p.\n", buffer2);
8833d6c2bc0SMauro Carvalho Chehab if (buffer1_len > 32768)
884b3ad24d2SMauro Carvalho Chehab pr_warn("length > 32k: %zu.\n", buffer1_len);
885b3ad24d2SMauro Carvalho Chehab /* pr_info("TS callback: %u bytes, %u TS cells @ %p.\n",
8863d6c2bc0SMauro Carvalho Chehab buffer1_len, buffer1_len / TS_SZ, buffer1); */
8873d6c2bc0SMauro Carvalho Chehab dvb_net_ule(dev, buffer1, buffer1_len);
8883d6c2bc0SMauro Carvalho Chehab return 0;
8893d6c2bc0SMauro Carvalho Chehab }
8903d6c2bc0SMauro Carvalho Chehab
8913d6c2bc0SMauro Carvalho Chehab
dvb_net_sec(struct net_device * dev,const u8 * pkt,int pkt_len)8923d6c2bc0SMauro Carvalho Chehab static void dvb_net_sec(struct net_device *dev,
8933d6c2bc0SMauro Carvalho Chehab const u8 *pkt, int pkt_len)
8943d6c2bc0SMauro Carvalho Chehab {
8953d6c2bc0SMauro Carvalho Chehab u8 *eth;
8963d6c2bc0SMauro Carvalho Chehab struct sk_buff *skb;
8973d6c2bc0SMauro Carvalho Chehab struct net_device_stats *stats = &dev->stats;
8983d6c2bc0SMauro Carvalho Chehab int snap = 0;
8993d6c2bc0SMauro Carvalho Chehab
9003d6c2bc0SMauro Carvalho Chehab /* note: pkt_len includes a 32bit checksum */
9013d6c2bc0SMauro Carvalho Chehab if (pkt_len < 16) {
902b3ad24d2SMauro Carvalho Chehab pr_warn("%s: IP/MPE packet length = %d too small.\n",
9033d6c2bc0SMauro Carvalho Chehab dev->name, pkt_len);
9043d6c2bc0SMauro Carvalho Chehab stats->rx_errors++;
9053d6c2bc0SMauro Carvalho Chehab stats->rx_length_errors++;
9063d6c2bc0SMauro Carvalho Chehab return;
9073d6c2bc0SMauro Carvalho Chehab }
9083d6c2bc0SMauro Carvalho Chehab /* it seems some ISPs manage to screw up here, so we have to
9093d6c2bc0SMauro Carvalho Chehab * relax the error checks... */
9103d6c2bc0SMauro Carvalho Chehab #if 0
9113d6c2bc0SMauro Carvalho Chehab if ((pkt[5] & 0xfd) != 0xc1) {
9123d6c2bc0SMauro Carvalho Chehab /* drop scrambled or broken packets */
9133d6c2bc0SMauro Carvalho Chehab #else
9143d6c2bc0SMauro Carvalho Chehab if ((pkt[5] & 0x3c) != 0x00) {
9153d6c2bc0SMauro Carvalho Chehab /* drop scrambled */
9163d6c2bc0SMauro Carvalho Chehab #endif
9173d6c2bc0SMauro Carvalho Chehab stats->rx_errors++;
9183d6c2bc0SMauro Carvalho Chehab stats->rx_crc_errors++;
9193d6c2bc0SMauro Carvalho Chehab return;
9203d6c2bc0SMauro Carvalho Chehab }
9213d6c2bc0SMauro Carvalho Chehab if (pkt[5] & 0x02) {
9223d6c2bc0SMauro Carvalho Chehab /* handle LLC/SNAP, see rfc-1042 */
9233d6c2bc0SMauro Carvalho Chehab if (pkt_len < 24 || memcmp(&pkt[12], "\xaa\xaa\x03\0\0\0", 6)) {
9243d6c2bc0SMauro Carvalho Chehab stats->rx_dropped++;
9253d6c2bc0SMauro Carvalho Chehab return;
9263d6c2bc0SMauro Carvalho Chehab }
9273d6c2bc0SMauro Carvalho Chehab snap = 8;
9283d6c2bc0SMauro Carvalho Chehab }
9293d6c2bc0SMauro Carvalho Chehab if (pkt[7]) {
9303d6c2bc0SMauro Carvalho Chehab /* FIXME: assemble datagram from multiple sections */
9313d6c2bc0SMauro Carvalho Chehab stats->rx_errors++;
9323d6c2bc0SMauro Carvalho Chehab stats->rx_frame_errors++;
9333d6c2bc0SMauro Carvalho Chehab return;
9343d6c2bc0SMauro Carvalho Chehab }
9353d6c2bc0SMauro Carvalho Chehab
9363d6c2bc0SMauro Carvalho Chehab /* we have 14 byte ethernet header (ip header follows);
9373d6c2bc0SMauro Carvalho Chehab * 12 byte MPE header; 4 byte checksum; + 2 byte alignment, 8 byte LLC/SNAP
9383d6c2bc0SMauro Carvalho Chehab */
9393d6c2bc0SMauro Carvalho Chehab if (!(skb = dev_alloc_skb(pkt_len - 4 - 12 + 14 + 2 - snap))) {
940b3ad24d2SMauro Carvalho Chehab //pr_notice("%s: Memory squeeze, dropping packet.\n", dev->name);
9413d6c2bc0SMauro Carvalho Chehab stats->rx_dropped++;
9423d6c2bc0SMauro Carvalho Chehab return;
9433d6c2bc0SMauro Carvalho Chehab }
9443d6c2bc0SMauro Carvalho Chehab skb_reserve(skb, 2); /* longword align L3 header */
9453d6c2bc0SMauro Carvalho Chehab skb->dev = dev;
9463d6c2bc0SMauro Carvalho Chehab
9473d6c2bc0SMauro Carvalho Chehab /* copy L3 payload */
9484df864c1SJohannes Berg eth = skb_put(skb, pkt_len - 12 - 4 + 14 - snap);
9493d6c2bc0SMauro Carvalho Chehab memcpy(eth + 14, pkt + 12 + snap, pkt_len - 12 - 4 - snap);
9503d6c2bc0SMauro Carvalho Chehab
9513d6c2bc0SMauro Carvalho Chehab /* create ethernet header: */
9523d6c2bc0SMauro Carvalho Chehab eth[0]=pkt[0x0b];
9533d6c2bc0SMauro Carvalho Chehab eth[1]=pkt[0x0a];
9543d6c2bc0SMauro Carvalho Chehab eth[2]=pkt[0x09];
9553d6c2bc0SMauro Carvalho Chehab eth[3]=pkt[0x08];
9563d6c2bc0SMauro Carvalho Chehab eth[4]=pkt[0x04];
9573d6c2bc0SMauro Carvalho Chehab eth[5]=pkt[0x03];
9583d6c2bc0SMauro Carvalho Chehab
9593d6c2bc0SMauro Carvalho Chehab eth[6]=eth[7]=eth[8]=eth[9]=eth[10]=eth[11]=0;
9603d6c2bc0SMauro Carvalho Chehab
9613d6c2bc0SMauro Carvalho Chehab if (snap) {
9623d6c2bc0SMauro Carvalho Chehab eth[12] = pkt[18];
9633d6c2bc0SMauro Carvalho Chehab eth[13] = pkt[19];
9643d6c2bc0SMauro Carvalho Chehab } else {
9653d6c2bc0SMauro Carvalho Chehab /* protocol numbers are from rfc-1700 or
9663d6c2bc0SMauro Carvalho Chehab * http://www.iana.org/assignments/ethernet-numbers
9673d6c2bc0SMauro Carvalho Chehab */
9683d6c2bc0SMauro Carvalho Chehab if (pkt[12] >> 4 == 6) { /* version field from IP header */
9693d6c2bc0SMauro Carvalho Chehab eth[12] = 0x86; /* IPv6 */
9703d6c2bc0SMauro Carvalho Chehab eth[13] = 0xdd;
9713d6c2bc0SMauro Carvalho Chehab } else {
9723d6c2bc0SMauro Carvalho Chehab eth[12] = 0x08; /* IPv4 */
9733d6c2bc0SMauro Carvalho Chehab eth[13] = 0x00;
9743d6c2bc0SMauro Carvalho Chehab }
9753d6c2bc0SMauro Carvalho Chehab }
9763d6c2bc0SMauro Carvalho Chehab
9773d6c2bc0SMauro Carvalho Chehab skb->protocol = dvb_net_eth_type_trans(skb, dev);
9783d6c2bc0SMauro Carvalho Chehab
9793d6c2bc0SMauro Carvalho Chehab stats->rx_packets++;
9803d6c2bc0SMauro Carvalho Chehab stats->rx_bytes+=skb->len;
9813d6c2bc0SMauro Carvalho Chehab netif_rx(skb);
9823d6c2bc0SMauro Carvalho Chehab }
9833d6c2bc0SMauro Carvalho Chehab
9843d6c2bc0SMauro Carvalho Chehab static int dvb_net_sec_callback(const u8 *buffer1, size_t buffer1_len,
9853d6c2bc0SMauro Carvalho Chehab const u8 *buffer2, size_t buffer2_len,
986fdbeb962SMauro Carvalho Chehab struct dmx_section_filter *filter, u32 *buffer_flags)
9873d6c2bc0SMauro Carvalho Chehab {
9883d6c2bc0SMauro Carvalho Chehab struct net_device *dev = filter->priv;
9893d6c2bc0SMauro Carvalho Chehab
990461afb27SMauro Carvalho Chehab /*
9913d6c2bc0SMauro Carvalho Chehab * we rely on the DVB API definition where exactly one complete
9923d6c2bc0SMauro Carvalho Chehab * section is delivered in buffer1
9933d6c2bc0SMauro Carvalho Chehab */
9943d6c2bc0SMauro Carvalho Chehab dvb_net_sec (dev, buffer1, buffer1_len);
9953d6c2bc0SMauro Carvalho Chehab return 0;
9963d6c2bc0SMauro Carvalho Chehab }
9973d6c2bc0SMauro Carvalho Chehab
998245c189dSLuc Van Oostenryck static netdev_tx_t dvb_net_tx(struct sk_buff *skb, struct net_device *dev)
9993d6c2bc0SMauro Carvalho Chehab {
10003d6c2bc0SMauro Carvalho Chehab dev_kfree_skb(skb);
10013d6c2bc0SMauro Carvalho Chehab return NETDEV_TX_OK;
10023d6c2bc0SMauro Carvalho Chehab }
10033d6c2bc0SMauro Carvalho Chehab
10043d6c2bc0SMauro Carvalho Chehab static u8 mask_normal[6]={0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
10053d6c2bc0SMauro Carvalho Chehab static u8 mask_allmulti[6]={0xff, 0xff, 0xff, 0x00, 0x00, 0x00};
10063d6c2bc0SMauro Carvalho Chehab static u8 mac_allmulti[6]={0x01, 0x00, 0x5e, 0x00, 0x00, 0x00};
10073d6c2bc0SMauro Carvalho Chehab static u8 mask_promisc[6]={0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
10083d6c2bc0SMauro Carvalho Chehab
10093d6c2bc0SMauro Carvalho Chehab static int dvb_net_filter_sec_set(struct net_device *dev,
10103d6c2bc0SMauro Carvalho Chehab struct dmx_section_filter **secfilter,
1011707182e4SJakub Kicinski const u8 *mac, u8 *mac_mask)
10123d6c2bc0SMauro Carvalho Chehab {
10133d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv = netdev_priv(dev);
10143d6c2bc0SMauro Carvalho Chehab int ret;
10153d6c2bc0SMauro Carvalho Chehab
10163d6c2bc0SMauro Carvalho Chehab *secfilter=NULL;
10173d6c2bc0SMauro Carvalho Chehab ret = priv->secfeed->allocate_filter(priv->secfeed, secfilter);
10183d6c2bc0SMauro Carvalho Chehab if (ret<0) {
1019b3ad24d2SMauro Carvalho Chehab pr_err("%s: could not get filter\n", dev->name);
10203d6c2bc0SMauro Carvalho Chehab return ret;
10213d6c2bc0SMauro Carvalho Chehab }
10223d6c2bc0SMauro Carvalho Chehab
10233d6c2bc0SMauro Carvalho Chehab (*secfilter)->priv=(void *) dev;
10243d6c2bc0SMauro Carvalho Chehab
10253d6c2bc0SMauro Carvalho Chehab memset((*secfilter)->filter_value, 0x00, DMX_MAX_FILTER_SIZE);
10263d6c2bc0SMauro Carvalho Chehab memset((*secfilter)->filter_mask, 0x00, DMX_MAX_FILTER_SIZE);
10273d6c2bc0SMauro Carvalho Chehab memset((*secfilter)->filter_mode, 0xff, DMX_MAX_FILTER_SIZE);
10283d6c2bc0SMauro Carvalho Chehab
10293d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_value[0]=0x3e;
10303d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_value[3]=mac[5];
10313d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_value[4]=mac[4];
10323d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_value[8]=mac[3];
10333d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_value[9]=mac[2];
10343d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_value[10]=mac[1];
10353d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_value[11]=mac[0];
10363d6c2bc0SMauro Carvalho Chehab
10373d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_mask[0] = 0xff;
10383d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_mask[3] = mac_mask[5];
10393d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_mask[4] = mac_mask[4];
10403d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_mask[8] = mac_mask[3];
10413d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_mask[9] = mac_mask[2];
10423d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_mask[10] = mac_mask[1];
10433d6c2bc0SMauro Carvalho Chehab (*secfilter)->filter_mask[11]=mac_mask[0];
10443d6c2bc0SMauro Carvalho Chehab
10455c7c0ca0SJoe Perches netdev_dbg(dev, "filter mac=%pM mask=%pM\n", mac, mac_mask);
10463d6c2bc0SMauro Carvalho Chehab
10473d6c2bc0SMauro Carvalho Chehab return 0;
10483d6c2bc0SMauro Carvalho Chehab }
10493d6c2bc0SMauro Carvalho Chehab
10503d6c2bc0SMauro Carvalho Chehab static int dvb_net_feed_start(struct net_device *dev)
10513d6c2bc0SMauro Carvalho Chehab {
10523d6c2bc0SMauro Carvalho Chehab int ret = 0, i;
10533d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv = netdev_priv(dev);
10543d6c2bc0SMauro Carvalho Chehab struct dmx_demux *demux = priv->demux;
1055707182e4SJakub Kicinski const unsigned char *mac = (const unsigned char *) dev->dev_addr;
10563d6c2bc0SMauro Carvalho Chehab
10575c7c0ca0SJoe Perches netdev_dbg(dev, "rx_mode %i\n", priv->rx_mode);
10583d6c2bc0SMauro Carvalho Chehab mutex_lock(&priv->mutex);
10593d6c2bc0SMauro Carvalho Chehab if (priv->tsfeed || priv->secfeed || priv->secfilter || priv->multi_secfilter[0])
1060b3ad24d2SMauro Carvalho Chehab pr_err("%s: BUG %d\n", __func__, __LINE__);
10613d6c2bc0SMauro Carvalho Chehab
10623d6c2bc0SMauro Carvalho Chehab priv->secfeed=NULL;
10633d6c2bc0SMauro Carvalho Chehab priv->secfilter=NULL;
10643d6c2bc0SMauro Carvalho Chehab priv->tsfeed = NULL;
10653d6c2bc0SMauro Carvalho Chehab
10663d6c2bc0SMauro Carvalho Chehab if (priv->feedtype == DVB_NET_FEEDTYPE_MPE) {
10675c7c0ca0SJoe Perches netdev_dbg(dev, "alloc secfeed\n");
10683d6c2bc0SMauro Carvalho Chehab ret=demux->allocate_section_feed(demux, &priv->secfeed,
10693d6c2bc0SMauro Carvalho Chehab dvb_net_sec_callback);
10703d6c2bc0SMauro Carvalho Chehab if (ret<0) {
1071b3ad24d2SMauro Carvalho Chehab pr_err("%s: could not allocate section feed\n",
1072b3ad24d2SMauro Carvalho Chehab dev->name);
10733d6c2bc0SMauro Carvalho Chehab goto error;
10743d6c2bc0SMauro Carvalho Chehab }
10753d6c2bc0SMauro Carvalho Chehab
1076dd79d27eSMauro Carvalho Chehab ret = priv->secfeed->set(priv->secfeed, priv->pid, 1);
10773d6c2bc0SMauro Carvalho Chehab
10783d6c2bc0SMauro Carvalho Chehab if (ret<0) {
1079b3ad24d2SMauro Carvalho Chehab pr_err("%s: could not set section feed\n", dev->name);
10803d6c2bc0SMauro Carvalho Chehab priv->demux->release_section_feed(priv->demux, priv->secfeed);
10813d6c2bc0SMauro Carvalho Chehab priv->secfeed=NULL;
10823d6c2bc0SMauro Carvalho Chehab goto error;
10833d6c2bc0SMauro Carvalho Chehab }
10843d6c2bc0SMauro Carvalho Chehab
10853d6c2bc0SMauro Carvalho Chehab if (priv->rx_mode != RX_MODE_PROMISC) {
10865c7c0ca0SJoe Perches netdev_dbg(dev, "set secfilter\n");
10873d6c2bc0SMauro Carvalho Chehab dvb_net_filter_sec_set(dev, &priv->secfilter, mac, mask_normal);
10883d6c2bc0SMauro Carvalho Chehab }
10893d6c2bc0SMauro Carvalho Chehab
10903d6c2bc0SMauro Carvalho Chehab switch (priv->rx_mode) {
10913d6c2bc0SMauro Carvalho Chehab case RX_MODE_MULTI:
10923d6c2bc0SMauro Carvalho Chehab for (i = 0; i < priv->multi_num; i++) {
10935c7c0ca0SJoe Perches netdev_dbg(dev, "set multi_secfilter[%d]\n", i);
10943d6c2bc0SMauro Carvalho Chehab dvb_net_filter_sec_set(dev, &priv->multi_secfilter[i],
10953d6c2bc0SMauro Carvalho Chehab priv->multi_macs[i], mask_normal);
10963d6c2bc0SMauro Carvalho Chehab }
10973d6c2bc0SMauro Carvalho Chehab break;
10983d6c2bc0SMauro Carvalho Chehab case RX_MODE_ALL_MULTI:
10993d6c2bc0SMauro Carvalho Chehab priv->multi_num=1;
11005c7c0ca0SJoe Perches netdev_dbg(dev, "set multi_secfilter[0]\n");
11013d6c2bc0SMauro Carvalho Chehab dvb_net_filter_sec_set(dev, &priv->multi_secfilter[0],
11023d6c2bc0SMauro Carvalho Chehab mac_allmulti, mask_allmulti);
11033d6c2bc0SMauro Carvalho Chehab break;
11043d6c2bc0SMauro Carvalho Chehab case RX_MODE_PROMISC:
11053d6c2bc0SMauro Carvalho Chehab priv->multi_num=0;
11065c7c0ca0SJoe Perches netdev_dbg(dev, "set secfilter\n");
11073d6c2bc0SMauro Carvalho Chehab dvb_net_filter_sec_set(dev, &priv->secfilter, mac, mask_promisc);
11083d6c2bc0SMauro Carvalho Chehab break;
11093d6c2bc0SMauro Carvalho Chehab }
11103d6c2bc0SMauro Carvalho Chehab
11115c7c0ca0SJoe Perches netdev_dbg(dev, "start filtering\n");
11123d6c2bc0SMauro Carvalho Chehab priv->secfeed->start_filtering(priv->secfeed);
11133d6c2bc0SMauro Carvalho Chehab } else if (priv->feedtype == DVB_NET_FEEDTYPE_ULE) {
1114e95be158SArnd Bergmann ktime_t timeout = ns_to_ktime(10 * NSEC_PER_MSEC);
11153d6c2bc0SMauro Carvalho Chehab
11163d6c2bc0SMauro Carvalho Chehab /* we have payloads encapsulated in TS */
11175c7c0ca0SJoe Perches netdev_dbg(dev, "alloc tsfeed\n");
11183d6c2bc0SMauro Carvalho Chehab ret = demux->allocate_ts_feed(demux, &priv->tsfeed, dvb_net_ts_callback);
11193d6c2bc0SMauro Carvalho Chehab if (ret < 0) {
1120b3ad24d2SMauro Carvalho Chehab pr_err("%s: could not allocate ts feed\n", dev->name);
11213d6c2bc0SMauro Carvalho Chehab goto error;
11223d6c2bc0SMauro Carvalho Chehab }
11233d6c2bc0SMauro Carvalho Chehab
11243d6c2bc0SMauro Carvalho Chehab /* Set netdevice pointer for ts decaps callback. */
11253d6c2bc0SMauro Carvalho Chehab priv->tsfeed->priv = (void *)dev;
11263d6c2bc0SMauro Carvalho Chehab ret = priv->tsfeed->set(priv->tsfeed,
11273d6c2bc0SMauro Carvalho Chehab priv->pid, /* pid */
11283d6c2bc0SMauro Carvalho Chehab TS_PACKET, /* type */
1129fde04ab9SMauro Carvalho Chehab DMX_PES_OTHER, /* pes type */
11303d6c2bc0SMauro Carvalho Chehab timeout /* timeout */
11313d6c2bc0SMauro Carvalho Chehab );
11323d6c2bc0SMauro Carvalho Chehab
11333d6c2bc0SMauro Carvalho Chehab if (ret < 0) {
1134b3ad24d2SMauro Carvalho Chehab pr_err("%s: could not set ts feed\n", dev->name);
11353d6c2bc0SMauro Carvalho Chehab priv->demux->release_ts_feed(priv->demux, priv->tsfeed);
11363d6c2bc0SMauro Carvalho Chehab priv->tsfeed = NULL;
11373d6c2bc0SMauro Carvalho Chehab goto error;
11383d6c2bc0SMauro Carvalho Chehab }
11393d6c2bc0SMauro Carvalho Chehab
11405c7c0ca0SJoe Perches netdev_dbg(dev, "start filtering\n");
11413d6c2bc0SMauro Carvalho Chehab priv->tsfeed->start_filtering(priv->tsfeed);
11423d6c2bc0SMauro Carvalho Chehab } else
11433d6c2bc0SMauro Carvalho Chehab ret = -EINVAL;
11443d6c2bc0SMauro Carvalho Chehab
11453d6c2bc0SMauro Carvalho Chehab error:
11463d6c2bc0SMauro Carvalho Chehab mutex_unlock(&priv->mutex);
11473d6c2bc0SMauro Carvalho Chehab return ret;
11483d6c2bc0SMauro Carvalho Chehab }
11493d6c2bc0SMauro Carvalho Chehab
11503d6c2bc0SMauro Carvalho Chehab static int dvb_net_feed_stop(struct net_device *dev)
11513d6c2bc0SMauro Carvalho Chehab {
11523d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv = netdev_priv(dev);
11533d6c2bc0SMauro Carvalho Chehab int i, ret = 0;
11543d6c2bc0SMauro Carvalho Chehab
11553d6c2bc0SMauro Carvalho Chehab mutex_lock(&priv->mutex);
11563d6c2bc0SMauro Carvalho Chehab if (priv->feedtype == DVB_NET_FEEDTYPE_MPE) {
11573d6c2bc0SMauro Carvalho Chehab if (priv->secfeed) {
11583d6c2bc0SMauro Carvalho Chehab if (priv->secfeed->is_filtering) {
11595c7c0ca0SJoe Perches netdev_dbg(dev, "stop secfeed\n");
11603d6c2bc0SMauro Carvalho Chehab priv->secfeed->stop_filtering(priv->secfeed);
11613d6c2bc0SMauro Carvalho Chehab }
11623d6c2bc0SMauro Carvalho Chehab
11633d6c2bc0SMauro Carvalho Chehab if (priv->secfilter) {
11645c7c0ca0SJoe Perches netdev_dbg(dev, "release secfilter\n");
11653d6c2bc0SMauro Carvalho Chehab priv->secfeed->release_filter(priv->secfeed,
11663d6c2bc0SMauro Carvalho Chehab priv->secfilter);
11673d6c2bc0SMauro Carvalho Chehab priv->secfilter=NULL;
11683d6c2bc0SMauro Carvalho Chehab }
11693d6c2bc0SMauro Carvalho Chehab
11703d6c2bc0SMauro Carvalho Chehab for (i=0; i<priv->multi_num; i++) {
11713d6c2bc0SMauro Carvalho Chehab if (priv->multi_secfilter[i]) {
11725c7c0ca0SJoe Perches netdev_dbg(dev, "release multi_filter[%d]\n",
11735c7c0ca0SJoe Perches i);
11743d6c2bc0SMauro Carvalho Chehab priv->secfeed->release_filter(priv->secfeed,
11753d6c2bc0SMauro Carvalho Chehab priv->multi_secfilter[i]);
11763d6c2bc0SMauro Carvalho Chehab priv->multi_secfilter[i] = NULL;
11773d6c2bc0SMauro Carvalho Chehab }
11783d6c2bc0SMauro Carvalho Chehab }
11793d6c2bc0SMauro Carvalho Chehab
11803d6c2bc0SMauro Carvalho Chehab priv->demux->release_section_feed(priv->demux, priv->secfeed);
11813d6c2bc0SMauro Carvalho Chehab priv->secfeed = NULL;
11823d6c2bc0SMauro Carvalho Chehab } else
1183b3ad24d2SMauro Carvalho Chehab pr_err("%s: no feed to stop\n", dev->name);
11843d6c2bc0SMauro Carvalho Chehab } else if (priv->feedtype == DVB_NET_FEEDTYPE_ULE) {
11853d6c2bc0SMauro Carvalho Chehab if (priv->tsfeed) {
11863d6c2bc0SMauro Carvalho Chehab if (priv->tsfeed->is_filtering) {
11875c7c0ca0SJoe Perches netdev_dbg(dev, "stop tsfeed\n");
11883d6c2bc0SMauro Carvalho Chehab priv->tsfeed->stop_filtering(priv->tsfeed);
11893d6c2bc0SMauro Carvalho Chehab }
11903d6c2bc0SMauro Carvalho Chehab priv->demux->release_ts_feed(priv->demux, priv->tsfeed);
11913d6c2bc0SMauro Carvalho Chehab priv->tsfeed = NULL;
11923d6c2bc0SMauro Carvalho Chehab }
11933d6c2bc0SMauro Carvalho Chehab else
1194b3ad24d2SMauro Carvalho Chehab pr_err("%s: no ts feed to stop\n", dev->name);
11953d6c2bc0SMauro Carvalho Chehab } else
11963d6c2bc0SMauro Carvalho Chehab ret = -EINVAL;
11973d6c2bc0SMauro Carvalho Chehab mutex_unlock(&priv->mutex);
11983d6c2bc0SMauro Carvalho Chehab return ret;
11993d6c2bc0SMauro Carvalho Chehab }
12003d6c2bc0SMauro Carvalho Chehab
12013d6c2bc0SMauro Carvalho Chehab
12023d6c2bc0SMauro Carvalho Chehab static int dvb_set_mc_filter(struct net_device *dev, unsigned char *addr)
12033d6c2bc0SMauro Carvalho Chehab {
12043d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv = netdev_priv(dev);
12053d6c2bc0SMauro Carvalho Chehab
12063d6c2bc0SMauro Carvalho Chehab if (priv->multi_num == DVB_NET_MULTICAST_MAX)
12073d6c2bc0SMauro Carvalho Chehab return -ENOMEM;
12083d6c2bc0SMauro Carvalho Chehab
12093d6c2bc0SMauro Carvalho Chehab memcpy(priv->multi_macs[priv->multi_num], addr, ETH_ALEN);
12103d6c2bc0SMauro Carvalho Chehab
12113d6c2bc0SMauro Carvalho Chehab priv->multi_num++;
12123d6c2bc0SMauro Carvalho Chehab return 0;
12133d6c2bc0SMauro Carvalho Chehab }
12143d6c2bc0SMauro Carvalho Chehab
12153d6c2bc0SMauro Carvalho Chehab
12163d6c2bc0SMauro Carvalho Chehab static void wq_set_multicast_list (struct work_struct *work)
12173d6c2bc0SMauro Carvalho Chehab {
12183d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv =
12193d6c2bc0SMauro Carvalho Chehab container_of(work, struct dvb_net_priv, set_multicast_list_wq);
12203d6c2bc0SMauro Carvalho Chehab struct net_device *dev = priv->net;
12213d6c2bc0SMauro Carvalho Chehab
12223d6c2bc0SMauro Carvalho Chehab dvb_net_feed_stop(dev);
12233d6c2bc0SMauro Carvalho Chehab priv->rx_mode = RX_MODE_UNI;
12243d6c2bc0SMauro Carvalho Chehab netif_addr_lock_bh(dev);
12253d6c2bc0SMauro Carvalho Chehab
12263d6c2bc0SMauro Carvalho Chehab if (dev->flags & IFF_PROMISC) {
12275c7c0ca0SJoe Perches netdev_dbg(dev, "promiscuous mode\n");
12283d6c2bc0SMauro Carvalho Chehab priv->rx_mode = RX_MODE_PROMISC;
12293d6c2bc0SMauro Carvalho Chehab } else if ((dev->flags & IFF_ALLMULTI)) {
12305c7c0ca0SJoe Perches netdev_dbg(dev, "allmulti mode\n");
12313d6c2bc0SMauro Carvalho Chehab priv->rx_mode = RX_MODE_ALL_MULTI;
12323d6c2bc0SMauro Carvalho Chehab } else if (!netdev_mc_empty(dev)) {
12333d6c2bc0SMauro Carvalho Chehab struct netdev_hw_addr *ha;
12343d6c2bc0SMauro Carvalho Chehab
12355c7c0ca0SJoe Perches netdev_dbg(dev, "set_mc_list, %d entries\n",
12365c7c0ca0SJoe Perches netdev_mc_count(dev));
12373d6c2bc0SMauro Carvalho Chehab
12383d6c2bc0SMauro Carvalho Chehab priv->rx_mode = RX_MODE_MULTI;
12393d6c2bc0SMauro Carvalho Chehab priv->multi_num = 0;
12403d6c2bc0SMauro Carvalho Chehab
12413d6c2bc0SMauro Carvalho Chehab netdev_for_each_mc_addr(ha, dev)
12423d6c2bc0SMauro Carvalho Chehab dvb_set_mc_filter(dev, ha->addr);
12433d6c2bc0SMauro Carvalho Chehab }
12443d6c2bc0SMauro Carvalho Chehab
12453d6c2bc0SMauro Carvalho Chehab netif_addr_unlock_bh(dev);
12463d6c2bc0SMauro Carvalho Chehab dvb_net_feed_start(dev);
12473d6c2bc0SMauro Carvalho Chehab }
12483d6c2bc0SMauro Carvalho Chehab
12493d6c2bc0SMauro Carvalho Chehab
12503d6c2bc0SMauro Carvalho Chehab static void dvb_net_set_multicast_list (struct net_device *dev)
12513d6c2bc0SMauro Carvalho Chehab {
12523d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv = netdev_priv(dev);
12533d6c2bc0SMauro Carvalho Chehab schedule_work(&priv->set_multicast_list_wq);
12543d6c2bc0SMauro Carvalho Chehab }
12553d6c2bc0SMauro Carvalho Chehab
12563d6c2bc0SMauro Carvalho Chehab
12573d6c2bc0SMauro Carvalho Chehab static void wq_restart_net_feed (struct work_struct *work)
12583d6c2bc0SMauro Carvalho Chehab {
12593d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv =
12603d6c2bc0SMauro Carvalho Chehab container_of(work, struct dvb_net_priv, restart_net_feed_wq);
12613d6c2bc0SMauro Carvalho Chehab struct net_device *dev = priv->net;
12623d6c2bc0SMauro Carvalho Chehab
12633d6c2bc0SMauro Carvalho Chehab if (netif_running(dev)) {
12643d6c2bc0SMauro Carvalho Chehab dvb_net_feed_stop(dev);
12653d6c2bc0SMauro Carvalho Chehab dvb_net_feed_start(dev);
12663d6c2bc0SMauro Carvalho Chehab }
12673d6c2bc0SMauro Carvalho Chehab }
12683d6c2bc0SMauro Carvalho Chehab
12693d6c2bc0SMauro Carvalho Chehab
12703d6c2bc0SMauro Carvalho Chehab static int dvb_net_set_mac (struct net_device *dev, void *p)
12713d6c2bc0SMauro Carvalho Chehab {
12723d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv = netdev_priv(dev);
12733d6c2bc0SMauro Carvalho Chehab struct sockaddr *addr=p;
12743d6c2bc0SMauro Carvalho Chehab
1275707182e4SJakub Kicinski eth_hw_addr_set(dev, addr->sa_data);
12763d6c2bc0SMauro Carvalho Chehab
12773d6c2bc0SMauro Carvalho Chehab if (netif_running(dev))
12783d6c2bc0SMauro Carvalho Chehab schedule_work(&priv->restart_net_feed_wq);
12793d6c2bc0SMauro Carvalho Chehab
12803d6c2bc0SMauro Carvalho Chehab return 0;
12813d6c2bc0SMauro Carvalho Chehab }
12823d6c2bc0SMauro Carvalho Chehab
12833d6c2bc0SMauro Carvalho Chehab
12843d6c2bc0SMauro Carvalho Chehab static int dvb_net_open(struct net_device *dev)
12853d6c2bc0SMauro Carvalho Chehab {
12863d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv = netdev_priv(dev);
12873d6c2bc0SMauro Carvalho Chehab
12883d6c2bc0SMauro Carvalho Chehab priv->in_use++;
12893d6c2bc0SMauro Carvalho Chehab dvb_net_feed_start(dev);
12903d6c2bc0SMauro Carvalho Chehab return 0;
12913d6c2bc0SMauro Carvalho Chehab }
12923d6c2bc0SMauro Carvalho Chehab
12933d6c2bc0SMauro Carvalho Chehab
12943d6c2bc0SMauro Carvalho Chehab static int dvb_net_stop(struct net_device *dev)
12953d6c2bc0SMauro Carvalho Chehab {
12963d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv = netdev_priv(dev);
12973d6c2bc0SMauro Carvalho Chehab
12983d6c2bc0SMauro Carvalho Chehab priv->in_use--;
12993d6c2bc0SMauro Carvalho Chehab return dvb_net_feed_stop(dev);
13003d6c2bc0SMauro Carvalho Chehab }
13013d6c2bc0SMauro Carvalho Chehab
13023d6c2bc0SMauro Carvalho Chehab static const struct header_ops dvb_header_ops = {
13033d6c2bc0SMauro Carvalho Chehab .create = eth_header,
13043d6c2bc0SMauro Carvalho Chehab .parse = eth_header_parse,
13053d6c2bc0SMauro Carvalho Chehab };
13063d6c2bc0SMauro Carvalho Chehab
13073d6c2bc0SMauro Carvalho Chehab
13083d6c2bc0SMauro Carvalho Chehab static const struct net_device_ops dvb_netdev_ops = {
13093d6c2bc0SMauro Carvalho Chehab .ndo_open = dvb_net_open,
13103d6c2bc0SMauro Carvalho Chehab .ndo_stop = dvb_net_stop,
13113d6c2bc0SMauro Carvalho Chehab .ndo_start_xmit = dvb_net_tx,
13123d6c2bc0SMauro Carvalho Chehab .ndo_set_rx_mode = dvb_net_set_multicast_list,
13133d6c2bc0SMauro Carvalho Chehab .ndo_set_mac_address = dvb_net_set_mac,
13143d6c2bc0SMauro Carvalho Chehab .ndo_validate_addr = eth_validate_addr,
13153d6c2bc0SMauro Carvalho Chehab };
13163d6c2bc0SMauro Carvalho Chehab
13173d6c2bc0SMauro Carvalho Chehab static void dvb_net_setup(struct net_device *dev)
13183d6c2bc0SMauro Carvalho Chehab {
13193d6c2bc0SMauro Carvalho Chehab ether_setup(dev);
13203d6c2bc0SMauro Carvalho Chehab
13213d6c2bc0SMauro Carvalho Chehab dev->header_ops = &dvb_header_ops;
13223d6c2bc0SMauro Carvalho Chehab dev->netdev_ops = &dvb_netdev_ops;
13233d6c2bc0SMauro Carvalho Chehab dev->mtu = 4096;
1324a52ad514SJarod Wilson dev->max_mtu = 4096;
13253d6c2bc0SMauro Carvalho Chehab
13263d6c2bc0SMauro Carvalho Chehab dev->flags |= IFF_NOARP;
13273d6c2bc0SMauro Carvalho Chehab }
13283d6c2bc0SMauro Carvalho Chehab
13293d6c2bc0SMauro Carvalho Chehab static int get_if(struct dvb_net *dvbnet)
13303d6c2bc0SMauro Carvalho Chehab {
13313d6c2bc0SMauro Carvalho Chehab int i;
13323d6c2bc0SMauro Carvalho Chehab
13333d6c2bc0SMauro Carvalho Chehab for (i=0; i<DVB_NET_DEVICES_MAX; i++)
13343d6c2bc0SMauro Carvalho Chehab if (!dvbnet->state[i])
13353d6c2bc0SMauro Carvalho Chehab break;
13363d6c2bc0SMauro Carvalho Chehab
13373d6c2bc0SMauro Carvalho Chehab if (i == DVB_NET_DEVICES_MAX)
13383d6c2bc0SMauro Carvalho Chehab return -1;
13393d6c2bc0SMauro Carvalho Chehab
13403d6c2bc0SMauro Carvalho Chehab dvbnet->state[i]=1;
13413d6c2bc0SMauro Carvalho Chehab return i;
13423d6c2bc0SMauro Carvalho Chehab }
13433d6c2bc0SMauro Carvalho Chehab
13443d6c2bc0SMauro Carvalho Chehab static int dvb_net_add_if(struct dvb_net *dvbnet, u16 pid, u8 feedtype)
13453d6c2bc0SMauro Carvalho Chehab {
13463d6c2bc0SMauro Carvalho Chehab struct net_device *net;
13473d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv;
13483d6c2bc0SMauro Carvalho Chehab int result;
13493d6c2bc0SMauro Carvalho Chehab int if_num;
13503d6c2bc0SMauro Carvalho Chehab
13513d6c2bc0SMauro Carvalho Chehab if (feedtype != DVB_NET_FEEDTYPE_MPE && feedtype != DVB_NET_FEEDTYPE_ULE)
13523d6c2bc0SMauro Carvalho Chehab return -EINVAL;
13533d6c2bc0SMauro Carvalho Chehab if ((if_num = get_if(dvbnet)) < 0)
13543d6c2bc0SMauro Carvalho Chehab return -EINVAL;
13553d6c2bc0SMauro Carvalho Chehab
1356c835a677STom Gundersen net = alloc_netdev(sizeof(struct dvb_net_priv), "dvb",
1357c835a677STom Gundersen NET_NAME_UNKNOWN, dvb_net_setup);
13583d6c2bc0SMauro Carvalho Chehab if (!net)
13593d6c2bc0SMauro Carvalho Chehab return -ENOMEM;
13603d6c2bc0SMauro Carvalho Chehab
13613d6c2bc0SMauro Carvalho Chehab if (dvbnet->dvbdev->id)
13623d6c2bc0SMauro Carvalho Chehab snprintf(net->name, IFNAMSIZ, "dvb%d%u%d",
13633d6c2bc0SMauro Carvalho Chehab dvbnet->dvbdev->adapter->num, dvbnet->dvbdev->id, if_num);
13643d6c2bc0SMauro Carvalho Chehab else
13653d6c2bc0SMauro Carvalho Chehab /* compatibility fix to keep dvb0_0 format */
13663d6c2bc0SMauro Carvalho Chehab snprintf(net->name, IFNAMSIZ, "dvb%d_%d",
13673d6c2bc0SMauro Carvalho Chehab dvbnet->dvbdev->adapter->num, if_num);
13683d6c2bc0SMauro Carvalho Chehab
13693d6c2bc0SMauro Carvalho Chehab net->addr_len = 6;
1370707182e4SJakub Kicinski eth_hw_addr_set(net, dvbnet->dvbdev->adapter->proposed_mac);
13713d6c2bc0SMauro Carvalho Chehab
13723d6c2bc0SMauro Carvalho Chehab dvbnet->device[if_num] = net;
13733d6c2bc0SMauro Carvalho Chehab
13743d6c2bc0SMauro Carvalho Chehab priv = netdev_priv(net);
13753d6c2bc0SMauro Carvalho Chehab priv->net = net;
13763d6c2bc0SMauro Carvalho Chehab priv->demux = dvbnet->demux;
13773d6c2bc0SMauro Carvalho Chehab priv->pid = pid;
13783d6c2bc0SMauro Carvalho Chehab priv->rx_mode = RX_MODE_UNI;
13793d6c2bc0SMauro Carvalho Chehab priv->need_pusi = 1;
13803d6c2bc0SMauro Carvalho Chehab priv->tscc = 0;
13813d6c2bc0SMauro Carvalho Chehab priv->feedtype = feedtype;
13823d6c2bc0SMauro Carvalho Chehab reset_ule(priv);
13833d6c2bc0SMauro Carvalho Chehab
13843d6c2bc0SMauro Carvalho Chehab INIT_WORK(&priv->set_multicast_list_wq, wq_set_multicast_list);
13853d6c2bc0SMauro Carvalho Chehab INIT_WORK(&priv->restart_net_feed_wq, wq_restart_net_feed);
13863d6c2bc0SMauro Carvalho Chehab mutex_init(&priv->mutex);
13873d6c2bc0SMauro Carvalho Chehab
13883d6c2bc0SMauro Carvalho Chehab net->base_addr = pid;
13893d6c2bc0SMauro Carvalho Chehab
13903d6c2bc0SMauro Carvalho Chehab if ((result = register_netdev(net)) < 0) {
13913d6c2bc0SMauro Carvalho Chehab dvbnet->device[if_num] = NULL;
13923d6c2bc0SMauro Carvalho Chehab free_netdev(net);
13933d6c2bc0SMauro Carvalho Chehab return result;
13943d6c2bc0SMauro Carvalho Chehab }
1395b3ad24d2SMauro Carvalho Chehab pr_info("created network interface %s\n", net->name);
13963d6c2bc0SMauro Carvalho Chehab
13973d6c2bc0SMauro Carvalho Chehab return if_num;
13983d6c2bc0SMauro Carvalho Chehab }
13993d6c2bc0SMauro Carvalho Chehab
14003d6c2bc0SMauro Carvalho Chehab static int dvb_net_remove_if(struct dvb_net *dvbnet, unsigned long num)
14013d6c2bc0SMauro Carvalho Chehab {
14023d6c2bc0SMauro Carvalho Chehab struct net_device *net = dvbnet->device[num];
14033d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv;
14043d6c2bc0SMauro Carvalho Chehab
14053d6c2bc0SMauro Carvalho Chehab if (!dvbnet->state[num])
14063d6c2bc0SMauro Carvalho Chehab return -EINVAL;
14073d6c2bc0SMauro Carvalho Chehab priv = netdev_priv(net);
14083d6c2bc0SMauro Carvalho Chehab if (priv->in_use)
14093d6c2bc0SMauro Carvalho Chehab return -EBUSY;
14103d6c2bc0SMauro Carvalho Chehab
14113d6c2bc0SMauro Carvalho Chehab dvb_net_stop(net);
14120b8e74c6SLinus Torvalds flush_work(&priv->set_multicast_list_wq);
14130b8e74c6SLinus Torvalds flush_work(&priv->restart_net_feed_wq);
1414b3ad24d2SMauro Carvalho Chehab pr_info("removed network interface %s\n", net->name);
14153d6c2bc0SMauro Carvalho Chehab unregister_netdev(net);
14163d6c2bc0SMauro Carvalho Chehab dvbnet->state[num]=0;
14173d6c2bc0SMauro Carvalho Chehab dvbnet->device[num] = NULL;
14183d6c2bc0SMauro Carvalho Chehab free_netdev(net);
14193d6c2bc0SMauro Carvalho Chehab
14203d6c2bc0SMauro Carvalho Chehab return 0;
14213d6c2bc0SMauro Carvalho Chehab }
14223d6c2bc0SMauro Carvalho Chehab
14233d6c2bc0SMauro Carvalho Chehab static int dvb_net_do_ioctl(struct file *file,
14243d6c2bc0SMauro Carvalho Chehab unsigned int cmd, void *parg)
14253d6c2bc0SMauro Carvalho Chehab {
14263d6c2bc0SMauro Carvalho Chehab struct dvb_device *dvbdev = file->private_data;
14273d6c2bc0SMauro Carvalho Chehab struct dvb_net *dvbnet = dvbdev->priv;
142830ad64b8SNikolaus Schulz int ret = 0;
14293d6c2bc0SMauro Carvalho Chehab
14303d6c2bc0SMauro Carvalho Chehab if (((file->f_flags&O_ACCMODE)==O_RDONLY))
14313d6c2bc0SMauro Carvalho Chehab return -EPERM;
14323d6c2bc0SMauro Carvalho Chehab
143330ad64b8SNikolaus Schulz if (mutex_lock_interruptible(&dvbnet->ioctl_mutex))
143430ad64b8SNikolaus Schulz return -ERESTARTSYS;
143530ad64b8SNikolaus Schulz
14363d6c2bc0SMauro Carvalho Chehab switch (cmd) {
14373d6c2bc0SMauro Carvalho Chehab case NET_ADD_IF:
14383d6c2bc0SMauro Carvalho Chehab {
14393d6c2bc0SMauro Carvalho Chehab struct dvb_net_if *dvbnetif = parg;
14403d6c2bc0SMauro Carvalho Chehab int result;
14413d6c2bc0SMauro Carvalho Chehab
144230ad64b8SNikolaus Schulz if (!capable(CAP_SYS_ADMIN)) {
144330ad64b8SNikolaus Schulz ret = -EPERM;
144430ad64b8SNikolaus Schulz goto ioctl_error;
144530ad64b8SNikolaus Schulz }
14463d6c2bc0SMauro Carvalho Chehab
144730ad64b8SNikolaus Schulz if (!try_module_get(dvbdev->adapter->module)) {
144830ad64b8SNikolaus Schulz ret = -EPERM;
144930ad64b8SNikolaus Schulz goto ioctl_error;
145030ad64b8SNikolaus Schulz }
14513d6c2bc0SMauro Carvalho Chehab
14523d6c2bc0SMauro Carvalho Chehab result=dvb_net_add_if(dvbnet, dvbnetif->pid, dvbnetif->feedtype);
14533d6c2bc0SMauro Carvalho Chehab if (result<0) {
14543d6c2bc0SMauro Carvalho Chehab module_put(dvbdev->adapter->module);
145530ad64b8SNikolaus Schulz ret = result;
145630ad64b8SNikolaus Schulz goto ioctl_error;
14573d6c2bc0SMauro Carvalho Chehab }
14583d6c2bc0SMauro Carvalho Chehab dvbnetif->if_num=result;
14593d6c2bc0SMauro Carvalho Chehab break;
14603d6c2bc0SMauro Carvalho Chehab }
14613d6c2bc0SMauro Carvalho Chehab case NET_GET_IF:
14623d6c2bc0SMauro Carvalho Chehab {
14633d6c2bc0SMauro Carvalho Chehab struct net_device *netdev;
14643d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv_data;
14653d6c2bc0SMauro Carvalho Chehab struct dvb_net_if *dvbnetif = parg;
1466abc0226dSMauro Carvalho Chehab int if_num = dvbnetif->if_num;
14673d6c2bc0SMauro Carvalho Chehab
1468abc0226dSMauro Carvalho Chehab if (if_num >= DVB_NET_DEVICES_MAX) {
1469abc0226dSMauro Carvalho Chehab ret = -EINVAL;
1470abc0226dSMauro Carvalho Chehab goto ioctl_error;
1471abc0226dSMauro Carvalho Chehab }
1472abc0226dSMauro Carvalho Chehab if_num = array_index_nospec(if_num, DVB_NET_DEVICES_MAX);
1473abc0226dSMauro Carvalho Chehab
1474abc0226dSMauro Carvalho Chehab if (!dvbnet->state[if_num]) {
147530ad64b8SNikolaus Schulz ret = -EINVAL;
147630ad64b8SNikolaus Schulz goto ioctl_error;
147730ad64b8SNikolaus Schulz }
14783d6c2bc0SMauro Carvalho Chehab
1479abc0226dSMauro Carvalho Chehab netdev = dvbnet->device[if_num];
14803d6c2bc0SMauro Carvalho Chehab
14813d6c2bc0SMauro Carvalho Chehab priv_data = netdev_priv(netdev);
14823d6c2bc0SMauro Carvalho Chehab dvbnetif->pid=priv_data->pid;
14833d6c2bc0SMauro Carvalho Chehab dvbnetif->feedtype=priv_data->feedtype;
14843d6c2bc0SMauro Carvalho Chehab break;
14853d6c2bc0SMauro Carvalho Chehab }
14863d6c2bc0SMauro Carvalho Chehab case NET_REMOVE_IF:
14873d6c2bc0SMauro Carvalho Chehab {
148830ad64b8SNikolaus Schulz if (!capable(CAP_SYS_ADMIN)) {
148930ad64b8SNikolaus Schulz ret = -EPERM;
149030ad64b8SNikolaus Schulz goto ioctl_error;
149130ad64b8SNikolaus Schulz }
149230ad64b8SNikolaus Schulz if ((unsigned long) parg >= DVB_NET_DEVICES_MAX) {
149330ad64b8SNikolaus Schulz ret = -EINVAL;
149430ad64b8SNikolaus Schulz goto ioctl_error;
149530ad64b8SNikolaus Schulz }
14963d6c2bc0SMauro Carvalho Chehab ret = dvb_net_remove_if(dvbnet, (unsigned long) parg);
14973d6c2bc0SMauro Carvalho Chehab if (!ret)
14983d6c2bc0SMauro Carvalho Chehab module_put(dvbdev->adapter->module);
149930ad64b8SNikolaus Schulz break;
15003d6c2bc0SMauro Carvalho Chehab }
15013d6c2bc0SMauro Carvalho Chehab
15023d6c2bc0SMauro Carvalho Chehab /* binary compatibility cruft */
15033d6c2bc0SMauro Carvalho Chehab case __NET_ADD_IF_OLD:
15043d6c2bc0SMauro Carvalho Chehab {
15053d6c2bc0SMauro Carvalho Chehab struct __dvb_net_if_old *dvbnetif = parg;
15063d6c2bc0SMauro Carvalho Chehab int result;
15073d6c2bc0SMauro Carvalho Chehab
150830ad64b8SNikolaus Schulz if (!capable(CAP_SYS_ADMIN)) {
150930ad64b8SNikolaus Schulz ret = -EPERM;
151030ad64b8SNikolaus Schulz goto ioctl_error;
151130ad64b8SNikolaus Schulz }
15123d6c2bc0SMauro Carvalho Chehab
151330ad64b8SNikolaus Schulz if (!try_module_get(dvbdev->adapter->module)) {
151430ad64b8SNikolaus Schulz ret = -EPERM;
151530ad64b8SNikolaus Schulz goto ioctl_error;
151630ad64b8SNikolaus Schulz }
15173d6c2bc0SMauro Carvalho Chehab
15183d6c2bc0SMauro Carvalho Chehab result=dvb_net_add_if(dvbnet, dvbnetif->pid, DVB_NET_FEEDTYPE_MPE);
15193d6c2bc0SMauro Carvalho Chehab if (result<0) {
15203d6c2bc0SMauro Carvalho Chehab module_put(dvbdev->adapter->module);
152130ad64b8SNikolaus Schulz ret = result;
152230ad64b8SNikolaus Schulz goto ioctl_error;
15233d6c2bc0SMauro Carvalho Chehab }
15243d6c2bc0SMauro Carvalho Chehab dvbnetif->if_num=result;
15253d6c2bc0SMauro Carvalho Chehab break;
15263d6c2bc0SMauro Carvalho Chehab }
15273d6c2bc0SMauro Carvalho Chehab case __NET_GET_IF_OLD:
15283d6c2bc0SMauro Carvalho Chehab {
15293d6c2bc0SMauro Carvalho Chehab struct net_device *netdev;
15303d6c2bc0SMauro Carvalho Chehab struct dvb_net_priv *priv_data;
15313d6c2bc0SMauro Carvalho Chehab struct __dvb_net_if_old *dvbnetif = parg;
1532abc0226dSMauro Carvalho Chehab int if_num = dvbnetif->if_num;
15333d6c2bc0SMauro Carvalho Chehab
1534abc0226dSMauro Carvalho Chehab if (if_num >= DVB_NET_DEVICES_MAX) {
1535abc0226dSMauro Carvalho Chehab ret = -EINVAL;
1536abc0226dSMauro Carvalho Chehab goto ioctl_error;
1537abc0226dSMauro Carvalho Chehab }
1538abc0226dSMauro Carvalho Chehab if_num = array_index_nospec(if_num, DVB_NET_DEVICES_MAX);
1539abc0226dSMauro Carvalho Chehab
1540abc0226dSMauro Carvalho Chehab if (!dvbnet->state[if_num]) {
154130ad64b8SNikolaus Schulz ret = -EINVAL;
154230ad64b8SNikolaus Schulz goto ioctl_error;
154330ad64b8SNikolaus Schulz }
15443d6c2bc0SMauro Carvalho Chehab
1545abc0226dSMauro Carvalho Chehab netdev = dvbnet->device[if_num];
15463d6c2bc0SMauro Carvalho Chehab
15473d6c2bc0SMauro Carvalho Chehab priv_data = netdev_priv(netdev);
15483d6c2bc0SMauro Carvalho Chehab dvbnetif->pid=priv_data->pid;
15493d6c2bc0SMauro Carvalho Chehab break;
15503d6c2bc0SMauro Carvalho Chehab }
15513d6c2bc0SMauro Carvalho Chehab default:
155230ad64b8SNikolaus Schulz ret = -ENOTTY;
155330ad64b8SNikolaus Schulz break;
15543d6c2bc0SMauro Carvalho Chehab }
155530ad64b8SNikolaus Schulz
155630ad64b8SNikolaus Schulz ioctl_error:
155730ad64b8SNikolaus Schulz mutex_unlock(&dvbnet->ioctl_mutex);
155830ad64b8SNikolaus Schulz return ret;
15593d6c2bc0SMauro Carvalho Chehab }
15603d6c2bc0SMauro Carvalho Chehab
15613d6c2bc0SMauro Carvalho Chehab static long dvb_net_ioctl(struct file *file,
15623d6c2bc0SMauro Carvalho Chehab unsigned int cmd, unsigned long arg)
15633d6c2bc0SMauro Carvalho Chehab {
15643d6c2bc0SMauro Carvalho Chehab return dvb_usercopy(file, cmd, arg, dvb_net_do_ioctl);
15653d6c2bc0SMauro Carvalho Chehab }
15663d6c2bc0SMauro Carvalho Chehab
1567*4172385bSHyunwoo Kim static int locked_dvb_net_open(struct inode *inode, struct file *file)
1568*4172385bSHyunwoo Kim {
1569*4172385bSHyunwoo Kim struct dvb_device *dvbdev = file->private_data;
1570*4172385bSHyunwoo Kim struct dvb_net *dvbnet = dvbdev->priv;
1571*4172385bSHyunwoo Kim int ret;
1572*4172385bSHyunwoo Kim
1573*4172385bSHyunwoo Kim if (mutex_lock_interruptible(&dvbnet->remove_mutex))
1574*4172385bSHyunwoo Kim return -ERESTARTSYS;
1575*4172385bSHyunwoo Kim
1576*4172385bSHyunwoo Kim if (dvbnet->exit) {
1577*4172385bSHyunwoo Kim mutex_unlock(&dvbnet->remove_mutex);
1578*4172385bSHyunwoo Kim return -ENODEV;
1579*4172385bSHyunwoo Kim }
1580*4172385bSHyunwoo Kim
1581*4172385bSHyunwoo Kim ret = dvb_generic_open(inode, file);
1582*4172385bSHyunwoo Kim
1583*4172385bSHyunwoo Kim mutex_unlock(&dvbnet->remove_mutex);
1584*4172385bSHyunwoo Kim
1585*4172385bSHyunwoo Kim return ret;
1586*4172385bSHyunwoo Kim }
1587*4172385bSHyunwoo Kim
15883d6c2bc0SMauro Carvalho Chehab static int dvb_net_close(struct inode *inode, struct file *file)
15893d6c2bc0SMauro Carvalho Chehab {
15903d6c2bc0SMauro Carvalho Chehab struct dvb_device *dvbdev = file->private_data;
15913d6c2bc0SMauro Carvalho Chehab struct dvb_net *dvbnet = dvbdev->priv;
15923d6c2bc0SMauro Carvalho Chehab
1593*4172385bSHyunwoo Kim mutex_lock(&dvbnet->remove_mutex);
1594*4172385bSHyunwoo Kim
15953d6c2bc0SMauro Carvalho Chehab dvb_generic_release(inode, file);
15963d6c2bc0SMauro Carvalho Chehab
1597*4172385bSHyunwoo Kim if (dvbdev->users == 1 && dvbnet->exit == 1) {
1598*4172385bSHyunwoo Kim mutex_unlock(&dvbnet->remove_mutex);
15993d6c2bc0SMauro Carvalho Chehab wake_up(&dvbdev->wait_queue);
1600*4172385bSHyunwoo Kim } else {
1601*4172385bSHyunwoo Kim mutex_unlock(&dvbnet->remove_mutex);
1602*4172385bSHyunwoo Kim }
1603*4172385bSHyunwoo Kim
16043d6c2bc0SMauro Carvalho Chehab return 0;
16053d6c2bc0SMauro Carvalho Chehab }
16063d6c2bc0SMauro Carvalho Chehab
16073d6c2bc0SMauro Carvalho Chehab
16083d6c2bc0SMauro Carvalho Chehab static const struct file_operations dvb_net_fops = {
16093d6c2bc0SMauro Carvalho Chehab .owner = THIS_MODULE,
16103d6c2bc0SMauro Carvalho Chehab .unlocked_ioctl = dvb_net_ioctl,
1611*4172385bSHyunwoo Kim .open = locked_dvb_net_open,
16123d6c2bc0SMauro Carvalho Chehab .release = dvb_net_close,
16133d6c2bc0SMauro Carvalho Chehab .llseek = noop_llseek,
16143d6c2bc0SMauro Carvalho Chehab };
16153d6c2bc0SMauro Carvalho Chehab
1616e3d65c33SMauro Carvalho Chehab static const struct dvb_device dvbdev_net = {
16173d6c2bc0SMauro Carvalho Chehab .priv = NULL,
16183d6c2bc0SMauro Carvalho Chehab .users = 1,
16193d6c2bc0SMauro Carvalho Chehab .writers = 1,
1620e3d65c33SMauro Carvalho Chehab #if defined(CONFIG_MEDIA_CONTROLLER_DVB)
1621e4fd3bc5SMauro Carvalho Chehab .name = "dvb-net",
1622e3d65c33SMauro Carvalho Chehab #endif
16233d6c2bc0SMauro Carvalho Chehab .fops = &dvb_net_fops,
16243d6c2bc0SMauro Carvalho Chehab };
16253d6c2bc0SMauro Carvalho Chehab
16263d6c2bc0SMauro Carvalho Chehab void dvb_net_release (struct dvb_net *dvbnet)
16273d6c2bc0SMauro Carvalho Chehab {
16283d6c2bc0SMauro Carvalho Chehab int i;
16293d6c2bc0SMauro Carvalho Chehab
1630*4172385bSHyunwoo Kim mutex_lock(&dvbnet->remove_mutex);
16313d6c2bc0SMauro Carvalho Chehab dvbnet->exit = 1;
1632*4172385bSHyunwoo Kim mutex_unlock(&dvbnet->remove_mutex);
1633*4172385bSHyunwoo Kim
16343d6c2bc0SMauro Carvalho Chehab if (dvbnet->dvbdev->users < 1)
16353d6c2bc0SMauro Carvalho Chehab wait_event(dvbnet->dvbdev->wait_queue,
16363d6c2bc0SMauro Carvalho Chehab dvbnet->dvbdev->users == 1);
16373d6c2bc0SMauro Carvalho Chehab
16383d6c2bc0SMauro Carvalho Chehab dvb_unregister_device(dvbnet->dvbdev);
16393d6c2bc0SMauro Carvalho Chehab
16403d6c2bc0SMauro Carvalho Chehab for (i=0; i<DVB_NET_DEVICES_MAX; i++) {
16413d6c2bc0SMauro Carvalho Chehab if (!dvbnet->state[i])
16423d6c2bc0SMauro Carvalho Chehab continue;
16433d6c2bc0SMauro Carvalho Chehab dvb_net_remove_if(dvbnet, i);
16443d6c2bc0SMauro Carvalho Chehab }
16453d6c2bc0SMauro Carvalho Chehab }
16463d6c2bc0SMauro Carvalho Chehab EXPORT_SYMBOL(dvb_net_release);
16473d6c2bc0SMauro Carvalho Chehab
16483d6c2bc0SMauro Carvalho Chehab
16493d6c2bc0SMauro Carvalho Chehab int dvb_net_init (struct dvb_adapter *adap, struct dvb_net *dvbnet,
16503d6c2bc0SMauro Carvalho Chehab struct dmx_demux *dmx)
16513d6c2bc0SMauro Carvalho Chehab {
16523d6c2bc0SMauro Carvalho Chehab int i;
16533d6c2bc0SMauro Carvalho Chehab
165430ad64b8SNikolaus Schulz mutex_init(&dvbnet->ioctl_mutex);
1655*4172385bSHyunwoo Kim mutex_init(&dvbnet->remove_mutex);
16563d6c2bc0SMauro Carvalho Chehab dvbnet->demux = dmx;
16573d6c2bc0SMauro Carvalho Chehab
16583d6c2bc0SMauro Carvalho Chehab for (i=0; i<DVB_NET_DEVICES_MAX; i++)
16593d6c2bc0SMauro Carvalho Chehab dvbnet->state[i] = 0;
16603d6c2bc0SMauro Carvalho Chehab
16613d6c2bc0SMauro Carvalho Chehab return dvb_register_device(adap, &dvbnet->dvbdev, &dvbdev_net,
1662df2f94e5SMauro Carvalho Chehab dvbnet, DVB_DEVICE_NET, 0);
16633d6c2bc0SMauro Carvalho Chehab }
16643d6c2bc0SMauro Carvalho Chehab EXPORT_SYMBOL(dvb_net_init);
1665