ray_cs.c

h内核

        if ((proto == 0xf380) || (proto == 0x3781)) {
            /* This is the selective translation table, only 2 entries */
            writeb(0xf8, &((struct snaphdr_t __iomem *)ptx->var)->org[3]);
        }
        /* Copy body of ethernet packet without ethernet header */
        memcpy_toio((void __iomem *)&ptx->var + sizeof(struct snaphdr_t), \
                    data + ETH_HLEN,  len - ETH_HLEN);
        return (int) sizeof(struct snaphdr_t) - ETH_HLEN;
    }
    else { /* already  802 type, and proto is length */
        DEBUG(3,"ray_cs translate_frame 802\n");
        if (proto == 0xffff) { /* evil netware IPX 802.3 without LLC */
        DEBUG(3,"ray_cs translate_frame evil IPX\n");
            memcpy_toio(&ptx->var, data + ETH_HLEN,  len - ETH_HLEN);
            return 0 - ETH_HLEN;
        }
        memcpy_toio(&ptx->var, data + ETH_HLEN,  len - ETH_HLEN);
        return 0 - ETH_HLEN;
    }
    /* TBD do other frame types */
} /* end translate_frame */
/*===========================================================================*/
static void ray_build_header(ray_dev_t *local, struct tx_msg __iomem *ptx, UCHAR msg_type,
                unsigned char *data)
{
    writeb(PROTOCOL_VER | msg_type, &ptx->mac.frame_ctl_1);
/*** IEEE 802.11 Address field assignments *************
                TODS FROMDS   addr_1     addr_2          addr_3   addr_4
Adhoc           0    0        dest       src (terminal)  BSSID    N/A
AP to Terminal  0    1        dest       AP(BSSID)       source   N/A
Terminal to AP  1    0        AP(BSSID)  src (terminal)  dest     N/A
AP to AP        1    1        dest AP    src AP          dest     source      
*******************************************************/
    if (local->net_type == ADHOC) {   
        writeb(0, &ptx->mac.frame_ctl_2);
        memcpy_toio(ptx->mac.addr_1, ((struct ethhdr *)data)->h_dest, 2 * ADDRLEN);
        memcpy_toio(ptx->mac.addr_3, local->bss_id, ADDRLEN);
    }
    else /* infrastructure */
    {
        if (local->sparm.b4.a_acting_as_ap_status)
        {
            writeb(FC2_FROM_DS, &ptx->mac.frame_ctl_2);
            memcpy_toio(ptx->mac.addr_1, ((struct ethhdr *)data)->h_dest, ADDRLEN);
            memcpy_toio(ptx->mac.addr_2, local->bss_id, 6);
            memcpy_toio(ptx->mac.addr_3, ((struct ethhdr *)data)->h_source, ADDRLEN);
        }
        else /* Terminal */
        {
            writeb(FC2_TO_DS, &ptx->mac.frame_ctl_2);
            memcpy_toio(ptx->mac.addr_1, local->bss_id, ADDRLEN);
            memcpy_toio(ptx->mac.addr_2, ((struct ethhdr *)data)->h_source, ADDRLEN);
            memcpy_toio(ptx->mac.addr_3, ((struct ethhdr *)data)->h_dest, ADDRLEN);
        }
    }
} /* end encapsulate_frame */


/*===========================================================================*/

static void netdev_get_drvinfo(struct net_device *dev,
			       struct ethtool_drvinfo *info)
{
	strcpy(info->driver, "ray_cs");
}

static struct ethtool_ops netdev_ethtool_ops = {
	.get_drvinfo		= netdev_get_drvinfo,
};

/*====================================================================*/

