开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
af_packet.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：42k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

af_packet.c：源码内容
  1. /*
  2.  * INET An implementation of the TCP/IP protocol suite for the LINUX
  3.  * operating system.  INET is implemented using the  BSD Socket
  4.  * interface as the means of communication with the user level.
  5.  *
  6.  * PACKET - implements raw packet sockets.
  7.  *
  8.  * Version: $Id: af_packet.c,v 1.58 2001/11/28 21:02:10 davem Exp $
  9.  *
  10.  * Authors: Ross Biro, <bir7@leland.Stanford.Edu>
  11.  * Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG>
  12.  * Alan Cox, <gw4pts@gw4pts.ampr.org>
  13.  *
  14.  * Fixes:
  15.  * Alan Cox : verify_area() now used correctly
  16.  * Alan Cox : new skbuff lists, look ma no backlogs!
  17.  * Alan Cox : tidied skbuff lists.
  18.  * Alan Cox : Now uses generic datagram routines I
  19.  * added. Also fixed the peek/read crash
  20.  * from all old Linux datagram code.
  21.  * Alan Cox : Uses the improved datagram code.
  22.  * Alan Cox : Added NULL's for socket options.
  23.  * Alan Cox : Re-commented the code.
  24.  * Alan Cox : Use new kernel side addressing
  25.  * Rob Janssen : Correct MTU usage.
  26.  * Dave Platt : Counter leaks caused by incorrect
  27.  * interrupt locking and some slightly
  28.  * dubious gcc output. Can you read
  29.  * compiler: it said _VOLATILE_
  30.  * Richard Kooijman : Timestamp fixes.
  31.  * Alan Cox : New buffers. Use sk->mac.raw.
  32.  * Alan Cox : sendmsg/recvmsg support.
  33.  * Alan Cox : Protocol setting support
  34.  * Alexey Kuznetsov : Untied from IPv4 stack.
  35.  * Cyrus Durgin : Fixed kerneld for kmod.
  36.  * Michal Ostrowski        :       Module initialization cleanup.
  37.  *
  38.  * This program is free software; you can redistribute it and/or
  39.  * modify it under the terms of the GNU General Public License
  40.  * as published by the Free Software Foundation; either version
  41.  * 2 of the License, or (at your option) any later version.
  42.  *
  43.  */
  44.  
  45. #include <linux/config.h>
  46. #include <linux/types.h>
  47. #include <linux/sched.h>
  48. #include <linux/mm.h>
  49. #include <linux/fcntl.h>
  50. #include <linux/socket.h>
  51. #include <linux/in.h>
  52. #include <linux/inet.h>
  53. #include <linux/netdevice.h>
  54. #include <linux/if_packet.h>
  55. #include <linux/wireless.h>
  56. #include <linux/kmod.h>
  57. #include <net/ip.h>
  58. #include <net/protocol.h>
  59. #include <linux/skbuff.h>
  60. #include <net/sock.h>
  61. #include <linux/errno.h>
  62. #include <linux/timer.h>
  63. #include <asm/system.h>
  64. #include <asm/uaccess.h>
  65. #include <asm/ioctls.h>
  66. #include <linux/proc_fs.h>
  67. #include <linux/poll.h>
  68. #include <linux/module.h>
  69. #include <linux/init.h>
  70. #include <linux/if_bridge.h>
  72. #ifdef CONFIG_NET_DIVERT
  73. #include <linux/divert.h>
  74. #endif /* CONFIG_NET_DIVERT */
  76. #ifdef CONFIG_INET
  77. #include <net/inet_common.h>
  78. #endif
  80. #ifdef CONFIG_DLCI
  81. extern int dlci_ioctl(unsigned int, void*);
  82. #endif
  84. #define CONFIG_SOCK_PACKET 1
  86. /*
  87.    Proposed replacement for SIOC{ADD,DEL}MULTI and
  88.    IFF_PROMISC, IFF_ALLMULTI flags.
  90.    It is more expensive, but I believe,
  91.    it is really correct solution: reentereble, safe and fault tolerant.
  93.    IFF_PROMISC/IFF_ALLMULTI/SIOC{ADD/DEL}MULTI are faked by keeping
  94.    reference count and global flag, so that real status is
  95.    (gflag|(count != 0)), so that we can use obsolete faulty interface
  96.    not harming clever users.
  97.  */
  98. #define CONFIG_PACKET_MULTICAST 1
  100. /*
  101.    Assumptions:
  102.    - if device has no dev->hard_header routine, it adds and removes ll header
  103.      inside itself. In this case ll header is invisible outside of device,
  104.      but higher levels still should reserve dev->hard_header_len.
  105.      Some devices are enough clever to reallocate skb, when header
  106.      will not fit to reserved space (tunnel), another ones are silly
  107.      (PPP).
  108.    - packet socket receives packets with pulled ll header,
  109.      so that SOCK_RAW should push it back.
  111. On receive:
  112. -----------
  114. Incoming, dev->hard_header!=NULL
  115.    mac.raw -> ll header
  116.    data    -> data
  118. Outgoing, dev->hard_header!=NULL
  119.    mac.raw -> ll header
  120.    data    -> ll header
  122. Incoming, dev->hard_header==NULL
  123.    mac.raw -> UNKNOWN position. It is very likely, that it points to ll header.
  124.               PPP makes it, that is wrong, because introduce assymetry
  125.       between rx and tx paths.
  126.    data    -> data
  128. Outgoing, dev->hard_header==NULL
  129.    mac.raw -> data. ll header is still not built!
  130.    data    -> data
  132. Resume
  133.   If dev->hard_header==NULL we are unlikely to restore sensible ll header.
  136. On transmit:
  137. ------------
  139. dev->hard_header != NULL
  140.    mac.raw -> ll header
  141.    data    -> ll header
  143. dev->hard_header == NULL (ll header is added by device, we cannot control it)
  144.    mac.raw -> data
  145.    data -> data
  147.    We should set nh.raw on output to correct posistion,
  148.    packet classifier depends on it.
  149.  */
  151. /* List of all packet sockets. */
  152. static struct sock * packet_sklist;
  153. static rwlock_t packet_sklist_lock = RW_LOCK_UNLOCKED;
  155. atomic_t packet_socks_nr;
  158. /* Private packet socket structures. */
  160. #ifdef CONFIG_PACKET_MULTICAST
  161. struct packet_mclist
  162. {
  163. struct packet_mclist *next;
  164. int ifindex;
  165. int count;
  166. unsigned short type;
  167. unsigned short alen;
  168. unsigned char addr[8];
  169. };
  170. #endif
  171. #ifdef CONFIG_PACKET_MMAP
  172. static int packet_set_ring(struct sock *sk, struct tpacket_req *req, int closing);
  173. #endif
  175. static void packet_flush_mclist(struct sock *sk);
  177. struct packet_opt
  178. {
  179. struct packet_type prot_hook;
  180. spinlock_t bind_lock;
  181. char running; /* prot_hook is attached*/
  182. int ifindex; /* bound device */
  183. struct tpacket_stats stats;
  184. #ifdef CONFIG_PACKET_MULTICAST
  185. struct packet_mclist *mclist;
  186. #endif
  187. #ifdef CONFIG_PACKET_MMAP
  188. atomic_t mapped;
  189. unsigned long *pg_vec;
  190. unsigned int pg_vec_order;
  191. unsigned int pg_vec_pages;
  192. unsigned int pg_vec_len;
  194. struct tpacket_hdr **iovec;
  195. unsigned int frame_size;
  196. unsigned int iovmax;
  197. unsigned int head;
  198. int copy_thresh;
  199. #endif
  200. };
  202. void packet_sock_destruct(struct sock *sk)
  203. {
  204. BUG_TRAP(atomic_read(&sk->rmem_alloc)==0);
  205. BUG_TRAP(atomic_read(&sk->wmem_alloc)==0);
  207. if (!sk->dead) {
  208. printk("Attempt to release alive packet socket: %pn", sk);
  209. return;
  210. }
  212. if (sk->protinfo.destruct_hook)
  213. kfree(sk->protinfo.destruct_hook);
  214. atomic_dec(&packet_socks_nr);
  215. #ifdef PACKET_REFCNT_DEBUG
  216. printk(KERN_DEBUG "PACKET socket %p is free, %d are aliven", sk, atomic_read(&packet_socks_nr));
  217. #endif
  218. MOD_DEC_USE_COUNT;
  219. }
  222. extern struct proto_ops packet_ops;
  224. #ifdef CONFIG_SOCK_PACKET
  225. extern struct proto_ops packet_ops_spkt;
  227. static int packet_rcv_spkt(struct sk_buff *skb, struct net_device *dev,  struct packet_type *pt)
  228. {
  229. struct sock *sk;
  230. struct sockaddr_pkt *spkt;
  232. /*
  233.  * When we registered the protocol we saved the socket in the data
  234.  * field for just this event.
  235.  */
  237. sk = (struct sock *) pt->data;
  239. /*
  240.  * Yank back the headers [hope the device set this
  241.  * right or kerboom...]
  242.  *
  243.  * Incoming packets have ll header pulled,
  244.  * push it back.
  245.  *
  246.  * For outgoing ones skb->data == skb->mac.raw
  247.  * so that this procedure is noop.
  248.  */
  250. if (skb->pkt_type == PACKET_LOOPBACK)
  251. goto out;
  253. if ((skb = skb_share_check(skb, GFP_ATOMIC)) == NULL)
  254. goto oom;
  256. spkt = (struct sockaddr_pkt*)skb->cb;
  258. skb_push(skb, skb->data-skb->mac.raw);
  260. /*
  261.  * The SOCK_PACKET socket receives _all_ frames.
  262.  */
  264. spkt->spkt_family = dev->type;
  265. strncpy(spkt->spkt_device, dev->name, sizeof(spkt->spkt_device));
  266. spkt->spkt_protocol = skb->protocol;
  268. /*
  269.  * Charge the memory to the socket. This is done specifically
  270.  * to prevent sockets using all the memory up.
  271.  */
  273. if (sock_queue_rcv_skb(sk,skb) == 0)
  274. return 0;
  276. out:
  277. kfree_skb(skb);
  278. oom:
  279. return 0;
  280. }
  283. /*
  284.  * Output a raw packet to a device layer. This bypasses all the other
  285.  * protocol layers and you must therefore supply it with a complete frame
  286.  */
  287.  
  288. static int packet_sendmsg_spkt(struct socket *sock, struct msghdr *msg, int len,
  289.        struct scm_cookie *scm)
  290. {
  291. struct sock *sk = sock->sk;
  292. struct sockaddr_pkt *saddr=(struct sockaddr_pkt *)msg->msg_name;
  293. struct sk_buff *skb;
  294. struct net_device *dev;
  295. unsigned short proto=0;
  296. int err;
  298. /*
  299.  * Get and verify the address. 
  300.  */
  302. if (saddr)
  303. {
  304. if (msg->msg_namelen < sizeof(struct sockaddr))
  305. return(-EINVAL);
  306. if (msg->msg_namelen==sizeof(struct sockaddr_pkt))
  307. proto=saddr->spkt_protocol;
  308. }
  309. else
  310. return(-ENOTCONN); /* SOCK_PACKET must be sent giving an address */
  312. /*
  313.  * Find the device first to size check it 
  314.  */
  316. saddr->spkt_device[13] = 0;
  317. dev = dev_get_by_name(saddr->spkt_device);
  318. err = -ENODEV;
  319. if (dev == NULL)
  320. goto out_unlock;
  322. /*
  323.  * You may not queue a frame bigger than the mtu. This is the lowest level
  324.  * raw protocol and you must do your own fragmentation at this level.
  325.  */
  326.  
  327. err = -EMSGSIZE;
  328.   if(len>dev->mtu+dev->hard_header_len)
  329. goto out_unlock;
  331. err = -ENOBUFS;
  332. skb = sock_wmalloc(sk, len+dev->hard_header_len+15, 0, GFP_KERNEL);
  334. /*
  335.  * If the write buffer is full, then tough. At this level the user gets to
  336.  * deal with the problem - do your own algorithmic backoffs. That's far
  337.  * more flexible.
  338.  */
  339.  
  340. if (skb == NULL) 
  341. goto out_unlock;
  343. /*
  344.  * Fill it in 
  345.  */
  346.  
  347. /* FIXME: Save some space for broken drivers that write a
  348.  * hard header at transmission time by themselves. PPP is the
  349.  * notable one here. This should really be fixed at the driver level.
  350.  */
  351. skb_reserve(skb,(dev->hard_header_len+15)&~15);
  352. skb->nh.raw = skb->data;
  354. /* Try to align data part correctly */
  355. if (dev->hard_header) {
  356. skb->data -= dev->hard_header_len;
  357. skb->tail -= dev->hard_header_len;
  358. }
  360. /* Returns -EFAULT on error */
  361. err = memcpy_fromiovec(skb_put(skb,len), msg->msg_iov, len);
  362. skb->protocol = proto;
  363. skb->dev = dev;
  364. skb->priority = sk->priority;
  365. if (err)
  366. goto out_free;
  368. err = -ENETDOWN;
  369. if (!(dev->flags & IFF_UP))
  370. goto out_free;
  372. /*
  373.  * Now send it
  374.  */
  376. dev_queue_xmit(skb);
  377. dev_put(dev);
  378. return(len);
  380. out_free:
  381. kfree_skb(skb);
  382. out_unlock:
  383. if (dev)
  384. dev_put(dev);
  385. return err;
  386. }
  387. #endif
  389. /*
  390.    This function makes lazy skb cloning in hope that most of packets
  391.    are discarded by BPF.
  393.    Note tricky part: we DO mangle shared skb! skb->data, skb->len
  394.    and skb->cb are mangled. It works because (and until) packets
  395.    falling here are owned by current CPU. Output packets are cloned
  396.    by dev_queue_xmit_nit(), input packets are processed by net_bh
  397.    sequencially, so that if we return skb to original state on exit,
  398.    we will not harm anyone.
  399.  */
  401. static int packet_rcv(struct sk_buff *skb, struct net_device *dev,  struct packet_type *pt)
  402. {
  403. struct sock *sk;
  404. struct sockaddr_ll *sll;
  405. struct packet_opt *po;
  406. u8 * skb_head = skb->data;
  407. int skb_len = skb->len;
  408. #ifdef CONFIG_FILTER
  409. unsigned snaplen;
  410. #endif
  412. if (skb->pkt_type == PACKET_LOOPBACK)
  413. goto drop;
  415. sk = (struct sock *) pt->data;
  416. po = sk->protinfo.af_packet;
  418. skb->dev = dev;
  420. if (dev->hard_header) {
  421. /* The device has an explicit notion of ll header,
  422.    exported to higher levels.
  424.    Otherwise, the device hides datails of it frame
  425.    structure, so that corresponding packet head
  426.    never delivered to user.
  427.  */
  428. if (sk->type != SOCK_DGRAM)
  429. skb_push(skb, skb->data - skb->mac.raw);
  430. else if (skb->pkt_type == PACKET_OUTGOING) {
  431. /* Special case: outgoing packets have ll header at head */
  432. skb_pull(skb, skb->nh.raw - skb->data);
  433. }
  434. }
  436. #ifdef CONFIG_FILTER
  437. snaplen = skb->len;
  439. if (sk->filter) {
  440. unsigned res = snaplen;
  441. struct sk_filter *filter;
  443. bh_lock_sock(sk);
  444. if ((filter = sk->filter) != NULL)
  445. res = sk_run_filter(skb, sk->filter->insns, sk->filter->len);
  446. bh_unlock_sock(sk);
  448. if (res == 0)
  449. goto drop_n_restore;
  450. if (snaplen > res)
  451. snaplen = res;
  452. }
  453. #endif /* CONFIG_FILTER */
  455. if (atomic_read(&sk->rmem_alloc) + skb->truesize >= (unsigned)sk->rcvbuf)
  456. goto drop_n_acct;
  458. if (skb_shared(skb)) {
  459. struct sk_buff *nskb = skb_clone(skb, GFP_ATOMIC);
  460. if (nskb == NULL)
  461. goto drop_n_acct;
  463. if (skb_head != skb->data) {
  464. skb->data = skb_head;
  465. skb->len = skb_len;
  466. }
  467. kfree_skb(skb);
  468. skb = nskb;
  469. }
  471. sll = (struct sockaddr_ll*)skb->cb;
  472. sll->sll_family = AF_PACKET;
  473. sll->sll_hatype = dev->type;
  474. sll->sll_protocol = skb->protocol;
  475. sll->sll_pkttype = skb->pkt_type;
  476. sll->sll_ifindex = dev->ifindex;
  477. sll->sll_halen = 0;
  479. if (dev->hard_header_parse)
  480. sll->sll_halen = dev->hard_header_parse(skb, sll->sll_addr);
  482. #ifdef CONFIG_FILTER
  483. if (pskb_trim(skb, snaplen))
  484. goto drop_n_acct;
  485. #endif
  487. skb_set_owner_r(skb, sk);
  488. skb->dev = NULL;
  489. spin_lock(&sk->receive_queue.lock);
  490. po->stats.tp_packets++;
  491. __skb_queue_tail(&sk->receive_queue, skb);
  492. spin_unlock(&sk->receive_queue.lock);
  493. sk->data_ready(sk,skb->len);
  494. return 0;
  496. drop_n_acct:
  497. spin_lock(&sk->receive_queue.lock);
  498. po->stats.tp_drops++;
  499. spin_unlock(&sk->receive_queue.lock);
  501. #ifdef CONFIG_FILTER
  502. drop_n_restore:
  503. #endif
  504. if (skb_head != skb->data && skb_shared(skb)) {
  505. skb->data = skb_head;
  506. skb->len = skb_len;
  507. }
  508. drop:
  509. kfree_skb(skb);
  510. return 0;
  511. }
  513. #ifdef CONFIG_PACKET_MMAP
  514. static int tpacket_rcv(struct sk_buff *skb, struct net_device *dev,  struct packet_type *pt)
  515. {
  516. struct sock *sk;
  517. struct packet_opt *po;
  518. struct sockaddr_ll *sll;
  519. struct tpacket_hdr *h;
  520. u8 * skb_head = skb->data;
  521. int skb_len = skb->len;
  522. unsigned snaplen;
  523. unsigned long status = TP_STATUS_LOSING|TP_STATUS_USER;
  524. unsigned short macoff, netoff;
  525. struct sk_buff *copy_skb = NULL;
  527. if (skb->pkt_type == PACKET_LOOPBACK)
  528. goto drop;
  530. sk = (struct sock *) pt->data;
  531. po = sk->protinfo.af_packet;
  533. if (dev->hard_header) {
  534. if (sk->type != SOCK_DGRAM)
  535. skb_push(skb, skb->data - skb->mac.raw);
  536. else if (skb->pkt_type == PACKET_OUTGOING) {
  537. /* Special case: outgoing packets have ll header at head */
  538. skb_pull(skb, skb->nh.raw - skb->data);
  539. if (skb->ip_summed == CHECKSUM_HW)
  540. status |= TP_STATUS_CSUMNOTREADY;
  541. }
  542. }
  544. snaplen = skb->len;
  546. #ifdef CONFIG_FILTER
  547. if (sk->filter) {
  548. unsigned res = snaplen;
  549. struct sk_filter *filter;
  551. bh_lock_sock(sk);
  552. if ((filter = sk->filter) != NULL)
  553. res = sk_run_filter(skb, sk->filter->insns, sk->filter->len);
  554. bh_unlock_sock(sk);
  556. if (res == 0)
  557. goto drop_n_restore;
  558. if (snaplen > res)
  559. snaplen = res;
  560. }
  561. #endif
  563. if (sk->type == SOCK_DGRAM) {
  564. macoff = netoff = TPACKET_ALIGN(TPACKET_HDRLEN) + 16;
  565. } else {
  566. unsigned maclen = skb->nh.raw - skb->data;
  567. netoff = TPACKET_ALIGN(TPACKET_HDRLEN + (maclen < 16 ? 16 : maclen));
  568. macoff = netoff - maclen;
  569. }
  571. if (macoff + snaplen > po->frame_size) {
  572. if (po->copy_thresh &&
  573.     atomic_read(&sk->rmem_alloc) + skb->truesize < (unsigned)sk->rcvbuf) {
  574. if (skb_shared(skb)) {
  575. copy_skb = skb_clone(skb, GFP_ATOMIC);
  576. } else {
  577. copy_skb = skb_get(skb);
  578. skb_head = skb->data;
  579. }
  580. if (copy_skb)
  581. skb_set_owner_r(copy_skb, sk);
  582. }
  583. snaplen = po->frame_size - macoff;
  584. if ((int)snaplen < 0)
  585. snaplen = 0;
  586. }
  587. if (snaplen > skb->len-skb->data_len)
  588. snaplen = skb->len-skb->data_len;
  590. spin_lock(&sk->receive_queue.lock);
  591. h = po->iovec[po->head];
  593. if (h->tp_status)
  594. goto ring_is_full;
  595. po->head = po->head != po->iovmax ? po->head+1 : 0;
  596. po->stats.tp_packets++;
  597. if (copy_skb) {
  598. status |= TP_STATUS_COPY;
  599. __skb_queue_tail(&sk->receive_queue, copy_skb);
  600. }
  601. if (!po->stats.tp_drops)
  602. status &= ~TP_STATUS_LOSING;
  603. spin_unlock(&sk->receive_queue.lock);
  605. memcpy((u8*)h + macoff, skb->data, snaplen);
  607. h->tp_len = skb->len;
  608. h->tp_snaplen = snaplen;
  609. h->tp_mac = macoff;
  610. h->tp_net = netoff;
  611. h->tp_sec = skb->stamp.tv_sec;
  612. h->tp_usec = skb->stamp.tv_usec;
  614. sll = (struct sockaddr_ll*)((u8*)h + TPACKET_ALIGN(sizeof(*h)));
  615. sll->sll_halen = 0;
  616. if (dev->hard_header_parse)
  617. sll->sll_halen = dev->hard_header_parse(skb, sll->sll_addr);
  618. sll->sll_family = AF_PACKET;
  619. sll->sll_hatype = dev->type;
  620. sll->sll_protocol = skb->protocol;
  621. sll->sll_pkttype = skb->pkt_type;
  622. sll->sll_ifindex = dev->ifindex;
  624. h->tp_status = status;
  625. mb();
  627. {
  628. struct page *p_start, *p_end;
  629. u8 *h_end = (u8 *)h + macoff + snaplen - 1;
  631. p_start = virt_to_page(h);
  632. p_end = virt_to_page(h_end);
  633. while (p_start <= p_end) {
  634. flush_dcache_page(p_start);
  635. p_start++;
  636. }
  637. }
  639. sk->data_ready(sk, 0);
  641. drop_n_restore:
  642. if (skb_head != skb->data && skb_shared(skb)) {
  643. skb->data = skb_head;
  644. skb->len = skb_len;
  645. }
  646. drop:
  647.         kfree_skb(skb);
  648. return 0;
  650. ring_is_full:
  651. po->stats.tp_drops++;
  652. spin_unlock(&sk->receive_queue.lock);
  654. sk->data_ready(sk, 0);
  655. if (copy_skb)
  656. kfree_skb(copy_skb);
  657. goto drop_n_restore;
  658. }
  660. #endif
  663. static int packet_sendmsg(struct socket *sock, struct msghdr *msg, int len,
  664.   struct scm_cookie *scm)
  665. {
  666. struct sock *sk = sock->sk;
  667. struct sockaddr_ll *saddr=(struct sockaddr_ll *)msg->msg_name;
  668. struct sk_buff *skb;
  669. struct net_device *dev;
  670. unsigned short proto;
  671. unsigned char *addr;
  672. int ifindex, err, reserve = 0;
  674. /*
  675.  * Get and verify the address. 
  676.  */
  677.  
  678. if (saddr == NULL) {
  679. ifindex = sk->protinfo.af_packet->ifindex;
  680. proto = sk->num;
  681. addr = NULL;
  682. } else {
  683. err = -EINVAL;
  684. if (msg->msg_namelen < sizeof(struct sockaddr_ll))
  685. goto out;
  686. ifindex = saddr->sll_ifindex;
  687. proto = saddr->sll_protocol;
  688. addr = saddr->sll_addr;
  689. }
  692. dev = dev_get_by_index(ifindex);
  693. err = -ENXIO;
  694. if (dev == NULL)
  695. goto out_unlock;
  696. if (sock->type == SOCK_RAW)
  697. reserve = dev->hard_header_len;
  699. err = -EMSGSIZE;
  700. if (len > dev->mtu+reserve)
  701. goto out_unlock;
  703. skb = sock_alloc_send_skb(sk, len+dev->hard_header_len+15, 
  704. msg->msg_flags & MSG_DONTWAIT, &err);
  705. if (skb==NULL)
  706. goto out_unlock;
  708. skb_reserve(skb, (dev->hard_header_len+15)&~15);
  709. skb->nh.raw = skb->data;
  711. if (dev->hard_header) {
  712. int res;
  713. err = -EINVAL;
  714. res = dev->hard_header(skb, dev, ntohs(proto), addr, NULL, len);
  715. if (sock->type != SOCK_DGRAM) {
  716. skb->tail = skb->data;
  717. skb->len = 0;
  718. } else if (res < 0)
  719. goto out_free;
  720. }
  722. /* Returns -EFAULT on error */
  723. err = memcpy_fromiovec(skb_put(skb,len), msg->msg_iov, len);
  724. if (err)
  725. goto out_free;
  727. skb->protocol = proto;
  728. skb->dev = dev;
  729. skb->priority = sk->priority;
  731. err = -ENETDOWN;
  732. if (!(dev->flags & IFF_UP))
  733. goto out_free;
  735. /*
  736.  * Now send it
  737.  */
  739. err = dev_queue_xmit(skb);
  740. if (err > 0 && (err = net_xmit_errno(err)) != 0)
  741. goto out_unlock;
  743. dev_put(dev);
  745. return(len);
  747. out_free:
  748. kfree_skb(skb);
  749. out_unlock:
  750. if (dev)
  751. dev_put(dev);
  752. out:
  753. return err;
  754. }
  756. /*
  757.  * Close a PACKET socket. This is fairly simple. We immediately go
  758.  * to 'closed' state and remove our protocol entry in the device list.
  759.  */
  761. static int packet_release(struct socket *sock)
  762. {
  763. struct sock *sk = sock->sk;
  764. struct sock **skp;
  766. if (!sk)
  767. return 0;
  769. write_lock_bh(&packet_sklist_lock);
  770. for (skp = &packet_sklist; *skp; skp = &(*skp)->next) {
  771. if (*skp == sk) {
  772. *skp = sk->next;
  773. __sock_put(sk);
  774. break;
  775. }
  776. }
  777. write_unlock_bh(&packet_sklist_lock);
  779. /*
  780.  * Unhook packet receive handler.
  781.  */
  783. if (sk->protinfo.af_packet->running) {
  784. /*
  785.  * Remove the protocol hook
  786.  */
  787. dev_remove_pack(&sk->protinfo.af_packet->prot_hook);
  788. sk->protinfo.af_packet->running = 0;
  789. __sock_put(sk);
  790. }
  792. #ifdef CONFIG_PACKET_MULTICAST
  793. packet_flush_mclist(sk);
  794. #endif
  796. #ifdef CONFIG_PACKET_MMAP
  797. if (sk->protinfo.af_packet->pg_vec) {
  798. struct tpacket_req req;
  799. memset(&req, 0, sizeof(req));
  800. packet_set_ring(sk, &req, 1);
  801. }
  802. #endif
  804. /*
  805.  * Now the socket is dead. No more input will appear.
  806.  */
  808. sock_orphan(sk);
  809. sock->sk = NULL;
  811. /* Purge queues */
  813. skb_queue_purge(&sk->receive_queue);
  815. sock_put(sk);
  816. return 0;
  817. }
  819. /*
  820.  * Attach a packet hook.
  821.  */
  823. static int packet_do_bind(struct sock *sk, struct net_device *dev, int protocol)
  824. {
  825. /*
  826.  * Detach an existing hook if present.
  827.  */
  829. lock_sock(sk);
  831. spin_lock(&sk->protinfo.af_packet->bind_lock);
  832. if (sk->protinfo.af_packet->running) {
  833. dev_remove_pack(&sk->protinfo.af_packet->prot_hook);
  834. __sock_put(sk);
  835. sk->protinfo.af_packet->running = 0;
  836. }
  838. sk->num = protocol;
  839. sk->protinfo.af_packet->prot_hook.type = protocol;
  840. sk->protinfo.af_packet->prot_hook.dev = dev;
  842. sk->protinfo.af_packet->ifindex = dev ? dev->ifindex : 0;
  844. if (protocol == 0)
  845. goto out_unlock;
  847. if (dev) {
  848. if (dev->flags&IFF_UP) {
  849. dev_add_pack(&sk->protinfo.af_packet->prot_hook);
  850. sock_hold(sk);
  851. sk->protinfo.af_packet->running = 1;
  852. } else {
  853. sk->err = ENETDOWN;
  854. if (!sk->dead)
  855. sk->error_report(sk);
  856. }
  857. } else {
  858. dev_add_pack(&sk->protinfo.af_packet->prot_hook);
  859. sock_hold(sk);
  860. sk->protinfo.af_packet->running = 1;
  861. }
  863. out_unlock:
  864. spin_unlock(&sk->protinfo.af_packet->bind_lock);
  865. release_sock(sk);
  866. return 0;
  867. }
  869. /*
  870.  * Bind a packet socket to a device
  871.  */
  873. #ifdef CONFIG_SOCK_PACKET
  875. static int packet_bind_spkt(struct socket *sock, struct sockaddr *uaddr, int addr_len)
  876. {
  877. struct sock *sk=sock->sk;
  878. char name[15];
  879. struct net_device *dev;
  880. int err = -ENODEV;
  882. /*
  883.  * Check legality
  884.  */
  885.  
  886. if(addr_len!=sizeof(struct sockaddr))
  887. return -EINVAL;
  888. strncpy(name,uaddr->sa_data,14);
  889. name[14]=0;
  891. dev = dev_get_by_name(name);
  892. if (dev) {
  893. err = packet_do_bind(sk, dev, sk->num);
  894. dev_put(dev);
  895. }
  896. return err;
  897. }
  898. #endif
  900. static int packet_bind(struct socket *sock, struct sockaddr *uaddr, int addr_len)
  901. {
  902. struct sockaddr_ll *sll = (struct sockaddr_ll*)uaddr;
  903. struct sock *sk=sock->sk;
  904. struct net_device *dev = NULL;
  905. int err;
  908. /*
  909.  * Check legality
  910.  */
  911.  
  912. if (addr_len < sizeof(struct sockaddr_ll))
  913. return -EINVAL;
  914. if (sll->sll_family != AF_PACKET)
  915. return -EINVAL;
  917. if (sll->sll_ifindex) {
  918. err = -ENODEV;
  919. dev = dev_get_by_index(sll->sll_ifindex);
  920. if (dev == NULL)
  921. goto out;
  922. }
  923. err = packet_do_bind(sk, dev, sll->sll_protocol ? : sk->num);
  924. if (dev)
  925. dev_put(dev);
  927. out:
  928. return err;
  929. }
  932. /*
  933.  * Create a packet of type SOCK_PACKET. 
  934.  */
  936. static int packet_create(struct socket *sock, int protocol)
  937. {
  938. struct sock *sk;
  939. int err;
  941. if (!capable(CAP_NET_RAW))
  942. return -EPERM;
  943. if (sock->type != SOCK_DGRAM && sock->type != SOCK_RAW
  944. #ifdef CONFIG_SOCK_PACKET
  945.     && sock->type != SOCK_PACKET
  946. #endif
  947.     )
  948. return -ESOCKTNOSUPPORT;
  950. sock->state = SS_UNCONNECTED;
  951. MOD_INC_USE_COUNT;
  953. err = -ENOBUFS;
  954. sk = sk_alloc(PF_PACKET, GFP_KERNEL, 1);
  955. if (sk == NULL)
  956. goto out;
  958. sock->ops = &packet_ops;
  959. #ifdef CONFIG_SOCK_PACKET
  960. if (sock->type == SOCK_PACKET)
  961. sock->ops = &packet_ops_spkt;
  962. #endif
  963. sock_init_data(sock,sk);
  965. sk->protinfo.af_packet = kmalloc(sizeof(struct packet_opt), GFP_KERNEL);
  966. if (sk->protinfo.af_packet == NULL)
  967. goto out_free;
  968. memset(sk->protinfo.af_packet, 0, sizeof(struct packet_opt));
  969. sk->family = PF_PACKET;
  970. sk->num = protocol;
  972. sk->destruct = packet_sock_destruct;
  973. atomic_inc(&packet_socks_nr);
  975. /*
  976.  * Attach a protocol block
  977.  */
  979. spin_lock_init(&sk->protinfo.af_packet->bind_lock);
  980. sk->protinfo.af_packet->prot_hook.func = packet_rcv;
  981. #ifdef CONFIG_SOCK_PACKET
  982. if (sock->type == SOCK_PACKET)
  983. sk->protinfo.af_packet->prot_hook.func = packet_rcv_spkt;
  984. #endif
  985. sk->protinfo.af_packet->prot_hook.data = (void *)sk;
  987. if (protocol) {
  988. sk->protinfo.af_packet->prot_hook.type = protocol;
  989. dev_add_pack(&sk->protinfo.af_packet->prot_hook);
  990. sock_hold(sk);
  991. sk->protinfo.af_packet->running = 1;
  992. }
  994. write_lock_bh(&packet_sklist_lock);
  995. sk->next = packet_sklist;
  996. packet_sklist = sk;
  997. sock_hold(sk);
  998. write_unlock_bh(&packet_sklist_lock);
  999. return(0);
  1001. out_free:
  1002. sk_free(sk);
  1003. out:
  1004. MOD_DEC_USE_COUNT;
  1005. return err;
  1006. }
  1008. /*
  1009.  * Pull a packet from our receive queue and hand it to the user.
  1010.  * If necessary we block.
  1011.  */
  1013. static int packet_recvmsg(struct socket *sock, struct msghdr *msg, int len,
  1014.   int flags, struct scm_cookie *scm)
  1015. {
  1016. struct sock *sk = sock->sk;
  1017. struct sk_buff *skb;
  1018. int copied, err;
  1020. err = -EINVAL;
  1021. if (flags & ~(MSG_PEEK|MSG_DONTWAIT|MSG_TRUNC))
  1022. goto out;
  1024. #if 0
  1025. /* What error should we return now? EUNATTACH? */
  1026. if (sk->protinfo.af_packet->ifindex < 0)
  1027. return -ENODEV;
  1028. #endif
  1030. /*
  1031.  * If the address length field is there to be filled in, we fill
  1032.  * it in now.
  1033.  */
  1035. if (sock->type == SOCK_PACKET)
  1036. msg->msg_namelen = sizeof(struct sockaddr_pkt);
  1037. else
  1038. msg->msg_namelen = sizeof(struct sockaddr_ll);
  1040. /*
  1041.  * Call the generic datagram receiver. This handles all sorts
  1042.  * of horrible races and re-entrancy so we can forget about it
  1043.  * in the protocol layers.
  1044.  *
  1045.  * Now it will return ENETDOWN, if device have just gone down,
  1046.  * but then it will block.
  1047.  */
  1049. skb=skb_recv_datagram(sk,flags,flags&MSG_DONTWAIT,&err);
  1051. /*
  1052.  * An error occurred so return it. Because skb_recv_datagram() 
  1053.  * handles the blocking we don't see and worry about blocking
  1054.  * retries.
  1055.  */
  1057. if(skb==NULL)
  1058. goto out;
  1060. /*
  1061.  * You lose any data beyond the buffer you gave. If it worries a
  1062.  * user program they can ask the device for its MTU anyway.
  1063.  */
  1065. copied = skb->len;
  1066. if (copied > len)
  1067. {
  1068. copied=len;
  1069. msg->msg_flags|=MSG_TRUNC;
  1070. }
  1072. err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied);
  1073. if (err)
  1074. goto out_free;
  1076. sock_recv_timestamp(msg, sk, skb);
  1078. if (msg->msg_name)
  1079. memcpy(msg->msg_name, skb->cb, msg->msg_namelen);
  1081. /*
  1082.  * Free or return the buffer as appropriate. Again this
  1083.  * hides all the races and re-entrancy issues from us.
  1084.  */
  1085. err = (flags&MSG_TRUNC) ? skb->len : copied;
  1087. out_free:
  1088. skb_free_datagram(sk, skb);
  1089. out:
  1090. return err;
  1091. }
  1093. #ifdef CONFIG_SOCK_PACKET
  1094. static int packet_getname_spkt(struct socket *sock, struct sockaddr *uaddr,
  1095.        int *uaddr_len, int peer)
  1096. {
  1097. struct net_device *dev;
  1098. struct sock *sk = sock->sk;
  1100. if (peer)
  1101. return -EOPNOTSUPP;
  1103. uaddr->sa_family = AF_PACKET;
  1104. dev = dev_get_by_index(sk->protinfo.af_packet->ifindex);
  1105. if (dev) {
  1106. strncpy(uaddr->sa_data, dev->name, 15);
  1107. dev_put(dev);
  1108. } else
  1109. memset(uaddr->sa_data, 0, 14);
  1110. *uaddr_len = sizeof(*uaddr);
  1112. return 0;
  1113. }
  1114. #endif
  1116. static int packet_getname(struct socket *sock, struct sockaddr *uaddr,
  1117.   int *uaddr_len, int peer)
  1118. {
  1119. struct net_device *dev;
  1120. struct sock *sk = sock->sk;
  1121. struct sockaddr_ll *sll = (struct sockaddr_ll*)uaddr;
  1123. if (peer)
  1124. return -EOPNOTSUPP;
  1126. sll->sll_family = AF_PACKET;
  1127. sll->sll_ifindex = sk->protinfo.af_packet->ifindex;
  1128. sll->sll_protocol = sk->num;
  1129. dev = dev_get_by_index(sk->protinfo.af_packet->ifindex);
  1130. if (dev) {
  1131. sll->sll_hatype = dev->type;
  1132. sll->sll_halen = dev->addr_len;
  1133. memcpy(sll->sll_addr, dev->dev_addr, dev->addr_len);
  1134. dev_put(dev);
  1135. } else {
  1136. sll->sll_hatype = 0; /* Bad: we have no ARPHRD_UNSPEC */
  1137. sll->sll_halen = 0;
  1138. }
  1139. *uaddr_len = sizeof(*sll);
  1141. return 0;
  1142. }
  1144. #ifdef CONFIG_PACKET_MULTICAST
  1145. static void packet_dev_mc(struct net_device *dev, struct packet_mclist *i, int what)
  1146. {
  1147. switch (i->type) {
  1148. case PACKET_MR_MULTICAST:
  1149. if (what > 0)
  1150. dev_mc_add(dev, i->addr, i->alen, 0);
  1151. else
  1152. dev_mc_delete(dev, i->addr, i->alen, 0);
  1153. break;
  1154. case PACKET_MR_PROMISC:
  1155. dev_set_promiscuity(dev, what);
  1156. break;
  1157. case PACKET_MR_ALLMULTI:
  1158. dev_set_allmulti(dev, what);
  1159. break;
  1160. default:;
  1161. }
  1162. }
  1164. static void packet_dev_mclist(struct net_device *dev, struct packet_mclist *i, int what)
  1165. {
  1166. for ( ; i; i=i->next) {
  1167. if (i->ifindex == dev->ifindex)
  1168. packet_dev_mc(dev, i, what);
  1169. }
  1170. }
  1172. static int packet_mc_add(struct sock *sk, struct packet_mreq *mreq)
  1173. {
  1174. struct packet_mclist *ml, *i;
  1175. struct net_device *dev;
  1176. int err;
  1178. rtnl_lock();
  1180. err = -ENODEV;
  1181. dev = __dev_get_by_index(mreq->mr_ifindex);
  1182. if (!dev)
  1183. goto done;
  1185. err = -EINVAL;
  1186. if (mreq->mr_alen > dev->addr_len)
  1187. goto done;
  1189. err = -ENOBUFS;
  1190. i = (struct packet_mclist *)kmalloc(sizeof(*i), GFP_KERNEL);
  1191. if (i == NULL)
  1192. goto done;
  1194. err = 0;
  1195. for (ml=sk->protinfo.af_packet->mclist; ml; ml=ml->next) {
  1196. if (ml->ifindex == mreq->mr_ifindex &&
  1197.     ml->type == mreq->mr_type &&
  1198.     ml->alen == mreq->mr_alen &&
  1199.     memcmp(ml->addr, mreq->mr_address, ml->alen) == 0) {
  1200. ml->count++;
  1201. /* Free the new element ... */
  1202. kfree(i);
  1203. goto done;
  1204. }
  1205. }
  1207. i->type = mreq->mr_type;
  1208. i->ifindex = mreq->mr_ifindex;
  1209. i->alen = mreq->mr_alen;
  1210. memcpy(i->addr, mreq->mr_address, i->alen);
  1211. i->count = 1;
  1212. i->next = sk->protinfo.af_packet->mclist;
  1213. sk->protinfo.af_packet->mclist = i;
  1214. packet_dev_mc(dev, i, +1);
  1216. done:
  1217. rtnl_unlock();
  1218. return err;
  1219. }
  1221. static int packet_mc_drop(struct sock *sk, struct packet_mreq *mreq)
  1222. {
  1223. struct packet_mclist *ml, **mlp;
  1225. rtnl_lock();
  1227. for (mlp=&sk->protinfo.af_packet->mclist; (ml=*mlp)!=NULL; mlp=&ml->next) {
  1228. if (ml->ifindex == mreq->mr_ifindex &&
  1229.     ml->type == mreq->mr_type &&
  1230.     ml->alen == mreq->mr_alen &&
  1231.     memcmp(ml->addr, mreq->mr_address, ml->alen) == 0) {
  1232. if (--ml->count == 0) {
  1233. struct net_device *dev;
  1234. *mlp = ml->next;
  1235. dev = dev_get_by_index(ml->ifindex);
  1236. if (dev) {
  1237. packet_dev_mc(dev, ml, -1);
  1238. dev_put(dev);
  1239. }
  1240. kfree(ml);
  1241. }
  1242. rtnl_unlock();
  1243. return 0;
  1244. }
  1245. }
  1246. rtnl_unlock();
  1247. return -EADDRNOTAVAIL;
  1248. }
  1250. static void packet_flush_mclist(struct sock *sk)
  1251. {
  1252. struct packet_mclist *ml;
  1254. if (sk->protinfo.af_packet->mclist == NULL)
  1255. return;
  1257. rtnl_lock();
  1258. while ((ml=sk->protinfo.af_packet->mclist) != NULL) {
  1259. struct net_device *dev;
  1260. sk->protinfo.af_packet->mclist = ml->next;
  1261. if ((dev = dev_get_by_index(ml->ifindex)) != NULL) {
  1262. packet_dev_mc(dev, ml, -1);
  1263. dev_put(dev);
  1264. }
  1265. kfree(ml);
  1266. }
  1267. rtnl_unlock();
  1268. }
  1269. #endif
  1271. static int
  1272. packet_setsockopt(struct socket *sock, int level, int optname, char *optval, int optlen)
  1273. {
  1274. struct sock *sk = sock->sk;
  1275. int ret;
  1277. if (level != SOL_PACKET)
  1278. return -ENOPROTOOPT;
  1280. switch(optname) {
  1281. #ifdef CONFIG_PACKET_MULTICAST
  1282. case PACKET_ADD_MEMBERSHIP:
  1283. case PACKET_DROP_MEMBERSHIP:
  1284. {
  1285. struct packet_mreq mreq;
  1286. if (optlen<sizeof(mreq))
  1287. return -EINVAL;
  1288. if (copy_from_user(&mreq,optval,sizeof(mreq)))
  1289. return -EFAULT;
  1290. if (optname == PACKET_ADD_MEMBERSHIP)
  1291. ret = packet_mc_add(sk, &mreq);
  1292. else
  1293. ret = packet_mc_drop(sk, &mreq);
  1294. return ret;
  1295. }
  1296. #endif
  1297. #ifdef CONFIG_PACKET_MMAP
  1298. case PACKET_RX_RING:
  1299. {
  1300. struct tpacket_req req;
  1302. if (optlen<sizeof(req))
  1303. return -EINVAL;
  1304. if (copy_from_user(&req,optval,sizeof(req)))
  1305. return -EFAULT;
  1306. return packet_set_ring(sk, &req, 0);
  1307. }
  1308. case PACKET_COPY_THRESH:
  1309. {
  1310. int val;
  1312. if (optlen!=sizeof(val))
  1313. return -EINVAL;
  1314. if (copy_from_user(&val,optval,sizeof(val)))
  1315. return -EFAULT;
  1317. sk->protinfo.af_packet->copy_thresh = val;
  1318. return 0;
  1319. }
  1320. #endif
  1321. default:
  1322. return -ENOPROTOOPT;
  1323. }
  1324. }
  1326. int packet_getsockopt(struct socket *sock, int level, int optname,
  1327.       char *optval, int *optlen)
  1328. {
  1329. int len;
  1330. struct sock *sk = sock->sk;
  1332. if (level != SOL_PACKET)
  1333. return -ENOPROTOOPT;
  1335.    if (get_user(len,optlen))
  1336.    return -EFAULT;
  1338. if (len < 0)
  1339. return -EINVAL;
  1341. switch(optname) {
  1342. case PACKET_STATISTICS:
  1343. {
  1344. struct tpacket_stats st;
  1346. if (len > sizeof(struct tpacket_stats))
  1347. len = sizeof(struct tpacket_stats);
  1348. spin_lock_bh(&sk->receive_queue.lock);
  1349. st = sk->protinfo.af_packet->stats;
  1350. memset(&sk->protinfo.af_packet->stats, 0, sizeof(st));
  1351. spin_unlock_bh(&sk->receive_queue.lock);
  1352. st.tp_packets += st.tp_drops;
  1354. if (copy_to_user(optval, &st, len))
  1355. return -EFAULT;
  1356. break;
  1357. }
  1358. default:
  1359. return -ENOPROTOOPT;
  1360. }
  1362.    if (put_user(len, optlen))
  1363.    return -EFAULT;
  1364.    return 0;
  1365. }
  1368. static int packet_notifier(struct notifier_block *this, unsigned long msg, void *data)
  1369. {
  1370. struct sock *sk;
  1371. struct packet_opt *po;
  1372. struct net_device *dev = (struct net_device*)data;
  1374. read_lock(&packet_sklist_lock);
  1375. for (sk = packet_sklist; sk; sk = sk->next) {
  1376. po = sk->protinfo.af_packet;
  1378. switch (msg) {
  1379. case NETDEV_DOWN:
  1380. case NETDEV_UNREGISTER:
  1381. if (dev->ifindex == po->ifindex) {
  1382. spin_lock(&po->bind_lock);
  1383. if (po->running) {
  1384. dev_remove_pack(&po->prot_hook);
  1385. __sock_put(sk);
  1386. po->running = 0;
  1387. sk->err = ENETDOWN;
  1388. if (!sk->dead)
  1389. sk->error_report(sk);
  1390. }
  1391. if (msg == NETDEV_UNREGISTER) {
  1392. po->ifindex = -1;
  1393. po->prot_hook.dev = NULL;
  1394. }
  1395. spin_unlock(&po->bind_lock);
  1396. }
  1397. #ifdef CONFIG_PACKET_MULTICAST
  1398. if (po->mclist)
  1399. packet_dev_mclist(dev, po->mclist, -1);
  1400. #endif
  1401. break;
  1402. case NETDEV_UP:
  1403. spin_lock(&po->bind_lock);
  1404. if (dev->ifindex == po->ifindex && sk->num && po->running==0) {
  1405. dev_add_pack(&po->prot_hook);
  1406. sock_hold(sk);
  1407. po->running = 1;
  1408. }
  1409. spin_unlock(&po->bind_lock);
  1410. #ifdef CONFIG_PACKET_MULTICAST
  1411. if (po->mclist)
  1412. packet_dev_mclist(dev, po->mclist, +1);
  1413. #endif
  1414. break;
  1415. }
  1416. }
  1417. read_unlock(&packet_sklist_lock);
  1418. return NOTIFY_DONE;
  1419. }
  1422. static int packet_ioctl(struct socket *sock, unsigned int cmd,
  1423. unsigned long arg)
  1424. {
  1425. struct sock *sk = sock->sk;
  1427. switch(cmd) 
  1428. {
  1429. case SIOCOUTQ:
  1430. {
  1431. int amount = atomic_read(&sk->wmem_alloc);
  1432. return put_user(amount, (int *)arg);
  1433. }
  1434. case SIOCINQ:
  1435. {
  1436. struct sk_buff *skb;
  1437. int amount = 0;
  1439. spin_lock_bh(&sk->receive_queue.lock);
  1440. skb = skb_peek(&sk->receive_queue);
  1441. if (skb)
  1442. amount = skb->len;
  1443. spin_unlock_bh(&sk->receive_queue.lock);
  1444. return put_user(amount, (int *)arg);
  1445. }
  1446. case FIOSETOWN:
  1447. case SIOCSPGRP: {
  1448. int pid;
  1449. if (get_user(pid, (int *) arg))
  1450. return -EFAULT; 
  1451. if (current->pid != pid && current->pgrp != -pid && 
  1452.     !capable(CAP_NET_ADMIN))
  1453. return -EPERM;
  1454. sk->proc = pid;
  1455. break;
  1456. }
  1457. case FIOGETOWN:
  1458. case SIOCGPGRP:
  1459. return put_user(sk->proc, (int *)arg);
  1460. case SIOCGSTAMP:
  1461. if(sk->stamp.tv_sec==0)
  1462. return -ENOENT;
  1463. if (copy_to_user((void *)arg, &sk->stamp,
  1464.  sizeof(struct timeval)))
  1465. return -EFAULT;
  1466. break;
  1467. case SIOCGIFFLAGS:
  1468. #ifndef CONFIG_INET
  1469. case SIOCSIFFLAGS:
  1470. #endif
  1471. case SIOCGIFCONF:
  1472. case SIOCGIFMETRIC:
  1473. case SIOCSIFMETRIC:
  1474. case SIOCGIFMEM:
  1475. case SIOCSIFMEM:
  1476. case SIOCGIFMTU:
  1477. case SIOCSIFMTU:
  1478. case SIOCSIFLINK:
  1479. case SIOCGIFHWADDR:
  1480. case SIOCSIFHWADDR:
  1481. case SIOCSIFMAP:
  1482. case SIOCGIFMAP:
  1483. case SIOCSIFSLAVE:
  1484. case SIOCGIFSLAVE:
  1485. case SIOCGIFINDEX:
  1486. case SIOCGIFNAME:
  1487. case SIOCGIFCOUNT:
  1488. case SIOCSIFHWBROADCAST:
  1489. return(dev_ioctl(cmd,(void *) arg));
  1491. case SIOCGIFBR:
  1492. case SIOCSIFBR:
  1493. #if defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE)
  1494. #ifdef CONFIG_INET
  1495. #ifdef CONFIG_KMOD
  1496. if (br_ioctl_hook == NULL)
  1497. request_module("bridge");
  1498. #endif
  1499. if (br_ioctl_hook != NULL)
  1500. return br_ioctl_hook(arg);
  1501. #endif
  1502. #endif
  1503. return -ENOPKG;
  1505. case SIOCGIFDIVERT:
  1506. case SIOCSIFDIVERT:
  1507. #ifdef CONFIG_NET_DIVERT
  1508. return divert_ioctl(cmd, (struct divert_cf *) arg);
  1509. #else
  1510. return -ENOPKG;
  1511. #endif /* CONFIG_NET_DIVERT */
  1513. #ifdef CONFIG_INET
  1514. case SIOCADDRT:
  1515. case SIOCDELRT:
  1516. case SIOCDARP:
  1517. case SIOCGARP:
  1518. case SIOCSARP:
  1519. case SIOCGIFADDR:
  1520. case SIOCSIFADDR:
  1521. case SIOCGIFBRDADDR:
  1522. case SIOCSIFBRDADDR:
  1523. case SIOCGIFNETMASK:
  1524. case SIOCSIFNETMASK:
  1525. case SIOCGIFDSTADDR:
  1526. case SIOCSIFDSTADDR:
  1527. case SIOCSIFFLAGS:
  1528. case SIOCADDDLCI:
  1529. case SIOCDELDLCI:
  1530. return inet_dgram_ops.ioctl(sock, cmd, arg);
  1531. #endif
  1533. default:
  1534. if ((cmd >= SIOCDEVPRIVATE) &&
  1535.     (cmd <= (SIOCDEVPRIVATE + 15)))
  1536. return(dev_ioctl(cmd,(void *) arg));
  1538. #ifdef CONFIG_NET_RADIO
  1539. if((cmd >= SIOCIWFIRST) && (cmd <= SIOCIWLAST))
  1540. return(dev_ioctl(cmd,(void *) arg));
  1541. #endif
  1542. return -EOPNOTSUPP;
  1543. }
  1544. return 0;
  1545. }
  1547. #ifndef CONFIG_PACKET_MMAP
  1548. #define packet_mmap sock_no_mmap
  1549. #define packet_poll datagram_poll
  1550. #else
  1552. unsigned int packet_poll(struct file * file, struct socket *sock, poll_table *wait)
  1553. {
  1554. struct sock *sk = sock->sk;
  1555. struct packet_opt *po = sk->protinfo.af_packet;
  1556. unsigned int mask = datagram_poll(file, sock, wait);
  1558. spin_lock_bh(&sk->receive_queue.lock);
  1559. if (po->iovec) {
  1560. unsigned last = po->head ? po->head-1 : po->iovmax;
  1562. if (po->iovec[last]->tp_status)
  1563. mask |= POLLIN | POLLRDNORM;
  1564. }
  1565. spin_unlock_bh(&sk->receive_queue.lock);
  1566. return mask;
  1567. }
  1570. /* Dirty? Well, I still did not learn better way to account
  1571.  * for user mmaps.
  1572.  */
  1574. static void packet_mm_open(struct vm_area_struct *vma)
  1575. {
  1576. struct file *file = vma->vm_file;
  1577. struct inode *inode = file->f_dentry->d_inode;
  1578. struct socket * sock = &inode->u.socket_i;
  1579. struct sock *sk = sock->sk;
  1581. if (sk)
  1582. atomic_inc(&sk->protinfo.af_packet->mapped);
  1583. }
  1585. static void packet_mm_close(struct vm_area_struct *vma)
  1586. {
  1587. struct file *file = vma->vm_file;
  1588. struct inode *inode = file->f_dentry->d_inode;
  1589. struct socket * sock = &inode->u.socket_i;
  1590. struct sock *sk = sock->sk;
  1592. if (sk)
  1593. atomic_dec(&sk->protinfo.af_packet->mapped);
  1594. }
  1596. static struct vm_operations_struct packet_mmap_ops = {
  1597. open: packet_mm_open,
  1598. close: packet_mm_close,
  1599. };
  1601. static void free_pg_vec(unsigned long *pg_vec, unsigned order, unsigned len)
  1602. {
  1603. int i;
  1605. for (i=0; i<len; i++) {
  1606. if (pg_vec[i]) {
  1607. struct page *page, *pend;
  1609. pend = virt_to_page(pg_vec[i] + (PAGE_SIZE << order) - 1);
  1610. for (page = virt_to_page(pg_vec[i]); page <= pend; page++)
  1611. ClearPageReserved(page);
  1612. free_pages(pg_vec[i], order);
  1613. }
  1614. }
  1615. kfree(pg_vec);
  1616. }
  1619. static int packet_set_ring(struct sock *sk, struct tpacket_req *req, int closing)
  1620. {
  1621. unsigned long *pg_vec = NULL;
  1622. struct tpacket_hdr **io_vec = NULL;
  1623. struct packet_opt *po = sk->protinfo.af_packet;
  1624. int order = 0;
  1625. int err = 0;
  1627. if (req->tp_block_nr) {
  1628. int i, l;
  1629. int frames_per_block;
  1631. /* Sanity tests and some calculations */
  1632. if ((int)req->tp_block_size <= 0)
  1633. return -EINVAL;
  1634. if (req->tp_block_size&(PAGE_SIZE-1))
  1635. return -EINVAL;
  1636. if (req->tp_frame_size < TPACKET_HDRLEN)
  1637. return -EINVAL;
  1638. if (req->tp_frame_size&(TPACKET_ALIGNMENT-1))
  1639. return -EINVAL;
  1640. frames_per_block = req->tp_block_size/req->tp_frame_size;
  1641. if (frames_per_block <= 0)
  1642. return -EINVAL;
  1643. if (frames_per_block*req->tp_block_nr != req->tp_frame_nr)
  1644. return -EINVAL;
  1645. /* OK! */
  1647. /* Allocate page vector */
  1648. while ((PAGE_SIZE<<order) < req->tp_block_size)
  1649. order++;
  1651. err = -ENOMEM;
  1653. pg_vec = kmalloc(req->tp_block_nr*sizeof(unsigned long*), GFP_KERNEL);
  1654. if (pg_vec == NULL)
  1655. goto out;
  1656. memset(pg_vec, 0, req->tp_block_nr*sizeof(unsigned long*));
  1658. for (i=0; i<req->tp_block_nr; i++) {
  1659. struct page *page, *pend;
  1660. pg_vec[i] = __get_free_pages(GFP_KERNEL, order);
  1661. if (!pg_vec[i])
  1662. goto out_free_pgvec;
  1664. pend = virt_to_page(pg_vec[i] + (PAGE_SIZE << order) - 1);
  1665. for (page = virt_to_page(pg_vec[i]); page <= pend; page++)
  1666. SetPageReserved(page);
  1667. }
  1668. /* Page vector is allocated */
  1670. /* Draw frames */
  1671. io_vec = kmalloc(req->tp_frame_nr*sizeof(struct tpacket_hdr*), GFP_KERNEL);
  1672. if (io_vec == NULL)
  1673. goto out_free_pgvec;
  1674. memset(io_vec, 0, req->tp_frame_nr*sizeof(struct tpacket_hdr*));
  1676. l = 0;
  1677. for (i=0; i<req->tp_block_nr; i++) {
  1678. unsigned long ptr = pg_vec[i];
  1679. int k;
  1681. for (k=0; k<frames_per_block; k++, l++) {
  1682. io_vec[l] = (struct tpacket_hdr*)ptr;
  1683. io_vec[l]->tp_status = TP_STATUS_KERNEL;
  1684. ptr += req->tp_frame_size;
  1685. }
  1686. }
  1687. /* Done */
  1688. } else {
  1689. if (req->tp_frame_nr)
  1690. return -EINVAL;
  1691. }
  1693. lock_sock(sk);
  1695. /* Detach socket from network */
  1696. spin_lock(&po->bind_lock);
  1697. if (po->running)
  1698. dev_remove_pack(&po->prot_hook);
  1699. spin_unlock(&po->bind_lock);
  1701. err = -EBUSY;
  1702. if (closing || atomic_read(&po->mapped) == 0) {
  1703. err = 0;
  1704. #define XC(a, b) ({ __typeof__ ((a)) __t; __t = (a); (a) = (b); __t; })
  1706. spin_lock_bh(&sk->receive_queue.lock);
  1707. pg_vec = XC(po->pg_vec, pg_vec);
  1708. io_vec = XC(po->iovec, io_vec);
  1709. po->iovmax = req->tp_frame_nr-1;
  1710. po->head = 0;
  1711. po->frame_size = req->tp_frame_size;
  1712. spin_unlock_bh(&sk->receive_queue.lock);
  1714. order = XC(po->pg_vec_order, order);
  1715. req->tp_block_nr = XC(po->pg_vec_len, req->tp_block_nr);
  1717. po->pg_vec_pages = req->tp_block_size/PAGE_SIZE;
  1718. po->prot_hook.func = po->iovec ? tpacket_rcv : packet_rcv;
  1719. skb_queue_purge(&sk->receive_queue);
  1720. #undef XC
  1721. if (atomic_read(&po->mapped))
  1722. printk(KERN_DEBUG "packet_mmap: vma is busy: %dn", atomic_read(&po->mapped));
  1723. }
  1725. spin_lock(&po->bind_lock);
  1726. if (po->running)
  1727. dev_add_pack(&po->prot_hook);
  1728. spin_unlock(&po->bind_lock);
  1730. release_sock(sk);
  1732. if (io_vec)
  1733. kfree(io_vec);
  1735. out_free_pgvec:
  1736. if (pg_vec)
  1737. free_pg_vec(pg_vec, order, req->tp_block_nr);
  1738. out:
  1739. return err;
  1740. }
  1742. static int packet_mmap(struct file *file, struct socket *sock, struct vm_area_struct *vma)
  1743. {
  1744. struct sock *sk = sock->sk;
  1745. struct packet_opt *po = sk->protinfo.af_packet;
  1746. unsigned long size;
  1747. unsigned long start;
  1748. int err = -EINVAL;
  1749. int i;
  1751. if (vma->vm_pgoff)
  1752. return -EINVAL;
  1754. size = vma->vm_end - vma->vm_start;
  1756. lock_sock(sk);
  1757. if (po->pg_vec == NULL)
  1758. goto out;
  1759. if (size != po->pg_vec_len*po->pg_vec_pages*PAGE_SIZE)
  1760. goto out;
  1762. atomic_inc(&po->mapped);
  1763. start = vma->vm_start;
  1764. err = -EAGAIN;
  1765. for (i=0; i<po->pg_vec_len; i++) {
  1766. if (remap_page_range(start, __pa(po->pg_vec[i]),
  1767.      po->pg_vec_pages*PAGE_SIZE,
  1768.      vma->vm_page_prot))
  1769. goto out;
  1770. start += po->pg_vec_pages*PAGE_SIZE;
  1771. }
  1772. vma->vm_ops = &packet_mmap_ops;
  1773. err = 0;
  1775. out:
  1776. release_sock(sk);
  1777. return err;
  1778. }
  1779. #endif
  1782. #ifdef CONFIG_SOCK_PACKET
  1783. struct proto_ops packet_ops_spkt = {
  1784. family: PF_PACKET,
  1786. release: packet_release,
  1787. bind: packet_bind_spkt,
  1788. connect: sock_no_connect,
  1789. socketpair: sock_no_socketpair,
  1790. accept: sock_no_accept,
  1791. getname: packet_getname_spkt,
  1792. poll: datagram_poll,
  1793. ioctl: packet_ioctl,
  1794. listen: sock_no_listen,
  1795. shutdown: sock_no_shutdown,
  1796. setsockopt: sock_no_setsockopt,
  1797. getsockopt: sock_no_getsockopt,
  1798. sendmsg: packet_sendmsg_spkt,
  1799. recvmsg: packet_recvmsg,
  1800. mmap: sock_no_mmap,
  1801. sendpage: sock_no_sendpage,
  1802. };
  1803. #endif
  1805. struct proto_ops packet_ops = {
  1806. family: PF_PACKET,
  1808. release: packet_release,
  1809. bind: packet_bind,
  1810. connect: sock_no_connect,
  1811. socketpair: sock_no_socketpair,
  1812. accept: sock_no_accept,
  1813. getname: packet_getname, 
  1814. poll: packet_poll,
  1815. ioctl: packet_ioctl,
  1816. listen: sock_no_listen,
  1817. shutdown: sock_no_shutdown,
  1818. setsockopt: packet_setsockopt,
  1819. getsockopt: packet_getsockopt,
  1820. sendmsg: packet_sendmsg,
  1821. recvmsg: packet_recvmsg,
  1822. mmap: packet_mmap,
  1823. sendpage: sock_no_sendpage,
  1824. };
  1826. static struct net_proto_family packet_family_ops = {
  1827. family: PF_PACKET,
  1828. create: packet_create,
  1829. };
  1831. static struct notifier_block packet_netdev_notifier = {
  1832. notifier_call: packet_notifier,
  1833. };
  1835. #ifdef CONFIG_PROC_FS
  1836. static int packet_read_proc(char *buffer, char **start, off_t offset,
  1837.      int length, int *eof, void *data)
  1838. {
  1839. off_t pos=0;
  1840. off_t begin=0;
  1841. int len=0;
  1842. struct sock *s;
  1844. len+= sprintf(buffer,"sk       RefCnt Type Proto  Iface R Rmem   User   Inoden");
  1846. read_lock(&packet_sklist_lock);
  1848. for (s = packet_sklist; s; s = s->next) {
  1849. len+=sprintf(buffer+len,"%p %-6d %-4d %04x   %-5d %1d %-6u %-6u %-6lu",
  1850.      s,
  1851.      atomic_read(&s->refcnt),
  1852.      s->type,
  1853.      ntohs(s->num),
  1854.      s->protinfo.af_packet->ifindex,
  1855.      s->protinfo.af_packet->running,
  1856.      atomic_read(&s->rmem_alloc),
  1857.      sock_i_uid(s),
  1858.      sock_i_ino(s)
  1859.      );
  1861. buffer[len++]='n';
  1863. pos=begin+len;
  1864. if(pos<offset) {
  1865. len=0;
  1866. begin=pos;
  1867. }
  1868. if(pos>offset+length)
  1869. goto done;
  1870. }
  1871. *eof = 1;
  1873. done:
  1874. read_unlock(&packet_sklist_lock);
  1875. *start=buffer+(offset-begin);
  1876. len-=(offset-begin);
  1877. if(len>length)
  1878. len=length;
  1879. if(len<0)
  1880. len=0;
  1881. return len;
  1882. }
  1883. #endif
  1885. static void __exit packet_exit(void)
  1886. {
  1887. remove_proc_entry("net/packet", 0);
  1888. unregister_netdevice_notifier(&packet_netdev_notifier);
  1889. sock_unregister(PF_PACKET);
  1890. return;
  1891. }
  1893. static int __init packet_init(void)
  1894. {
  1895. sock_register(&packet_family_ops);
  1896. register_netdevice_notifier(&packet_netdev_notifier);
  1897. #ifdef CONFIG_PROC_FS
  1898. create_proc_read_entry("net/packet", 0, 0, packet_read_proc, NULL);
  1899. #endif
  1900. return 0;
  1901. }
  1903. module_init(packet_init);
  1904. module_exit(packet_exit);
  1905. MODULE_LICENSE("GPL");