1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828 |
- --- a/drivers/net/ethernet/atheros/Makefile
- +++ b/drivers/net/ethernet/atheros/Makefile
- @@ -7,3 +7,4 @@ obj-$(CONFIG_ATL2) += atlx/
- obj-$(CONFIG_ATL1E) += atl1e/
- obj-$(CONFIG_ATL1C) += atl1c/
- obj-$(CONFIG_ALX) += alx/
- +obj-$(CONFIG_NET_AR231X) += ar231x/
- --- a/drivers/net/ethernet/atheros/Kconfig
- +++ b/drivers/net/ethernet/atheros/Kconfig
- @@ -5,7 +5,7 @@
- config NET_VENDOR_ATHEROS
- bool "Atheros devices"
- default y
- - depends on PCI
- + depends on (PCI || ATH25)
- ---help---
- If you have a network (Ethernet) card belonging to this class, say Y.
-
- @@ -78,4 +78,10 @@ config ALX
- To compile this driver as a module, choose M here. The module
- will be called alx.
-
- +config NET_AR231X
- + tristate "Atheros AR231X built-in Ethernet support"
- + depends on ATH25
- + help
- + Support for the AR231x/531x ethernet controller
- +
- endif # NET_VENDOR_ATHEROS
- --- /dev/null
- +++ b/drivers/net/ethernet/atheros/ar231x/Makefile
- @@ -0,0 +1 @@
- +obj-$(CONFIG_NET_AR231X) += ar231x.o
- --- /dev/null
- +++ b/drivers/net/ethernet/atheros/ar231x/ar231x.c
- @@ -0,0 +1,1206 @@
- +/*
- + * ar231x.c: Linux driver for the Atheros AR231x Ethernet device.
- + *
- + * Copyright (C) 2004 by Sameer Dekate <sdekate@arubanetworks.com>
- + * Copyright (C) 2006 Imre Kaloz <kaloz@openwrt.org>
- + * Copyright (C) 2006-2009 Felix Fietkau <nbd@nbd.name>
- + *
- + * Thanks to Atheros for providing hardware and documentation
- + * enabling me to write this driver.
- + *
- + * This program is free software; you can redistribute it and/or modify
- + * it under the terms of the GNU General Public License as published by
- + * the Free Software Foundation; either version 2 of the License, or
- + * (at your option) any later version.
- + *
- + * Additional credits:
- + * This code is taken from John Taylor's Sibyte driver and then
- + * modified for the AR2313.
- + */
- +
- +#include <linux/module.h>
- +#include <linux/types.h>
- +#include <linux/errno.h>
- +#include <linux/ioport.h>
- +#include <linux/netdevice.h>
- +#include <linux/etherdevice.h>
- +#include <linux/interrupt.h>
- +#include <linux/skbuff.h>
- +#include <linux/init.h>
- +#include <linux/delay.h>
- +#include <linux/mm.h>
- +#include <linux/mii.h>
- +#include <linux/phy.h>
- +#include <linux/platform_device.h>
- +#include <linux/io.h>
- +
- +#define AR2313_MTU 1692
- +#define AR2313_PRIOS 1
- +#define AR2313_QUEUES (2*AR2313_PRIOS)
- +#define AR2313_DESCR_ENTRIES 64
- +
- +#ifndef min
- +#define min(a, b) (((a) < (b)) ? (a) : (b))
- +#endif
- +
- +#ifndef SMP_CACHE_BYTES
- +#define SMP_CACHE_BYTES L1_CACHE_BYTES
- +#endif
- +
- +#define AR2313_MBOX_SET_BIT 0x8
- +
- +#include "ar231x.h"
- +
- +/**
- + * New interrupt handler strategy:
- + *
- + * An old interrupt handler worked using the traditional method of
- + * replacing an skbuff with a new one when a packet arrives. However
- + * the rx rings do not need to contain a static number of buffer
- + * descriptors, thus it makes sense to move the memory allocation out
- + * of the main interrupt handler and do it in a bottom half handler
- + * and only allocate new buffers when the number of buffers in the
- + * ring is below a certain threshold. In order to avoid starving the
- + * NIC under heavy load it is however necessary to force allocation
- + * when hitting a minimum threshold. The strategy for alloction is as
- + * follows:
- + *
- + * RX_LOW_BUF_THRES - allocate buffers in the bottom half
- + * RX_PANIC_LOW_THRES - we are very low on buffers, allocate
- + * the buffers in the interrupt handler
- + * RX_RING_THRES - maximum number of buffers in the rx ring
- + *
- + * One advantagous side effect of this allocation approach is that the
- + * entire rx processing can be done without holding any spin lock
- + * since the rx rings and registers are totally independent of the tx
- + * ring and its registers. This of course includes the kmalloc's of
- + * new skb's. Thus start_xmit can run in parallel with rx processing
- + * and the memory allocation on SMP systems.
- + *
- + * Note that running the skb reallocation in a bottom half opens up
- + * another can of races which needs to be handled properly. In
- + * particular it can happen that the interrupt handler tries to run
- + * the reallocation while the bottom half is either running on another
- + * CPU or was interrupted on the same CPU. To get around this the
- + * driver uses bitops to prevent the reallocation routines from being
- + * reentered.
- + *
- + * TX handling can also be done without holding any spin lock, wheee
- + * this is fun! since tx_csm is only written to by the interrupt
- + * handler.
- + */
- +
- +/**
- + * Threshold values for RX buffer allocation - the low water marks for
- + * when to start refilling the rings are set to 75% of the ring
- + * sizes. It seems to make sense to refill the rings entirely from the
- + * intrrupt handler once it gets below the panic threshold, that way
- + * we don't risk that the refilling is moved to another CPU when the
- + * one running the interrupt handler just got the slab code hot in its
- + * cache.
- + */
- +#define RX_RING_SIZE AR2313_DESCR_ENTRIES
- +#define RX_PANIC_THRES (RX_RING_SIZE/4)
- +#define RX_LOW_THRES ((3*RX_RING_SIZE)/4)
- +#define CRC_LEN 4
- +#define RX_OFFSET 2
- +
- +#if defined(CONFIG_VLAN_8021Q) || defined(CONFIG_VLAN_8021Q_MODULE)
- +#define VLAN_HDR 4
- +#else
- +#define VLAN_HDR 0
- +#endif
- +
- +#define AR2313_BUFSIZE (AR2313_MTU + VLAN_HDR + ETH_HLEN + CRC_LEN + \
- + RX_OFFSET)
- +
- +#ifdef MODULE
- +MODULE_LICENSE("GPL");
- +MODULE_AUTHOR("Sameer Dekate <sdekate@arubanetworks.com>, Imre Kaloz <kaloz@openwrt.org>, Felix Fietkau <nbd@nbd.name>");
- +MODULE_DESCRIPTION("AR231x Ethernet driver");
- +#endif
- +
- +#define virt_to_phys(x) ((u32)(x) & 0x1fffffff)
- +
- +/* prototypes */
- +static void ar231x_halt(struct net_device *dev);
- +static void rx_tasklet_func(unsigned long data);
- +static void rx_tasklet_cleanup(struct net_device *dev);
- +static void ar231x_multicast_list(struct net_device *dev);
- +static void ar231x_tx_timeout(struct net_device *dev);
- +
- +static int ar231x_mdiobus_read(struct mii_bus *bus, int phy_addr, int regnum);
- +static int ar231x_mdiobus_write(struct mii_bus *bus, int phy_addr, int regnum,
- + u16 value);
- +static int ar231x_mdiobus_reset(struct mii_bus *bus);
- +static int ar231x_mdiobus_probe(struct net_device *dev);
- +static void ar231x_adjust_link(struct net_device *dev);
- +
- +#ifndef ERR
- +#define ERR(fmt, args...) printk("%s: " fmt, __func__, ##args)
- +#endif
- +
- +#ifdef CONFIG_NET_POLL_CONTROLLER
- +static void
- +ar231x_netpoll(struct net_device *dev)
- +{
- + unsigned long flags;
- +
- + local_irq_save(flags);
- + ar231x_interrupt(dev->irq, dev);
- + local_irq_restore(flags);
- +}
- +#endif
- +
- +static const struct net_device_ops ar231x_ops = {
- + .ndo_open = ar231x_open,
- + .ndo_stop = ar231x_close,
- + .ndo_start_xmit = ar231x_start_xmit,
- + .ndo_set_rx_mode = ar231x_multicast_list,
- + .ndo_do_ioctl = ar231x_ioctl,
- + .ndo_change_mtu = eth_change_mtu,
- + .ndo_validate_addr = eth_validate_addr,
- + .ndo_set_mac_address = eth_mac_addr,
- + .ndo_tx_timeout = ar231x_tx_timeout,
- +#ifdef CONFIG_NET_POLL_CONTROLLER
- + .ndo_poll_controller = ar231x_netpoll,
- +#endif
- +};
- +
- +static int ar231x_probe(struct platform_device *pdev)
- +{
- + struct net_device *dev;
- + struct ar231x_private *sp;
- + struct resource *res;
- + unsigned long ar_eth_base;
- + char buf[64];
- +
- + dev = alloc_etherdev(sizeof(struct ar231x_private));
- +
- + if (dev == NULL) {
- + printk(KERN_ERR
- + "ar231x: Unable to allocate net_device structure!\n");
- + return -ENOMEM;
- + }
- +
- + platform_set_drvdata(pdev, dev);
- +
- + sp = netdev_priv(dev);
- + sp->dev = dev;
- + sp->cfg = pdev->dev.platform_data;
- +
- + sprintf(buf, "eth%d_membase", pdev->id);
- + res = platform_get_resource_byname(pdev, IORESOURCE_MEM, buf);
- + if (!res)
- + return -ENODEV;
- +
- + sp->link = 0;
- + ar_eth_base = res->start;
- +
- + sprintf(buf, "eth%d_irq", pdev->id);
- + dev->irq = platform_get_irq_byname(pdev, buf);
- +
- + spin_lock_init(&sp->lock);
- +
- + dev->features |= NETIF_F_HIGHDMA;
- + dev->netdev_ops = &ar231x_ops;
- +
- + tasklet_init(&sp->rx_tasklet, rx_tasklet_func, (unsigned long)dev);
- + tasklet_disable(&sp->rx_tasklet);
- +
- + sp->eth_regs = ioremap_nocache(ar_eth_base, sizeof(*sp->eth_regs));
- + if (!sp->eth_regs) {
- + printk("Can't remap eth registers\n");
- + return -ENXIO;
- + }
- +
- + /**
- + * When there's only one MAC, PHY regs are typically on ENET0,
- + * even though the MAC might be on ENET1.
- + * So remap PHY regs separately.
- + */
- + res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "eth0_mii");
- + if (!res) {
- + res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
- + "eth1_mii");
- + if (!res)
- + return -ENODEV;
- + }
- + sp->phy_regs = ioremap_nocache(res->start, resource_size(res));
- + if (!sp->phy_regs) {
- + printk("Can't remap phy registers\n");
- + return -ENXIO;
- + }
- +
- + sp->dma_regs = ioremap_nocache(ar_eth_base + 0x1000,
- + sizeof(*sp->dma_regs));
- + if (!sp->dma_regs) {
- + printk("Can't remap DMA registers\n");
- + return -ENXIO;
- + }
- + dev->base_addr = ar_eth_base + 0x1000;
- +
- + strncpy(sp->name, "Atheros AR231x", sizeof(sp->name) - 1);
- + sp->name[sizeof(sp->name) - 1] = '\0';
- + memcpy(dev->dev_addr, sp->cfg->macaddr, 6);
- +
- + if (ar231x_init(dev)) {
- + /* ar231x_init() calls ar231x_init_cleanup() on error */
- + kfree(dev);
- + return -ENODEV;
- + }
- +
- + if (register_netdev(dev)) {
- + printk("%s: register_netdev failed\n", __func__);
- + return -1;
- + }
- +
- + printk("%s: %s: %pM, irq %d\n", dev->name, sp->name, dev->dev_addr,
- + dev->irq);
- +
- + sp->mii_bus = mdiobus_alloc();
- + if (sp->mii_bus == NULL)
- + return -1;
- +
- + sp->mii_bus->priv = dev;
- + sp->mii_bus->read = ar231x_mdiobus_read;
- + sp->mii_bus->write = ar231x_mdiobus_write;
- + sp->mii_bus->reset = ar231x_mdiobus_reset;
- + sp->mii_bus->name = "ar231x_eth_mii";
- + snprintf(sp->mii_bus->id, MII_BUS_ID_SIZE, "%d", pdev->id);
- + sp->mii_bus->irq = kmalloc(sizeof(int), GFP_KERNEL);
- + *sp->mii_bus->irq = PHY_POLL;
- +
- + mdiobus_register(sp->mii_bus);
- +
- + if (ar231x_mdiobus_probe(dev) != 0) {
- + printk(KERN_ERR "%s: mdiobus_probe failed\n", dev->name);
- + rx_tasklet_cleanup(dev);
- + ar231x_init_cleanup(dev);
- + unregister_netdev(dev);
- + kfree(dev);
- + return -ENODEV;
- + }
- +
- + /* start link poll timer */
- + ar231x_setup_timer(dev);
- +
- + return 0;
- +}
- +
- +static void ar231x_multicast_list(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + unsigned int filter;
- +
- + filter = sp->eth_regs->mac_control;
- +
- + if (dev->flags & IFF_PROMISC)
- + filter |= MAC_CONTROL_PR;
- + else
- + filter &= ~MAC_CONTROL_PR;
- + if ((dev->flags & IFF_ALLMULTI) || (netdev_mc_count(dev) > 0))
- + filter |= MAC_CONTROL_PM;
- + else
- + filter &= ~MAC_CONTROL_PM;
- +
- + sp->eth_regs->mac_control = filter;
- +}
- +
- +static void rx_tasklet_cleanup(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- +
- + /**
- + * Tasklet may be scheduled. Need to get it removed from the list
- + * since we're about to free the struct.
- + */
- +
- + sp->unloading = 1;
- + tasklet_enable(&sp->rx_tasklet);
- + tasklet_kill(&sp->rx_tasklet);
- +}
- +
- +static int ar231x_remove(struct platform_device *pdev)
- +{
- + struct net_device *dev = platform_get_drvdata(pdev);
- + struct ar231x_private *sp = netdev_priv(dev);
- +
- + rx_tasklet_cleanup(dev);
- + ar231x_init_cleanup(dev);
- + unregister_netdev(dev);
- + mdiobus_unregister(sp->mii_bus);
- + mdiobus_free(sp->mii_bus);
- + kfree(dev);
- + return 0;
- +}
- +
- +/**
- + * Restart the AR2313 ethernet controller.
- + */
- +static int ar231x_restart(struct net_device *dev)
- +{
- + /* disable interrupts */
- + disable_irq(dev->irq);
- +
- + /* stop mac */
- + ar231x_halt(dev);
- +
- + /* initialize */
- + ar231x_init(dev);
- +
- + /* enable interrupts */
- + enable_irq(dev->irq);
- +
- + return 0;
- +}
- +
- +static struct platform_driver ar231x_driver = {
- + .driver.name = "ar231x-eth",
- + .probe = ar231x_probe,
- + .remove = ar231x_remove,
- +};
- +
- +module_platform_driver(ar231x_driver);
- +
- +static void ar231x_free_descriptors(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- +
- + if (sp->rx_ring != NULL) {
- + kfree((void *)KSEG0ADDR(sp->rx_ring));
- + sp->rx_ring = NULL;
- + sp->tx_ring = NULL;
- + }
- +}
- +
- +static int ar231x_allocate_descriptors(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + int size;
- + int j;
- + ar231x_descr_t *space;
- +
- + if (sp->rx_ring != NULL) {
- + printk("%s: already done.\n", __func__);
- + return 0;
- + }
- +
- + size = sizeof(ar231x_descr_t) * (AR2313_DESCR_ENTRIES * AR2313_QUEUES);
- + space = kmalloc(size, GFP_KERNEL);
- + if (space == NULL)
- + return 1;
- +
- + /* invalidate caches */
- + dma_cache_inv((unsigned int)space, size);
- +
- + /* now convert pointer to KSEG1 */
- + space = (ar231x_descr_t *)KSEG1ADDR(space);
- +
- + memset((void *)space, 0, size);
- +
- + sp->rx_ring = space;
- + space += AR2313_DESCR_ENTRIES;
- +
- + sp->tx_ring = space;
- + space += AR2313_DESCR_ENTRIES;
- +
- + /* Initialize the transmit Descriptors */
- + for (j = 0; j < AR2313_DESCR_ENTRIES; j++) {
- + ar231x_descr_t *td = &sp->tx_ring[j];
- +
- + td->status = 0;
- + td->devcs = DMA_TX1_CHAINED;
- + td->addr = 0;
- + td->descr = virt_to_phys(&sp->tx_ring[DSC_NEXT(j)]);
- + }
- +
- + return 0;
- +}
- +
- +/**
- + * Generic cleanup handling data allocated during init. Used when the
- + * module is unloaded or if an error occurs during initialization
- + */
- +static void ar231x_init_cleanup(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + struct sk_buff *skb;
- + int j;
- +
- + ar231x_free_descriptors(dev);
- +
- + if (sp->eth_regs)
- + iounmap((void *)sp->eth_regs);
- + if (sp->dma_regs)
- + iounmap((void *)sp->dma_regs);
- + if (sp->phy_regs)
- + iounmap((void *)sp->phy_regs);
- +
- + if (sp->rx_skb) {
- + for (j = 0; j < AR2313_DESCR_ENTRIES; j++) {
- + skb = sp->rx_skb[j];
- + if (skb) {
- + sp->rx_skb[j] = NULL;
- + dev_kfree_skb(skb);
- + }
- + }
- + kfree(sp->rx_skb);
- + sp->rx_skb = NULL;
- + }
- +
- + if (sp->tx_skb) {
- + for (j = 0; j < AR2313_DESCR_ENTRIES; j++) {
- + skb = sp->tx_skb[j];
- + if (skb) {
- + sp->tx_skb[j] = NULL;
- + dev_kfree_skb(skb);
- + }
- + }
- + kfree(sp->tx_skb);
- + sp->tx_skb = NULL;
- + }
- +}
- +
- +static int ar231x_setup_timer(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- +
- + init_timer(&sp->link_timer);
- +
- + sp->link_timer.function = ar231x_link_timer_fn;
- + sp->link_timer.data = (int)dev;
- + sp->link_timer.expires = jiffies + HZ;
- +
- + add_timer(&sp->link_timer);
- + return 0;
- +}
- +
- +static void ar231x_link_timer_fn(unsigned long data)
- +{
- + struct net_device *dev = (struct net_device *)data;
- + struct ar231x_private *sp = netdev_priv(dev);
- +
- + /**
- + * See if the link status changed.
- + * This was needed to make sure we set the PHY to the
- + * autonegotiated value of half or full duplex.
- + */
- + ar231x_check_link(dev);
- +
- + /**
- + * Loop faster when we don't have link.
- + * This was needed to speed up the AP bootstrap time.
- + */
- + if (sp->link == 0)
- + mod_timer(&sp->link_timer, jiffies + HZ / 2);
- + else
- + mod_timer(&sp->link_timer, jiffies + LINK_TIMER);
- +}
- +
- +static void ar231x_check_link(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + u16 phy_data;
- +
- + phy_data = ar231x_mdiobus_read(sp->mii_bus, sp->phy, MII_BMSR);
- + if (sp->phy_data != phy_data) {
- + if (phy_data & BMSR_LSTATUS) {
- + /**
- + * Link is present, ready link partner ability to
- + * deterine duplexity.
- + */
- + int duplex = 0;
- + u16 reg;
- +
- + sp->link = 1;
- + reg = ar231x_mdiobus_read(sp->mii_bus, sp->phy,
- + MII_BMCR);
- + if (reg & BMCR_ANENABLE) {
- + /* auto neg enabled */
- + reg = ar231x_mdiobus_read(sp->mii_bus, sp->phy,
- + MII_LPA);
- + duplex = reg & (LPA_100FULL | LPA_10FULL) ?
- + 1 : 0;
- + } else {
- + /* no auto neg, just read duplex config */
- + duplex = (reg & BMCR_FULLDPLX) ? 1 : 0;
- + }
- +
- + printk(KERN_INFO "%s: Configuring MAC for %s duplex\n",
- + dev->name, (duplex) ? "full" : "half");
- +
- + if (duplex) {
- + /* full duplex */
- + sp->eth_regs->mac_control =
- + (sp->eth_regs->mac_control |
- + MAC_CONTROL_F) & ~MAC_CONTROL_DRO;
- + } else {
- + /* half duplex */
- + sp->eth_regs->mac_control =
- + (sp->eth_regs->mac_control |
- + MAC_CONTROL_DRO) & ~MAC_CONTROL_F;
- + }
- + } else {
- + /* no link */
- + sp->link = 0;
- + }
- + sp->phy_data = phy_data;
- + }
- +}
- +
- +static int ar231x_reset_reg(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + unsigned int ethsal, ethsah;
- + unsigned int flags;
- +
- + sp->cfg->reset_set(sp->cfg->reset_mac);
- + mdelay(10);
- + sp->cfg->reset_clear(sp->cfg->reset_mac);
- + mdelay(10);
- + sp->cfg->reset_set(sp->cfg->reset_phy);
- + mdelay(10);
- + sp->cfg->reset_clear(sp->cfg->reset_phy);
- + mdelay(10);
- +
- + sp->dma_regs->bus_mode = (DMA_BUS_MODE_SWR);
- + mdelay(10);
- + sp->dma_regs->bus_mode =
- + ((32 << DMA_BUS_MODE_PBL_SHIFT) | DMA_BUS_MODE_BLE);
- +
- + /* enable interrupts */
- + sp->dma_regs->intr_ena = DMA_STATUS_AIS | DMA_STATUS_NIS |
- + DMA_STATUS_RI | DMA_STATUS_TI |
- + DMA_STATUS_FBE;
- + sp->dma_regs->xmt_base = virt_to_phys(sp->tx_ring);
- + sp->dma_regs->rcv_base = virt_to_phys(sp->rx_ring);
- + sp->dma_regs->control =
- + (DMA_CONTROL_SR | DMA_CONTROL_ST | DMA_CONTROL_SF);
- +
- + sp->eth_regs->flow_control = (FLOW_CONTROL_FCE);
- + sp->eth_regs->vlan_tag = (0x8100);
- +
- + /* Enable Ethernet Interface */
- + flags = (MAC_CONTROL_TE | /* transmit enable */
- + MAC_CONTROL_PM | /* pass mcast */
- + MAC_CONTROL_F | /* full duplex */
- + MAC_CONTROL_HBD); /* heart beat disabled */
- +
- + if (dev->flags & IFF_PROMISC) { /* set promiscuous mode */
- + flags |= MAC_CONTROL_PR;
- + }
- + sp->eth_regs->mac_control = flags;
- +
- + /* Set all Ethernet station address registers to their initial values */
- + ethsah = (((u_int) (dev->dev_addr[5]) << 8) & (u_int) 0x0000FF00) |
- + (((u_int) (dev->dev_addr[4]) << 0) & (u_int) 0x000000FF);
- +
- + ethsal = (((u_int) (dev->dev_addr[3]) << 24) & (u_int) 0xFF000000) |
- + (((u_int) (dev->dev_addr[2]) << 16) & (u_int) 0x00FF0000) |
- + (((u_int) (dev->dev_addr[1]) << 8) & (u_int) 0x0000FF00) |
- + (((u_int) (dev->dev_addr[0]) << 0) & (u_int) 0x000000FF);
- +
- + sp->eth_regs->mac_addr[0] = ethsah;
- + sp->eth_regs->mac_addr[1] = ethsal;
- +
- + mdelay(10);
- +
- + return 0;
- +}
- +
- +static int ar231x_init(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + int ecode = 0;
- +
- + /* Allocate descriptors */
- + if (ar231x_allocate_descriptors(dev)) {
- + printk("%s: %s: ar231x_allocate_descriptors failed\n",
- + dev->name, __func__);
- + ecode = -EAGAIN;
- + goto init_error;
- + }
- +
- + /* Get the memory for the skb rings */
- + if (sp->rx_skb == NULL) {
- + sp->rx_skb =
- + kmalloc(sizeof(struct sk_buff *) * AR2313_DESCR_ENTRIES,
- + GFP_KERNEL);
- + if (!(sp->rx_skb)) {
- + printk("%s: %s: rx_skb kmalloc failed\n",
- + dev->name, __func__);
- + ecode = -EAGAIN;
- + goto init_error;
- + }
- + }
- + memset(sp->rx_skb, 0, sizeof(struct sk_buff *) * AR2313_DESCR_ENTRIES);
- +
- + if (sp->tx_skb == NULL) {
- + sp->tx_skb =
- + kmalloc(sizeof(struct sk_buff *) * AR2313_DESCR_ENTRIES,
- + GFP_KERNEL);
- + if (!(sp->tx_skb)) {
- + printk("%s: %s: tx_skb kmalloc failed\n",
- + dev->name, __func__);
- + ecode = -EAGAIN;
- + goto init_error;
- + }
- + }
- + memset(sp->tx_skb, 0, sizeof(struct sk_buff *) * AR2313_DESCR_ENTRIES);
- +
- + /**
- + * Set tx_csm before we start receiving interrupts, otherwise
- + * the interrupt handler might think it is supposed to process
- + * tx ints before we are up and running, which may cause a null
- + * pointer access in the int handler.
- + */
- + sp->rx_skbprd = 0;
- + sp->cur_rx = 0;
- + sp->tx_prd = 0;
- + sp->tx_csm = 0;
- +
- + /* Zero the stats before starting the interface */
- + memset(&dev->stats, 0, sizeof(dev->stats));
- +
- + /**
- + * We load the ring here as there seem to be no way to tell the
- + * firmware to wipe the ring without re-initializing it.
- + */
- + ar231x_load_rx_ring(dev, RX_RING_SIZE);
- +
- + /* Init hardware */
- + ar231x_reset_reg(dev);
- +
- + /* Get the IRQ */
- + ecode = request_irq(dev->irq, &ar231x_interrupt, 0,
- + dev->name, dev);
- + if (ecode) {
- + printk(KERN_WARNING "%s: %s: Requested IRQ %d is busy\n",
- + dev->name, __func__, dev->irq);
- + goto init_error;
- + }
- +
- + tasklet_enable(&sp->rx_tasklet);
- +
- + return 0;
- +
- +init_error:
- + ar231x_init_cleanup(dev);
- + return ecode;
- +}
- +
- +/**
- + * Load the rx ring.
- + *
- + * Loading rings is safe without holding the spin lock since this is
- + * done only before the device is enabled, thus no interrupts are
- + * generated and by the interrupt handler/tasklet handler.
- + */
- +static void ar231x_load_rx_ring(struct net_device *dev, int nr_bufs)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + short i, idx;
- +
- + idx = sp->rx_skbprd;
- +
- + for (i = 0; i < nr_bufs; i++) {
- + struct sk_buff *skb;
- + ar231x_descr_t *rd;
- +
- + if (sp->rx_skb[idx])
- + break;
- +
- + skb = netdev_alloc_skb_ip_align(dev, AR2313_BUFSIZE);
- + if (!skb) {
- + printk("\n\n\n\n %s: No memory in system\n\n\n\n",
- + __func__);
- + break;
- + }
- +
- + /* Make sure IP header starts on a fresh cache line */
- + skb->dev = dev;
- + sp->rx_skb[idx] = skb;
- +
- + rd = (ar231x_descr_t *)&sp->rx_ring[idx];
- +
- + /* initialize dma descriptor */
- + rd->devcs = ((AR2313_BUFSIZE << DMA_RX1_BSIZE_SHIFT) |
- + DMA_RX1_CHAINED);
- + rd->addr = virt_to_phys(skb->data);
- + rd->descr = virt_to_phys(&sp->rx_ring[DSC_NEXT(idx)]);
- + rd->status = DMA_RX_OWN;
- +
- + idx = DSC_NEXT(idx);
- + }
- +
- + if (i)
- + sp->rx_skbprd = idx;
- +}
- +
- +#define AR2313_MAX_PKTS_PER_CALL 64
- +
- +static int ar231x_rx_int(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + struct sk_buff *skb, *skb_new;
- + ar231x_descr_t *rxdesc;
- + unsigned int status;
- + u32 idx;
- + int pkts = 0;
- + int rval;
- +
- + idx = sp->cur_rx;
- +
- + /* process at most the entire ring and then wait for another int */
- + while (1) {
- + rxdesc = &sp->rx_ring[idx];
- + status = rxdesc->status;
- +
- + if (status & DMA_RX_OWN) {
- + /* SiByte owns descriptor or descr not yet filled in */
- + rval = 0;
- + break;
- + }
- +
- + if (++pkts > AR2313_MAX_PKTS_PER_CALL) {
- + rval = 1;
- + break;
- + }
- +
- + if ((status & DMA_RX_ERROR) && !(status & DMA_RX_LONG)) {
- + dev->stats.rx_errors++;
- + dev->stats.rx_dropped++;
- +
- + /* add statistics counters */
- + if (status & DMA_RX_ERR_CRC)
- + dev->stats.rx_crc_errors++;
- + if (status & DMA_RX_ERR_COL)
- + dev->stats.rx_over_errors++;
- + if (status & DMA_RX_ERR_LENGTH)
- + dev->stats.rx_length_errors++;
- + if (status & DMA_RX_ERR_RUNT)
- + dev->stats.rx_over_errors++;
- + if (status & DMA_RX_ERR_DESC)
- + dev->stats.rx_over_errors++;
- +
- + } else {
- + /* alloc new buffer. */
- + skb_new = netdev_alloc_skb_ip_align(dev,
- + AR2313_BUFSIZE);
- + if (skb_new != NULL) {
- + skb = sp->rx_skb[idx];
- + /* set skb */
- + skb_put(skb, ((status >> DMA_RX_LEN_SHIFT) &
- + 0x3fff) - CRC_LEN);
- +
- + dev->stats.rx_bytes += skb->len;
- + skb->protocol = eth_type_trans(skb, dev);
- + /* pass the packet to upper layers */
- + netif_rx(skb);
- +
- + skb_new->dev = dev;
- + /* reset descriptor's curr_addr */
- + rxdesc->addr = virt_to_phys(skb_new->data);
- +
- + dev->stats.rx_packets++;
- + sp->rx_skb[idx] = skb_new;
- + } else {
- + dev->stats.rx_dropped++;
- + }
- + }
- +
- + rxdesc->devcs = ((AR2313_BUFSIZE << DMA_RX1_BSIZE_SHIFT) |
- + DMA_RX1_CHAINED);
- + rxdesc->status = DMA_RX_OWN;
- +
- + idx = DSC_NEXT(idx);
- + }
- +
- + sp->cur_rx = idx;
- +
- + return rval;
- +}
- +
- +static void ar231x_tx_int(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + u32 idx;
- + struct sk_buff *skb;
- + ar231x_descr_t *txdesc;
- + unsigned int status = 0;
- +
- + idx = sp->tx_csm;
- +
- + while (idx != sp->tx_prd) {
- + txdesc = &sp->tx_ring[idx];
- + status = txdesc->status;
- +
- + if (status & DMA_TX_OWN) {
- + /* ar231x dma still owns descr */
- + break;
- + }
- + /* done with this descriptor */
- + dma_unmap_single(NULL, txdesc->addr,
- + txdesc->devcs & DMA_TX1_BSIZE_MASK,
- + DMA_TO_DEVICE);
- + txdesc->status = 0;
- +
- + if (status & DMA_TX_ERROR) {
- + dev->stats.tx_errors++;
- + dev->stats.tx_dropped++;
- + if (status & DMA_TX_ERR_UNDER)
- + dev->stats.tx_fifo_errors++;
- + if (status & DMA_TX_ERR_HB)
- + dev->stats.tx_heartbeat_errors++;
- + if (status & (DMA_TX_ERR_LOSS | DMA_TX_ERR_LINK))
- + dev->stats.tx_carrier_errors++;
- + if (status & (DMA_TX_ERR_LATE | DMA_TX_ERR_COL |
- + DMA_TX_ERR_JABBER | DMA_TX_ERR_DEFER))
- + dev->stats.tx_aborted_errors++;
- + } else {
- + /* transmit OK */
- + dev->stats.tx_packets++;
- + }
- +
- + skb = sp->tx_skb[idx];
- + sp->tx_skb[idx] = NULL;
- + idx = DSC_NEXT(idx);
- + dev->stats.tx_bytes += skb->len;
- + dev_kfree_skb_irq(skb);
- + }
- +
- + sp->tx_csm = idx;
- +}
- +
- +static void rx_tasklet_func(unsigned long data)
- +{
- + struct net_device *dev = (struct net_device *)data;
- + struct ar231x_private *sp = netdev_priv(dev);
- +
- + if (sp->unloading)
- + return;
- +
- + if (ar231x_rx_int(dev)) {
- + tasklet_hi_schedule(&sp->rx_tasklet);
- + } else {
- + unsigned long flags;
- +
- + spin_lock_irqsave(&sp->lock, flags);
- + sp->dma_regs->intr_ena |= DMA_STATUS_RI;
- + spin_unlock_irqrestore(&sp->lock, flags);
- + }
- +}
- +
- +static void rx_schedule(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- +
- + sp->dma_regs->intr_ena &= ~DMA_STATUS_RI;
- +
- + tasklet_hi_schedule(&sp->rx_tasklet);
- +}
- +
- +static irqreturn_t ar231x_interrupt(int irq, void *dev_id)
- +{
- + struct net_device *dev = (struct net_device *)dev_id;
- + struct ar231x_private *sp = netdev_priv(dev);
- + unsigned int status, enabled;
- +
- + /* clear interrupt */
- + /* Don't clear RI bit if currently disabled */
- + status = sp->dma_regs->status;
- + enabled = sp->dma_regs->intr_ena;
- + sp->dma_regs->status = status & enabled;
- +
- + if (status & DMA_STATUS_NIS) {
- + /* normal status */
- + /**
- + * Don't schedule rx processing if interrupt
- + * is already disabled.
- + */
- + if (status & enabled & DMA_STATUS_RI) {
- + /* receive interrupt */
- + rx_schedule(dev);
- + }
- + if (status & DMA_STATUS_TI) {
- + /* transmit interrupt */
- + ar231x_tx_int(dev);
- + }
- + }
- +
- + /* abnormal status */
- + if (status & (DMA_STATUS_FBE | DMA_STATUS_TPS))
- + ar231x_restart(dev);
- +
- + return IRQ_HANDLED;
- +}
- +
- +static int ar231x_open(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + unsigned int ethsal, ethsah;
- +
- + /* reset the hardware, in case the MAC address changed */
- + ethsah = (((u_int) (dev->dev_addr[5]) << 8) & (u_int) 0x0000FF00) |
- + (((u_int) (dev->dev_addr[4]) << 0) & (u_int) 0x000000FF);
- +
- + ethsal = (((u_int) (dev->dev_addr[3]) << 24) & (u_int) 0xFF000000) |
- + (((u_int) (dev->dev_addr[2]) << 16) & (u_int) 0x00FF0000) |
- + (((u_int) (dev->dev_addr[1]) << 8) & (u_int) 0x0000FF00) |
- + (((u_int) (dev->dev_addr[0]) << 0) & (u_int) 0x000000FF);
- +
- + sp->eth_regs->mac_addr[0] = ethsah;
- + sp->eth_regs->mac_addr[1] = ethsal;
- +
- + mdelay(10);
- +
- + dev->mtu = 1500;
- + netif_start_queue(dev);
- +
- + sp->eth_regs->mac_control |= MAC_CONTROL_RE;
- +
- + return 0;
- +}
- +
- +static void ar231x_tx_timeout(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + unsigned long flags;
- +
- + spin_lock_irqsave(&sp->lock, flags);
- + ar231x_restart(dev);
- + spin_unlock_irqrestore(&sp->lock, flags);
- +}
- +
- +static void ar231x_halt(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + int j;
- +
- + tasklet_disable(&sp->rx_tasklet);
- +
- + /* kill the MAC */
- + sp->eth_regs->mac_control &= ~(MAC_CONTROL_RE | /* disable Receives */
- + MAC_CONTROL_TE); /* disable Transmits */
- + /* stop dma */
- + sp->dma_regs->control = 0;
- + sp->dma_regs->bus_mode = DMA_BUS_MODE_SWR;
- +
- + /* place phy and MAC in reset */
- + sp->cfg->reset_set(sp->cfg->reset_mac);
- + sp->cfg->reset_set(sp->cfg->reset_phy);
- +
- + /* free buffers on tx ring */
- + for (j = 0; j < AR2313_DESCR_ENTRIES; j++) {
- + struct sk_buff *skb;
- + ar231x_descr_t *txdesc;
- +
- + txdesc = &sp->tx_ring[j];
- + txdesc->descr = 0;
- +
- + skb = sp->tx_skb[j];
- + if (skb) {
- + dev_kfree_skb(skb);
- + sp->tx_skb[j] = NULL;
- + }
- + }
- +}
- +
- +/**
- + * close should do nothing. Here's why. It's called when
- + * 'ifconfig bond0 down' is run. If it calls free_irq then
- + * the irq is gone forever ! When bond0 is made 'up' again,
- + * the ar231x_open () does not call request_irq (). Worse,
- + * the call to ar231x_halt() generates a WDOG reset due to
- + * the write to reset register and the box reboots.
- + * Commenting this out is good since it allows the
- + * system to resume when bond0 is made up again.
- + */
- +static int ar231x_close(struct net_device *dev)
- +{
- +#if 0
- + /* Disable interrupts */
- + disable_irq(dev->irq);
- +
- + /**
- + * Without (or before) releasing irq and stopping hardware, this
- + * is an absolute non-sense, by the way. It will be reset instantly
- + * by the first irq.
- + */
- + netif_stop_queue(dev);
- +
- + /* stop the MAC and DMA engines */
- + ar231x_halt(dev);
- +
- + /* release the interrupt */
- + free_irq(dev->irq, dev);
- +
- +#endif
- + return 0;
- +}
- +
- +static int ar231x_start_xmit(struct sk_buff *skb, struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + ar231x_descr_t *td;
- + u32 idx;
- +
- + idx = sp->tx_prd;
- + td = &sp->tx_ring[idx];
- +
- + if (td->status & DMA_TX_OWN) {
- + /* free skbuf and lie to the caller that we sent it out */
- + dev->stats.tx_dropped++;
- + dev_kfree_skb(skb);
- +
- + /* restart transmitter in case locked */
- + sp->dma_regs->xmt_poll = 0;
- + return 0;
- + }
- +
- + /* Setup the transmit descriptor. */
- + td->devcs = ((skb->len << DMA_TX1_BSIZE_SHIFT) |
- + (DMA_TX1_LS | DMA_TX1_IC | DMA_TX1_CHAINED));
- + td->addr = dma_map_single(NULL, skb->data, skb->len, DMA_TO_DEVICE);
- + td->status = DMA_TX_OWN;
- +
- + /* kick transmitter last */
- + sp->dma_regs->xmt_poll = 0;
- +
- + sp->tx_skb[idx] = skb;
- + idx = DSC_NEXT(idx);
- + sp->tx_prd = idx;
- +
- + return 0;
- +}
- +
- +static int ar231x_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- +
- + switch (cmd) {
- + case SIOCGMIIPHY:
- + case SIOCGMIIREG:
- + case SIOCSMIIREG:
- + return phy_mii_ioctl(sp->phy_dev, ifr, cmd);
- +
- + default:
- + break;
- + }
- +
- + return -EOPNOTSUPP;
- +}
- +
- +static void ar231x_adjust_link(struct net_device *dev)
- +{
- + struct ar231x_private *sp = netdev_priv(dev);
- + unsigned int mc;
- +
- + if (!sp->phy_dev->link)
- + return;
- +
- + if (sp->phy_dev->duplex != sp->oldduplex) {
- + mc = readl(&sp->eth_regs->mac_control);
- + mc &= ~(MAC_CONTROL_F | MAC_CONTROL_DRO);
- + if (sp->phy_dev->duplex)
- + mc |= MAC_CONTROL_F;
- + else
- + mc |= MAC_CONTROL_DRO;
- + writel(mc, &sp->eth_regs->mac_control);
- + sp->oldduplex = sp->phy_dev->duplex;
- + }
- +}
- +
- +#define MII_ADDR(phy, reg) \
- + ((reg << MII_ADDR_REG_SHIFT) | (phy << MII_ADDR_PHY_SHIFT))
- +
- +static int
- +ar231x_mdiobus_read(struct mii_bus *bus, int phy_addr, int regnum)
- +{
- + struct net_device *const dev = bus->priv;
- + struct ar231x_private *sp = netdev_priv(dev);
- + volatile MII *ethernet = sp->phy_regs;
- +
- + ethernet->mii_addr = MII_ADDR(phy_addr, regnum);
- + while (ethernet->mii_addr & MII_ADDR_BUSY)
- + ;
- + return ethernet->mii_data >> MII_DATA_SHIFT;
- +}
- +
- +static int
- +ar231x_mdiobus_write(struct mii_bus *bus, int phy_addr, int regnum, u16 value)
- +{
- + struct net_device *const dev = bus->priv;
- + struct ar231x_private *sp = netdev_priv(dev);
- + volatile MII *ethernet = sp->phy_regs;
- +
- + while (ethernet->mii_addr & MII_ADDR_BUSY)
- + ;
- + ethernet->mii_data = value << MII_DATA_SHIFT;
- + ethernet->mii_addr = MII_ADDR(phy_addr, regnum) | MII_ADDR_WRITE;
- +
- + return 0;
- +}
- +
- +static int ar231x_mdiobus_reset(struct mii_bus *bus)
- +{
- + struct net_device *const dev = bus->priv;
- +
- + ar231x_reset_reg(dev);
- +
- + return 0;
- +}
- +
- +static int ar231x_mdiobus_probe(struct net_device *dev)
- +{
- + struct ar231x_private *const sp = netdev_priv(dev);
- + struct phy_device *phydev = NULL;
- + int phy_addr;
- +
- + /* find the first (lowest address) PHY on the current MAC's MII bus */
- + for (phy_addr = 0; phy_addr < PHY_MAX_ADDR; phy_addr++)
- + if (sp->mii_bus->phy_map[phy_addr]) {
- + phydev = sp->mii_bus->phy_map[phy_addr];
- + sp->phy = phy_addr;
- + break; /* break out with first one found */
- + }
- +
- + if (!phydev) {
- + printk(KERN_ERR "ar231x: %s: no PHY found\n", dev->name);
- + return -1;
- + }
- +
- + /* now we are supposed to have a proper phydev, to attach to... */
- + BUG_ON(!phydev);
- + BUG_ON(phydev->attached_dev);
- +
- + phydev = phy_connect(dev, dev_name(&phydev->dev), &ar231x_adjust_link,
- + PHY_INTERFACE_MODE_MII);
- +
- + if (IS_ERR(phydev)) {
- + printk(KERN_ERR "%s: Could not attach to PHY\n", dev->name);
- + return PTR_ERR(phydev);
- + }
- +
- + /* mask with MAC supported features */
- + phydev->supported &= (SUPPORTED_10baseT_Half
- + | SUPPORTED_10baseT_Full
- + | SUPPORTED_100baseT_Half
- + | SUPPORTED_100baseT_Full
- + | SUPPORTED_Autoneg
- + /* | SUPPORTED_Pause | SUPPORTED_Asym_Pause */
- + | SUPPORTED_MII
- + | SUPPORTED_TP);
- +
- + phydev->advertising = phydev->supported;
- +
- + sp->oldduplex = -1;
- + sp->phy_dev = phydev;
- +
- + printk(KERN_INFO "%s: attached PHY driver [%s] (mii_bus:phy_addr=%s)\n",
- + dev->name, phydev->drv->name, dev_name(&phydev->dev));
- +
- + return 0;
- +}
- +
- --- /dev/null
- +++ b/drivers/net/ethernet/atheros/ar231x/ar231x.h
- @@ -0,0 +1,288 @@
- +/*
- + * ar231x.h: Linux driver for the Atheros AR231x Ethernet device.
- + *
- + * Copyright (C) 2004 by Sameer Dekate <sdekate@arubanetworks.com>
- + * Copyright (C) 2006 Imre Kaloz <kaloz@openwrt.org>
- + * Copyright (C) 2006-2009 Felix Fietkau <nbd@nbd.name>
- + *
- + * Thanks to Atheros for providing hardware and documentation
- + * enabling me to write this driver.
- + *
- + * This program is free software; you can redistribute it and/or modify
- + * it under the terms of the GNU General Public License as published by
- + * the Free Software Foundation; either version 2 of the License, or
- + * (at your option) any later version.
- + */
- +
- +#ifndef _AR2313_H_
- +#define _AR2313_H_
- +
- +#include <linux/interrupt.h>
- +#include <generated/autoconf.h>
- +#include <linux/bitops.h>
- +#include <ath25_platform.h>
- +
- +/* probe link timer - 5 secs */
- +#define LINK_TIMER (5*HZ)
- +
- +#define IS_DMA_TX_INT(X) (((X) & (DMA_STATUS_TI)) != 0)
- +#define IS_DMA_RX_INT(X) (((X) & (DMA_STATUS_RI)) != 0)
- +#define IS_DRIVER_OWNED(X) (((X) & (DMA_TX_OWN)) == 0)
- +
- +#define AR2313_TX_TIMEOUT (HZ/4)
- +
- +/* Rings */
- +#define DSC_RING_ENTRIES_SIZE (AR2313_DESCR_ENTRIES * sizeof(struct desc))
- +#define DSC_NEXT(idx) ((idx + 1) & (AR2313_DESCR_ENTRIES - 1))
- +
- +#define AR2313_MBGET 2
- +#define AR2313_MBSET 3
- +#define AR2313_PCI_RECONFIG 4
- +#define AR2313_PCI_DUMP 5
- +#define AR2313_TEST_PANIC 6
- +#define AR2313_TEST_NULLPTR 7
- +#define AR2313_READ_DATA 8
- +#define AR2313_WRITE_DATA 9
- +#define AR2313_GET_VERSION 10
- +#define AR2313_TEST_HANG 11
- +#define AR2313_SYNC 12
- +
- +#define DMA_RX_ERR_CRC BIT(1)
- +#define DMA_RX_ERR_DRIB BIT(2)
- +#define DMA_RX_ERR_MII BIT(3)
- +#define DMA_RX_EV2 BIT(5)
- +#define DMA_RX_ERR_COL BIT(6)
- +#define DMA_RX_LONG BIT(7)
- +#define DMA_RX_LS BIT(8) /* last descriptor */
- +#define DMA_RX_FS BIT(9) /* first descriptor */
- +#define DMA_RX_MF BIT(10) /* multicast frame */
- +#define DMA_RX_ERR_RUNT BIT(11) /* runt frame */
- +#define DMA_RX_ERR_LENGTH BIT(12) /* length error */
- +#define DMA_RX_ERR_DESC BIT(14) /* descriptor error */
- +#define DMA_RX_ERROR BIT(15) /* error summary */
- +#define DMA_RX_LEN_MASK 0x3fff0000
- +#define DMA_RX_LEN_SHIFT 16
- +#define DMA_RX_FILT BIT(30)
- +#define DMA_RX_OWN BIT(31) /* desc owned by DMA controller */
- +
- +#define DMA_RX1_BSIZE_MASK 0x000007ff
- +#define DMA_RX1_BSIZE_SHIFT 0
- +#define DMA_RX1_CHAINED BIT(24)
- +#define DMA_RX1_RER BIT(25)
- +
- +#define DMA_TX_ERR_UNDER BIT(1) /* underflow error */
- +#define DMA_TX_ERR_DEFER BIT(2) /* excessive deferral */
- +#define DMA_TX_COL_MASK 0x78
- +#define DMA_TX_COL_SHIFT 3
- +#define DMA_TX_ERR_HB BIT(7) /* hearbeat failure */
- +#define DMA_TX_ERR_COL BIT(8) /* excessive collisions */
- +#define DMA_TX_ERR_LATE BIT(9) /* late collision */
- +#define DMA_TX_ERR_LINK BIT(10) /* no carrier */
- +#define DMA_TX_ERR_LOSS BIT(11) /* loss of carrier */
- +#define DMA_TX_ERR_JABBER BIT(14) /* transmit jabber timeout */
- +#define DMA_TX_ERROR BIT(15) /* frame aborted */
- +#define DMA_TX_OWN BIT(31) /* descr owned by DMA controller */
- +
- +#define DMA_TX1_BSIZE_MASK 0x000007ff
- +#define DMA_TX1_BSIZE_SHIFT 0
- +#define DMA_TX1_CHAINED BIT(24) /* chained descriptors */
- +#define DMA_TX1_TER BIT(25) /* transmit end of ring */
- +#define DMA_TX1_FS BIT(29) /* first segment */
- +#define DMA_TX1_LS BIT(30) /* last segment */
- +#define DMA_TX1_IC BIT(31) /* interrupt on completion */
- +
- +#define RCVPKT_LENGTH(X) (X >> 16) /* Received pkt Length */
- +
- +#define MAC_CONTROL_RE BIT(2) /* receive enable */
- +#define MAC_CONTROL_TE BIT(3) /* transmit enable */
- +#define MAC_CONTROL_DC BIT(5) /* Deferral check */
- +#define MAC_CONTROL_ASTP BIT(8) /* Auto pad strip */
- +#define MAC_CONTROL_DRTY BIT(10) /* Disable retry */
- +#define MAC_CONTROL_DBF BIT(11) /* Disable bcast frames */
- +#define MAC_CONTROL_LCC BIT(12) /* late collision ctrl */
- +#define MAC_CONTROL_HP BIT(13) /* Hash Perfect filtering */
- +#define MAC_CONTROL_HASH BIT(14) /* Unicast hash filtering */
- +#define MAC_CONTROL_HO BIT(15) /* Hash only filtering */
- +#define MAC_CONTROL_PB BIT(16) /* Pass Bad frames */
- +#define MAC_CONTROL_IF BIT(17) /* Inverse filtering */
- +#define MAC_CONTROL_PR BIT(18) /* promis mode (valid frames only) */
- +#define MAC_CONTROL_PM BIT(19) /* pass multicast */
- +#define MAC_CONTROL_F BIT(20) /* full-duplex */
- +#define MAC_CONTROL_DRO BIT(23) /* Disable Receive Own */
- +#define MAC_CONTROL_HBD BIT(28) /* heart-beat disabled (MUST BE SET) */
- +#define MAC_CONTROL_BLE BIT(30) /* big endian mode */
- +#define MAC_CONTROL_RA BIT(31) /* rcv all (valid and invalid frames) */
- +
- +#define MII_ADDR_BUSY BIT(0)
- +#define MII_ADDR_WRITE BIT(1)
- +#define MII_ADDR_REG_SHIFT 6
- +#define MII_ADDR_PHY_SHIFT 11
- +#define MII_DATA_SHIFT 0
- +
- +#define FLOW_CONTROL_FCE BIT(1)
- +
- +#define DMA_BUS_MODE_SWR BIT(0) /* software reset */
- +#define DMA_BUS_MODE_BLE BIT(7) /* big endian mode */
- +#define DMA_BUS_MODE_PBL_SHIFT 8 /* programmable burst length 32 */
- +#define DMA_BUS_MODE_DBO BIT(20) /* big-endian descriptors */
- +
- +#define DMA_STATUS_TI BIT(0) /* transmit interrupt */
- +#define DMA_STATUS_TPS BIT(1) /* transmit process stopped */
- +#define DMA_STATUS_TU BIT(2) /* transmit buffer unavailable */
- +#define DMA_STATUS_TJT BIT(3) /* transmit buffer timeout */
- +#define DMA_STATUS_UNF BIT(5) /* transmit underflow */
- +#define DMA_STATUS_RI BIT(6) /* receive interrupt */
- +#define DMA_STATUS_RU BIT(7) /* receive buffer unavailable */
- +#define DMA_STATUS_RPS BIT(8) /* receive process stopped */
- +#define DMA_STATUS_ETI BIT(10) /* early transmit interrupt */
- +#define DMA_STATUS_FBE BIT(13) /* fatal bus interrupt */
- +#define DMA_STATUS_ERI BIT(14) /* early receive interrupt */
- +#define DMA_STATUS_AIS BIT(15) /* abnormal interrupt summary */
- +#define DMA_STATUS_NIS BIT(16) /* normal interrupt summary */
- +#define DMA_STATUS_RS_SHIFT 17 /* receive process state */
- +#define DMA_STATUS_TS_SHIFT 20 /* transmit process state */
- +#define DMA_STATUS_EB_SHIFT 23 /* error bits */
- +
- +#define DMA_CONTROL_SR BIT(1) /* start receive */
- +#define DMA_CONTROL_ST BIT(13) /* start transmit */
- +#define DMA_CONTROL_SF BIT(21) /* store and forward */
- +
- +typedef struct {
- + volatile unsigned int status; /* OWN, Device control and status. */
- + volatile unsigned int devcs; /* pkt Control bits + Length */
- + volatile unsigned int addr; /* Current Address. */
- + volatile unsigned int descr; /* Next descriptor in chain. */
- +} ar231x_descr_t;
- +
- +/**
- + * New Combo structure for Both Eth0 AND eth1
- + *
- + * Don't directly access MII related regs since phy chip could be actually
- + * connected to another ethernet block.
- + */
- +typedef struct {
- + volatile unsigned int mac_control; /* 0x00 */
- + volatile unsigned int mac_addr[2]; /* 0x04 - 0x08 */
- + volatile unsigned int mcast_table[2]; /* 0x0c - 0x10 */
- + volatile unsigned int __mii_addr; /* 0x14 */
- + volatile unsigned int __mii_data; /* 0x18 */
- + volatile unsigned int flow_control; /* 0x1c */
- + volatile unsigned int vlan_tag; /* 0x20 */
- + volatile unsigned int pad[7]; /* 0x24 - 0x3c */
- + volatile unsigned int ucast_table[8]; /* 0x40-0x5c */
- +} ETHERNET_STRUCT;
- +
- +typedef struct {
- + volatile unsigned int mii_addr;
- + volatile unsigned int mii_data;
- +} MII;
- +
- +/********************************************************************
- + * Interrupt controller
- + ********************************************************************/
- +
- +typedef struct {
- + volatile unsigned int wdog_control; /* 0x08 */
- + volatile unsigned int wdog_timer; /* 0x0c */
- + volatile unsigned int misc_status; /* 0x10 */
- + volatile unsigned int misc_mask; /* 0x14 */
- + volatile unsigned int global_status; /* 0x18 */
- + volatile unsigned int reserved; /* 0x1c */
- + volatile unsigned int reset_control; /* 0x20 */
- +} INTERRUPT;
- +
- +/********************************************************************
- + * DMA controller
- + ********************************************************************/
- +typedef struct {
- + volatile unsigned int bus_mode; /* 0x00 (CSR0) */
- + volatile unsigned int xmt_poll; /* 0x04 (CSR1) */
- + volatile unsigned int rcv_poll; /* 0x08 (CSR2) */
- + volatile unsigned int rcv_base; /* 0x0c (CSR3) */
- + volatile unsigned int xmt_base; /* 0x10 (CSR4) */
- + volatile unsigned int status; /* 0x14 (CSR5) */
- + volatile unsigned int control; /* 0x18 (CSR6) */
- + volatile unsigned int intr_ena; /* 0x1c (CSR7) */
- + volatile unsigned int rcv_missed; /* 0x20 (CSR8) */
- + volatile unsigned int reserved[11]; /* 0x24-0x4c (CSR9-19) */
- + volatile unsigned int cur_tx_buf_addr; /* 0x50 (CSR20) */
- + volatile unsigned int cur_rx_buf_addr; /* 0x50 (CSR21) */
- +} DMA;
- +
- +/**
- + * Struct private for the Sibyte.
- + *
- + * Elements are grouped so variables used by the tx handling goes
- + * together, and will go into the same cache lines etc. in order to
- + * avoid cache line contention between the rx and tx handling on SMP.
- + *
- + * Frequently accessed variables are put at the beginning of the
- + * struct to help the compiler generate better/shorter code.
- + */
- +struct ar231x_private {
- + struct net_device *dev;
- + int version;
- + u32 mb[2];
- +
- + volatile MII *phy_regs;
- + volatile ETHERNET_STRUCT *eth_regs;
- + volatile DMA *dma_regs;
- + struct ar231x_eth *cfg;
- +
- + spinlock_t lock; /* Serialise access to device */
- +
- + /* RX and TX descriptors, must be adjacent */
- + ar231x_descr_t *rx_ring;
- + ar231x_descr_t *tx_ring;
- +
- + struct sk_buff **rx_skb;
- + struct sk_buff **tx_skb;
- +
- + /* RX elements */
- + u32 rx_skbprd;
- + u32 cur_rx;
- +
- + /* TX elements */
- + u32 tx_prd;
- + u32 tx_csm;
- +
- + /* Misc elements */
- + char name[48];
- + struct {
- + u32 address;
- + u32 length;
- + char *mapping;
- + } desc;
- +
- + struct timer_list link_timer;
- + unsigned short phy; /* merlot phy = 1, samsung phy = 0x1f */
- + unsigned short mac;
- + unsigned short link; /* 0 - link down, 1 - link up */
- + u16 phy_data;
- +
- + struct tasklet_struct rx_tasklet;
- + int unloading;
- +
- + struct phy_device *phy_dev;
- + struct mii_bus *mii_bus;
- + int oldduplex;
- +};
- +
- +/* Prototypes */
- +static int ar231x_init(struct net_device *dev);
- +#ifdef TX_TIMEOUT
- +static void ar231x_tx_timeout(struct net_device *dev);
- +#endif
- +static int ar231x_restart(struct net_device *dev);
- +static void ar231x_load_rx_ring(struct net_device *dev, int bufs);
- +static irqreturn_t ar231x_interrupt(int irq, void *dev_id);
- +static int ar231x_open(struct net_device *dev);
- +static int ar231x_start_xmit(struct sk_buff *skb, struct net_device *dev);
- +static int ar231x_close(struct net_device *dev);
- +static int ar231x_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd);
- +static void ar231x_init_cleanup(struct net_device *dev);
- +static int ar231x_setup_timer(struct net_device *dev);
- +static void ar231x_link_timer_fn(unsigned long data);
- +static void ar231x_check_link(struct net_device *dev);
- +
- +#endif /* _AR2313_H_ */
- --- a/arch/mips/ath25/ar2315_regs.h
- +++ b/arch/mips/ath25/ar2315_regs.h
- @@ -57,6 +57,9 @@
- #define AR2315_PCI_EXT_BASE 0x80000000 /* PCI external */
- #define AR2315_PCI_EXT_SIZE 0x40000000
-
- +/* MII registers offset inside Ethernet MMR region */
- +#define AR2315_ENET0_MII_BASE (AR2315_ENET0_BASE + 0x14)
- +
- /*
- * Configuration registers
- */
- --- a/arch/mips/ath25/ar5312_regs.h
- +++ b/arch/mips/ath25/ar5312_regs.h
- @@ -64,6 +64,10 @@
- #define AR5312_AR5312_REV7 0x0057 /* AR5312 WMAC (AP30-040) */
- #define AR5312_AR2313_REV8 0x0058 /* AR2313 WMAC (AP43-030) */
-
- +/* MII registers offset inside Ethernet MMR region */
- +#define AR5312_ENET0_MII_BASE (AR5312_ENET0_BASE + 0x14)
- +#define AR5312_ENET1_MII_BASE (AR5312_ENET1_BASE + 0x14)
- +
- /* Reset/Timer Block Address Map */
- #define AR5312_TIMER 0x0000 /* countdown timer */
- #define AR5312_RELOAD 0x0004 /* timer reload value */
- --- a/arch/mips/ath25/ar2315.c
- +++ b/arch/mips/ath25/ar2315.c
- @@ -136,6 +136,8 @@ static void ar2315_irq_dispatch(void)
-
- if (pending & CAUSEF_IP3)
- do_IRQ(AR2315_IRQ_WLAN0);
- + else if (pending & CAUSEF_IP4)
- + do_IRQ(AR2315_IRQ_ENET0);
- #ifdef CONFIG_PCI_AR2315
- else if (pending & CAUSEF_IP5)
- do_IRQ(AR2315_IRQ_LCBUS_PCI);
- @@ -169,6 +171,29 @@ void __init ar2315_arch_init_irq(void)
- ar2315_misc_irq_domain = domain;
- }
-
- +static void ar2315_device_reset_set(u32 mask)
- +{
- + u32 val;
- +
- + val = ar2315_rst_reg_read(AR2315_RESET);
- + ar2315_rst_reg_write(AR2315_RESET, val | mask);
- +}
- +
- +static void ar2315_device_reset_clear(u32 mask)
- +{
- + u32 val;
- +
- + val = ar2315_rst_reg_read(AR2315_RESET);
- + ar2315_rst_reg_write(AR2315_RESET, val & ~mask);
- +}
- +
- +static struct ar231x_eth ar2315_eth_data = {
- + .reset_set = ar2315_device_reset_set,
- + .reset_clear = ar2315_device_reset_clear,
- + .reset_mac = AR2315_RESET_ENET0,
- + .reset_phy = AR2315_RESET_EPHY0,
- +};
- +
- static struct resource ar2315_gpio_res[] = {
- {
- .name = "ar2315-gpio",
- @@ -205,6 +230,11 @@ void __init ar2315_init_devices(void)
- ar2315_gpio_res[1].end = ar2315_gpio_res[1].start;
- platform_device_register(&ar2315_gpio);
-
- + ar2315_eth_data.macaddr = ath25_board.config->enet0_mac;
- + ath25_add_ethernet(0, AR2315_ENET0_BASE, "eth0_mii",
- + AR2315_ENET0_MII_BASE, AR2315_IRQ_ENET0,
- + &ar2315_eth_data);
- +
- ath25_add_wmac(0, AR2315_WLAN0_BASE, AR2315_IRQ_WLAN0);
- }
-
- --- a/arch/mips/ath25/ar5312.c
- +++ b/arch/mips/ath25/ar5312.c
- @@ -132,6 +132,10 @@ static void ar5312_irq_dispatch(void)
-
- if (pending & CAUSEF_IP2)
- do_IRQ(AR5312_IRQ_WLAN0);
- + else if (pending & CAUSEF_IP3)
- + do_IRQ(AR5312_IRQ_ENET0);
- + else if (pending & CAUSEF_IP4)
- + do_IRQ(AR5312_IRQ_ENET1);
- else if (pending & CAUSEF_IP5)
- do_IRQ(AR5312_IRQ_WLAN1);
- else if (pending & CAUSEF_IP6)
- @@ -163,6 +167,36 @@ void __init ar5312_arch_init_irq(void)
- ar5312_misc_irq_domain = domain;
- }
-
- +static void ar5312_device_reset_set(u32 mask)
- +{
- + u32 val;
- +
- + val = ar5312_rst_reg_read(AR5312_RESET);
- + ar5312_rst_reg_write(AR5312_RESET, val | mask);
- +}
- +
- +static void ar5312_device_reset_clear(u32 mask)
- +{
- + u32 val;
- +
- + val = ar5312_rst_reg_read(AR5312_RESET);
- + ar5312_rst_reg_write(AR5312_RESET, val & ~mask);
- +}
- +
- +static struct ar231x_eth ar5312_eth0_data = {
- + .reset_set = ar5312_device_reset_set,
- + .reset_clear = ar5312_device_reset_clear,
- + .reset_mac = AR5312_RESET_ENET0,
- + .reset_phy = AR5312_RESET_EPHY0,
- +};
- +
- +static struct ar231x_eth ar5312_eth1_data = {
- + .reset_set = ar5312_device_reset_set,
- + .reset_clear = ar5312_device_reset_clear,
- + .reset_mac = AR5312_RESET_ENET1,
- + .reset_phy = AR5312_RESET_EPHY1,
- +};
- +
- static struct physmap_flash_data ar5312_flash_data = {
- .width = 2,
- };
- @@ -243,6 +277,7 @@ static void __init ar5312_flash_init(voi
- void __init ar5312_init_devices(void)
- {
- struct ath25_boarddata *config;
- + u8 *c;
-
- ar5312_flash_init();
-
- @@ -266,8 +301,30 @@ void __init ar5312_init_devices(void)
-
- platform_device_register(&ar5312_gpio);
-
- + /* Fix up MAC addresses if necessary */
- + if (is_broadcast_ether_addr(config->enet0_mac))
- + ether_addr_copy(config->enet0_mac, config->enet1_mac);
- +
- + /* If ENET0 and ENET1 have the same mac address,
- + * increment the one from ENET1 */
- + if (ether_addr_equal(config->enet0_mac, config->enet1_mac)) {
- + c = config->enet1_mac + 5;
- + while ((c >= config->enet1_mac) && !(++(*c)))
- + c--;
- + }
- +
- switch (ath25_soc) {
- case ATH25_SOC_AR5312:
- + ar5312_eth0_data.macaddr = config->enet0_mac;
- + ath25_add_ethernet(0, AR5312_ENET0_BASE, "eth0_mii",
- + AR5312_ENET0_MII_BASE, AR5312_IRQ_ENET0,
- + &ar5312_eth0_data);
- +
- + ar5312_eth1_data.macaddr = config->enet1_mac;
- + ath25_add_ethernet(1, AR5312_ENET1_BASE, "eth1_mii",
- + AR5312_ENET1_MII_BASE, AR5312_IRQ_ENET1,
- + &ar5312_eth1_data);
- +
- if (!ath25_board.radio)
- return;
-
- @@ -276,8 +333,18 @@ void __init ar5312_init_devices(void)
-
- ath25_add_wmac(0, AR5312_WLAN0_BASE, AR5312_IRQ_WLAN0);
- break;
- + /*
- + * AR2312/3 ethernet uses the PHY of ENET0, but the MAC
- + * of ENET1. Atheros calls it 'twisted' for a reason :)
- + */
- case ATH25_SOC_AR2312:
- case ATH25_SOC_AR2313:
- + ar5312_eth1_data.reset_phy = ar5312_eth0_data.reset_phy;
- + ar5312_eth1_data.macaddr = config->enet0_mac;
- + ath25_add_ethernet(1, AR5312_ENET1_BASE, "eth0_mii",
- + AR5312_ENET0_MII_BASE, AR5312_IRQ_ENET1,
- + &ar5312_eth1_data);
- +
- if (!ath25_board.radio)
- return;
- break;
- --- a/arch/mips/ath25/devices.h
- +++ b/arch/mips/ath25/devices.h
- @@ -32,6 +32,8 @@ extern struct ar231x_board_config ath25_
- extern void (*ath25_irq_dispatch)(void);
-
- int ath25_find_config(phys_addr_t offset, unsigned long size);
- +int ath25_add_ethernet(int nr, u32 base, const char *mii_name, u32 mii_base,
- + int irq, void *pdata);
- void ath25_serial_setup(u32 mapbase, int irq, unsigned int uartclk);
- int ath25_add_wmac(int nr, u32 base, int irq);
-
- --- a/arch/mips/ath25/devices.c
- +++ b/arch/mips/ath25/devices.c
- @@ -12,6 +12,51 @@
- struct ar231x_board_config ath25_board;
- enum ath25_soc_type ath25_soc = ATH25_SOC_UNKNOWN;
-
- +static struct resource ath25_eth0_res[] = {
- + {
- + .name = "eth0_membase",
- + .flags = IORESOURCE_MEM,
- + },
- + {
- + .name = "eth0_mii",
- + .flags = IORESOURCE_MEM,
- + },
- + {
- + .name = "eth0_irq",
- + .flags = IORESOURCE_IRQ,
- + }
- +};
- +
- +static struct resource ath25_eth1_res[] = {
- + {
- + .name = "eth1_membase",
- + .flags = IORESOURCE_MEM,
- + },
- + {
- + .name = "eth1_mii",
- + .flags = IORESOURCE_MEM,
- + },
- + {
- + .name = "eth1_irq",
- + .flags = IORESOURCE_IRQ,
- + }
- +};
- +
- +static struct platform_device ath25_eth[] = {
- + {
- + .id = 0,
- + .name = "ar231x-eth",
- + .resource = ath25_eth0_res,
- + .num_resources = ARRAY_SIZE(ath25_eth0_res)
- + },
- + {
- + .id = 1,
- + .name = "ar231x-eth",
- + .resource = ath25_eth1_res,
- + .num_resources = ARRAY_SIZE(ath25_eth1_res)
- + }
- +};
- +
- static struct resource ath25_wmac0_res[] = {
- {
- .name = "wmac0_membase",
- @@ -70,6 +115,25 @@ const char *get_system_type(void)
- return soc_type_strings[ath25_soc];
- }
-
- +int __init ath25_add_ethernet(int nr, u32 base, const char *mii_name,
- + u32 mii_base, int irq, void *pdata)
- +{
- + struct resource *res;
- +
- + ath25_eth[nr].dev.platform_data = pdata;
- + res = &ath25_eth[nr].resource[0];
- + res->start = base;
- + res->end = base + 0x2000 - 1;
- + res++;
- + res->name = mii_name;
- + res->start = mii_base;
- + res->end = mii_base + 8 - 1;
- + res++;
- + res->start = irq;
- + res->end = irq;
- + return platform_device_register(&ath25_eth[nr]);
- +}
- +
- void __init ath25_serial_setup(u32 mapbase, int irq, unsigned int uartclk)
- {
- struct uart_port s;
- --- a/arch/mips/include/asm/mach-ath25/ath25_platform.h
- +++ b/arch/mips/include/asm/mach-ath25/ath25_platform.h
- @@ -70,4 +70,15 @@ struct ar231x_board_config {
- const char *radio;
- };
-
- +/*
- + * Platform device information for the Ethernet MAC
- + */
- +struct ar231x_eth {
- + void (*reset_set)(u32);
- + void (*reset_clear)(u32);
- + u32 reset_mac;
- + u32 reset_phy;
- + char *macaddr;
- +};
- +
- #endif /* __ASM_MACH_ATH25_PLATFORM_H */
|