int regen_active = 0; int kill_regen = 0; int regen_pid = 0; unsigned long dsfs_skb_count = 0; static void p_timeout(unsigned long data) { SignalSemaphore((struct semaphore *)data); } int pm_sleep(int ticks) { struct timer_list l_timer; register int retCode; P_InitSemaphore(semaphore); if (!seconds) return 0; init_timer(&l_timer); l_timer.expires = jiffies + ((HZ / 100) * ticks); l_timer.data = (unsigned long)&semaphore; l_timer.function = p_timeout; add_timer(&l_timer); retCode = down_interruptible(&semaphore); del_timer(&l_timer); return ((retCode == -EINTR) ? -EINTR : 0); } int xmit_skb(struct sk_buff *skb) { dsfs_skb_count--; return (dev_queue_xmit(skb)); } void release_skb(struct sk_buff *skb) { dsfs_skb_count--; kfree_skb(skb); } struct sk_buff *create_xmit_packet(int interface, int *err, int *skb_len) { struct sk_buff *skb; struct net_device *dev; if (err) *err = 0; if (skb_len) *skb_len = 0; dev = dev_get_by_index(interface); if (!dev) { if (err) *err = -ENXIO; return NULL; } if (!(dev->flags & IFF_UP)) { dev_put(dev); if (err) *err = -ENETDOWN; return NULL; } skb = alloc_skb(dev->mtu + dev->hard_header_len + 15, GFP_ATOMIC); if (!skb) { dev_put(dev); if (err) *err = -ENOBUFS; return NULL; } dsfs_skb_count++; skb_reserve(skb, (dev->hard_header_len + 15) & ~15); skb->nh.raw = skb->data; if (skb_len) *skb_len = (dev->mtu + dev->hard_header_len + 4); skb->dev = dev; dev_put(dev); return skb; } struct vlan_ethhdr { unsigned char h_dest[6]; /* destination eth addr */ unsigned char h_source[6]; /* source ether addr */ unsigned short h_vlan_proto; /* Should always be 0x8100 */ unsigned short h_vlan_TCI; /* Encapsulates priority and VLAN ID */ unsigned short h_vlan_encapsulated_proto; /* packet type ID field (or len) */ }; void put_xmit_data(struct sk_buff *skb, unsigned char *data, int len, int proto, P_HANDLE *p_handle) { struct vlan_ethhdr *vlan; if (skb->dev->hard_header) skb->dev->hard_header(skb, skb->dev, ntohs(proto), NULL, NULL, len); skb->tail = skb->data; skb->len = 0; // strip vlan headers if told to do so vlan = (struct vlan_ethhdr *)data; if ((p_handle->xmit_flags & STRIP_VLAN) && (ntohs(vlan->h_vlan_proto) == 0x8100)) { memmove(skb->data, data, 12); memmove(&skb->data[12], &data[16], len - 16); skb_put(skb, len - 4); } else { memmove(skb->data, data, len); skb_put(skb, len); } skb->protocol = proto; return; } int xmit_packet(struct sk_buff *skb) { struct net_device *dev; int err; dev = dev_get_by_index(skb->dev->ifindex); if (!dev) { release_skb(skb); return -ENXIO; } if (!(dev->flags & IFF_UP)) { dev_put(dev); release_skb(skb); return -ENETDOWN; } skb->priority = 0; // 0-6 set to 0 err = xmit_skb(skb); if (err > 0 && (err = net_xmit_errno(err)) != 0) { dev_put(dev); return err; } dev_put(dev); return 0; } int regen_data(void *arg) { register ULONG pindex; struct sk_buff *skb; long long size; int err, skb_len; ULONG length = 0; VIRTUAL_SETUP *v = (VIRTUAL_SETUP *)arg; P_HANDLE *p_handle; #if LINUX_26 daemonize("if_regen%d", (int)v->pid); #else sprintf(current->comm, "if_regen%d", (int)v->pid); daemonize(); #endif regen_active++; v->active++; while (v->ctl) { retry:; if (v->interval) { #if LINUX_26 v->currtime = CURRENT_TIME.tv_sec; #else v->currtime = CURRENT_TIME; #endif if (v->lasttime == v->currtime) { if (v->totalbytes >= (v->interval * (1000000 / 8))) { pi_sleep(1); goto retry; } } } if (kill_regen) break; skb = create_xmit_packet(v->pindex, &err, &skb_len); if (!skb) { switch (err) { case -ENXIO: v->retry_errors++; v->interface_errors++; if (!pm_sleep(VIRTUAL_SLEEP)) goto retry; goto exit_process; case -ENETDOWN: v->interface_errors++; v->retry_errors++; if (!pm_sleep(VIRTUAL_SLEEP)) goto retry; goto exit_process; case -EMSGSIZE: v->size_errors++; v->retry_errors++; if (!pm_sleep(VIRTUAL_SLEEP)) goto retry; goto exit_process; case -EINVAL: v->fault_errors++; v->retry_errors++; if (!pm_sleep(VIRTUAL_SLEEP)) goto retry; goto exit_process; case -ENOBUFS: v->no_buffer_errors++; v->retry_errors++; if (!pm_sleep(VIRTUAL_SLEEP)) goto retry; goto exit_process; default: v->fault_errors++; v->retry_errors++; if (!pm_sleep(VIRTUAL_SLEEP)) goto retry; goto exit_process; } } read_again:; if ((kill_regen) || (!v->ctl)) { release_skb(skb); goto exit_process; } p_handle = v->p_handle; if (!p_handle) { release_skb(skb); goto exit_process; } // this is the function that copies data into the skb // via copy_to_iovec pindex = regen_chain_packet(v->interface, skb, skb_len, p_handle, &length, NULL, NULL, &p_handle->start, &p_handle->end, v->d); if (pindex == -ENOENT) { release_skb(skb); goto exit_process; } if (pindex == 0xFFFFFFFF) { if (!pm_sleep(VIRTUAL_SLEEP)) goto read_again; release_skb(skb); goto exit_process; } if (!length) { if (!pm_sleep(VIRTUAL_SLEEP)) goto read_again; release_skb(skb); goto exit_process; } size = skb->len; err = xmit_packet(skb); if (err) { v->packets_aborted++; } else { v->bytes_xmit += size; v->packets_xmit++; } if (v->interval) { #if LINUX_26 v->currtime = CURRENT_TIME.tv_sec; #else v->currtime = CURRENT_TIME; #endif if (v->lasttime != v->currtime) v->totalbytes = 0; v->totalbytes += size; v->lasttime = v->currtime; } } exit_process:; v->active--; regen_active--; return 0; }