static int ray_dev_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
{
    ray_dev_t *local = (ray_dev_t *)dev->priv;
    dev_link_t *link = local->finder;
    int err = 0;
#if WIRELESS_EXT > 7
    struct iwreq *wrq = (struct iwreq *) ifr;
#endif	/* WIRELESS_EXT > 7 */

    if (!(link->state & DEV_PRESENT)) {
        DEBUG(2,"ray_dev_ioctl - device not present\n");
        return -1;
    }
    DEBUG(2,"ray_cs IOCTL dev=%p, ifr=%p, cmd = 0x%x\n",dev,ifr,cmd);
    /* Validate the command */
    switch (cmd)
    {
#if WIRELESS_EXT > 7
      /* --------------- WIRELESS EXTENSIONS --------------- */
      /* Get name */
    case SIOCGIWNAME:
      strcpy(wrq->u.name, "IEEE 802.11-FH");
      break;

      /* Get frequency/channel */
    case SIOCGIWFREQ:
      wrq->u.freq.m = local->sparm.b5.a_hop_pattern;
      wrq->u.freq.e = 0;
      break;

      /* Set frequency/channel */
    case SIOCSIWFREQ:
      /* Reject if card is already initialised */
      if(local->card_status != CARD_AWAITING_PARAM)
	{
	  err = -EBUSY;
	  break;
	}

      /* Setting by channel number */
      if ((wrq->u.freq.m > USA_HOP_MOD) || (wrq->u.freq.e > 0))
	err = -EOPNOTSUPP;
      else
	  local->sparm.b5.a_hop_pattern = wrq->u.freq.m;
      break;

      /* Get current network name (ESSID) */
    case SIOCGIWESSID:
      if (wrq->u.data.pointer)
	{
	  char essid[IW_ESSID_MAX_SIZE + 1];
	  /* Get the essid that was set */
	  memcpy(essid, local->sparm.b5.a_current_ess_id,
		 IW_ESSID_MAX_SIZE);
	  essid[IW_ESSID_MAX_SIZE] = '\0';

	  /* Push it out ! */
	  wrq->u.data.length = strlen(essid) + 1;
	  wrq->u.data.flags = 1; /* active */
	  if (copy_to_user(wrq->u.data.pointer, essid, sizeof(essid)))
		  err = -EFAULT;
	}
      break;

      /* Set desired network name (ESSID) */
    case SIOCSIWESSID:
      /* Reject if card is already initialised */
      if(local->card_status != CARD_AWAITING_PARAM)
	{
	  err = -EBUSY;
	  break;
	}

	if (wrq->u.data.pointer)
	{
	    char	card_essid[IW_ESSID_MAX_SIZE + 1];
	    
	    /* Check if we asked for `any' */
	    if(wrq->u.data.flags == 0)
	    {
		/* Corey : can you do that ? */
		err = -EOPNOTSUPP;
	    }
	    else
	    {
		/* Check the size of the string */
		if(wrq->u.data.length >
		   IW_ESSID_MAX_SIZE + 1)
		{
		    err = -E2BIG;
		    break;
		}
		if (copy_from_user(card_essid,
				   wrq->u.data.pointer,
				   wrq->u.data.length)) {
			err = -EFAULT;
			break;
		}
		card_essid[IW_ESSID_MAX_SIZE] = '\0';

		/* Set the ESSID in the card */
		memcpy(local->sparm.b5.a_current_ess_id, card_essid,
		       IW_ESSID_MAX_SIZE);
	    }
	}
	break;

      /* Get current Access Point (BSSID in our case) */
    case SIOCGIWAP:
      memcpy(wrq->u.ap_addr.sa_data, local->bss_id, ETH_ALEN);
      wrq->u.ap_addr.sa_family = ARPHRD_ETHER;
      break;

      /* Get the current bit-rate */
    case SIOCGIWRATE:
      if(local->net_default_tx_rate == 3)
	wrq->u.bitrate.value = 2000000;		/* Hum... */
      else
	wrq->u.bitrate.value = local->net_default_tx_rate * 500000;
      wrq->u.bitrate.fixed = 0;		/* We are in auto mode */
      break;

      /* Set the desired bit-rate */
    case SIOCSIWRATE:
      /* Check if rate is in range */
      if((wrq->u.bitrate.value != 1000000) &&
	 (wrq->u.bitrate.value != 2000000))
	{
	  err = -EINVAL;
	  break;
	}
      /* Hack for 1.5 Mb/s instead of 2 Mb/s */
      if((local->fw_ver == 0x55) &&		/* Please check */
	 (wrq->u.bitrate.value == 2000000))
	local->net_default_tx_rate = 3;
      else
	local->net_default_tx_rate = wrq->u.bitrate.value/500000;
      break;

      /* Get the current RTS threshold */
    case SIOCGIWRTS:
      wrq->u.rts.value = (local->sparm.b5.a_rts_threshold[0] << 8)
	+ local->sparm.b5.a_rts_threshold[1];
#if WIRELESS_EXT > 8
      wrq->u.rts.disabled = (wrq->u.rts.value == 32767);
#endif /* WIRELESS_EXT > 8 */
      wrq->u.rts.fixed = 1;
      break;

      /* Set the desired RTS threshold */
    case SIOCSIWRTS:
    {
	int rthr = wrq->u.rts.value;

      /* Reject if card is already initialised */
      if(local->card_status != CARD_AWAITING_PARAM)
	{
	  err = -EBUSY;
	  break;
	}

	/* if(wrq->u.rts.fixed == 0) we should complain */
#if WIRELESS_EXT > 8
	if(wrq->u.rts.disabled)
	    rthr = 32767;
	else
#endif /* WIRELESS_EXT > 8 */
	    if((rthr < 0) || (rthr > 2347)) /* What's the max packet size ??? */
	    {
		err = -EINVAL;
		break;
	    }
	local->sparm.b5.a_rts_threshold[0] = (rthr >> 8) & 0xFF;
	local->sparm.b5.a_rts_threshold[1] = rthr & 0xFF;
    }
    break;

      /* Get the current fragmentation threshold */
    case SIOCGIWFRAG:
      wrq->u.frag.value = (local->sparm.b5.a_frag_threshold[0] << 8)
	+ local->sparm.b5.a_frag_threshold[1];
#if WIRELESS_EXT > 8
      wrq->u.frag.disabled = (wrq->u.frag.value == 32767);
#endif /* WIRELESS_EXT > 8 */
      wrq->u.frag.fixed = 1;
      break;

      /* Set the desired fragmentation threshold */
    case SIOCSIWFRAG:
    {
	int fthr = wrq->u.frag.value;

      /* Reject if card is already initialised */
      if(local->card_status != CARD_AWAITING_PARAM)
	{
	  err = -EBUSY;
	  break;
	}

	/* if(wrq->u.frag.fixed == 0) should complain */
#if WIRELESS_EXT > 8
	if(wrq->u.frag.disabled)
	    fthr = 32767;
	else
#endif /* WIRELESS_EXT > 8 */
	    if((fthr < 256) || (fthr > 2347)) /* To check out ! */
	    {
		err = -EINVAL;
		break;
	    }
	local->sparm.b5.a_frag_threshold[0] = (fthr >> 8) & 0xFF;
	local->sparm.b5.a_frag_threshold[1] = fthr & 0xFF;
    }
    break;

#endif	/* WIRELESS_EXT > 7 */
#if WIRELESS_EXT > 8

      /* Get the current mode of operation */
    case SIOCGIWMODE:
      if(local->sparm.b5.a_network_type)
	wrq->u.mode = IW_MODE_INFRA;
      else
	wrq->u.mode = IW_MODE_ADHOC;
      break;

      /* Set the current mode of operation */
    case SIOCSIWMODE:
    {
	char card_mode = 1;
	
      /* Reject if card is already initialised */
      if(local->card_status != CARD_AWAITING_PARAM)
	{
	  err = -EBUSY;
	  break;
	}

	switch (wrq->u.mode)
	{
	case IW_MODE_ADHOC:
	    card_mode = 0;
	    // Fall through
	case IW_MODE_INFRA:
	    local->sparm.b5.a_network_type = card_mode;
	    break;
	default:
	    err = -EINVAL;
	}
    }
    break;

#endif /* WIRELESS_EXT > 8 */
#if WIRELESS_EXT > 7
      /* ------------------ IWSPY SUPPORT ------------------ */
      /* Define the range (variations) of above parameters */
    case SIOCGIWRANGE:
      /* Basic checking... */
      if(wrq->u.data.pointer != (caddr_t) 0)
	{
	  struct iw_range	range;
	  memset((char *) &range, 0, sizeof(struct iw_range));

	  /* Set the length (very important for backward compatibility) */
	  wrq->u.data.length = sizeof(struct iw_range);

#if WIRELESS_EXT > 10
	  /* Set the Wireless Extension versions */
	  range.we_version_compiled = WIRELESS_EXT;
	  range.we_version_source = 9;
#endif /* WIRELESS_EXT > 10 */

	  /* Set information in the range struct */
	  range.throughput = 1.1 * 1000 * 1000;	/* Put the right number here */
	  range.num_channels = hop_pattern_length[(int)country]; 
	  range.num_frequency = 0;
	  range.max_qual.qual = 0;
	  range.max_qual.level = 255;	/* What's the correct value ? */
	  range.max_qual.noise = 255;	/* Idem */
	  range.num_bitrates = 2;
	  range.bitrate[0] = 1000000;	/* 1 Mb/s */
	  range.bitrate[1] = 2000000;	/* 2 Mb/s */

	  /* Copy structure to the user buffer */
	  if(copy_to_user(wrq->u.data.pointer, &range,
			  sizeof(struct iw_range)))
	    err = -EFAULT;
	}
      break;

#ifdef WIRELESS_SPY
      /* Set addresses to spy */
    case SIOCSIWSPY:
      /* Check the number of addresses */
      if(wrq->u.data.length > IW_MAX_SPY)
	{
	  err = -E2BIG;
	  break;
	}
      local->spy_number = wrq->u.data.length;

      /* If there is some addresses to copy */
      if(local->spy_number > 0)
	{
	  struct sockaddr	address[IW_MAX_SPY];
	  int			i;