硬件平台:FL2440(s3c2440)
内核版本:2.6.35
主机平台:Ubuntu11.04
内核版本:2.6.39
原创作品,转载请标明出处http://blog.csdn.net/yming0221/article/details/6609742
1、下图是DM9000的引脚图
2、这里我们结合具体的开发板FL2440
下面是FL2440和DM9000的引脚链接图
本人移植DM9000的时候将设备的资源定义放在了arch/arm/plat-s3c24xx/devs.c中,详情点击上一篇博文linux内核移植-移植2.6.35.4内核到s3c2440
下面是设备的资源定义
-
-
- static struct resource s3c_dm9000_resource[] = {
- [0] = {
- .start = S3C24XX_PA_DM9000,
- .end = S3C24XX_PA_DM9000+ 0x3,
- .flags = IORESOURCE_MEM
- },
- [1]={
- .start = S3C24XX_PA_DM9000 + 0x4,
- .end = S3C24XX_PA_DM9000 + 0x4 + 0x7c,
- .flags = IORESOURCE_MEM
- },
- [2] = {
- .start = IRQ_EINT7,
- .end = IRQ_EINT7,
- .flags = IORESOURCE_IRQ
- },
- };
这里可以看到,DM9000网卡使用的地址空间资源在nGCS4地址区域,所以上图的DM9000地址使能引脚连接nGCS4引脚。中断使用的是EINT7外部中断。
接着定义平台数据和平台设备,代码如下:
-
- static struct dm9000_plat_data s3c_device_dm9000_platdata = {
- .flags= DM9000_PLATF_16BITONLY,
- };
-
-
- struct platform_device s3c_device_dm9000 = {
- .name= "dm9000",
- .id= 0,
- .num_resources= ARRAY_SIZE(s3c_dm9000_resource),
- .resource= s3c_dm9000_resource,
- .dev= {
- .platform_data = &s3c_device_dm9000_platdata,
- }
- };
最后导出函数符号,保存函数地址和名称
- EXPORT_SYMBOL(s3c_device_dm9000);
3、设备启动的初始化过程
- MACHINE_START(S3C2440, "SMDK2440")
-
- .phys_io = S3C2410_PA_UART,
- .io_pg_offst = (((u32)S3C24XX_VA_UART) >> 18) & 0xfffc,
- .boot_params = S3C2410_SDRAM_PA + 0x100,
-
- .init_irq = s3c24xx_init_irq,
- .map_io = smdk2440_map_io,
- .init_machine = smdk2440_machine_init,
- .timer = &s3c24xx_timer,
- MACHINE_END
而后会执行下面函数
- static void __init smdk2440_machine_init(void)
- {
- s3c24xx_fb_set_platdata(&smdk2440_fb_info);
- s3c_i2c0_set_platdata(NULL);
-
- s3c24xx_ts_set_platdata(&smdk2410_ts_cfg);
-
- platform_add_devices(smdk2440_devices, ARRAY_SIZE(smdk2440_devices));
- smdk_machine_init();
- }
下面是具体的设备列表
- static struct platform_device *smdk2440_devices[] __initdata = {
- &s3c_device_ohci,
- &s3c_device_lcd,
- &s3c_device_wdt,
- &s3c_device_i2c0,
- &s3c_device_iis,
- &s3c_device_rtc,
- &s3c24xx_uda134x,
- &s3c_device_dm9000,
- &s3c_device_adc,
- &s3c_device_ts,
-
- };
这样系统启动时,会给设备列表中的设备分配资源(地址资源和中断资源等)。
4、信息传输中的信息封装结构
4.1、sk_buff结构,定义在include/linux/skbuff.h中
- struct sk_buff {
-
- struct sk_buff *next;
- struct sk_buff *prev;
-
- ktime_t tstamp;
-
- struct sock *sk;
- struct net_device *dev;
-
-
-
-
-
-
-
- char cb[48] __aligned(8);
-
- unsigned long _skb_refdst;
- #ifdef CONFIG_XFRM
- struct sec_path *sp;
- #endif
- unsigned int len,
- data_len;
- __u16 mac_len,
- hdr_len;
- union {
- __wsum csum;
- struct {
- __u16 csum_start;
- __u16 csum_offset;
- };
- };
- __u32 priority;
- kmemcheck_bitfield_begin(flags1);
- __u8 local_df:1,
- cloned:1,
- ip_summed:2,
- nohdr:1,
- nfctinfo:3;
- __u8 pkt_type:3,
- fclone:2,
- ipvs_property:1,
- peeked:1,
- nf_trace:1;
- kmemcheck_bitfield_end(flags1);
- __be16 protocol;
-
- void (*destructor)(struct sk_buff *skb);
- #if defined(CONFIG_NF_CONNTRACK) || defined(CONFIG_NF_CONNTRACK_MODULE)
- struct nf_conntrack *nfct;
- struct sk_buff *nfct_reasm;
- #endif
- #ifdef CONFIG_BRIDGE_NETFILTER
- struct nf_bridge_info *nf_bridge;
- #endif
-
- int skb_iif;
- #ifdef CONFIG_NET_SCHED
- __u16 tc_index;
- #ifdef CONFIG_NET_CLS_ACT
- __u16 tc_verd;
- #endif
- #endif
-
- __u32 rxhash;
-
- kmemcheck_bitfield_begin(flags2);
- __u16 queue_mapping:16;
- #ifdef CONFIG_IPV6_NDISC_NODETYPE
- __u8 ndisc_nodetype:2,
- deliver_no_wcard:1;
- #else
- __u8 deliver_no_wcard:1;
- #endif
- kmemcheck_bitfield_end(flags2);
-
-
-
- #ifdef CONFIG_NET_DMA
- dma_cookie_t dma_cookie;
- #endif
- #ifdef CONFIG_NETWORK_SECMARK
- __u32 secmark;
- #endif
- union {
- __u32 mark;
- __u32 dropcount;
- };
-
- __u16 vlan_tci;
-
- sk_buff_data_t transport_header;
- sk_buff_data_t network_header;
- sk_buff_data_t mac_header;
-
- sk_buff_data_t tail;
- sk_buff_data_t end;
- unsigned char *head,
- *data;
- unsigned int truesize;
- atomic_t users;
- };
元素的含义如下(摘自内核,源码,版本2.6.35.4)
*struct sk_buff - socket buffer
* @next: Next buffer inlist
* @prev: Previous buffer in list
* @sk: Socketwe are owned by
* @tstamp: Time we arrived
* @dev:Device we arrived on/are leaving by
* @transport_header:Transport layer header
* @network_header: Network layerheader
* @mac_header: Link layer header
*@_skb_refdst: destination entry (with norefcount bit)
* @sp:the security path, used for xfrm
* @cb: Control buffer. Freefor use by every layer. Put private vars here
* @len: Lengthof actual data
* @data_len: Data length
* @mac_len:Length of link layer header
* @hdr_len: writable headerlength of cloned skb
* @csum: Checksum (must includestart/offset pair)
* @csum_start: Offset from skb->headwhere checksumming should start
* @csum_offset: Offset fromcsum_start where checksum should be stored
* @local_df:allow local fragmentation
* @cloned: Head may be cloned(check refcnt to be sure)
* @nohdr: Payload reference only,must not modify header
* @pkt_type: Packet class
*@fclone: skbuff clone status
* @ip_summed: Driver fed us anIP checksum
* @priority: Packet queueing priority
*@users: User count - see {datagram,tcp}.c
* @protocol:Packet protocol from driver
* @truesize: Buffer size
*@head: Head of buffer
* @data: Data head pointer
*@tail: Tail pointer
* @end: End pointer
*@destructor: Destruct function
* @mark: Generic packetmark
* @nfct: Associated connection, if any
*@ipvs_property: skbuff is owned by ipvs
* @peeked: thispacket has been seen already, so stats have been
* done forit, don't do them again
* @nf_trace: netfilter packet traceflag
* @nfctinfo: Relationship of this skb to theconnection
* @nfct_reasm: netfilter conntrack re-assemblypointer
* @nf_bridge: Saved data about a bridged frame - seebr_netfilter.c
* @skb_iif: ifindex of device we arrivedon
* @rxhash: the packet hash computed on receive
*@queue_mapping: Queue mapping for multiqueue devices
*@tc_index: Traffic control index
* @tc_verd: traffic controlverdict
* @ndisc_nodetype: router type (from link layer)
*@dma_cookie: a cookie to one of several possible DMA operations
*done by skb DMA functions
* @secmark: security marking
*@vlan_tci: vlan tag control information
关于sk_buff的更多分析见另一篇转载的博文http://blog.csdn.net/yming0221/article/details/6609734
4.2、net_device
关于net_device一个非常庞大的结构体,定义在/inlcude/linux/netdevice.h中
如下:
我还没有细细的分析这个结构体,驱动程序在probe函数中使用register_netdev()注册该结构体指明的设备,将内核操作硬件的函数个内核联系起来。
硬件平台:FL2440(s3c2440)
内核版本:2.6.35
主机平台:Ubuntu 11.04
内核版本:2.6.39
原创作品,转载请标明出处http://blog.csdn.net/yming0221/article/details/6612623
下面开始分析具体的代码,这里由于使DM9000驱动更容易理解,在不影响基本的功能的前提下,这里将尽可能的简化该驱动(如:去掉该驱动中支持电源管理的功能)
分析该驱动
1、首先看一下该驱动的平台设备驱动的结构体定义
-
-
-
-
- static struct platform_driver dm9000_driver = {
- .driver = {
- .name = "dm9000",
- .owner = THIS_MODULE,
- },
- .probe = dm9000_probe,
- .remove = __devexit_p(dm9000_drv_remove),
- };
在执行insmod后内核自动那个执行下面的函数- static int __init
- dm9000_init(void)
- {
- printk(KERN_INFO "%s Ethernet Driver, V%s\n", CARDNAME, DRV_VERSION);
-
- return platform_driver_register(&dm9000_driver);
- }
调用函数platform_driver_register()函数注册驱动。
3、自动执行驱动的probe函数,进行资源的探测和申请资源。
其中BWSCON为总线宽度 等待控制寄存器
其中第[19:18]位的作用如下
下面函数中将两位设置为11,也就是WAIT使能,bank4使用UB/LB。
alloc_etherdev()函数分配一个网络设备的结构体,原型在include/linux/etherdevice.h
原型如下:
- extern struct net_device *alloc_etherdev_mq(int sizeof_priv, unsigned int queue_count);
- #define alloc_etherdev(sizeof_priv) alloc_etherdev_mq(sizeof_priv, 1)
该函数中需要将获得的资源信息存储在一个结构体中,定义如下:
-
- typedef struct board_info {
-
- void __iomem *io_addr;
- void __iomem *io_data;
- u16 irq;
-
- u16 tx_pkt_cnt;
- u16 queue_pkt_len;
- u16 queue_start_addr;
- u16 queue_ip_summed;
- u16 dbug_cnt;
- u8 io_mode;
- u8 phy_addr;
- u8 imr_all;
-
- unsigned int flags;
- unsigned int in_suspend :1;
- unsigned int wake_supported :1;
- int debug_level;
-
- enum dm9000_type type;
-
- void (*inblk)(void __iomem *port, void *data, int length);
- void (*outblk)(void __iomem *port, void *data, int length);
- void (*dumpblk)(void __iomem *port, int length);
-
- struct device *dev;
-
- struct resource *addr_res;
- struct resource *data_res;
- struct resource *addr_req;
- struct resource *data_req;
- struct resource *irq_res;
-
- int irq_wake;
-
- struct mutex addr_lock;
-
- struct delayed_work phy_poll;
- struct net_device *ndev;
-
- spinlock_t lock;
-
- struct mii_if_info mii;
- u32 msg_enable;
- u32 wake_state;
-
- int rx_csum;
- int can_csum;
- int ip_summed;
- } board_info_t;
下面是probe函数,
其中有个函数db = netdev_priv(ndev)
该函数实际上是返回网卡私有成员的数据结构地址
函数如下,定义在include/linux/net_device.h中
- static inline void *netdev_priv(const struct net_device *dev)
- {
- return (char *)dev + ALIGN(sizeof(struct net_device), NETDEV_ALIGN);
- }
-
-
-
- static int __devinit
- dm9000_probe(struct platform_device *pdev)
- {
- struct dm9000_plat_data *pdata = pdev->dev.platform_data;
- struct board_info *db;
- struct net_device *ndev;
- const unsigned char *mac_src;
- int ret = 0;
- int iosize;
- int i;
- u32 id_val;
-
- unsigned char ne_def_eth_mac_addr[]={0x00,0x12,0x34,0x56,0x80,0x49};
- static void *bwscon;
- static void *gpfcon;
- static void *extint0;
- static void *intmsk;
-
- #define BWSCON (0x48000000)
- #define GPFCON (0x56000050)
- #define EXTINT0 (0x56000088)
- #define INTMSK (0x4A000008)
-
- bwscon=ioremap_nocache(BWSCON,0x0000004);
- gpfcon=ioremap_nocache(GPFCON,0x0000004);
- extint0=ioremap_nocache(EXTINT0,0x0000004);
- intmsk=ioremap_nocache(INTMSK,0x0000004);
-
- writel( readl(bwscon)|0xc0000,bwscon);
- writel( (readl(gpfcon) & ~(0x3 << 14)) | (0x2 << 14), gpfcon);
- writel( readl(gpfcon) | (0x1 << 7), gpfcon);
- writel( (readl(extint0) & ~(0xf << 28)) | (0x4 << 28), extint0);
- writel( (readl(intmsk)) & ~0x80, intmsk);
-
-
-
-
- ndev = alloc_etherdev(sizeof(struct board_info));
- if (!ndev) {
- dev_err(&pdev->dev, "could not allocate device.\n");
- return -ENOMEM;
- }
-
-
-
-
- SET_NETDEV_DEV(ndev, &pdev->dev);
-
- dev_dbg(&pdev->dev, "dm9000_probe()\n");
-
-
-
- db = netdev_priv(ndev);
-
- db->dev = &pdev->dev;
- db->ndev = ndev;
-
- spin_lock_init(&db->lock);
- mutex_init(&db->addr_lock);
-
- INIT_DELAYED_WORK(&db->phy_poll, dm9000_poll_work);
-
- db->addr_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
- db->data_res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
- db->irq_res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
-
- if (db->addr_res == NULL || db->data_res == NULL ||
- db->irq_res == NULL) {
- dev_err(db->dev, "insufficient resources\n");
- ret = -ENOENT;
- goto out;
- }
-
- db->irq_wake = platform_get_irq(pdev, 1);
- if (db->irq_wake >= 0) {
- dev_dbg(db->dev, "wakeup irq %d\n", db->irq_wake);
-
- ret = request_irq(db->irq_wake, dm9000_wol_interrupt,
- IRQF_SHARED, dev_name(db->dev), ndev);
- if (ret) {
- dev_err(db->dev, "cannot get wakeup irq (%d)\n", ret);
- } else {
-
-
- ret = set_irq_wake(db->irq_wake, 1);
- if (ret) {
- dev_err(db->dev, "irq %d cannot set wakeup (%d)\n",
- db->irq_wake, ret);
- ret = 0;
- } else {
- set_irq_wake(db->irq_wake, 0);
- db->wake_supported = 1;
- }
- }
- }
-
- iosize = resource_size(db->addr_res);
- db->addr_req = request_mem_region(db->addr_res->start, iosize,
- pdev->name);
-
- if (db->addr_req == NULL) {
- dev_err(db->dev, "cannot claim address reg area\n");
- ret = -EIO;
- goto out;
- }
-
- db->io_addr = ioremap(db->addr_res->start, iosize);
-
- if (db->io_addr == NULL) {
- dev_err(db->dev, "failed to ioremap address reg\n");
- ret = -EINVAL;
- goto out;
- }
-
- iosize = resource_size(db->data_res);
- db->data_req = request_mem_region(db->data_res->start, iosize,
- pdev->name);
-
- if (db->data_req == NULL) {
- dev_err(db->dev, "cannot claim data reg area\n");
- ret = -EIO;
- goto out;
- }
-
- db->io_data = ioremap(db->data_res->start, iosize);
-
- if (db->io_data == NULL) {
- dev_err(db->dev, "failed to ioremap data reg\n");
- ret = -EINVAL;
- goto out;
- }
-
-
-
- ndev->base_addr = (unsigned long)db->io_addr;
- ndev->irq = db->irq_res->start;
-
-
- dm9000_set_io(db, iosize);
-
-
-
-
- if (pdata != NULL) {
-
-
-
- if (pdata->flags & DM9000_PLATF_8BITONLY)
- dm9000_set_io(db, 1);
-
- if (pdata->flags & DM9000_PLATF_16BITONLY)
- dm9000_set_io(db, 2);
-
- if (pdata->flags & DM9000_PLATF_32BITONLY)
- dm9000_set_io(db, 4);
-
-
-
-
- if (pdata->inblk != NULL)
- db->inblk = pdata->inblk;
-
- if (pdata->outblk != NULL)
- db->outblk = pdata->outblk;
-
- if (pdata->dumpblk != NULL)
- db->dumpblk = pdata->dumpblk;
-
- db->flags = pdata->flags;
- }
-
- #ifdef CONFIG_DM9000_FORCE_SIMPLE_PHY_POLL
- db->flags |= DM9000_PLATF_SIMPLE_PHY;
- #endif
-
- dm9000_reset(db);
-
-
- for (i = 0; i < 8; i++) {
- id_val = ior(db, DM9000_VIDL);
- id_val |= (u32)ior(db, DM9000_VIDH) << 8;
- id_val |= (u32)ior(db, DM9000_PIDL) << 16;
- id_val |= (u32)ior(db, DM9000_PIDH) << 24;
-
- if (id_val == DM9000_ID)
- break;
- dev_err(db->dev, "read wrong id 0x%08x\n", id_val);
- }
-
- if (id_val != DM9000_ID) {
- dev_err(db->dev, "wrong id: 0x%08x\n", id_val);
- ret = -ENODEV;
- goto out;
- }
-
-
-
- id_val = ior(db, DM9000_CHIPR);
- dev_dbg(db->dev, "dm9000 revision 0x%02x\n", id_val);
-
- switch (id_val) {
- case CHIPR_DM9000A:
- db->type = TYPE_DM9000A;
- break;
- case CHIPR_DM9000B:
- db->type = TYPE_DM9000B;
- break;
- default:
- dev_dbg(db->dev, "ID %02x => defaulting to DM9000E\n", id_val);
- db->type = TYPE_DM9000E;
- }
-
-
- if (db->type == TYPE_DM9000A || db->type == TYPE_DM9000B) {
- db->can_csum = 1;
- db->rx_csum = 1;
- ndev->features |= NETIF_F_IP_CSUM;
- }
-
-
-
-
- ether_setup(ndev);
-
- ndev->netdev_ops = &dm9000_netdev_ops;
- ndev->watchdog_timeo = msecs_to_jiffies(watchdog);
- ndev->ethtool_ops = &dm9000_ethtool_ops;
-
- db->msg_enable = NETIF_MSG_LINK;
- db->mii.phy_id_mask = 0x1f;
- db->mii.reg_num_mask = 0x1f;
- db->mii.force_media = 0;
- db->mii.full_duplex = 0;
- db->mii.dev = ndev;
- db->mii.mdio_read = dm9000_phy_read;
- db->mii.mdio_write = dm9000_phy_write;
-
- mac_src = "eeprom";
-
-
- for (i = 0; i < 6; i += 2)
- dm9000_read_eeprom(db, i / 2, ndev->dev_addr+i);
-
- if (!is_valid_ether_addr(ndev->dev_addr) && pdata != NULL) {
- mac_src = "platform data";
- memcpy(ndev->dev_addr, pdata->dev_addr, 6);
- }
-
- if (!is_valid_ether_addr(ndev->dev_addr)) {
-
-
- mac_src = "chip";
- for (i = 0; i < 6; i++)
- ndev->dev_addr[i] = ne_def_eth_mac_addr[i];
- }
-
- if (!is_valid_ether_addr(ndev->dev_addr))
- dev_warn(db->dev, "%s: Invalid ethernet MAC address. Please "
- "set using ifconfig\n", ndev->name);
-
-
- platform_set_drvdata(pdev, ndev);
-
-
- ret = register_netdev(ndev);
-
- if (ret == 0)
- printk(KERN_INFO "%s: dm9000%c at %p,%p IRQ %d MAC: %pM (%s)\n",
- ndev->name, dm9000_type_to_char(db->type),
- db->io_addr, db->io_data, ndev->irq,
- ndev->dev_addr, mac_src);
- return 0;
-
-
- out:
- dev_err(db->dev, "not found (%d).\n", ret);
-
- dm9000_release_board(pdev, db);
- free_netdev(ndev);
-
- return ret;
- }
这样,最后完成了网络设备的数据保存到总线上,将网络设备注册到内核。4、设备的移除函数
-
- static int __devexit
- dm9000_drv_remove(struct platform_device *pdev)
- {
- struct net_device *ndev = platform_get_drvdata(pdev);
-
- platform_set_drvdata(pdev, NULL);
-
- unregister_netdev(ndev);
- dm9000_release_board(pdev, (board_info_t *) netdev_priv(ndev));
- free_netdev(ndev);
-
- dev_dbg(&pdev->dev, "released and freed device\n");
- return 0;
- }
硬件平台:FL2440(s3c2440)
内核版本:2.6.35
主机平台:Ubuntu11.04
内核版本:2.6.39
交叉编译器:arm-linuc-gcc4.3.2
原创作品,转载请标明出处http://blog.csdn.net/yming0221/article/details/6615027
本文接上文
ARM-Linux驱动--DM9000网卡驱动分析(一)
ARM-Linux驱动--DM9000网卡驱动分析(二)
下面开始看网卡设备的打开、关闭函数和操作函数
- static const struct net_device_ops dm9000_netdev_ops = {
- .ndo_open = dm9000_open,
- .ndo_stop = dm9000_stop,
- .ndo_start_xmit = dm9000_start_xmit,
- .ndo_tx_timeout = dm9000_timeout,
- .ndo_set_multicast_list = dm9000_hash_table,
- .ndo_do_ioctl = dm9000_ioctl,
- .ndo_change_mtu = eth_change_mtu,
- .ndo_validate_addr = eth_validate_addr,
- .ndo_set_mac_address = eth_mac_addr,
- #ifdef CONFIG_NET_POLL_CONTROLLER
- .ndo_poll_controller = dm9000_poll_controller,
- #endif
- };
1、DM9000的打开函数
由于在函数alloc_netdev_mq()中分配net_device和网卡的私有数据是一起分配的,详见函数的实现
- struct net_device *alloc_netdev_mq(int sizeof_priv, const char *name,
- void (*setup)(struct net_device *), unsigned int queue_count)
- {
- ...................
- alloc_size = sizeof(struct net_device);
- if (sizeof_priv) {
-
- alloc_size = ALIGN(alloc_size, NETDEV_ALIGN);
- alloc_size += sizeof_priv;
- }
-
- alloc_size += NETDEV_ALIGN - 1;
-
- p = kzalloc(alloc_size, GFP_KERNEL);
- if (!p) {
- printk(KERN_ERR "alloc_netdev: Unable to allocate device.\n");
- return NULL;
- }
-
- tx = kcalloc(queue_count, sizeof(struct netdev_queue), GFP_KERNEL);
- if (!tx) {
- printk(KERN_ERR "alloc_netdev: Unable to allocate "
- "tx qdiscs.\n");
- goto free_p;
- }
-
- #ifdef CONFIG_RPS
- rx = kcalloc(queue_count, sizeof(struct netdev_rx_queue), GFP_KERNEL);
- if (!rx) {
- printk(KERN_ERR "alloc_netdev: Unable to allocate "
- "rx queues.\n");
- goto free_tx;
- }
- ..............
- }
所以使用函数netdev_priv()函数返回的是网卡的私有数据的地址,函数的实现如下:
-
-
-
-
-
-
- static inline void *netdev_priv(const struct net_device *dev)
- {
- return (char *)dev + ALIGN(sizeof(struct net_device), NETDEV_ALIGN);
- }
这样两者会同时生存和消失。
dm9000_open()函数
-
-
-
-
- static int
- dm9000_open(struct net_device *dev)
- {
- board_info_t *db = netdev_priv(dev);
- unsigned long irqflags = db->irq_res->flags & IRQF_TRIGGER_MASK;
-
- if (netif_msg_ifup(db))
- dev_dbg(db->dev, "enabling %s\n", dev->name);
-
-
-
-
- if (irqflags == IRQF_TRIGGER_NONE)
- dev_warn(db->dev, "WARNING: no IRQ resource flags set.\n");
-
- irqflags |= IRQF_SHARED;
-
-
- if (request_irq(dev->irq, dm9000_interrupt, irqflags, dev->name, dev))
- return -EAGAIN;
-
-
- dm9000_reset(db);
- dm9000_init_dm9000(dev);
-
-
- db->dbug_cnt = 0;
-
- mii_check_media(&db->mii, netif_msg_link(db), 1);
- netif_start_queue(dev);
-
-
-
- dm9000_schedule_poll(db);
-
- return 0;
- }
2、网卡关闭函数
-
-
-
-
- static int
- dm9000_stop(struct net_device *ndev)
- {
- board_info_t *db = netdev_priv(ndev);
-
- if (netif_msg_ifdown(db))
- dev_dbg(db->dev, "shutting down %s\n", ndev->name);
-
- cancel_delayed_work_sync(&db->phy_poll);
-
- netif_stop_queue(ndev);
- netif_carrier_off(ndev);
-
-
- free_irq(ndev->irq, ndev);
-
- dm9000_shutdown(ndev);
-
- return 0;
- }
下面是调用的dm9000_shutdown(ndev)函数,该函数的功能是复位phy,配置寄存器GPR位0为1,关闭dm9000电源,配置寄存器IMR位7为1,disable中断,配置寄存器RCR,disable接收
函数如下:
- static void
- dm9000_shutdown(struct net_device *dev)
- {
- board_info_t *db = netdev_priv(dev);
-
-
- dm9000_phy_write(dev, 0, MII_BMCR, BMCR_RESET);
- iow(db, DM9000_GPR, 0x01);
- iow(db, DM9000_IMR, IMR_PAR);
- iow(db, DM9000_RCR, 0x00);
- }
3、接下来了解一下数据的发送函数dm9000_start_xmit
上图可以看出DM9000的SRAM中地址0x0000到0x0BFF是TXBuffer,从0x0C00到0x3FFF是RXBuffer,包的有效数据必须提前放到TXBuffer缓冲区,使用端口命令来选择MWCMD寄存器。最后设置TXCR寄存器的bit[0]TXREQ来自动发送包。
发送包的步骤如下:
(1)检查存储器宽度,通过读取ISR的bit[7:6]来确定位数
(2)写数据到TXSRAM
(3)写传输长度到TXPLL和TXPLH寄存器
(4)设置TXCR的bit[0]TXREQ来发送包
-
-
-
-
- static int
- dm9000_start_xmit(struct sk_buff *skb, struct net_device *dev)
- {
- unsigned long flags;
- board_info_t *db = netdev_priv(dev);
-
- dm9000_dbg(db, 3, "%s:\n", __func__);
-
- if (db->tx_pkt_cnt > 1)
- return NETDEV_TX_BUSY;
-
- spin_lock_irqsave(&db->lock, flags);
-
-
-
-
-
- writeb(DM9000_MWCMD, db->io_addr);
-
- (db->outblk)(db->io_data, skb->data, skb->len);
-
- dev->stats.tx_bytes += skb->len;
-
- db->tx_pkt_cnt++;
-
- if (db->tx_pkt_cnt == 1) {
- dm9000_send_packet(dev, skb->ip_summed, skb->len);
- } else {
-
- db->queue_pkt_len = skb->len;
- db->queue_ip_summed = skb->ip_summed;
- netif_stop_queue(dev);
- }
- spin_unlock_irqrestore(&db->lock, flags);
-
- dev_kfree_skb(skb);
-
- return NETDEV_TX_OK;
- }
上面函数调用下面的函数 dm9000_send_packet来发送数据
- static void dm9000_send_packet(struct net_device *dev,
- int ip_summed,
- u16 pkt_len)
- {
- board_info_t *dm = to_dm9000_board(dev);
-
-
- if (dm->ip_summed != ip_summed) {
- if (ip_summed == CHECKSUM_NONE)
- iow(dm, DM9000_TCCR, 0);
- else
- iow(dm, DM9000_TCCR, TCCR_IP | TCCR_UDP | TCCR_TCP);
- dm->ip_summed = ip_summed;
- }
-
-
-
- iow(dm, DM9000_TXPLL, pkt_len);
- iow(dm, DM9000_TXPLH, pkt_len >> 8);
-
-
-
- iow(dm, DM9000_TCR, TCR_TXREQ);
- }
5、下面看一下当一个数据包发送完成后的中断处理函数dm9000_tx_done
-
-
-
-
-
- static void dm9000_tx_done(struct net_device *dev, board_info_t *db)
- {
- int tx_status = ior(db, DM9000_NSR);
-
- if (tx_status & (NSR_TX2END | NSR_TX1END)) {
-
- db->tx_pkt_cnt--;
- dev->stats.tx_packets++;
-
- if (netif_msg_tx_done(db))
- dev_dbg(db->dev, "tx done, NSR %02x\n", tx_status);
-
-
- if (db->tx_pkt_cnt > 0)
- dm9000_send_packet(dev, db->queue_ip_summed,
- db->queue_pkt_len);
- netif_wake_queue(dev);
- }
- }
硬件平台:FL2440 (S3C2440)
内核版本:2.6.35
主机平台:Ubuntu 11.04
内核版本:2.6.39
交叉编译器:arm-linux-gcc 4.3.2
原创作品,转载请标明出处
本文接上文
ARM-Linux驱动--DM9000网卡驱动分析(一)
ARM-Linux驱动--DM9000网卡驱动分析(二)
ARM-Linux驱动--DM9000网卡驱动分析(三)
1、接下来接着分析DM9000网卡驱动的数据接收函数
-
-
-
-
- static void
- dm9000_rx(struct net_device *dev)
- {
- board_info_t *db = netdev_priv(dev);
- struct dm9000_rxhdr rxhdr;
- struct sk_buff *skb;
- u8 rxbyte, *rdptr;
- bool GoodPacket;
- int RxLen;
-
-
- do {
-
- ior(db, DM9000_MRCMDX);
-
- rxbyte = readb(db->io_data);
-
-
-
- if (rxbyte & DM9000_PKT_ERR) {
- dev_warn(db->dev, "status check fail: %d\n", rxbyte);
- iow(db, DM9000_RCR, 0x00);
- iow(db, DM9000_ISR, IMR_PAR);
- return;
- }
-
-
- if (!(rxbyte & DM9000_PKT_RDY))
- return;
-
-
- GoodPacket = true;
- writeb(DM9000_MRCMD, db->io_addr);
-
- (db->inblk)(db->io_data, &rxhdr, sizeof(rxhdr));
-
- RxLen = le16_to_cpu(rxhdr.RxLen);
-
- if (netif_msg_rx_status(db))
- dev_dbg(db->dev, "RX: status %02x, length %04x\n",
- rxhdr.RxStatus, RxLen);
-
-
- if (RxLen < 0x40) {
- GoodPacket = false;
- if (netif_msg_rx_err(db))
- dev_dbg(db->dev, "RX: Bad Packet (runt)\n");
- }
-
- if (RxLen > DM9000_PKT_MAX) {
- dev_dbg(db->dev, "RST: RX Len:%x\n", RxLen);
- }
-
-
-
- if (rxhdr.RxStatus & (RSR_FOE | RSR_CE | RSR_AE |
- RSR_PLE | RSR_RWTO |
- RSR_LCS | RSR_RF)) {
- GoodPacket = false;
- if (rxhdr.RxStatus & RSR_FOE) {
- if (netif_msg_rx_err(db))
- dev_dbg(db->dev, "fifo error\n");
- dev->stats.rx_fifo_errors++;
- }
- if (rxhdr.RxStatus & RSR_CE) {
- if (netif_msg_rx_err(db))
- dev_dbg(db->dev, "crc error\n");
- dev->stats.rx_crc_errors++;
- }
- if (rxhdr.RxStatus & RSR_RF) {
- if (netif_msg_rx_err(db))
- dev_dbg(db->dev, "length error\n");
- dev->stats.rx_length_errors++;
- }
- }
-
-
- if (GoodPacket &&
- ((skb = dev_alloc_skb(RxLen + 4)) != NULL)) {
- skb_reserve(skb, 2);
- rdptr = (u8 *) skb_put(skb, RxLen - 4);
-
-
-
- (db->inblk)(db->io_data, rdptr, RxLen);
- dev->stats.rx_bytes += RxLen;
-
-
- skb->protocol = eth_type_trans(skb, dev);
- if (db->rx_csum) {
- if ((((rxbyte & 0x1c) << 3) & rxbyte) == 0)
- skb->ip_summed = CHECKSUM_UNNECESSARY;
- else
- skb->ip_summed = CHECKSUM_NONE;
- }
- netif_rx(skb);
- dev->stats.rx_packets++;
-
- } else {
-
-
- (db->dumpblk)(db->io_data, RxLen);
- }
- } while (rxbyte & DM9000_PKT_RDY);
- }
2、下面是完整的DM9000驱动代码,可以完整的查看
- #include
- #include
- #include
- #include
- #include
- #include
- #include
- #include
- #include
- #include
- #include
- #include
- #include
- #include
- #include
-
- #include
- #include
- #include
-
- #include "dm9000.h"
-
- #include
- #include
- #include
-
-
-
- #define DM9000_PHY 0x40 /* PHY address 0x01 */
-
- #define CARDNAME "dm9000"
- #define DRV_VERSION "1.31"
-
-
-
-
- static int watchdog = 5000;
- module_param(watchdog, int, 0400);
- MODULE_PARM_DESC(watchdog, "transmit timeout in milliseconds");
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
- enum dm9000_type {
- TYPE_DM9000E,
- TYPE_DM9000A,
- TYPE_DM9000B
- };
-
-
- typedef struct board_info {
-
- void __iomem *io_addr;
- void __iomem *io_data;
- u16 irq;
-
- u16 tx_pkt_cnt;
- u16 queue_pkt_len;
- u16 queue_start_addr;
- u16 queue_ip_summed;
- u16 dbug_cnt;
- u8 io_mode;
- u8 phy_addr;
- u8 imr_all;
-
- unsigned int flags;
- unsigned int in_suspend :1;
- unsigned int wake_supported :1;
- int debug_level;
-
- enum dm9000_type type;
-
- void (*inblk)(void __iomem *port, void *data, int length);
- void (*outblk)(void __iomem *port, void *data, int length);
- void (*dumpblk)(void __iomem *port, int length);
-
- struct device *dev;
-
- struct resource *addr_res;
- struct resource *data_res;
- struct resource *addr_req;
- struct resource *data_req;
- struct resource *irq_res;
-
- int irq_wake;
-
- struct mutex addr_lock;
-
- struct delayed_work phy_poll;
- struct net_device *ndev;
-
- spinlock_t lock;
-
- struct mii_if_info mii;
- u32 msg_enable;
- u32 wake_state;
-
- int rx_csum;
- int can_csum;
- int ip_summed;
- } board_info_t;
-
-
-
- #define dm9000_dbg(db, lev, msg...) do { \
- if ((lev) < CONFIG_DM9000_DEBUGLEVEL && \
- (lev) < db->debug_level) { \
- dev_dbg(db->dev, msg); \
- } \
- } while (0)
-
- static inline board_info_t *to_dm9000_board(struct net_device *dev)
- {
- return netdev_priv(dev);
- }
-
-
-
- static void
- dm9000_reset(board_info_t * db)
- {
- dev_dbg(db->dev, "resetting device\n");
-
-
- writeb(DM9000_NCR, db->io_addr);
- udelay(200);
- writeb(NCR_RST, db->io_data);
- udelay(200);
- }
-
-
-
-
- static u8
- ior(board_info_t * db, int reg)
- {
- writeb(reg, db->io_addr);
- return readb(db->io_data);
- }
-
-
-
-
-
- static void
- iow(board_info_t * db, int reg, int value)
- {
- writeb(reg, db->io_addr);
- writeb(value, db->io_data);
- }
-
-
-
- static void dm9000_outblk_8bit(void __iomem *reg, void *data, int count)
- {
- writesb(reg, data, count);
- }
-
- static void dm9000_outblk_16bit(void __iomem *reg, void *data, int count)
- {
- writesw(reg, data, (count+1) >> 1);
- }
-
- static void dm9000_outblk_32bit(void __iomem *reg, void *data, int count)
- {
- writesl(reg, data, (count+3) >> 2);
- }
-
-
-
- static void dm9000_inblk_8bit(void __iomem *reg, void *data, int count)
- {
- readsb(reg, data, count);
- }
-
-
- static void dm9000_inblk_16bit(void __iomem *reg, void *data, int count)
- {
- readsw(reg, data, (count+1) >> 1);
- }
-
- static void dm9000_inblk_32bit(void __iomem *reg, void *data, int count)
- {
- readsl(reg, data, (count+3) >> 2);
- }
-
-
-
- static void dm9000_dumpblk_8bit(void __iomem *reg, int count)
- {
- int i;
- int tmp;
-
- for (i = 0; i < count; i++)
- tmp = readb(reg);
- }
-
- static void dm9000_dumpblk_16bit(void __iomem *reg, int count)
- {
- int i;
- int tmp;
-
- count = (count + 1) >> 1;
-
- for (i = 0; i < count; i++)
- tmp = readw(reg);
- }
-
- static void dm9000_dumpblk_32bit(void __iomem *reg, int count)
- {
- int i;
- int tmp;
-
- count = (count + 3) >> 2;
-
- for (i = 0; i < count; i++)
- tmp = readl(reg);
- }
-
-
-
-
-
-
-
- static void dm9000_set_io(struct board_info *db, int byte_width)
- {
-
-
-
-
- switch (byte_width) {
- case 1:
- db->dumpblk = dm9000_dumpblk_8bit;
- db->outblk = dm9000_outblk_8bit;
- db->inblk = dm9000_inblk_8bit;
- break;
-
-
- case 3:
- dev_dbg(db->dev, ": 3 byte IO, falling back to 16bit\n");
- case 2:
- db->dumpblk = dm9000_dumpblk_16bit;
- db->outblk = dm9000_outblk_16bit;
- db->inblk = dm9000_inblk_16bit;
- break;
-
- case 4:
- default:
- db->dumpblk = dm9000_dumpblk_32bit;
- db->outblk = dm9000_outblk_32bit;
- db->inblk = dm9000_inblk_32bit;
- break;
- }
- }
-
- static void dm9000_schedule_poll(board_info_t *db)
- {
- if (db->type == TYPE_DM9000E)
- schedule_delayed_work(&db->phy_poll, HZ * 2);
- }
-
- static int dm9000_ioctl(struct net_device *dev, struct ifreq *req, int cmd)
- {
- board_info_t *dm = to_dm9000_board(dev);
-
- if (!netif_running(dev))
- return -EINVAL;
-
- return generic_mii_ioctl(&dm->mii, if_mii(req), cmd, NULL);
- }
-
- static unsigned int
- dm9000_read_locked(board_info_t *db, int reg)
- {
- unsigned long flags;
- unsigned int ret;
-
- spin_lock_irqsave(&db->lock, flags);
- ret = ior(db, reg);
- spin_unlock_irqrestore(&db->lock, flags);
-
- return ret;
- }
-
- static int dm9000_wait_eeprom(board_info_t *db)
- {
- unsigned int status;
- int timeout = 8;
-
-
-
-
-
-
-
-
-
-
-
-
- while (1) {
- status = dm9000_read_locked(db, DM9000_EPCR);
-
- if ((status & EPCR_ERRE) == 0)
- break;
-
- msleep(1);
-
- if (timeout-- < 0) {
- dev_dbg(db->dev, "timeout waiting EEPROM\n");
- break;
- }
- }
-
- return 0;
- }
-
-
-
-
- static void
- dm9000_read_eeprom(board_info_t *db, int offset, u8 *to)
- {
- unsigned long flags;
-
- if (db->flags & DM9000_PLATF_NO_EEPROM) {
- to[0] = 0xff;
- to[1] = 0xff;
- return;
- }
-
- mutex_lock(&db->addr_lock);
-
- spin_lock_irqsave(&db->lock, flags);
-
- iow(db, DM9000_EPAR, offset);
- iow(db, DM9000_EPCR, EPCR_ERPRR);
-
- spin_unlock_irqrestore(&db->lock, flags);
-
- dm9000_wait_eeprom(db);
-
-
- msleep(1);
-
- spin_lock_irqsave(&db->lock, flags);
-
- iow(db, DM9000_EPCR, 0x0);
-
- to[0] = ior(db, DM9000_EPDRL);
- to[1] = ior(db, DM9000_EPDRH);
-
- spin_unlock_irqrestore(&db->lock, flags);
-
- mutex_unlock(&db->addr_lock);
- }
-
-
-
-
- static void
- dm9000_write_eeprom(board_info_t *db, int offset, u8 *data)
- {
- unsigned long flags;
-
- if (db->flags & DM9000_PLATF_NO_EEPROM)
- return;
-
- mutex_lock(&db->addr_lock);
-
- spin_lock_irqsave(&db->lock, flags);
- iow(db, DM9000_EPAR, offset);
- iow(db, DM9000_EPDRH, data[1]);
- iow(db, DM9000_EPDRL, data[0]);
- iow(db, DM9000_EPCR, EPCR_WEP | EPCR_ERPRW);
- spin_unlock_irqrestore(&db->lock, flags);
-
- dm9000_wait_eeprom(db);
-
- mdelay(1);
-
- spin_lock_irqsave(&db->lock, flags);
- iow(db, DM9000_EPCR, 0);
- spin_unlock_irqrestore(&db->lock, flags);
-
- mutex_unlock(&db->addr_lock);
- }
-
-
-
- static void dm9000_get_drvinfo(struct net_device *dev,
- struct ethtool_drvinfo *info)
- {
- board_info_t *dm = to_dm9000_board(dev);
-
- strcpy(info->driver, CARDNAME);
- strcpy(info->version, DRV_VERSION);
- strcpy(info->bus_info, to_platform_device(dm->dev)->name);
- }
-
- static u32 dm9000_get_msglevel(struct net_device *dev)
- {
- board_info_t *dm = to_dm9000_board(dev);
-
- return dm->msg_enable;
- }
-
- static void dm9000_set_msglevel(struct net_device *dev, u32 value)
- {
- board_info_t *dm = to_dm9000_board(dev);
-
- dm->msg_enable = value;
- }
-
- static int dm9000_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
- {
- board_info_t *dm = to_dm9000_board(dev);
-
- mii_ethtool_gset(&dm->mii, cmd);
- return 0;
- }
-
- static int dm9000_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
- {
- board_info_t *dm = to_dm9000_board(dev);
-
- return mii_ethtool_sset(&dm->mii, cmd);
- }
-
- static int dm9000_nway_reset(struct net_device *dev)
- {
- board_info_t *dm = to_dm9000_board(dev);
- return mii_nway_restart(&dm->mii);
- }
-
- static uint32_t dm9000_get_rx_csum(struct net_device *dev)
- {
- board_info_t *dm = to_dm9000_board(dev);
- return dm->rx_csum;
- }
-
- static int dm9000_set_rx_csum_unlocked(struct net_device *dev, uint32_t data)
- {
- board_info_t *dm = to_dm9000_board(dev);
-
- if (dm->can_csum) {
- dm->rx_csum = data;
- iow(dm, DM9000_RCSR, dm->rx_csum ? RCSR_CSUM : 0);
-
- return 0;
- }
-
- return -EOPNOTSUPP;
- }
-
- static int dm9000_set_rx_csum(struct net_device *dev, uint32_t data)
- {
- board_info_t *dm = to_dm9000_board(dev);
- unsigned long flags;
- int ret;
-
- spin_lock_irqsave(&dm->lock, flags);
- ret = dm9000_set_rx_csum_unlocked(dev, data);
- spin_unlock_irqrestore(&dm->lock, flags);
-
- return ret;
- }
-
- static int dm9000_set_tx_csum(struct net_device *dev, uint32_t data)
- {
- board_info_t *dm = to_dm9000_board(dev);
- int ret = -EOPNOTSUPP;
-
- if (dm->can_csum)
- ret = ethtool_op_set_tx_csum(dev, data);
- return ret;
- }
-
- static u32 dm9000_get_link(struct net_device *dev)
- {
- board_info_t *dm = to_dm9000_board(dev);
- u32 ret;
-
- if (dm->flags & DM9000_PLATF_EXT_PHY)
- ret = mii_link_ok(&dm->mii);
- else
- ret = dm9000_read_locked(dm, DM9000_NSR) & NSR_LINKST ? 1 : 0;
-
- return ret;
- }
-
- #define DM_EEPROM_MAGIC (0x444D394B)
-
- static int dm9000_get_eeprom_len(struct net_device *dev)
- {
- return 128;
- }
-
- static int dm9000_get_eeprom(struct net_device *dev,
- struct ethtool_eeprom *ee, u8 *data)
- {
- board_info_t *dm = to_dm9000_board(dev);
- int offset = ee->offset;
- int len = ee->len;
- int i;
-
-
-
- if ((len & 1) != 0 || (offset & 1) != 0)
- return -EINVAL;
-
- if (dm->flags & DM9000_PLATF_NO_EEPROM)
- return -ENOENT;
-
- ee->magic = DM_EEPROM_MAGIC;
-
- for (i = 0; i < len; i += 2)
- dm9000_read_eeprom(dm, (offset + i) / 2, data + i);
-
- return 0;
- }
-
- static int dm9000_set_eeprom(struct net_device *dev,
- struct ethtool_eeprom *ee, u8 *data)
- {
- board_info_t *dm = to_dm9000_board(dev);
- int offset = ee->offset;
- int len = ee->len;
- int i;
-
-
-
- if ((len & 1) != 0 || (offset & 1) != 0)
- return -EINVAL;
-
- if (dm->flags & DM9000_PLATF_NO_EEPROM)
- return -ENOENT;
-
- if (ee->magic != DM_EEPROM_MAGIC)
- return -EINVAL;
-
- for (i = 0; i < len; i += 2)
- dm9000_write_eeprom(dm, (offset + i) / 2, data + i);
-
- return 0;
- }
-
- static void dm9000_get_wol(struct net_device *dev, struct ethtool_wolinfo *w)
- {
- board_info_t *dm = to_dm9000_board(dev);
-
- memset(w, 0, sizeof(struct ethtool_wolinfo));
-
-
- w->supported = dm->wake_supported ? WAKE_MAGIC : 0;
- w->wolopts = dm->wake_state;
- }
-
- static int dm9000_set_wol(struct net_device *dev, struct ethtool_wolinfo *w)
- {
- board_info_t *dm = to_dm9000_board(dev);
- unsigned long flags;
- u32 opts = w->wolopts;
- u32 wcr = 0;
-
- if (!dm->wake_supported)
- return -EOPNOTSUPP;
-
- if (opts & ~WAKE_MAGIC)
- return -EINVAL;
-
- if (opts & WAKE_MAGIC)
- wcr |= WCR_MAGICEN;
-
- mutex_lock(&dm->addr_lock);
-
- spin_lock_irqsave(&dm->lock, flags);
- iow(dm, DM9000_WCR, wcr);
- spin_unlock_irqrestore(&dm->lock, flags);
-
- mutex_unlock(&dm->addr_lock);
-
- if (dm->wake_state != opts) {
-
-
- if (!dm->wake_state)
- set_irq_wake(dm->irq_wake, 1);
- else if (dm->wake_state & !opts)
- set_irq_wake(dm->irq_wake, 0);
- }
-
- dm->wake_state = opts;
- return 0;
- }
-
- static const struct ethtool_ops dm9000_ethtool_ops = {
- .get_drvinfo = dm9000_get_drvinfo,
- .get_settings = dm9000_get_settings,
- .set_settings = dm9000_set_settings,
- .get_msglevel = dm9000_get_msglevel,
- .set_msglevel = dm9000_set_msglevel,
- .nway_reset = dm9000_nway_reset,
- .get_link = dm9000_get_link,
- .get_wol = dm9000_get_wol,
- .set_wol = dm9000_set_wol,
- .get_eeprom_len = dm9000_get_eeprom_len,
- .get_eeprom = dm9000_get_eeprom,
- .set_eeprom = dm9000_set_eeprom,
- .get_rx_csum = dm9000_get_rx_csum,
- .set_rx_csum = dm9000_set_rx_csum,
- .get_tx_csum = ethtool_op_get_tx_csum,
- .set_tx_csum = dm9000_set_tx_csum,
- };
-
- static void dm9000_show_carrier(board_info_t *db,
- unsigned carrier, unsigned nsr)
- {
- struct net_device *ndev = db->ndev;
- unsigned ncr = dm9000_read_locked(db, DM9000_NCR);
-
- if (carrier)
- dev_info(db->dev, "%s: link up, %dMbps, %s-duplex, no LPA\n",
- ndev->name, (nsr & NSR_SPEED) ? 10 : 100,
- (ncr & NCR_FDX) ? "full" : "half");
- else
- dev_info(db->dev, "%s: link down\n", ndev->name);
- }
-
- static void
- dm9000_poll_work(struct work_struct *w)
- {
- struct delayed_work *dw = to_delayed_work(w);
- board_info_t *db = container_of(dw, board_info_t, phy_poll);
- struct net_device *ndev = db->ndev;
-
- if (db->flags & DM9000_PLATF_SIMPLE_PHY &&
- !(db->flags & DM9000_PLATF_EXT_PHY)) {
- unsigned nsr = dm9000_read_locked(db, DM9000_NSR);
- unsigned old_carrier = netif_carrier_ok(ndev) ? 1 : 0;
- unsigned new_carrier;
-
- new_carrier = (nsr & NSR_LINKST) ? 1 : 0;
-
- if (old_carrier != new_carrier) {
- if (netif_msg_link(db))
- dm9000_show_carrier(db, new_carrier, nsr);
-
- if (!new_carrier)
- netif_carrier_off(ndev);
- else
- netif_carrier_on(ndev);
- }
- } else
- mii_check_media(&db->mii, netif_msg_link(db), 0);
-
- if (netif_running(ndev))
- dm9000_schedule_poll(db);
- }
-
-
-
-
-
-
- static void
- dm9000_release_board(struct platform_device *pdev, struct board_info *db)
- {
-
-
- iounmap(db->io_addr);
- iounmap(db->io_data);
-
-
-
- release_resource(db->data_req);
- kfree(db->data_req);
-
- release_resource(db->addr_req);
- kfree(db->addr_req);
- }
-
- static unsigned char dm9000_type_to_char(enum dm9000_type type)
- {
- switch (type) {
- case TYPE_DM9000E: return 'e';
- case TYPE_DM9000A: return 'a';
- case TYPE_DM9000B: return 'b';
- }
-
- return '?';
- }
-
-
-
-
- static void
- dm9000_hash_table_unlocked(struct net_device *dev)
- {
- board_info_t *db = netdev_priv(dev);
- struct netdev_hw_addr *ha;
- int i, oft;
- u32 hash_val;
- u16 hash_table[4];
- u8 rcr = RCR_DIS_LONG | RCR_DIS_CRC | RCR_RXEN;
-
- dm9000_dbg(db, 1, "entering %s\n", __func__);
-
- for (i = 0, oft = DM9000_PAR; i < 6; i++, oft++)
- iow(db, oft, dev->dev_addr[i]);
-
-
- for (i = 0; i < 4; i++)
- hash_table[i] = 0x0;
-
-
- hash_table[3] = 0x8000;
-
- if (dev->flags & IFF_PROMISC)
- rcr |= RCR_PRMSC;
-
- if (dev->flags & IFF_ALLMULTI)
- rcr |= RCR_ALL;
-
-
- netdev_for_each_mc_addr(ha, dev) {
- hash_val = ether_crc_le(6, ha->addr) & 0x3f;
- hash_table[hash_val / 16] |= (u16) 1 << (hash_val % 16);
- }
-
-
- for (i = 0, oft = DM9000_MAR; i < 4; i++) {
- iow(db, oft++, hash_table[i]);
- iow(db, oft++, hash_table[i] >> 8);
- }
-
- iow(db, DM9000_RCR, rcr);
- }
-
- static void
- dm9000_hash_table(struct net_device *dev)
- {
- board_info_t *db = netdev_priv(dev);
- unsigned long flags;
-
- spin_lock_irqsave(&db->lock, flags);
- dm9000_hash_table_unlocked(dev);
- spin_unlock_irqrestore(&db->lock, flags);
- }
-
-
-
-
- static void
- dm9000_init_dm9000(struct net_device *dev)
- {
- board_info_t *db = netdev_priv(dev);
- unsigned int imr;
- unsigned int ncr;
-
- dm9000_dbg(db, 1, "entering %s\n", __func__);
-
-
- db->io_mode = ior(db, DM9000_ISR) >> 6;
-
-
- dm9000_set_rx_csum_unlocked(dev, db->rx_csum);
-
-
- iow(db, DM9000_GPR, 0);
- iow(db, DM9000_GPCR, GPCR_GEP_CNTL);
- iow(db, DM9000_GPR, 0);
-
- ncr = (db->flags & DM9000_PLATF_EXT_PHY) ? NCR_EXT_PHY : 0;
-
-
-
-
- if (db->wake_supported)
- ncr |= NCR_WAKEEN;
-
- iow(db, DM9000_NCR, ncr);
-
-
- iow(db, DM9000_TCR, 0);
- iow(db, DM9000_BPTR, 0x3f);
- iow(db, DM9000_FCR, 0xff);
- iow(db, DM9000_SMCR, 0);
-
- iow(db, DM9000_NSR, NSR_WAKEST | NSR_TX2END | NSR_TX1END);
- iow(db, DM9000_ISR, ISR_CLR_STATUS);
-
-
- dm9000_hash_table_unlocked(dev);
-
- imr = IMR_PAR | IMR_PTM | IMR_PRM;
- if (db->type != TYPE_DM9000E)
- imr |= IMR_LNKCHNG;
-
- db->imr_all = imr;
-
-
- iow(db, DM9000_IMR, imr);
-
-
- db->tx_pkt_cnt = 0;
- db->queue_pkt_len = 0;
- dev->trans_start = jiffies;
- }
-
-
- static void dm9000_timeout(struct net_device *dev)
- {
- board_info_t *db = netdev_priv(dev);
- u8 reg_save;
- unsigned long flags;
-
-
- reg_save = readb(db->io_addr);
- spin_lock_irqsave(&db->lock, flags);
-
- netif_stop_queue(dev);
- dm9000_reset(db);
- dm9000_init_dm9000(dev);
-
- dev->trans_start = jiffies;
- netif_wake_queue(dev);
-
-
- writeb(reg_save, db->io_addr);
- spin_unlock_irqrestore(&db->lock, flags);
- }
-
- static void dm9000_send_packet(struct net_device *dev,
- int ip_summed,
- u16 pkt_len)
- {
- board_info_t *dm = to_dm9000_board(dev);
-
-
- if (dm->ip_summed != ip_summed) {
- if (ip_summed == CHECKSUM_NONE)
- iow(dm, DM9000_TCCR, 0);
- else
- iow(dm, DM9000_TCCR, TCCR_IP | TCCR_UDP | TCCR_TCP);
- dm->ip_summed = ip_summed;
- }
-
-
-
- iow(dm, DM9000_TXPLL, pkt_len);
- iow(dm, DM9000_TXPLH, pkt_len >> 8);
-
-
-
- iow(dm, DM9000_TCR, TCR_TXREQ);
- }
-
-
-
-
-
- static int
- dm9000_start_xmit(struct sk_buff *skb, struct net_device *dev)
- {
- unsigned long flags;
- board_info_t *db = netdev_priv(dev);
-
- dm9000_dbg(db, 3, "%s:\n", __func__);
-
- if (db->tx_pkt_cnt > 1)
- return NETDEV_TX_BUSY;
-
- spin_lock_irqsave(&db->lock, flags);
-
-
-
-
-
- writeb(DM9000_MWCMD, db->io_addr);
-
- (db->outblk)(db->io_data, skb->data, skb->len);
-
- dev->stats.tx_bytes += skb->len;
-
- db->tx_pkt_cnt++;
-
- if (db->tx_pkt_cnt == 1) {
- dm9000_send_packet(dev, skb->ip_summed, skb->len);
- } else {
-
- db->queue_pkt_len = skb->len;
- db->queue_ip_summed = skb->ip_summed;
- netif_stop_queue(dev);
- }
-
- spin_unlock_irqrestore(&db->lock, flags);
-
-
- dev_kfree_skb(skb);
-
- return NETDEV_TX_OK;
- }
-
-
-
-
-
-
- static void dm9000_tx_done(struct net_device *dev, board_info_t *db)
- {
- int tx_status = ior(db, DM9000_NSR);
-
- if (tx_status & (NSR_TX2END | NSR_TX1END)) {
-
- db->tx_pkt_cnt--;
- dev->stats.tx_packets++;
-
- if (netif_msg_tx_done(db))
- dev_dbg(db->dev, "tx done, NSR %02x\n", tx_status);
-
-
- if (db->tx_pkt_cnt > 0)
- dm9000_send_packet(dev, db->queue_ip_summed,
- db->queue_pkt_len);
- netif_wake_queue(dev);
- }
- }
-
-
- struct dm9000_rxhdr {
- u8 RxPktReady;
- u8 RxStatus;
- __le16 RxLen;
- } __attribute__((__packed__));
-
-
-
-
-
- static void
- dm9000_rx(struct net_device *dev)
- {
- board_info_t *db = netdev_priv(dev);
- struct dm9000_rxhdr rxhdr;
- struct sk_buff *skb;
- u8 rxbyte, *rdptr;
- bool GoodPacket;
- int RxLen;
-
-
- do {
-
- ior(db, DM9000_MRCMDX);
-
- rxbyte = readb(db->io_data);
-
-
-
- if (rxbyte & DM9000_PKT_ERR) {
- dev_warn(db->dev, "status check fail: %d\n", rxbyte);
- iow(db, DM9000_RCR, 0x00);
- iow(db, DM9000_ISR, IMR_PAR);
- return;
- }
-
-
- if (!(rxbyte & DM9000_PKT_RDY))
- return;
-
-
- GoodPacket = true;
- writeb(DM9000_MRCMD, db->io_addr);
-
- (db->inblk)(db->io_data, &rxhdr, sizeof(rxhdr));
-
- RxLen = le16_to_cpu(rxhdr.RxLen);
-
- if (netif_msg_rx_status(db))
- dev_dbg(db->dev, "RX: status %02x, length %04x\n",
- rxhdr.RxStatus, RxLen);
-
-
- if (RxLen < 0x40) {
- GoodPacket = false;
- if (netif_msg_rx_err(db))
- dev_dbg(db->dev, "RX: Bad Packet (runt)\n");
- }
-
- if (RxLen > DM9000_PKT_MAX) {
- dev_dbg(db->dev, "RST: RX Len:%x\n", RxLen);
- }
-
-
-
- if (rxhdr.RxStatus & (RSR_FOE | RSR_CE | RSR_AE |
- RSR_PLE | RSR_RWTO |
- RSR_LCS | RSR_RF)) {
- GoodPacket = false;
- if (rxhdr.RxStatus & RSR_FOE) {
- if (netif_msg_rx_err(db))
- dev_dbg(db->dev, "fifo error\n");
- dev->stats.rx_fifo_errors++;
- }
- if (rxhdr.RxStatus & RSR_CE) {
- if (netif_msg_rx_err(db))
- dev_dbg(db->dev, "crc error\n");
- dev->stats.rx_crc_errors++;
- }
- if (rxhdr.RxStatus & RSR_RF) {
- if (netif_msg_rx_err(db))
- dev_dbg(db->dev, "length error\n");
- dev->stats.rx_length_errors++;
- }
- }
-
-
- if (GoodPacket &&
- ((skb = dev_alloc_skb(RxLen + 4)) != NULL)) {
- skb_reserve(skb, 2);
- rdptr = (u8 *) skb_put(skb, RxLen - 4);
-
-
-
- (db->inblk)(db->io_data, rdptr, RxLen);
- dev->stats.rx_bytes += RxLen;
-
-
- skb->protocol = eth_type_trans(skb, dev);
- if (db->rx_csum) {
- if ((((rxbyte & 0x1c) << 3) & rxbyte) == 0)
- skb->ip_summed = CHECKSUM_UNNECESSARY;
- else
- skb->ip_summed = CHECKSUM_NONE;
- }
- netif_rx(skb);
- dev->stats.rx_packets++;
-
- } else {
-
-
- (db->dumpblk)(db->io_data, RxLen);
- }
- } while (rxbyte & DM9000_PKT_RDY);
- }
-
- static irqreturn_t dm9000_interrupt(int irq, void *dev_id)
- {
- struct net_device *dev = dev_id;
- board_info_t *db = netdev_priv(dev);
- int int_status;
- unsigned long flags;
- u8 reg_save;
-
- dm9000_dbg(db, 3, "entering %s\n", __func__);
-
-
-
-
- spin_lock_irqsave(&db->lock, flags);
-
-
- reg_save = readb(db->io_addr);
-
-
- iow(db, DM9000_IMR, IMR_PAR);
-
-
- int_status = ior(db, DM9000_ISR);
- iow(db, DM9000_ISR, int_status);
-
- if (netif_msg_intr(db))
- dev_dbg(db->dev, "interrupt status %02x\n", int_status);
-
-
- if (int_status & ISR_PRS)
- dm9000_rx(dev);
-
-
- if (int_status & ISR_PTS)
- dm9000_tx_done(dev, db);
-
- if (db->type != TYPE_DM9000E) {
- if (int_status & ISR_LNKCHNG) {
-
- schedule_delayed_work(&db->phy_poll, 1);
- }
- }
-
-
- iow(db, DM9000_IMR, db->imr_all);
-
-
- writeb(reg_save, db->io_addr);
-
- spin_unlock_irqrestore(&db->lock, flags);
-
- return IRQ_HANDLED;
- }
-
- static irqreturn_t dm9000_wol_interrupt(int irq, void *dev_id)
- {
- struct net_device *dev = dev_id;
- board_info_t *db = netdev_priv(dev);
- unsigned long flags;
- unsigned nsr, wcr;
-
- spin_lock_irqsave(&db->lock, flags);
-
- nsr = ior(db, DM9000_NSR);
- wcr = ior(db, DM9000_WCR);
-
- dev_dbg(db->dev, "%s: NSR=0x%02x, WCR=0x%02x\n", __func__, nsr, wcr);
-
- if (nsr & NSR_WAKEST) {
-
- iow(db, DM9000_NSR, NSR_WAKEST);
-
- if (wcr & WCR_LINKST)
- dev_info(db->dev, "wake by link status change\n");
- if (wcr & WCR_SAMPLEST)
- dev_info(db->dev, "wake by sample packet\n");
- if (wcr & WCR_MAGICST )
- dev_info(db->dev, "wake by magic packet\n");
- if (!(wcr & (WCR_LINKST | WCR_SAMPLEST | WCR_MAGICST)))
- dev_err(db->dev, "wake signalled with no reason? "
- "NSR=0x%02x, WSR=0x%02x\n", nsr, wcr);
-
- }
-
- spin_unlock_irqrestore(&db->lock, flags);
-
- return (nsr & NSR_WAKEST) ? IRQ_HANDLED : IRQ_NONE;
- }
-
- #ifdef CONFIG_NET_POLL_CONTROLLER
-
-
-
- static void dm9000_poll_controller(struct net_device *dev)
- {
- disable_irq(dev->irq);
- dm9000_interrupt(dev->irq, dev);
- enable_irq(dev->irq);
- }
- #endif
-
-
-
-
-
- static int
- dm9000_open(struct net_device *dev)
- {
- board_info_t *db = netdev_priv(dev);
- unsigned long irqflags = db->irq_res->flags & IRQF_TRIGGER_MASK;
-
- if (netif_msg_ifup(db))
- dev_dbg(db->dev, "enabling %s\n", dev->name);
-
-
-
-
- if (irqflags == IRQF_TRIGGER_NONE)
- dev_warn(db->dev, "WARNING: no IRQ resource flags set.\n");
-
- irqflags |= IRQF_SHARED;
-
-
- if (request_irq(dev->irq, dm9000_interrupt, irqflags, dev->name, dev))
- return -EAGAIN;
-
-
- dm9000_reset(db);
- dm9000_init_dm9000(dev);
-
-
- db->dbug_cnt = 0;
-
- mii_check_media(&db->mii, netif_msg_link(db), 1);
- netif_start_queue(dev);
-
-
-
- dm9000_schedule_poll(db);
-
- return 0;
- }
-
-
-
-
-
- static void dm9000_msleep(board_info_t *db, unsigned int ms)
- {
- if (db->in_suspend)
- mdelay(ms);
- else
- msleep(ms);
- }
-
-
-
-
- static int
- dm9000_phy_read(struct net_device *dev, int phy_reg_unused, int reg)
- {
- board_info_t *db = netdev_priv(dev);
- unsigned long flags;
- unsigned int reg_save;
- int ret;
-
- mutex_lock(&db->addr_lock);
-
- spin_lock_irqsave(&db->lock,flags);
-
-
- reg_save = readb(db->io_addr);
-
-
- iow(db, DM9000_EPAR, DM9000_PHY | reg);
-
- iow(db, DM9000_EPCR, EPCR_ERPRR | EPCR_EPOS);
-
- writeb(reg_save, db->io_addr);
- spin_unlock_irqrestore(&db->lock,flags);
-
- dm9000_msleep(db, 1);
-
- spin_lock_irqsave(&db->lock,flags);
- reg_save = readb(db->io_addr);
-
- iow(db, DM9000_EPCR, 0x0);
-
-
- ret = (ior(db, DM9000_EPDRH) << 8) | ior(db, DM9000_EPDRL);
-
-
- writeb(reg_save, db->io_addr);
- spin_unlock_irqrestore(&db->lock,flags);
-
- mutex_unlock(&db->addr_lock);
-
- dm9000_dbg(db, 5, "phy_read[%02x] -> %04x\n", reg, ret);
- return ret;
- }
-
-
-
-
- static void
- dm9000_phy_write(struct net_device *dev,
- int phyaddr_unused, int reg, int value)
- {
- board_info_t *db = netdev_priv(dev);
- unsigned long flags;
- unsigned long reg_save;
-
- dm9000_dbg(db, 5, "phy_write[%02x] = %04x\n", reg, value);
- mutex_lock(&db->addr_lock);
-
- spin_lock_irqsave(&db->lock,flags);
-
-
- reg_save = readb(db->io_addr);
-
-
- iow(db, DM9000_EPAR, DM9000_PHY | reg);
-
-
- iow(db, DM9000_EPDRL, value);
- iow(db, DM9000_EPDRH, value >> 8);
-
- iow(db, DM9000_EPCR, EPCR_EPOS | EPCR_ERPRW);
-
- writeb(reg_save, db->io_addr);
- spin_unlock_irqrestore(&db->lock, flags);
-
- dm9000_msleep(db, 1);
-
- spin_lock_irqsave(&db->lock,flags);
- reg_save = readb(db->io_addr);
-
- iow(db, DM9000_EPCR, 0x0);
-
-
- writeb(reg_save, db->io_addr);
-
- spin_unlock_irqrestore(&db->lock, flags);
- mutex_unlock(&db->addr_lock);
- }
-
-
- static void
- dm9000_shutdown(struct net_device *dev)
- {
- board_info_t *db = netdev_priv(dev);
-
-
- dm9000_phy_write(dev, 0, MII_BMCR, BMCR_RESET);
- iow(db, DM9000_GPR, 0x01);
- iow(db, DM9000_IMR, IMR_PAR);
- iow(db, DM9000_RCR, 0x00);
- }
-
-
-
-
-
- static int
- dm9000_stop(struct net_device *ndev)
- {
- board_info_t *db = netdev_priv(ndev);
-
- if (netif_msg_ifdown(db))
- dev_dbg(db->dev, "shutting down %s\n", ndev->name);
-
- cancel_delayed_work_sync(&db->phy_poll);
-
- netif_stop_queue(ndev);
- netif_carrier_off(ndev);
-
-
- free_irq(ndev->irq, ndev);
-
- dm9000_shutdown(ndev);
-
- return 0;
- }
-
- static const struct net_device_ops dm9000_netdev_ops = {
- .ndo_open = dm9000_open,
- .ndo_stop = dm9000_stop,
- .ndo_start_xmit = dm9000_start_xmit,
- .ndo_tx_timeout = dm9000_timeout,
- .ndo_set_multicast_list = dm9000_hash_table,
- .ndo_do_ioctl = dm9000_ioctl,
- .ndo_change_mtu = eth_change_mtu,
- .ndo_validate_addr = eth_validate_addr,
- .ndo_set_mac_address = eth_mac_addr,
- #ifdef CONFIG_NET_POLL_CONTROLLER
- .ndo_poll_controller = dm9000_poll_controller,
- #endif
- };
-
-
-
-
- static int __devinit
- dm9000_probe(struct platform_device *pdev)
- {
- struct dm9000_plat_data *pdata = pdev->dev.platform_data;
- struct board_info *db;
- struct net_device *ndev;
- const unsigned char *mac_src;
- int ret = 0;
- int iosize;
- int i;
- u32 id_val;
-
- unsigned char ne_def_eth_mac_addr[]={0x00,0x12,0x34,0x56,0x80,0x49};
- static void *bwscon;
- static void *gpfcon;
- static void *extint0;
- static void *intmsk;
-
- #define BWSCON (0x48000000)
- #define GPFCON (0x56000050)
- #define EXTINT0 (0x56000088)
- #define INTMSK (0x4A000008)
-
- bwscon=ioremap_nocache(BWSCON,0x0000004);
- gpfcon=ioremap_nocache(GPFCON,0x0000004);
- extint0=ioremap_nocache(EXTINT0,0x0000004);
- intmsk=ioremap_nocache(INTMSK,0x0000004);
-
- writel( readl(bwscon)|0xc0000,bwscon);
- writel( (readl(gpfcon) & ~(0x3 << 14)) | (0x2 << 14), gpfcon);
- writel( readl(gpfcon) | (0x1 << 7), gpfcon);
- writel( (readl(extint0) & ~(0xf << 28)) | (0x4 << 28), extint0);
- writel( (readl(intmsk)) & ~0x80, intmsk);
-
-
-
-
- ndev = alloc_etherdev(sizeof(struct board_info));
- if (!ndev) {
- dev_err(&pdev->dev, "could not allocate device.\n");
- return -ENOMEM;
- }
-
-
-
-
- SET_NETDEV_DEV(ndev, &pdev->dev);
-
- dev_dbg(&pdev->dev, "dm9000_probe()\n");
-
-
-
- db = netdev_priv(ndev);
-
- db->dev = &pdev->dev;
- db->ndev = ndev;
-
- spin_lock_init(&db->lock);
- mutex_init(&db->addr_lock);
-
- INIT_DELAYED_WORK(&db->phy_poll, dm9000_poll_work);
-
- db->addr_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
- db->data_res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
- db->irq_res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
-
- if (db->addr_res == NULL || db->data_res == NULL ||
- db->irq_res == NULL) {
- dev_err(db->dev, "insufficient resources\n");
- ret = -ENOENT;
- goto out;
- }
-
- db->irq_wake = platform_get_irq(pdev, 1);
- if (db->irq_wake >= 0) {
- dev_dbg(db->dev, "wakeup irq %d\n", db->irq_wake);
-
- ret = request_irq(db->irq_wake, dm9000_wol_interrupt,
- IRQF_SHARED, dev_name(db->dev), ndev);
- if (ret) {
- dev_err(db->dev, "cannot get wakeup irq (%d)\n", ret);
- } else {
-
-
- ret = set_irq_wake(db->irq_wake, 1);
- if (ret) {
- dev_err(db->dev, "irq %d cannot set wakeup (%d)\n",
- db->irq_wake, ret);
- ret = 0;
- } else {
- set_irq_wake(db->irq_wake, 0);
- db->wake_supported = 1;
- }
- }
- }
-
- iosize = resource_size(db->addr_res);
- db->addr_req = request_mem_region(db->addr_res->start, iosize,
- pdev->name);
-
- if (db->addr_req == NULL) {
- dev_err(db->dev, "cannot claim address reg area\n");
- ret = -EIO;
- goto out;
- }
-
- db->io_addr = ioremap(db->addr_res->start, iosize);
-
- if (db->io_addr == NULL) {
- dev_err(db->dev, "failed to ioremap address reg\n");
- ret = -EINVAL;
- goto out;
- }
-
- iosize = resource_size(db->data_res);
- db->data_req = request_mem_region(db->data_res->start, iosize,
- pdev->name);
-
- if (db->data_req == NULL) {
- dev_err(db->dev, "cannot claim data reg area\n");
- ret = -EIO;
- goto out;
- }
-
- db->io_data = ioremap(db->data_res->start, iosize);
-
- if (db->io_data == NULL) {
- dev_err(db->dev, "failed to ioremap data reg\n");
- ret = -EINVAL;
- goto out;
- }
-
-
-
- ndev->base_addr = (unsigned long)db->io_addr;
- ndev->irq = db->irq_res->start;
-
-
- dm9000_set_io(db, iosize);
-
-
-
-
- if (pdata != NULL) {
-
-
-
- if (pdata->flags & DM9000_PLATF_8BITONLY)
- dm9000_set_io(db, 1);
-
- if (pdata->flags & DM9000_PLATF_16BITONLY)
- dm9000_set_io(db, 2);
-
- if (pdata->flags & DM9000_PLATF_32BITONLY)
- dm9000_set_io(db, 4);
-
-
-
-
- if (pdata->inblk != NULL)
- db->inblk = pdata->inblk;
-
- if (pdata->outblk != NULL)
- db->outblk = pdata->outblk;
-
- if (pdata->dumpblk != NULL)
- db->dumpblk = pdata->dumpblk;
-
- db->flags = pdata->flags;
- }
-
- #ifdef CONFIG_DM9000_FORCE_SIMPLE_PHY_POLL
- db->flags |= DM9000_PLATF_SIMPLE_PHY;
- #endif
-
- dm9000_reset(db);
-
-
- for (i = 0; i < 8; i++) {
- id_val = ior(db, DM9000_VIDL);
- id_val |= (u32)ior(db, DM9000_VIDH) << 8;
- id_val |= (u32)ior(db, DM9000_PIDL) << 16;
- id_val |= (u32)ior(db, DM9000_PIDH) << 24;
-
- if (id_val == DM9000_ID)
- break;
- dev_err(db->dev, "read wrong id 0x%08x\n", id_val);
- }
-
- if (id_val != DM9000_ID) {
- dev_err(db->dev, "wrong id: 0x%08x\n", id_val);
- ret = -ENODEV;
- goto out;
- }
-
-
-
- id_val = ior(db, DM9000_CHIPR);
- dev_dbg(db->dev, "dm9000 revision 0x%02x\n", id_val);
-
- switch (id_val) {
- case CHIPR_DM9000A:
- db->type = TYPE_DM9000A;
- break;
- case CHIPR_DM9000B:
- db->type = TYPE_DM9000B;
- break;
- default:
- dev_dbg(db->dev, "ID %02x => defaulting to DM9000E\n", id_val);
- db->type = TYPE_DM9000E;
- }
-
-
- if (db->type == TYPE_DM9000A || db->type == TYPE_DM9000B) {
- db->can_csum = 1;
- db->rx_csum = 1;
- ndev->features |= NETIF_F_IP_CSUM;
- }
-
-
-
-
- ether_setup(ndev);
-
- ndev->netdev_ops = &dm9000_netdev_ops;
- ndev->watchdog_timeo = msecs_to_jiffies(watchdog);
- ndev->ethtool_ops = &dm9000_ethtool_ops;
-
- db->msg_enable = NETIF_MSG_LINK;
- db->mii.phy_id_mask = 0x1f;
- db->mii.reg_num_mask = 0x1f;
- db->mii.force_media = 0;
- db->mii.full_duplex = 0;
- db->mii.dev = ndev;
- db->mii.mdio_read = dm9000_phy_read;
- db->mii.mdio_write = dm9000_phy_write;
-
- mac_src = "eeprom";
-
-
- for (i = 0; i < 6; i += 2)
- dm9000_read_eeprom(db, i / 2, ndev->dev_addr+i);
-
- if (!is_valid_ether_addr(ndev->dev_addr) && pdata != NULL) {
- mac_src = "platform data";
- memcpy(ndev->dev_addr, pdata->dev_addr, 6);
- }
-
- if (!is_valid_ether_addr(ndev->dev_addr)) {
-
-
- mac_src = "chip";
- for (i = 0; i < 6; i++)
- ndev->dev_addr[i] = ne_def_eth_mac_addr[i];
- }
-
- if (!is_valid_ether_addr(ndev->dev_addr))
- dev_warn(db->dev, "%s: Invalid ethernet MAC address. Please "
- "set using ifconfig\n", ndev->name);
-
-
- platform_set_drvdata(pdev, ndev);
-
-
- ret = register_netdev(ndev);
-
- if (ret == 0)
- printk(KERN_INFO "%s: dm9000%c at %p,%p IRQ %d MAC: %pM (%s)\n",
- ndev->name, dm9000_type_to_char(db->type),
- db->io_addr, db->io_data, ndev->irq,
- ndev->dev_addr, mac_src);
- return 0;
-
-
- out:
- dev_err(db->dev, "not found (%d).\n", ret);
-
- dm9000_release_board(pdev, db);
- free_netdev(ndev);
-
- return ret;
- }
-
-
- static int __devexit
- dm9000_drv_remove(struct platform_device *pdev)
- {
- struct net_device *ndev = platform_get_drvdata(pdev);
-
- platform_set_drvdata(pdev, NULL);
-
- unregister_netdev(ndev);
- dm9000_release_board(pdev, (board_info_t *) netdev_priv(ndev));
- free_netdev(ndev);
-
- dev_dbg(&pdev->dev, "released and freed device\n");
- return 0;
- }
-
-
-
-
-
- static struct platform_driver dm9000_driver = {
- .driver = {
- .name = "dm9000",
- .owner = THIS_MODULE,
- },
- .probe = dm9000_probe,
- .remove = __devexit_p(dm9000_drv_remove),
- };
-
- static int __init
- dm9000_init(void)
- {
- printk(KERN_INFO "%s Ethernet Driver, V%s\n", CARDNAME, DRV_VERSION);
-
- return platform_driver_register(&dm9000_driver);
- }
-
- static void __exit
- dm9000_cleanup(void)
- {
- platform_driver_unregister(&dm9000_driver);
- }
-
- module_init(dm9000_init);
- module_exit(dm9000_cleanup);
-
- MODULE_AUTHOR("Modified by yan");
- MODULE_DESCRIPTION("Davicom DM9000 network driver");
- MODULE_LICENSE("GPL");
- MODULE_ALIAS("platform:dm9000");
阅读(1080) | 评论(0) | 转发(0) |