123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926 |
- /**************************************************************************
- * via-velocity.c: Etherboot device driver for the VIA 6120 Gigabit
- * Changes for Etherboot port:
- * Copyright (c) 2006 by Timothy Legge <tlegge@rogers.com>
- *
- * 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.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
- *
- * This driver is based on:
- * via-velocity.c: VIA Velocity VT6120, VT6122 Ethernet driver
- * The changes are (c) Copyright 2004, Red Hat Inc.
- * <alan@redhat.com>
- * Additional fixes and clean up: Francois Romieu
- *
- * Original code:
- * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
- * All rights reserved.
- * Author: Chuang Liang-Shing, AJ Jiang
- *
- * Linux Driver Version 2.6.15.4
- *
- * REVISION HISTORY:
- * ================
- *
- * v1.0 03-06-2006 timlegge Initial port of Linux driver
- *
- * Indent Options: indent -kr -i8
- *************************************************************************/
-
- FILE_LICENCE ( GPL2_OR_LATER );
-
- #include "etherboot.h"
- #include "nic.h"
- #include <ipxe/pci.h>
- #include <ipxe/ethernet.h>
-
- #include "via-velocity.h"
-
- typedef int pci_power_t;
-
- #define PCI_D0 ((int) 0)
- #define PCI_D1 ((int) 1)
- #define PCI_D2 ((int) 2)
- #define PCI_D3hot ((int) 3)
- #define PCI_D3cold ((int) 4)
- #define PCI_POWER_ERROR ((int) -1)
-
-
- /* Condensed operations for readability. */
- #define virt_to_le32desc(addr) cpu_to_le32(virt_to_bus(addr))
- #define le32desc_to_virt(addr) bus_to_virt(le32_to_cpu(addr))
-
- //FIXME: Move to pci.c
- int pci_set_power_state(struct pci_device *dev, int state);
-
- /* FIXME: Move BASE to the private structure */
- static u32 BASE;
-
- /* NIC specific static variables go here */
- #define VELOCITY_PARAM(N,D) \
- static const int N[MAX_UNITS]=OPTION_DEFAULT;
- /* MODULE_PARM(N, "1-" __MODULE_STRING(MAX_UNITS) "i");\
- MODULE_PARM_DESC(N, D); */
-
- VELOCITY_PARAM(RxDescriptors, "Number of receive descriptors");
- VELOCITY_PARAM(TxDescriptors, "Number of transmit descriptors");
-
-
- #define VLAN_ID_MIN 0
- #define VLAN_ID_MAX 4095
- #define VLAN_ID_DEF 0
- /* VID_setting[] is used for setting the VID of NIC.
- 0: default VID.
- 1-4094: other VIDs.
- */
- VELOCITY_PARAM(VID_setting, "802.1Q VLAN ID");
-
- #define RX_THRESH_MIN 0
- #define RX_THRESH_MAX 3
- #define RX_THRESH_DEF 0
- /* rx_thresh[] is used for controlling the receive fifo threshold.
- 0: indicate the rxfifo threshold is 128 bytes.
- 1: indicate the rxfifo threshold is 512 bytes.
- 2: indicate the rxfifo threshold is 1024 bytes.
- 3: indicate the rxfifo threshold is store & forward.
- */
- VELOCITY_PARAM(rx_thresh, "Receive fifo threshold");
-
- #define DMA_LENGTH_MIN 0
- #define DMA_LENGTH_MAX 7
- #define DMA_LENGTH_DEF 0
-
- /* DMA_length[] is used for controlling the DMA length
- 0: 8 DWORDs
- 1: 16 DWORDs
- 2: 32 DWORDs
- 3: 64 DWORDs
- 4: 128 DWORDs
- 5: 256 DWORDs
- 6: SF(flush till emply)
- 7: SF(flush till emply)
- */
- VELOCITY_PARAM(DMA_length, "DMA length");
-
- #define TAGGING_DEF 0
- /* enable_tagging[] is used for enabling 802.1Q VID tagging.
- 0: disable VID seeting(default).
- 1: enable VID setting.
- */
- VELOCITY_PARAM(enable_tagging, "Enable 802.1Q tagging");
-
- #define IP_ALIG_DEF 0
- /* IP_byte_align[] is used for IP header DWORD byte aligned
- 0: indicate the IP header won't be DWORD byte aligned.(Default) .
- 1: indicate the IP header will be DWORD byte aligned.
- In some enviroment, the IP header should be DWORD byte aligned,
- or the packet will be droped when we receive it. (eg: IPVS)
- */
- VELOCITY_PARAM(IP_byte_align, "Enable IP header dword aligned");
-
- #define TX_CSUM_DEF 1
- /* txcsum_offload[] is used for setting the checksum offload ability of NIC.
- (We only support RX checksum offload now)
- 0: disable csum_offload[checksum offload
- 1: enable checksum offload. (Default)
- */
- VELOCITY_PARAM(txcsum_offload, "Enable transmit packet checksum offload");
-
- #define FLOW_CNTL_DEF 1
- #define FLOW_CNTL_MIN 1
- #define FLOW_CNTL_MAX 5
-
- /* flow_control[] is used for setting the flow control ability of NIC.
- 1: hardware deafult - AUTO (default). Use Hardware default value in ANAR.
- 2: enable TX flow control.
- 3: enable RX flow control.
- 4: enable RX/TX flow control.
- 5: disable
- */
- VELOCITY_PARAM(flow_control, "Enable flow control ability");
-
- #define MED_LNK_DEF 0
- #define MED_LNK_MIN 0
- #define MED_LNK_MAX 4
- /* speed_duplex[] is used for setting the speed and duplex mode of NIC.
- 0: indicate autonegotiation for both speed and duplex mode
- 1: indicate 100Mbps half duplex mode
- 2: indicate 100Mbps full duplex mode
- 3: indicate 10Mbps half duplex mode
- 4: indicate 10Mbps full duplex mode
-
- Note:
- if EEPROM have been set to the force mode, this option is ignored
- by driver.
- */
- VELOCITY_PARAM(speed_duplex, "Setting the speed and duplex mode");
-
- #define VAL_PKT_LEN_DEF 0
- /* ValPktLen[] is used for setting the checksum offload ability of NIC.
- 0: Receive frame with invalid layer 2 length (Default)
- 1: Drop frame with invalid layer 2 length
- */
- VELOCITY_PARAM(ValPktLen, "Receiving or Drop invalid 802.3 frame");
-
- #define WOL_OPT_DEF 0
- #define WOL_OPT_MIN 0
- #define WOL_OPT_MAX 7
- /* wol_opts[] is used for controlling wake on lan behavior.
- 0: Wake up if recevied a magic packet. (Default)
- 1: Wake up if link status is on/off.
- 2: Wake up if recevied an arp packet.
- 4: Wake up if recevied any unicast packet.
- Those value can be sumed up to support more than one option.
- */
- VELOCITY_PARAM(wol_opts, "Wake On Lan options");
-
- #define INT_WORKS_DEF 20
- #define INT_WORKS_MIN 10
- #define INT_WORKS_MAX 64
-
- VELOCITY_PARAM(int_works, "Number of packets per interrupt services");
-
- /* The descriptors for this card are required to be aligned on
- 64 byte boundaries. As the align attribute does not guarantee alignment
- greater than the alignment of the start address (which for Etherboot
- is 16 bytes of alignment) it requires some extra steps. Add 64 to the
- size of the array and the init_ring adjusts the alignment */
-
- /* Define the TX Descriptor */
- static u8 tx_ring[TX_DESC_DEF * sizeof(struct tx_desc) + 64];
-
- /* Create a static buffer of size PKT_BUF_SZ for each TX Descriptor.
- All descriptors point to a part of this buffer */
- static u8 txb[(TX_DESC_DEF * PKT_BUF_SZ) + 64];
-
- /* Define the RX Descriptor */
- static u8 rx_ring[RX_DESC_DEF * sizeof(struct rx_desc) + 64];
-
- /* Create a static buffer of size PKT_BUF_SZ for each RX Descriptor
- All descriptors point to a part of this buffer */
- static u8 rxb[(RX_DESC_DEF * PKT_BUF_SZ) + 64];
-
- static void velocity_init_info(struct pci_device *pdev,
- struct velocity_info *vptr,
- struct velocity_info_tbl *info);
- static int velocity_get_pci_info(struct velocity_info *,
- struct pci_device *pdev);
- static int velocity_open(struct nic *nic, struct pci_device *pci);
-
- static int velocity_soft_reset(struct velocity_info *vptr);
- static void velocity_init_cam_filter(struct velocity_info *vptr);
- static void mii_init(struct velocity_info *vptr, u32 mii_status);
- static u32 velocity_get_opt_media_mode(struct velocity_info *vptr);
- static void velocity_print_link_status(struct velocity_info *vptr);
- static void safe_disable_mii_autopoll(struct mac_regs *regs);
- static void enable_flow_control_ability(struct velocity_info *vptr);
- static void enable_mii_autopoll(struct mac_regs *regs);
- static int velocity_mii_read(struct mac_regs *, u8 byIdx, u16 * pdata);
- static int velocity_mii_write(struct mac_regs *, u8 byMiiAddr, u16 data);
- static u32 mii_check_media_mode(struct mac_regs *regs);
- static u32 check_connection_type(struct mac_regs *regs);
- static int velocity_set_media_mode(struct velocity_info *vptr,
- u32 mii_status);
-
-
- /*
- * Internal board variants. At the moment we have only one
- */
-
- static struct velocity_info_tbl chip_info_table[] = {
- {CHIP_TYPE_VT6110,
- "VIA Networking Velocity Family Gigabit Ethernet Adapter", 256, 1,
- 0x00FFFFFFUL},
- {0, NULL, 0, 0, 0}
- };
-
- /**
- * velocity_set_int_opt - parser for integer options
- * @opt: pointer to option value
- * @val: value the user requested (or -1 for default)
- * @min: lowest value allowed
- * @max: highest value allowed
- * @def: default value
- * @name: property name
- * @dev: device name
- *
- * Set an integer property in the module options. This function does
- * all the verification and checking as well as reporting so that
- * we don't duplicate code for each option.
- */
-
- static void velocity_set_int_opt(int *opt, int val, int min, int max,
- int def, char *name, const char *devname)
- {
- if (val == -1) {
- printf("%s: set value of parameter %s to %d\n",
- devname, name, def);
- *opt = def;
- } else if (val < min || val > max) {
- printf
- ("%s: the value of parameter %s is invalid, the valid range is (%d-%d)\n",
- devname, name, min, max);
- *opt = def;
- } else {
- printf("%s: set value of parameter %s to %d\n",
- devname, name, val);
- *opt = val;
- }
- }
-
- /**
- * velocity_set_bool_opt - parser for boolean options
- * @opt: pointer to option value
- * @val: value the user requested (or -1 for default)
- * @def: default value (yes/no)
- * @flag: numeric value to set for true.
- * @name: property name
- * @dev: device name
- *
- * Set a boolean property in the module options. This function does
- * all the verification and checking as well as reporting so that
- * we don't duplicate code for each option.
- */
-
- static void velocity_set_bool_opt(u32 * opt, int val, int def, u32 flag,
- char *name, const char *devname)
- {
- (*opt) &= (~flag);
- if (val == -1) {
- printf("%s: set parameter %s to %s\n",
- devname, name, def ? "TRUE" : "FALSE");
- *opt |= (def ? flag : 0);
- } else if (val < 0 || val > 1) {
- printf
- ("%s: the value of parameter %s is invalid, the valid range is (0-1)\n",
- devname, name);
- *opt |= (def ? flag : 0);
- } else {
- printf("%s: set parameter %s to %s\n",
- devname, name, val ? "TRUE" : "FALSE");
- *opt |= (val ? flag : 0);
- }
- }
-
- /**
- * velocity_get_options - set options on device
- * @opts: option structure for the device
- * @index: index of option to use in module options array
- * @devname: device name
- *
- * Turn the module and command options into a single structure
- * for the current device
- */
-
- static void velocity_get_options(struct velocity_opt *opts, int index,
- const char *devname)
- {
-
- /* FIXME Do the options need to be configurable */
- velocity_set_int_opt(&opts->rx_thresh, -1, RX_THRESH_MIN,
- RX_THRESH_MAX, RX_THRESH_DEF, "rx_thresh",
- devname);
- velocity_set_int_opt(&opts->DMA_length, DMA_length[index],
- DMA_LENGTH_MIN, DMA_LENGTH_MAX,
- DMA_LENGTH_DEF, "DMA_length", devname);
- velocity_set_int_opt(&opts->numrx, RxDescriptors[index],
- RX_DESC_MIN, RX_DESC_MAX, RX_DESC_DEF,
- "RxDescriptors", devname);
- velocity_set_int_opt(&opts->numtx, TxDescriptors[index],
- TX_DESC_MIN, TX_DESC_MAX, TX_DESC_DEF,
- "TxDescriptors", devname);
- velocity_set_int_opt(&opts->vid, VID_setting[index], VLAN_ID_MIN,
- VLAN_ID_MAX, VLAN_ID_DEF, "VID_setting",
- devname);
- velocity_set_bool_opt(&opts->flags, enable_tagging[index],
- TAGGING_DEF, VELOCITY_FLAGS_TAGGING,
- "enable_tagging", devname);
- velocity_set_bool_opt(&opts->flags, txcsum_offload[index],
- TX_CSUM_DEF, VELOCITY_FLAGS_TX_CSUM,
- "txcsum_offload", devname);
- velocity_set_int_opt(&opts->flow_cntl, flow_control[index],
- FLOW_CNTL_MIN, FLOW_CNTL_MAX, FLOW_CNTL_DEF,
- "flow_control", devname);
- velocity_set_bool_opt(&opts->flags, IP_byte_align[index],
- IP_ALIG_DEF, VELOCITY_FLAGS_IP_ALIGN,
- "IP_byte_align", devname);
- velocity_set_bool_opt(&opts->flags, ValPktLen[index],
- VAL_PKT_LEN_DEF, VELOCITY_FLAGS_VAL_PKT_LEN,
- "ValPktLen", devname);
- velocity_set_int_opt((void *) &opts->spd_dpx, speed_duplex[index],
- MED_LNK_MIN, MED_LNK_MAX, MED_LNK_DEF,
- "Media link mode", devname);
- velocity_set_int_opt((int *) &opts->wol_opts, wol_opts[index],
- WOL_OPT_MIN, WOL_OPT_MAX, WOL_OPT_DEF,
- "Wake On Lan options", devname);
- velocity_set_int_opt((int *) &opts->int_works, int_works[index],
- INT_WORKS_MIN, INT_WORKS_MAX, INT_WORKS_DEF,
- "Interrupt service works", devname);
- opts->numrx = (opts->numrx & ~3);
- }
-
- /**
- * velocity_init_cam_filter - initialise CAM
- * @vptr: velocity to program
- *
- * Initialize the content addressable memory used for filters. Load
- * appropriately according to the presence of VLAN
- */
-
- static void velocity_init_cam_filter(struct velocity_info *vptr)
- {
- struct mac_regs *regs = vptr->mac_regs;
-
- /* Turn on MCFG_PQEN, turn off MCFG_RTGOPT */
- WORD_REG_BITS_SET(MCFG_PQEN, MCFG_RTGOPT, ®s->MCFG);
- WORD_REG_BITS_ON(MCFG_VIDFR, ®s->MCFG);
-
- /* Disable all CAMs */
- memset(vptr->vCAMmask, 0, sizeof(u8) * 8);
- memset(vptr->mCAMmask, 0, sizeof(u8) * 8);
- mac_set_cam_mask(regs, vptr->vCAMmask, VELOCITY_VLAN_ID_CAM);
- mac_set_cam_mask(regs, vptr->mCAMmask, VELOCITY_MULTICAST_CAM);
-
- /* Enable first VCAM */
- if (vptr->flags & VELOCITY_FLAGS_TAGGING) {
- /* If Tagging option is enabled and VLAN ID is not zero, then
- turn on MCFG_RTGOPT also */
- if (vptr->options.vid != 0)
- WORD_REG_BITS_ON(MCFG_RTGOPT, ®s->MCFG);
-
- mac_set_cam(regs, 0, (u8 *) & (vptr->options.vid),
- VELOCITY_VLAN_ID_CAM);
- vptr->vCAMmask[0] |= 1;
- mac_set_cam_mask(regs, vptr->vCAMmask,
- VELOCITY_VLAN_ID_CAM);
- } else {
- u16 temp = 0;
- mac_set_cam(regs, 0, (u8 *) & temp, VELOCITY_VLAN_ID_CAM);
- temp = 1;
- mac_set_cam_mask(regs, (u8 *) & temp,
- VELOCITY_VLAN_ID_CAM);
- }
- }
-
- static inline void velocity_give_many_rx_descs(struct velocity_info *vptr)
- {
- struct mac_regs *regs = vptr->mac_regs;
- int avail, dirty, unusable;
-
- /*
- * RD number must be equal to 4X per hardware spec
- * (programming guide rev 1.20, p.13)
- */
- if (vptr->rd_filled < 4)
- return;
-
- wmb();
-
- unusable = vptr->rd_filled & 0x0003;
- dirty = vptr->rd_dirty - unusable;
- for (avail = vptr->rd_filled & 0xfffc; avail; avail--) {
- dirty = (dirty > 0) ? dirty - 1 : vptr->options.numrx - 1;
- // printf("return dirty: %d\n", dirty);
- vptr->rd_ring[dirty].rdesc0.owner = OWNED_BY_NIC;
- }
-
- writew(vptr->rd_filled & 0xfffc, ®s->RBRDU);
- vptr->rd_filled = unusable;
- }
-
- static int velocity_rx_refill(struct velocity_info *vptr)
- {
- int dirty = vptr->rd_dirty, done = 0, ret = 0;
-
- // printf("rx_refill - rd_curr = %d, dirty = %d\n", vptr->rd_curr, dirty);
- do {
- struct rx_desc *rd = vptr->rd_ring + dirty;
-
- /* Fine for an all zero Rx desc at init time as well */
- if (rd->rdesc0.owner == OWNED_BY_NIC)
- break;
- // printf("rx_refill - after owner %d\n", dirty);
-
- rd->inten = 1;
- rd->pa_high = 0;
- rd->rdesc0.len = cpu_to_le32(vptr->rx_buf_sz);;
-
- done++;
- dirty = (dirty < vptr->options.numrx - 1) ? dirty + 1 : 0;
- } while (dirty != vptr->rd_curr);
-
- if (done) {
- // printf("\nGive Back Desc\n");
- vptr->rd_dirty = dirty;
- vptr->rd_filled += done;
- velocity_give_many_rx_descs(vptr);
- }
-
- return ret;
- }
-
- extern void hex_dump(const char *data, const unsigned int len);
- /**************************************************************************
- POLL - Wait for a frame
- ***************************************************************************/
- static int velocity_poll(struct nic *nic, int retrieve)
- {
- /* Work out whether or not there's an ethernet packet ready to
- * read. Return 0 if not.
- */
-
- int rd_curr = vptr->rd_curr % RX_DESC_DEF;
- struct rx_desc *rd = &(vptr->rd_ring[rd_curr]);
-
- if (rd->rdesc0.owner == OWNED_BY_NIC)
- return 0;
- rmb();
-
- if ( ! retrieve ) return 1;
-
- /*
- * Don't drop CE or RL error frame although RXOK is off
- */
- if ((rd->rdesc0.RSR & RSR_RXOK)
- || (!(rd->rdesc0.RSR & RSR_RXOK)
- && (rd->rdesc0.RSR & (RSR_CE | RSR_RL)))) {
-
- nic->packetlen = rd->rdesc0.len;
- // ptr->rxb + (rd_curr * PKT_BUF_SZ)
- memcpy(nic->packet, bus_to_virt(rd->pa_low),
- nic->packetlen - 4);
-
- vptr->rd_curr++;
- vptr->rd_curr = vptr->rd_curr % RX_DESC_DEF;
- velocity_rx_refill(vptr);
- return 1; /* Remove this line once this method is implemented */
- }
- return 0;
- }
-
- #define TX_TIMEOUT (1000);
- /**************************************************************************
- TRANSMIT - Transmit a frame
- ***************************************************************************/
- static void velocity_transmit(struct nic *nic, const char *dest, /* Destination */
- unsigned int type, /* Type */
- unsigned int size, /* size */
- const char *packet)
- { /* Packet */
- u16 nstype;
- u32 to;
- u8 *ptxb;
- unsigned int pktlen;
- struct tx_desc *td_ptr;
-
- int entry = vptr->td_curr % TX_DESC_DEF;
- td_ptr = &(vptr->td_rings[entry]);
-
- /* point to the current txb incase multiple tx_rings are used */
- ptxb = vptr->txb + (entry * PKT_BUF_SZ);
- memcpy(ptxb, dest, ETH_ALEN); /* Destination */
- memcpy(ptxb + ETH_ALEN, nic->node_addr, ETH_ALEN); /* Source */
- nstype = htons((u16) type); /* Type */
- memcpy(ptxb + 2 * ETH_ALEN, (u8 *) & nstype, 2); /* Type */
- memcpy(ptxb + ETH_HLEN, packet, size);
-
- td_ptr->tdesc1.TCPLS = TCPLS_NORMAL;
- td_ptr->tdesc1.TCR = TCR0_TIC;
- td_ptr->td_buf[0].queue = 0;
-
- size += ETH_HLEN;
- while (size < ETH_ZLEN) /* pad to min length */
- ptxb[size++] = '\0';
-
- if (size < ETH_ZLEN) {
- // printf("Padd that packet\n");
- pktlen = ETH_ZLEN;
- // memcpy(ptxb, skb->data, skb->len);
- memset(ptxb + size, 0, ETH_ZLEN - size);
-
- vptr->td_rings[entry].tdesc0.pktsize = pktlen;
- vptr->td_rings[entry].td_buf[0].pa_low = virt_to_bus(ptxb);
- vptr->td_rings[entry].td_buf[0].pa_high &=
- cpu_to_le32(0xffff0000UL);
- vptr->td_rings[entry].td_buf[0].bufsize =
- vptr->td_rings[entry].tdesc0.pktsize;
- vptr->td_rings[entry].tdesc1.CMDZ = 2;
- } else {
- // printf("Correct size packet\n");
- td_ptr->tdesc0.pktsize = size;
- td_ptr->td_buf[0].pa_low = virt_to_bus(ptxb);
- td_ptr->td_buf[0].pa_high = 0;
- td_ptr->td_buf[0].bufsize = td_ptr->tdesc0.pktsize;
- // tdinfo->nskb_dma = 1;
- td_ptr->tdesc1.CMDZ = 2;
- }
-
- if (vptr->flags & VELOCITY_FLAGS_TAGGING) {
- td_ptr->tdesc1.pqinf.VID = (vptr->options.vid & 0xfff);
- td_ptr->tdesc1.pqinf.priority = 0;
- td_ptr->tdesc1.pqinf.CFI = 0;
- td_ptr->tdesc1.TCR |= TCR0_VETAG;
- }
-
- vptr->td_curr = (entry + 1);
-
- {
-
- int prev = entry - 1;
-
- if (prev < 0)
- prev = TX_DESC_DEF - 1;
- td_ptr->tdesc0.owner |= OWNED_BY_NIC;
- td_ptr = &(vptr->td_rings[prev]);
- td_ptr->td_buf[0].queue = 1;
- mac_tx_queue_wake(vptr->mac_regs, 0);
-
- }
-
- to = currticks() + TX_TIMEOUT;
- while ((td_ptr->tdesc0.owner & OWNED_BY_NIC) && (currticks() < to)); /* wait */
-
- if (currticks() >= to) {
- printf("TX Time Out");
- }
-
- }
-
- /**************************************************************************
- DISABLE - Turn off ethernet interface
- ***************************************************************************/
- static void velocity_disable(struct nic *nic __unused)
- {
- /* put the card in its initial state */
- /* This function serves 3 purposes.
- * This disables DMA and interrupts so we don't receive
- * unexpected packets or interrupts from the card after
- * etherboot has finished.
- * This frees resources so etherboot may use
- * this driver on another interface
- * This allows etherboot to reinitialize the interface
- * if something is something goes wrong.
- */
- struct mac_regs *regs = vptr->mac_regs;
- mac_disable_int(regs);
- writel(CR0_STOP, ®s->CR0Set);
- writew(0xFFFF, ®s->TDCSRClr);
- writeb(0xFF, ®s->RDCSRClr);
- safe_disable_mii_autopoll(regs);
- mac_clear_isr(regs);
-
- /* Power down the chip */
- // pci_set_power_state(vptr->pdev, PCI_D3hot);
-
- vptr->flags &= (~VELOCITY_FLAGS_OPENED);
- }
-
- /**************************************************************************
- IRQ - handle interrupts
- ***************************************************************************/
- static void velocity_irq(struct nic *nic __unused, irq_action_t action)
- {
- /* This routine is somewhat optional. Etherboot itself
- * doesn't use interrupts, but they are required under some
- * circumstances when we're acting as a PXE stack.
- *
- * If you don't implement this routine, the only effect will
- * be that your driver cannot be used via Etherboot's UNDI
- * API. This won't affect programs that use only the UDP
- * portion of the PXE API, such as pxelinux.
- */
-
- switch (action) {
- case DISABLE:
- case ENABLE:
- /* Set receive interrupt enabled/disabled state */
- /*
- outb ( action == ENABLE ? IntrMaskEnabled : IntrMaskDisabled,
- nic->ioaddr + IntrMaskRegister );
- */
- break;
- case FORCE:
- /* Force NIC to generate a receive interrupt */
- /*
- outb ( ForceInterrupt, nic->ioaddr + IntrForceRegister );
- */
- break;
- }
- }
-
- static struct nic_operations velocity_operations = {
- .connect = dummy_connect,
- .poll = velocity_poll,
- .transmit = velocity_transmit,
- .irq = velocity_irq,
- };
-
- /**************************************************************************
- PROBE - Look for an adapter, this routine's visible to the outside
- ***************************************************************************/
- static int velocity_probe( struct nic *nic, struct pci_device *pci)
- {
- int ret, i;
- struct mac_regs *regs;
-
- printf("via-velocity.c: Found %s Vendor=0x%hX Device=0x%hX\n",
- pci->id->name, pci->vendor, pci->device);
-
- /* point to private storage */
- vptr = &vptx;
- info = chip_info_table;
-
- velocity_init_info(pci, vptr, info);
-
- //FIXME: pci_enable_device(pci);
- //FIXME: pci_set_power_state(pci, PCI_D0);
-
- ret = velocity_get_pci_info(vptr, pci);
- if (ret < 0) {
- printf("Failed to find PCI device.\n");
- return 0;
- }
-
- regs = ioremap(vptr->memaddr, vptr->io_size);
- if (regs == NULL) {
- printf("Unable to remap io\n");
- return 0;
- }
-
- vptr->mac_regs = regs;
-
- BASE = vptr->ioaddr;
-
- printf("Chip ID: %hX\n", vptr->chip_id);
-
- for (i = 0; i < 6; i++)
- nic->node_addr[i] = readb(®s->PAR[i]);
-
- DBG ( "%s: %s at ioaddr %#hX\n", pci->id->name, eth_ntoa ( nic->node_addr ),
- (unsigned int) BASE );
-
- velocity_get_options(&vptr->options, 0, pci->id->name);
-
- /*
- * Mask out the options cannot be set to the chip
- */
- vptr->options.flags &= 0x00FFFFFFUL; //info->flags = 0x00FFFFFFUL;
-
- /*
- * Enable the chip specified capbilities
- */
-
- vptr->flags =
- vptr->options.
- flags | (0x00FFFFFFUL /*info->flags */ & 0xFF000000UL);
-
- vptr->wol_opts = vptr->options.wol_opts;
- vptr->flags |= VELOCITY_FLAGS_WOL_ENABLED;
-
- vptr->phy_id = MII_GET_PHY_ID(vptr->mac_regs);
-
- if (vptr->flags & VELOCITY_FLAGS_TX_CSUM) {
- printf("features missing\n");
- }
-
- /* and leave the chip powered down */
- // FIXME: pci_set_power_state(pci, PCI_D3hot);
-
- check_connection_type(vptr->mac_regs);
- velocity_open(nic, pci);
-
- /* store NIC parameters */
- nic->nic_op = &velocity_operations;
- return 1;
- }
-
- //#define IORESOURCE_IO 0x00000100 /* Resource type */
-
- /**
- * velocity_init_info - init private data
- * @pdev: PCI device
- * @vptr: Velocity info
- * @info: Board type
- *
- * Set up the initial velocity_info struct for the device that has been
- * discovered.
- */
-
- static void velocity_init_info(struct pci_device *pdev,
- struct velocity_info *vptr,
- struct velocity_info_tbl *info)
- {
- memset(vptr, 0, sizeof(struct velocity_info));
-
- vptr->pdev = pdev;
- vptr->chip_id = info->chip_id;
- vptr->io_size = info->io_size;
- vptr->num_txq = info->txqueue;
- vptr->multicast_limit = MCAM_SIZE;
-
- printf
- ("chip_id: 0x%hX, io_size: %d, num_txq %d, multicast_limit: %d\n",
- vptr->chip_id, (unsigned int) vptr->io_size, vptr->num_txq,
- vptr->multicast_limit);
- printf("Name: %s\n", info->name);
-
- // spin_lock_init(&vptr->lock);
- // INIT_LIST_HEAD(&vptr->list);
- }
-
- /**
- * velocity_get_pci_info - retrieve PCI info for device
- * @vptr: velocity device
- * @pdev: PCI device it matches
- *
- * Retrieve the PCI configuration space data that interests us from
- * the kernel PCI layer
- */
-
- #define IORESOURCE_IO 0x00000100 /* Resource type */
- #define IORESOURCE_PREFETCH 0x00001000 /* No side effects */
-
- #define IORESOURCE_MEM 0x00000200
- #define BAR_0 0
- #define BAR_1 1
- #define BAR_5 5
- #define PCI_BASE_ADDRESS_SPACE 0x01 /* 0 = memory, 1 = I/O */
- #define PCI_BASE_ADDRESS_SPACE_IO 0x01
- #define PCI_BASE_ADDRESS_SPACE_MEMORY 0x00
- #define PCI_BASE_ADDRESS_MEM_TYPE_MASK 0x06
- #define PCI_BASE_ADDRESS_MEM_TYPE_32 0x00 /* 32 bit address */
- #define PCI_BASE_ADDRESS_MEM_TYPE_1M 0x02 /* Below 1M [obsolete] */
- #define PCI_BASE_ADDRESS_MEM_TYPE_64 0x04 /* 64 bit address */
- #define PCI_BASE_ADDRESS_MEM_PREFETCH 0x08 /* prefetchable? */
- //#define PCI_BASE_ADDRESS_MEM_MASK (~0x0fUL)
- // #define PCI_BASE_ADDRESS_IO_MASK (~0x03UL)
-
- unsigned long pci_resource_flags(struct pci_device *pdev, unsigned int bar)
- {
- uint32_t l, sz;
- unsigned long flags = 0;
-
- pci_read_config_dword(pdev, bar, &l);
- pci_write_config_dword(pdev, bar, ~0);
- pci_read_config_dword(pdev, bar, &sz);
- pci_write_config_dword(pdev, bar, l);
-
- if (!sz || sz == 0xffffffff)
- printf("Weird size\n");
- if (l == 0xffffffff)
- l = 0;
- if ((l & PCI_BASE_ADDRESS_SPACE) == PCI_BASE_ADDRESS_SPACE_MEMORY) {
- /* sz = pci_size(l, sz, PCI_BASE_ADDRESS_MEM_MASK);
- if (!sz)
- continue;
- res->start = l & PCI_BASE_ADDRESS_MEM_MASK;
- */ flags |= l & ~PCI_BASE_ADDRESS_MEM_MASK;
- printf("Memory Resource\n");
- } else {
- // sz = pci_size(l, sz, PCI_BASE_ADDRESS_IO_MASK & 0xffff);
- /// if (!sz)
- /// continue;
- // res->start = l & PCI_BASE_ADDRESS_IO_MASK;
- flags |= l & ~PCI_BASE_ADDRESS_IO_MASK;
- printf("I/O Resource\n");
- }
- if (flags & PCI_BASE_ADDRESS_SPACE_IO) {
- printf("Why is it here\n");
- flags |= IORESOURCE_IO;
- } else {
- printf("here\n");
- //flags &= ~IORESOURCE_IO;
- }
-
-
- if (flags & PCI_BASE_ADDRESS_MEM_PREFETCH)
- flags |= IORESOURCE_MEM | IORESOURCE_PREFETCH;
-
-
- return flags;
- }
- static int velocity_get_pci_info(struct velocity_info *vptr,
- struct pci_device *pdev)
- {
- if (pci_read_config_byte(pdev, PCI_REVISION_ID, &vptr->rev_id) < 0) {
- printf("DEBUG: pci_read_config_byte failed\n");
- return -1;
- }
-
- adjust_pci_device(pdev);
-
- vptr->ioaddr = pci_bar_start(pdev, PCI_BASE_ADDRESS_0);
- vptr->memaddr = pci_bar_start(pdev, PCI_BASE_ADDRESS_1);
-
- printf("Looking for I/O Resource - Found:");
- if (!
- (pci_resource_flags(pdev, PCI_BASE_ADDRESS_0) & IORESOURCE_IO))
- {
- printf
- ("DEBUG: region #0 is not an I/O resource, aborting.\n");
- return -1;
- }
-
- printf("Looking for Memory Resource - Found:");
- if ((pci_resource_flags(pdev, PCI_BASE_ADDRESS_1) & IORESOURCE_IO)) {
- printf("DEBUG: region #1 is an I/O resource, aborting.\n");
- return -1;
- }
-
- if (pci_bar_size(pdev, PCI_BASE_ADDRESS_1) < 256) {
- printf("DEBUG: region #1 is too small.\n");
- return -1;
- }
- vptr->pdev = pdev;
-
- return 0;
- }
-
- /**
- * velocity_print_link_status - link status reporting
- * @vptr: velocity to report on
- *
- * Turn the link status of the velocity card into a kernel log
- * description of the new link state, detailing speed and duplex
- * status
- */
-
- static void velocity_print_link_status(struct velocity_info *vptr)
- {
-
- if (vptr->mii_status & VELOCITY_LINK_FAIL) {
- printf("failed to detect cable link\n");
- } else if (vptr->options.spd_dpx == SPD_DPX_AUTO) {
- printf("Link autonegation");
-
- if (vptr->mii_status & VELOCITY_SPEED_1000)
- printf(" speed 1000M bps");
- else if (vptr->mii_status & VELOCITY_SPEED_100)
- printf(" speed 100M bps");
- else
- printf(" speed 10M bps");
-
- if (vptr->mii_status & VELOCITY_DUPLEX_FULL)
- printf(" full duplex\n");
- else
- printf(" half duplex\n");
- } else {
- printf("Link forced");
- switch (vptr->options.spd_dpx) {
- case SPD_DPX_100_HALF:
- printf(" speed 100M bps half duplex\n");
- break;
- case SPD_DPX_100_FULL:
- printf(" speed 100M bps full duplex\n");
- break;
- case SPD_DPX_10_HALF:
- printf(" speed 10M bps half duplex\n");
- break;
- case SPD_DPX_10_FULL:
- printf(" speed 10M bps full duplex\n");
- break;
- default:
- break;
- }
- }
- }
-
- /**
- * velocity_rx_reset - handle a receive reset
- * @vptr: velocity we are resetting
- *
- * Reset the ownership and status for the receive ring side.
- * Hand all the receive queue to the NIC.
- */
-
- static void velocity_rx_reset(struct velocity_info *vptr)
- {
-
- struct mac_regs *regs = vptr->mac_regs;
- int i;
-
- //ptr->rd_dirty = vptr->rd_filled = vptr->rd_curr = 0;
-
- /*
- * Init state, all RD entries belong to the NIC
- */
- for (i = 0; i < vptr->options.numrx; ++i)
- vptr->rd_ring[i].rdesc0.owner = OWNED_BY_NIC;
-
- writew(RX_DESC_DEF, ®s->RBRDU);
- writel(virt_to_le32desc(vptr->rd_ring), ®s->RDBaseLo);
- writew(0, ®s->RDIdx);
- writew(RX_DESC_DEF - 1, ®s->RDCSize);
- }
-
- /**
- * velocity_init_registers - initialise MAC registers
- * @vptr: velocity to init
- * @type: type of initialisation (hot or cold)
- *
- * Initialise the MAC on a reset or on first set up on the
- * hardware.
- */
-
- static void velocity_init_registers(struct nic *nic,
- struct velocity_info *vptr,
- enum velocity_init_type type)
- {
- struct mac_regs *regs = vptr->mac_regs;
- int i, mii_status;
-
- mac_wol_reset(regs);
-
- switch (type) {
- case VELOCITY_INIT_RESET:
- case VELOCITY_INIT_WOL:
-
- //netif_stop_queue(vptr->dev);
-
- /*
- * Reset RX to prevent RX pointer not on the 4X location
- */
- velocity_rx_reset(vptr);
- mac_rx_queue_run(regs);
- mac_rx_queue_wake(regs);
-
- mii_status = velocity_get_opt_media_mode(vptr);
-
- if (velocity_set_media_mode(vptr, mii_status) !=
- VELOCITY_LINK_CHANGE) {
- velocity_print_link_status(vptr);
- if (!(vptr->mii_status & VELOCITY_LINK_FAIL))
- printf("Link Failed\n");
- // netif_wake_queue(vptr->dev);
- }
-
- enable_flow_control_ability(vptr);
-
- mac_clear_isr(regs);
- writel(CR0_STOP, ®s->CR0Clr);
- //writel((CR0_DPOLL | CR0_TXON | CR0_RXON | CR0_STRT),
- writel((CR0_DPOLL | CR0_TXON | CR0_RXON | CR0_STRT),
- ®s->CR0Set);
- break;
-
- case VELOCITY_INIT_COLD:
- default:
- /*
- * Do reset
- */
- velocity_soft_reset(vptr);
- mdelay(5);
-
- mac_eeprom_reload(regs);
- for (i = 0; i < 6; i++) {
- writeb(nic->node_addr[i], &(regs->PAR[i]));
- }
- /*
- * clear Pre_ACPI bit.
- */
- BYTE_REG_BITS_OFF(CFGA_PACPI, &(regs->CFGA));
- mac_set_rx_thresh(regs, vptr->options.rx_thresh);
- mac_set_dma_length(regs, vptr->options.DMA_length);
-
- writeb(WOLCFG_SAM | WOLCFG_SAB, ®s->WOLCFGSet);
- /*
- * Back off algorithm use original IEEE standard
- */
- BYTE_REG_BITS_SET(CFGB_OFSET,
- (CFGB_CRANDOM | CFGB_CAP | CFGB_MBA |
- CFGB_BAKOPT), ®s->CFGB);
-
- /*
- * Init CAM filter
- */
- velocity_init_cam_filter(vptr);
-
- /*
- * Set packet filter: Receive directed and broadcast address
- */
- //FIXME Multicast velocity_set_multi(nic);
-
- /*
- * Enable MII auto-polling
- */
- enable_mii_autopoll(regs);
-
- vptr->int_mask = INT_MASK_DEF;
-
- writel(virt_to_le32desc(vptr->rd_ring), ®s->RDBaseLo);
- writew(vptr->options.numrx - 1, ®s->RDCSize);
- mac_rx_queue_run(regs);
- mac_rx_queue_wake(regs);
-
- writew(vptr->options.numtx - 1, ®s->TDCSize);
-
- // for (i = 0; i < vptr->num_txq; i++) {
- writel(virt_to_le32desc(vptr->td_rings),
- &(regs->TDBaseLo[0]));
- mac_tx_queue_run(regs, 0);
- // }
-
- init_flow_control_register(vptr);
-
- writel(CR0_STOP, ®s->CR0Clr);
- writel((CR0_DPOLL | CR0_TXON | CR0_RXON | CR0_STRT),
- ®s->CR0Set);
-
- mii_status = velocity_get_opt_media_mode(vptr);
- // netif_stop_queue(vptr->dev);
-
- mii_init(vptr, mii_status);
-
- if (velocity_set_media_mode(vptr, mii_status) !=
- VELOCITY_LINK_CHANGE) {
- velocity_print_link_status(vptr);
- if (!(vptr->mii_status & VELOCITY_LINK_FAIL))
- printf("Link Faaailll\n");
- // netif_wake_queue(vptr->dev);
- }
-
- enable_flow_control_ability(vptr);
- mac_hw_mibs_init(regs);
- mac_write_int_mask(vptr->int_mask, regs);
- mac_clear_isr(regs);
-
-
- }
- velocity_print_link_status(vptr);
- }
-
- /**
- * velocity_soft_reset - soft reset
- * @vptr: velocity to reset
- *
- * Kick off a soft reset of the velocity adapter and then poll
- * until the reset sequence has completed before returning.
- */
-
- static int velocity_soft_reset(struct velocity_info *vptr)
- {
- struct mac_regs *regs = vptr->mac_regs;
- unsigned int i = 0;
-
- writel(CR0_SFRST, ®s->CR0Set);
-
- for (i = 0; i < W_MAX_TIMEOUT; i++) {
- udelay(5);
- if (!DWORD_REG_BITS_IS_ON(CR0_SFRST, ®s->CR0Set))
- break;
- }
-
- if (i == W_MAX_TIMEOUT) {
- writel(CR0_FORSRST, ®s->CR0Set);
- /* FIXME: PCI POSTING */
- /* delay 2ms */
- mdelay(2);
- }
- return 0;
- }
-
- /**
- * velocity_init_rings - set up DMA rings
- * @vptr: Velocity to set up
- *
- * Allocate PCI mapped DMA rings for the receive and transmit layer
- * to use.
- */
-
- static int velocity_init_rings(struct velocity_info *vptr)
- {
-
- int idx;
-
- vptr->rd_curr = 0;
- vptr->td_curr = 0;
- memset(vptr->td_rings, 0, TX_DESC_DEF * sizeof(struct tx_desc));
- memset(vptr->rd_ring, 0, RX_DESC_DEF * sizeof(struct rx_desc));
- // memset(vptr->tx_buffs, 0, TX_DESC_DEF * PKT_BUF_SZ);
-
-
- for (idx = 0; idx < RX_DESC_DEF; idx++) {
- vptr->rd_ring[idx].rdesc0.RSR = 0;
- vptr->rd_ring[idx].rdesc0.len = 0;
- vptr->rd_ring[idx].rdesc0.reserved = 0;
- vptr->rd_ring[idx].rdesc0.owner = 0;
- vptr->rd_ring[idx].len = cpu_to_le32(vptr->rx_buf_sz);
- vptr->rd_ring[idx].inten = 1;
- vptr->rd_ring[idx].pa_low =
- virt_to_bus(vptr->rxb + (RX_DESC_DEF * idx));
- vptr->rd_ring[idx].pa_high = 0;
- vptr->rd_ring[idx].rdesc0.owner = OWNED_BY_NIC;
- }
-
- /* for (i = 0; idx < TX_DESC_DEF; idx++ ) {
- vptr->td_rings[idx].tdesc1.TCPLS = TCPLS_NORMAL;
- vptr->td_rings[idx].tdesc1.TCR = TCR0_TIC;
- vptr->td_rings[idx].td_buf[0].queue = 0;
- vptr->td_rings[idx].tdesc0.owner = ~OWNED_BY_NIC;
- vptr->td_rings[idx].tdesc0.pktsize = 0;
- vptr->td_rings[idx].td_buf[0].pa_low = cpu_to_le32(virt_to_bus(vptr->txb + (idx * PKT_BUF_SZ)));
- vptr->td_rings[idx].td_buf[0].pa_high = 0;
- vptr->td_rings[idx].td_buf[0].bufsize = 0;
- vptr->td_rings[idx].tdesc1.CMDZ = 2;
- }
- */
- return 0;
- }
-
- /**
- * velocity_open - interface activation callback
- * @dev: network layer device to open
- *
- * Called when the network layer brings the interface up. Returns
- * a negative posix error code on failure, or zero on success.
- *
- * All the ring allocation and set up is done on open for this
- * adapter to minimise memory usage when inactive
- */
-
- #define PCI_BYTE_REG_BITS_ON(x,i,p) do{\
- u8 byReg;\
- pci_read_config_byte((p), (i), &(byReg));\
- (byReg) |= (x);\
- pci_write_config_byte((p), (i), (byReg));\
- } while (0)
-
- //
- // Registers in the PCI configuration space
- //
- #define PCI_REG_COMMAND 0x04 //
- #define PCI_REG_MODE0 0x60 //
- #define PCI_REG_MODE1 0x61 //
- #define PCI_REG_MODE2 0x62 //
- #define PCI_REG_MODE3 0x63 //
- #define PCI_REG_DELAY_TIMER 0x64 //
-
- // Bits in the (MODE2, 0x62) register
- //
- #define MODE2_PCEROPT 0x80 // take PCI bus ERror as a fatal and shutdown from software control
- #define MODE2_TXQ16 0x40 // TX write-back Queue control. 0->32 entries available in Tx write-back queue, 1->16 entries
- #define MODE2_TXPOST 0x08 // (Not support in VT3119)
- #define MODE2_AUTOOPT 0x04 // (VT3119 GHCI without such behavior)
- #define MODE2_MODE10T 0x02 // used to control tx Threshold for 10M case
- #define MODE2_TCPLSOPT 0x01 // TCP large send field update disable, hardware will not update related fields, leave it to software.
-
- //
- // Bits in the MODE3 register
- //
- #define MODE3_MIION 0x04 // MII symbol codine error detect enable ??
-
- // Bits in the (COMMAND, 0x04) register
- #define COMMAND_BUSM 0x04
- #define COMMAND_WAIT 0x80
- static int velocity_open(struct nic *nic, struct pci_device *pci __unused)
- {
- u8 diff;
- u32 TxPhyAddr, RxPhyAddr;
- u32 TxBufPhyAddr, RxBufPhyAddr;
- vptr->TxDescArrays = tx_ring;
- if (vptr->TxDescArrays == 0)
- printf("Allot Error");
-
- /* Tx Descriptor needs 64 bytes alignment; */
- TxPhyAddr = virt_to_bus(vptr->TxDescArrays);
- printf("Unaligned Address : %X\n", TxPhyAddr);
- diff = 64 - (TxPhyAddr - ((TxPhyAddr >> 6) << 6));
- TxPhyAddr += diff;
- vptr->td_rings = (struct tx_desc *) (vptr->TxDescArrays + diff);
-
- printf("Aligned Address: %lX\n", virt_to_bus(vptr->td_rings));
- vptr->tx_buffs = txb;
- /* Rx Buffer needs 64 bytes alignment; */
- TxBufPhyAddr = virt_to_bus(vptr->tx_buffs);
- diff = 64 - (TxBufPhyAddr - ((TxBufPhyAddr >> 6) << 6));
- TxBufPhyAddr += diff;
- vptr->txb = (unsigned char *) (vptr->tx_buffs + diff);
-
- vptr->RxDescArrays = rx_ring;
- /* Rx Descriptor needs 64 bytes alignment; */
- RxPhyAddr = virt_to_bus(vptr->RxDescArrays);
- diff = 64 - (RxPhyAddr - ((RxPhyAddr >> 6) << 6));
- RxPhyAddr += diff;
- vptr->rd_ring = (struct rx_desc *) (vptr->RxDescArrays + diff);
-
- vptr->rx_buffs = rxb;
- /* Rx Buffer needs 64 bytes alignment; */
- RxBufPhyAddr = virt_to_bus(vptr->rx_buffs);
- diff = 64 - (RxBufPhyAddr - ((RxBufPhyAddr >> 6) << 6));
- RxBufPhyAddr += diff;
- vptr->rxb = (unsigned char *) (vptr->rx_buffs + diff);
-
- if (vptr->RxDescArrays == NULL || vptr->RxDescArrays == NULL) {
- printf("Allocate tx_ring or rd_ring failed\n");
- return 0;
- }
-
- vptr->rx_buf_sz = PKT_BUF_SZ;
- /*
- // turn this on to avoid retry forever
- PCI_BYTE_REG_BITS_ON(MODE2_PCEROPT, PCI_REG_MODE2, pci);
- // for some legacy BIOS and OS don't open BusM
- // bit in PCI configuration space. So, turn it on.
- PCI_BYTE_REG_BITS_ON(COMMAND_BUSM, PCI_REG_COMMAND, pci);
- // turn this on to detect MII coding error
- PCI_BYTE_REG_BITS_ON(MODE3_MIION, PCI_REG_MODE3, pci);
- */
- velocity_init_rings(vptr);
-
- /* Ensure chip is running */
- //FIXME: pci_set_power_state(vptr->pdev, PCI_D0);
-
- velocity_init_registers(nic, vptr, VELOCITY_INIT_COLD);
- mac_write_int_mask(0, vptr->mac_regs);
- // _int(vptr->mac_regs);
- //mac_enable_int(vptr->mac_regs);
-
- vptr->flags |= VELOCITY_FLAGS_OPENED;
- return 1;
-
- }
-
- /*
- * MII access , media link mode setting functions
- */
-
-
- /**
- * mii_init - set up MII
- * @vptr: velocity adapter
- * @mii_status: links tatus
- *
- * Set up the PHY for the current link state.
- */
-
- static void mii_init(struct velocity_info *vptr, u32 mii_status __unused)
- {
- u16 BMCR;
-
- switch (PHYID_GET_PHY_ID(vptr->phy_id)) {
- case PHYID_CICADA_CS8201:
- /*
- * Reset to hardware default
- */
- MII_REG_BITS_OFF((ANAR_ASMDIR | ANAR_PAUSE), MII_REG_ANAR,
- vptr->mac_regs);
- /*
- * Turn on ECHODIS bit in NWay-forced full mode and turn it
- * off it in NWay-forced half mode for NWay-forced v.s.
- * legacy-forced issue.
- */
- if (vptr->mii_status & VELOCITY_DUPLEX_FULL)
- MII_REG_BITS_ON(TCSR_ECHODIS, MII_REG_TCSR,
- vptr->mac_regs);
- else
- MII_REG_BITS_OFF(TCSR_ECHODIS, MII_REG_TCSR,
- vptr->mac_regs);
- /*
- * Turn on Link/Activity LED enable bit for CIS8201
- */
- MII_REG_BITS_ON(PLED_LALBE, MII_REG_PLED, vptr->mac_regs);
- break;
- case PHYID_VT3216_32BIT:
- case PHYID_VT3216_64BIT:
- /*
- * Reset to hardware default
- */
- MII_REG_BITS_ON((ANAR_ASMDIR | ANAR_PAUSE), MII_REG_ANAR,
- vptr->mac_regs);
- /*
- * Turn on ECHODIS bit in NWay-forced full mode and turn it
- * off it in NWay-forced half mode for NWay-forced v.s.
- * legacy-forced issue
- */
- if (vptr->mii_status & VELOCITY_DUPLEX_FULL)
- MII_REG_BITS_ON(TCSR_ECHODIS, MII_REG_TCSR,
- vptr->mac_regs);
- else
- MII_REG_BITS_OFF(TCSR_ECHODIS, MII_REG_TCSR,
- vptr->mac_regs);
- break;
-
- case PHYID_MARVELL_1000:
- case PHYID_MARVELL_1000S:
- /*
- * Assert CRS on Transmit
- */
- MII_REG_BITS_ON(PSCR_ACRSTX, MII_REG_PSCR, vptr->mac_regs);
- /*
- * Reset to hardware default
- */
- MII_REG_BITS_ON((ANAR_ASMDIR | ANAR_PAUSE), MII_REG_ANAR,
- vptr->mac_regs);
- break;
- default:
- ;
- }
- velocity_mii_read(vptr->mac_regs, MII_REG_BMCR, &BMCR);
- if (BMCR & BMCR_ISO) {
- BMCR &= ~BMCR_ISO;
- velocity_mii_write(vptr->mac_regs, MII_REG_BMCR, BMCR);
- }
- }
-
- /**
- * safe_disable_mii_autopoll - autopoll off
- * @regs: velocity registers
- *
- * Turn off the autopoll and wait for it to disable on the chip
- */
-
- static void safe_disable_mii_autopoll(struct mac_regs *regs)
- {
- u16 ww;
-
- /* turn off MAUTO */
- writeb(0, ®s->MIICR);
- for (ww = 0; ww < W_MAX_TIMEOUT; ww++) {
- udelay(1);
- if (BYTE_REG_BITS_IS_ON(MIISR_MIDLE, ®s->MIISR))
- break;
- }
- }
-
- /**
- * enable_mii_autopoll - turn on autopolling
- * @regs: velocity registers
- *
- * Enable the MII link status autopoll feature on the Velocity
- * hardware. Wait for it to enable.
- */
-
- static void enable_mii_autopoll(struct mac_regs *regs)
- {
- unsigned int ii;
-
- writeb(0, &(regs->MIICR));
- writeb(MIIADR_SWMPL, ®s->MIIADR);
-
- for (ii = 0; ii < W_MAX_TIMEOUT; ii++) {
- udelay(1);
- if (BYTE_REG_BITS_IS_ON(MIISR_MIDLE, ®s->MIISR))
- break;
- }
-
- writeb(MIICR_MAUTO, ®s->MIICR);
-
- for (ii = 0; ii < W_MAX_TIMEOUT; ii++) {
- udelay(1);
- if (!BYTE_REG_BITS_IS_ON(MIISR_MIDLE, ®s->MIISR))
- break;
- }
-
- }
-
- /**
- * velocity_mii_read - read MII data
- * @regs: velocity registers
- * @index: MII register index
- * @data: buffer for received data
- *
- * Perform a single read of an MII 16bit register. Returns zero
- * on success or -ETIMEDOUT if the PHY did not respond.
- */
-
- static int velocity_mii_read(struct mac_regs *regs, u8 index, u16 * data)
- {
- u16 ww;
-
- /*
- * Disable MIICR_MAUTO, so that mii addr can be set normally
- */
- safe_disable_mii_autopoll(regs);
-
- writeb(index, ®s->MIIADR);
-
- BYTE_REG_BITS_ON(MIICR_RCMD, ®s->MIICR);
-
- for (ww = 0; ww < W_MAX_TIMEOUT; ww++) {
- if (!(readb(®s->MIICR) & MIICR_RCMD))
- break;
- }
-
- *data = readw(®s->MIIDATA);
-
- enable_mii_autopoll(regs);
- if (ww == W_MAX_TIMEOUT)
- return -1;
- return 0;
- }
-
- /**
- * velocity_mii_write - write MII data
- * @regs: velocity registers
- * @index: MII register index
- * @data: 16bit data for the MII register
- *
- * Perform a single write to an MII 16bit register. Returns zero
- * on success or -ETIMEDOUT if the PHY did not respond.
- */
-
- static int velocity_mii_write(struct mac_regs *regs, u8 mii_addr, u16 data)
- {
- u16 ww;
-
- /*
- * Disable MIICR_MAUTO, so that mii addr can be set normally
- */
- safe_disable_mii_autopoll(regs);
-
- /* MII reg offset */
- writeb(mii_addr, ®s->MIIADR);
- /* set MII data */
- writew(data, ®s->MIIDATA);
-
- /* turn on MIICR_WCMD */
- BYTE_REG_BITS_ON(MIICR_WCMD, ®s->MIICR);
-
- /* W_MAX_TIMEOUT is the timeout period */
- for (ww = 0; ww < W_MAX_TIMEOUT; ww++) {
- udelay(5);
- if (!(readb(®s->MIICR) & MIICR_WCMD))
- break;
- }
- enable_mii_autopoll(regs);
-
- if (ww == W_MAX_TIMEOUT)
- return -1;
- return 0;
- }
-
- /**
- * velocity_get_opt_media_mode - get media selection
- * @vptr: velocity adapter
- *
- * Get the media mode stored in EEPROM or module options and load
- * mii_status accordingly. The requested link state information
- * is also returned.
- */
-
- static u32 velocity_get_opt_media_mode(struct velocity_info *vptr)
- {
- u32 status = 0;
-
- switch (vptr->options.spd_dpx) {
- case SPD_DPX_AUTO:
- status = VELOCITY_AUTONEG_ENABLE;
- break;
- case SPD_DPX_100_FULL:
- status = VELOCITY_SPEED_100 | VELOCITY_DUPLEX_FULL;
- break;
- case SPD_DPX_10_FULL:
- status = VELOCITY_SPEED_10 | VELOCITY_DUPLEX_FULL;
- break;
- case SPD_DPX_100_HALF:
- status = VELOCITY_SPEED_100;
- break;
- case SPD_DPX_10_HALF:
- status = VELOCITY_SPEED_10;
- break;
- }
- vptr->mii_status = status;
- return status;
- }
-
- /**
- * mii_set_auto_on - autonegotiate on
- * @vptr: velocity
- *
- * Enable autonegotation on this interface
- */
-
- static void mii_set_auto_on(struct velocity_info *vptr)
- {
- if (MII_REG_BITS_IS_ON(BMCR_AUTO, MII_REG_BMCR, vptr->mac_regs))
- MII_REG_BITS_ON(BMCR_REAUTO, MII_REG_BMCR, vptr->mac_regs);
- else
- MII_REG_BITS_ON(BMCR_AUTO, MII_REG_BMCR, vptr->mac_regs);
- }
-
-
- /*
- static void mii_set_auto_off(struct velocity_info * vptr)
- {
- MII_REG_BITS_OFF(BMCR_AUTO, MII_REG_BMCR, vptr->mac_regs);
- }
- */
-
- /**
- * set_mii_flow_control - flow control setup
- * @vptr: velocity interface
- *
- * Set up the flow control on this interface according to
- * the supplied user/eeprom options.
- */
-
- static void set_mii_flow_control(struct velocity_info *vptr)
- {
- /*Enable or Disable PAUSE in ANAR */
- switch (vptr->options.flow_cntl) {
- case FLOW_CNTL_TX:
- MII_REG_BITS_OFF(ANAR_PAUSE, MII_REG_ANAR, vptr->mac_regs);
- MII_REG_BITS_ON(ANAR_ASMDIR, MII_REG_ANAR, vptr->mac_regs);
- break;
-
- case FLOW_CNTL_RX:
- MII_REG_BITS_ON(ANAR_PAUSE, MII_REG_ANAR, vptr->mac_regs);
- MII_REG_BITS_ON(ANAR_ASMDIR, MII_REG_ANAR, vptr->mac_regs);
- break;
-
- case FLOW_CNTL_TX_RX:
- MII_REG_BITS_ON(ANAR_PAUSE, MII_REG_ANAR, vptr->mac_regs);
- MII_REG_BITS_ON(ANAR_ASMDIR, MII_REG_ANAR, vptr->mac_regs);
- break;
-
- case FLOW_CNTL_DISABLE:
- MII_REG_BITS_OFF(ANAR_PAUSE, MII_REG_ANAR, vptr->mac_regs);
- MII_REG_BITS_OFF(ANAR_ASMDIR, MII_REG_ANAR,
- vptr->mac_regs);
- break;
- default:
- break;
- }
- }
-
- /**
- * velocity_set_media_mode - set media mode
- * @mii_status: old MII link state
- *
- * Check the media link state and configure the flow control
- * PHY and also velocity hardware setup accordingly. In particular
- * we need to set up CD polling and frame bursting.
- */
-
- static int velocity_set_media_mode(struct velocity_info *vptr,
- u32 mii_status)
- {
- struct mac_regs *regs = vptr->mac_regs;
-
- vptr->mii_status = mii_check_media_mode(vptr->mac_regs);
-
- /* Set mii link status */
- set_mii_flow_control(vptr);
-
- if (PHYID_GET_PHY_ID(vptr->phy_id) == PHYID_CICADA_CS8201) {
- MII_REG_BITS_ON(AUXCR_MDPPS, MII_REG_AUXCR,
- vptr->mac_regs);
- }
-
- /*
- * If connection type is AUTO
- */
- if (mii_status & VELOCITY_AUTONEG_ENABLE) {
- printf("Velocity is AUTO mode\n");
- /* clear force MAC mode bit */
- BYTE_REG_BITS_OFF(CHIPGCR_FCMODE, ®s->CHIPGCR);
- /* set duplex mode of MAC according to duplex mode of MII */
- MII_REG_BITS_ON(ANAR_TXFD | ANAR_TX | ANAR_10FD | ANAR_10,
- MII_REG_ANAR, vptr->mac_regs);
- MII_REG_BITS_ON(G1000CR_1000FD | G1000CR_1000,
- MII_REG_G1000CR, vptr->mac_regs);
- MII_REG_BITS_ON(BMCR_SPEED1G, MII_REG_BMCR,
- vptr->mac_regs);
-
- /* enable AUTO-NEGO mode */
- mii_set_auto_on(vptr);
- } else {
- u16 ANAR;
- u8 CHIPGCR;
-
- /*
- * 1. if it's 3119, disable frame bursting in halfduplex mode
- * and enable it in fullduplex mode
- * 2. set correct MII/GMII and half/full duplex mode in CHIPGCR
- * 3. only enable CD heart beat counter in 10HD mode
- */
-
- /* set force MAC mode bit */
- BYTE_REG_BITS_ON(CHIPGCR_FCMODE, ®s->CHIPGCR);
-
- CHIPGCR = readb(®s->CHIPGCR);
- CHIPGCR &= ~CHIPGCR_FCGMII;
-
- if (mii_status & VELOCITY_DUPLEX_FULL) {
- CHIPGCR |= CHIPGCR_FCFDX;
- writeb(CHIPGCR, ®s->CHIPGCR);
- printf
- ("DEBUG: set Velocity to forced full mode\n");
- if (vptr->rev_id < REV_ID_VT3216_A0)
- BYTE_REG_BITS_OFF(TCR_TB2BDIS, ®s->TCR);
- } else {
- CHIPGCR &= ~CHIPGCR_FCFDX;
- printf
- ("DEBUG: set Velocity to forced half mode\n");
- writeb(CHIPGCR, ®s->CHIPGCR);
- if (vptr->rev_id < REV_ID_VT3216_A0)
- BYTE_REG_BITS_ON(TCR_TB2BDIS, ®s->TCR);
- }
-
- MII_REG_BITS_OFF(G1000CR_1000FD | G1000CR_1000,
- MII_REG_G1000CR, vptr->mac_regs);
-
- if (!(mii_status & VELOCITY_DUPLEX_FULL)
- && (mii_status & VELOCITY_SPEED_10)) {
- BYTE_REG_BITS_OFF(TESTCFG_HBDIS, ®s->TESTCFG);
- } else {
- BYTE_REG_BITS_ON(TESTCFG_HBDIS, ®s->TESTCFG);
- }
- /* MII_REG_BITS_OFF(BMCR_SPEED1G, MII_REG_BMCR, vptr->mac_regs); */
- velocity_mii_read(vptr->mac_regs, MII_REG_ANAR, &ANAR);
- ANAR &= (~(ANAR_TXFD | ANAR_TX | ANAR_10FD | ANAR_10));
- if (mii_status & VELOCITY_SPEED_100) {
- if (mii_status & VELOCITY_DUPLEX_FULL)
- ANAR |= ANAR_TXFD;
- else
- ANAR |= ANAR_TX;
- } else {
- if (mii_status & VELOCITY_DUPLEX_FULL)
- ANAR |= ANAR_10FD;
- else
- ANAR |= ANAR_10;
- }
- velocity_mii_write(vptr->mac_regs, MII_REG_ANAR, ANAR);
- /* enable AUTO-NEGO mode */
- mii_set_auto_on(vptr);
- /* MII_REG_BITS_ON(BMCR_AUTO, MII_REG_BMCR, vptr->mac_regs); */
- }
- /* vptr->mii_status=mii_check_media_mode(vptr->mac_regs); */
- /* vptr->mii_status=check_connection_type(vptr->mac_regs); */
- return VELOCITY_LINK_CHANGE;
- }
-
- /**
- * mii_check_media_mode - check media state
- * @regs: velocity registers
- *
- * Check the current MII status and determine the link status
- * accordingly
- */
-
- static u32 mii_check_media_mode(struct mac_regs *regs)
- {
- u32 status = 0;
- u16 ANAR;
-
- if (!MII_REG_BITS_IS_ON(BMSR_LNK, MII_REG_BMSR, regs))
- status |= VELOCITY_LINK_FAIL;
-
- if (MII_REG_BITS_IS_ON(G1000CR_1000FD, MII_REG_G1000CR, regs))
- status |= VELOCITY_SPEED_1000 | VELOCITY_DUPLEX_FULL;
- else if (MII_REG_BITS_IS_ON(G1000CR_1000, MII_REG_G1000CR, regs))
- status |= (VELOCITY_SPEED_1000);
- else {
- velocity_mii_read(regs, MII_REG_ANAR, &ANAR);
- if (ANAR & ANAR_TXFD)
- status |=
- (VELOCITY_SPEED_100 | VELOCITY_DUPLEX_FULL);
- else if (ANAR & ANAR_TX)
- status |= VELOCITY_SPEED_100;
- else if (ANAR & ANAR_10FD)
- status |=
- (VELOCITY_SPEED_10 | VELOCITY_DUPLEX_FULL);
- else
- status |= (VELOCITY_SPEED_10);
- }
-
- if (MII_REG_BITS_IS_ON(BMCR_AUTO, MII_REG_BMCR, regs)) {
- velocity_mii_read(regs, MII_REG_ANAR, &ANAR);
- if ((ANAR & (ANAR_TXFD | ANAR_TX | ANAR_10FD | ANAR_10))
- == (ANAR_TXFD | ANAR_TX | ANAR_10FD | ANAR_10)) {
- if (MII_REG_BITS_IS_ON
- (G1000CR_1000 | G1000CR_1000FD,
- MII_REG_G1000CR, regs))
- status |= VELOCITY_AUTONEG_ENABLE;
- }
- }
-
- return status;
- }
-
- static u32 check_connection_type(struct mac_regs *regs)
- {
- u32 status = 0;
- u8 PHYSR0;
- u16 ANAR;
- PHYSR0 = readb(®s->PHYSR0);
-
- /*
- if (!(PHYSR0 & PHYSR0_LINKGD))
- status|=VELOCITY_LINK_FAIL;
- */
-
- if (PHYSR0 & PHYSR0_FDPX)
- status |= VELOCITY_DUPLEX_FULL;
-
- if (PHYSR0 & PHYSR0_SPDG)
- status |= VELOCITY_SPEED_1000;
- if (PHYSR0 & PHYSR0_SPD10)
- status |= VELOCITY_SPEED_10;
- else
- status |= VELOCITY_SPEED_100;
-
- if (MII_REG_BITS_IS_ON(BMCR_AUTO, MII_REG_BMCR, regs)) {
- velocity_mii_read(regs, MII_REG_ANAR, &ANAR);
- if ((ANAR & (ANAR_TXFD | ANAR_TX | ANAR_10FD | ANAR_10))
- == (ANAR_TXFD | ANAR_TX | ANAR_10FD | ANAR_10)) {
- if (MII_REG_BITS_IS_ON
- (G1000CR_1000 | G1000CR_1000FD,
- MII_REG_G1000CR, regs))
- status |= VELOCITY_AUTONEG_ENABLE;
- }
- }
-
- return status;
- }
-
- /**
- * enable_flow_control_ability - flow control
- * @vptr: veloity to configure
- *
- * Set up flow control according to the flow control options
- * determined by the eeprom/configuration.
- */
-
- static void enable_flow_control_ability(struct velocity_info *vptr)
- {
-
- struct mac_regs *regs = vptr->mac_regs;
-
- switch (vptr->options.flow_cntl) {
-
- case FLOW_CNTL_DEFAULT:
- if (BYTE_REG_BITS_IS_ON(PHYSR0_RXFLC, ®s->PHYSR0))
- writel(CR0_FDXRFCEN, ®s->CR0Set);
- else
- writel(CR0_FDXRFCEN, ®s->CR0Clr);
-
- if (BYTE_REG_BITS_IS_ON(PHYSR0_TXFLC, ®s->PHYSR0))
- writel(CR0_FDXTFCEN, ®s->CR0Set);
- else
- writel(CR0_FDXTFCEN, ®s->CR0Clr);
- break;
-
- case FLOW_CNTL_TX:
- writel(CR0_FDXTFCEN, ®s->CR0Set);
- writel(CR0_FDXRFCEN, ®s->CR0Clr);
- break;
-
- case FLOW_CNTL_RX:
- writel(CR0_FDXRFCEN, ®s->CR0Set);
- writel(CR0_FDXTFCEN, ®s->CR0Clr);
- break;
-
- case FLOW_CNTL_TX_RX:
- writel(CR0_FDXTFCEN, ®s->CR0Set);
- writel(CR0_FDXRFCEN, ®s->CR0Set);
- break;
-
- case FLOW_CNTL_DISABLE:
- writel(CR0_FDXRFCEN, ®s->CR0Clr);
- writel(CR0_FDXTFCEN, ®s->CR0Clr);
- break;
-
- default:
- break;
- }
-
- }
-
- /* FIXME: Move to pci.c */
- /**
- * pci_set_power_state - Set the power state of a PCI device
- * @dev: PCI device to be suspended
- * @state: Power state we're entering
- *
- * Transition a device to a new power state, using the Power Management
- * Capabilities in the device's config space.
- *
- * RETURN VALUE:
- * -EINVAL if trying to enter a lower state than we're already in.
- * 0 if we're already in the requested state.
- * -EIO if device does not support PCI PM.
- * 0 if we can successfully change the power state.
- */
-
- int pci_set_power_state(struct pci_device *dev, int state)
- {
- int pm;
- u16 pmcsr;
- int current_state = 0;
-
- /* bound the state we're entering */
- if (state > 3)
- state = 3;
-
- /* Validate current state:
- * Can enter D0 from any state, but if we can only go deeper
- * to sleep if we're already in a low power state
- */
- if (state > 0 && current_state > state)
- return -1;
- else if (current_state == state)
- return 0; /* we're already there */
-
- /* find PCI PM capability in list */
- pm = pci_find_capability(dev, PCI_CAP_ID_PM);
-
- /* abort if the device doesn't support PM capabilities */
- if (!pm)
- return -2;
-
- /* check if this device supports the desired state */
- if (state == 1 || state == 2) {
- u16 pmc;
- pci_read_config_word(dev, pm + PCI_PM_PMC, &pmc);
- if (state == 1 && !(pmc & PCI_PM_CAP_D1))
- return -2;
- else if (state == 2 && !(pmc & PCI_PM_CAP_D2))
- return -2;
- }
-
- /* If we're in D3, force entire word to 0.
- * This doesn't affect PME_Status, disables PME_En, and
- * sets PowerState to 0.
- */
- if (current_state >= 3)
- pmcsr = 0;
- else {
- pci_read_config_word(dev, pm + PCI_PM_CTRL, &pmcsr);
- pmcsr &= ~PCI_PM_CTRL_STATE_MASK;
- pmcsr |= state;
- }
-
- /* enter specified state */
- pci_write_config_word(dev, pm + PCI_PM_CTRL, pmcsr);
-
- /* Mandatory power management transition delays */
- /* see PCI PM 1.1 5.6.1 table 18 */
- if (state == 3 || current_state == 3)
- mdelay(10);
- else if (state == 2 || current_state == 2)
- udelay(200);
- current_state = state;
-
- return 0;
- }
-
- static struct pci_device_id velocity_nics[] = {
- PCI_ROM(0x1106, 0x3119, "via-velocity", "VIA Networking Velocity Family Gigabit Ethernet Adapter", 0),
- };
-
- PCI_DRIVER ( velocity_driver, velocity_nics, PCI_NO_CLASS );
-
- DRIVER ( "VIA-VELOCITY/PCI", nic_driver, pci_driver, velocity_driver,
- velocity_probe, velocity_disable );
|