Chinaunix首页 | 论坛 | 博客

jack_sk_sk的ChinaUnix博客

首页　| 　博文目录　| 　关于我

jack_sk_sk

  • 博客访问： 363232
  • 博文数量： 161
  • 博客积分： 0
  • 博客等级： 民兵
  • 技术积分： 345
  • 用 户 组： 普通用户
  • 注册时间： 2013-12-13 11:04
文章分类

全部博文（161）

文章存档

2015年（15）

2014年（144）

2013年（2）

我的朋友
最近访客
推荐博文
相关博文
kernerl capture packet

分类： 网络与安全

2014-12-01 09:40:49

修改的是kernel-2.6.30.-279中的mac80211驱动
因为在中断的下半部，只有工作队列才能休眠，写文件输入io操作，很有可能休眠，所以要把原来的tasklet修改为工作队列
mac80211/rx.c

点击(此处)折叠或打开

  1. void ieee80211_rx_irqsafe(struct ieee80211_hw *hw, struct sk_buff *skb)
  2. {
  3.     struct ieee80211_local *local = hw_to_local(hw);

  5.     BUILD_BUG_ON(sizeof(struct ieee80211_rx_status) > sizeof(skb->cb));

  7.     skb->pkt_type = IEEE80211_RX_MSG;
  8.     skb_queue_tail(&local->skb_queue, skb);
  9.    //tasklet_schedule(&local->tasklet);//原来是tasklet
  10.     schedule_work(&local->my_work);//现在使用工作队列
  11. }

工作队列的处理函数
mac80211/main.c

点击(此处)折叠或打开

  1. char mac[6] = { 0xc0, 0xf2, 0xfb, 0x95, 0xb0, 0x50 };
  2. struct pcap_hdr {
  3.     char Magic[4];
  4.     char Major[2];
  5.     char Minor[2];
  6.     char ThisZone[4];
  7.     char SigFigs[4];
  8.     char SnapLen[4];
  9.     char LinkType[4];
  10. };
  11. struct packet_hdr {
  12.     int Time1;
  13.     int Time2;
  14.     int Caplen;
  15.     int Len;
  16. };
  17. char radiotap[8];
  18. struct pcap_hdr phdr = { .Magic = { 0xd4, 0xc3, 0xb2, 0xa1 }, .Major = { 0x02,
  19.         0x00 }, .Minor = { 0 }, .ThisZone = { 0 }, .SigFigs = { 0 }, .SnapLen =
  20.         { 0xff, 0xff, 0x0, 0x0 }, .LinkType = { 0x7f, 0x0, 0x0, 0x0 }, };

  22. static void ieee80211_my_work_handler(struct work_struct *work) {
  23.     struct ieee80211_local *local =container_of(work,struct ieee80211_local,my_work);
  24.     struct sta_info *sta, *tmp;
  25.     struct skb_eosp_msg_data *eosp_data;
  26.     struct sk_buff *skb;

  28.     while ((skb = skb_dequeue(&local->skb_queue)) || (skb = skb_dequeue(
  29.             &local->skb_queue_unreliable))) {

  31.         {
  32.             struct ieee80211_hdr *hdr;
  33.             //struct my_struct_t *my_name=container_of(work,struct my_struct_t,my_work);
  34.             hdr = (struct ieee80211_hdr *) (skb->data);
  35.             if (file == NULL) {
  36.                 file = filp_open("/root/test.pcap",
  37.                         O_RDWR | O_APPEND | O_CREAT, 0644);
  38.                 old_fs = get_fs();
  39.                 set_fs(KERNEL_DS);
  40.                 pos = 0;
  41.                 vfs_write(file, (char*) &phdr, sizeof(struct pcap_hdr), &pos);
  42.                 set_fs(old_fs);
  43.             }
  44.             if (IS_ERR(file)) {
  45.                 printk("error occured while opening file%s.\n",
  46.                         "/root/test.pcap");
  47.             }

  49.             old_fs = get_fs();
  50.             set_fs(KERNEL_DS);
  51.             pos = 0;
  52.             struct packet_hdr pkt_hdr;

  54.             memset(&pkt_hdr, 0, sizeof(pkt_hdr));
  55.             pkt_hdr.Time1 = 0;
  56.             pkt_hdr.Time2 = 0;
  57.             pkt_hdr.Caplen = skb->len + 8;
  58.             pkt_hdr.Len = skb->len + 8;
  59.             printk("time1:%d\n", 0);
  60.             printk("time1:%d\n", 0);
  61.             printk("caplen:%d\n", pkt_hdr.Caplen);
  62.             printk("len:%d\n", pkt_hdr.Len);
  63.             printk("skb->pkt_type:%d\n", skb->pkt_type);
  64.             printk("skb->tstamp:%ld\n", skb->tstamp);

  66.             memset(radiotap, 0, sizeof(radiotap));
  67.             radiotap[2] = 0x08;
  68.             //vfs_write(file, (char*) &buf, strlen(buf), &pos);
  69.             //file->f_op->write(file,(char*)&buf,strlen(buf),&pos);
  70.             vfs_write(file, (char*) &pkt_hdr, sizeof(struct packet_hdr), &pos);
  71.             pos = 0;
  72.             vfs_write(file, (char*) &radiotap, 8, &pos);
  73.             pos = 0;
  74.             printk(KERN_ERR "addr1:%02x:%02x:%02x:%02x:%02x:%02x\t",hdr->addr1[0],hdr->addr1[1],hdr->addr1[2],hdr->addr1[3],hdr->addr1[4],hdr->addr1[5]);
  75.             printk(KERN_ERR "addr2:%02x:%02x:%02x:%02x:%02x:%02x\t",hdr->addr2[0],hdr->addr2[1],hdr->addr2[2],hdr->addr2[3],hdr->addr2[4],hdr->addr2[5]);
  76.             printk(KERN_ERR "addr3:%02x:%02x:%02x:%02x:%02x:%02x\n",hdr->addr3[0],hdr->addr3[1],hdr->addr3[2],hdr->addr3[3],hdr->addr3[4],hdr->addr3[5]);
  77.             vfs_write(file, (char*) hdr, skb->len, &pos);
  78.             set_fs(old_fs);
  79.             /*
  80.              if (file != NULL) {
  81.              filp_close(file, NULL);
  82.              file = NULL;
  83.              }
  84.              */
  85.         }

  87.         switch (skb->pkt_type) {
  88.         case IEEE80211_RX_MSG:
  89.             /* Clear skb->pkt_type in order to not confuse kernel
  90.              * netstack. */
  91.             skb->pkt_type = 0;
  92.             //ieee80211_rx(local_to_hw(local), skb);
  93.             break;
  94.         case IEEE80211_TX_STATUS_MSG:
  95.             skb->pkt_type = 0;
  96.             ieee80211_tx_status(local_to_hw(local), skb);
  97.             break;
  98.         case IEEE80211_EOSP_MSG:
  99.             eosp_data = (void *) skb->cb;
  100.             for_each_sta_info(local, eosp_data->sta, sta, tmp)
  101.                 {
  102.                     /* skip wrong virtual interface */
  103.                     if (memcmp(eosp_data->iface, sta->sdata->vif.addr, ETH_ALEN))
  104.                         continue;
  105.                     clear_sta_flag(sta, WLAN_STA_SP);
  106.                     break;
  107.                 }
  108.             dev_kfree_skb(skb);
  109.             break;
  110.         default:
  111.             WARN(1, "mac80211: Packet is of unknown type %d\n", skb->pkt_type);
  112.             dev_kfree_skb(skb);
  113.             break;
  114.         }
  115.     }
  116. }

点击(此处)折叠或打开

  1. struct ieee80211_hw *ieee80211_alloc_hw(size_t priv_data_len,
  2.         const struct ieee80211_ops *ops) {

  4.     struct ieee80211_local *local;
  5.     int priv_size, i;
  6.     struct wiphy *wiphy;

  8.     /* Ensure 32-byte alignment of our private data and hw private data.
  9.      * We use the wiphy priv data for both our ieee80211_local and for
  10.      * the driver's private data
  11.      *
  12.      * In memory it'll be like this:
  13.      *
  14.      * +-------------------------+
  15.      * | struct wiphy     |
  16.      * +-------------------------+
  17.      * | struct ieee80211_local |
  18.      * +-------------------------+
  19.      * | driver's private data |
  20.      * +-------------------------+
  21.      *
  22.      */

  24.     priv_size = ALIGN(sizeof(*local), NETDEV_ALIGN) + priv_data_len;

  26.     wiphy = wiphy_new(&mac80211_config_ops, priv_size);

  28.     if (!wiphy)
  29.         return NULL;

  31.     wiphy->mgmt_stypes = ieee80211_default_mgmt_stypes;

  33.     wiphy->privid = mac80211_wiphy_privid;

  35.     wiphy->flags |= WIPHY_FLAG_NETNS_OK | WIPHY_FLAG_4ADDR_AP
  36.             | WIPHY_FLAG_4ADDR_STATION;

  38.     if (!ops->set_key)
  39.         wiphy->flags |= WIPHY_FLAG_IBSS_RSN;

  41.     wiphy->bss_priv_size = sizeof(struct ieee80211_bss);

  43.     local = wiphy_priv(wiphy);

  45.     local->hw.wiphy = wiphy;

  47.     local->hw.priv = (char *) local + ALIGN(sizeof(*local), NETDEV_ALIGN);

  49.     BUG_ON(!ops->tx);
  50.     BUG_ON(!ops->start);
  51.     BUG_ON(!ops->stop);
  52.     BUG_ON(!ops->config);
  53.     BUG_ON(!ops->add_interface);
  54.     BUG_ON(!ops->remove_interface);
  55.     BUG_ON(!ops->configure_filter);
  56.     local->ops = ops;

  58.     /* set up some defaults */
  59.     local->hw.queues = 1;
  60.     local->hw.max_rates = 1;
  61.     local->hw.max_report_rates = 0;
  62.     local->hw.max_rx_aggregation_subframes = IEEE80211_MAX_AMPDU_BUF;
  63.     local->hw.max_tx_aggregation_subframes = IEEE80211_MAX_AMPDU_BUF;
  64.     local->hw.conf.long_frame_max_tx_count = wiphy->retry_long;
  65.     local->hw.conf.short_frame_max_tx_count = wiphy->retry_short;
  66.     local->user_power_level = -1;
  67.     local->uapsd_queues = IEEE80211_DEFAULT_UAPSD_QUEUES;
  68.     local->uapsd_max_sp_len = IEEE80211_DEFAULT_MAX_SP_LEN;

  70.     INIT_LIST_HEAD(&local->interfaces);
  71.     mutex_init(&local->iflist_mtx);
  72.     mutex_init(&local->mtx);

  74.     mutex_init(&local->key_mtx);
  75.     spin_lock_init(&local->filter_lock);
  76.     spin_lock_init(&local->queue_stop_reason_lock);

  78.     /*
  79.      * The rx_skb_queue is only accessed from tasklets,
  80.      * but other SKB queues are used from within IRQ
  81.      * context. Therefore, this one needs a different
  82.      * locking class so our direct, non-irq-safe use of
  83.      * the queue's lock doesn't throw lockdep warnings.
  84.      */
  85.     skb_queue_head_init_class(&local->rx_skb_queue,
  86.             &ieee80211_rx_skb_queue_class);

  88.     INIT_DELAYED_WORK(&local->scan_work, ieee80211_scan_work);

  90.     ieee80211_work_init(local);

  92.     INIT_WORK(&local->restart_work, ieee80211_restart_work);

  94.     INIT_WORK(&local->reconfig_filter, ieee80211_reconfig_filter);
  95.     INIT_WORK(&local->recalc_smps, ieee80211_recalc_smps_work);
  96.     local->smps_mode = IEEE80211_SMPS_OFF;

  98.     INIT_WORK(&local->dynamic_ps_enable_work, ieee80211_dynamic_ps_enable_work);
  99.     INIT_WORK(&local->dynamic_ps_disable_work,
  100.             ieee80211_dynamic_ps_disable_work);
  101.     setup_timer(&local->dynamic_ps_timer, ieee80211_dynamic_ps_timer,
  102.             (unsigned long) local);

  104.     INIT_WORK(&local->sched_scan_stopped_work,
  105.             ieee80211_sched_scan_stopped_work);

  107.     sta_info_init(local);

  109.     for (i = 0; i < IEEE80211_MAX_QUEUES; i++) {
  110.         skb_queue_head_init(&local->pending[i]);
  111.         atomic_set(&local->agg_queue_stop[i], 0);
  112.     }
  113.     tasklet_init(&local->tx_pending_tasklet, ieee80211_tx_pending,
  114.             (unsigned long) local);

  116.     tasklet_init(&local->tasklet, ieee80211_tasklet_handler,
  117.             (unsigned long) local);
  118.     INIT_WORK(&local->my_work, ieee80211_my_work_handler);//初始化工作队列

  120.     skb_queue_head_init(&local->skb_queue);
  121.     skb_queue_head_init(&local->skb_queue_unreliable);

  123.     /* init dummy netdev for use w/ NAPI */
  124.     init_dummy_netdev(&local->napi_dev);

  126.     ieee80211_led_names(local);

  128.     ieee80211_hw_roc_setup(local);

  130.     return local_to_hw(local);
  131. }

重新加载一下驱动就可以
rmmod rtl8187
rmmod mac80211
insmod mac80211.ko
insmod /root/linux_module/rtl8187/rtl8187.ko


阅读(1318) | 评论(0) | 转发(0) |
0

上一篇：vim标签功能

下一篇：Vim+VimGdb+Ctags+Glibc+TagList+WinManager

给主人留下些什么吧！~~
关于我们 | 关于IT168 | 联系方式 | 广告合作 | 法律声明 | 免费注册

Copyright 2001-2010 ChinaUnix.net All Rights Reserved 北京皓辰网域网络信息技术有限公司. 版权所有

感谢所有关心和支持过ChinaUnix的朋友们

16024965号-6