123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235 |
- #include "u.h"
- #include "../port/lib.h"
- #include "mem.h"
- #include "dat.h"
- #include "fns.h"
- #include "io.h"
- #include "../port/error.h"
- #include "../port/netif.h"
- #include "etherif.h"
- #include "ethermii.h"
- int
- mii(Mii* mii, int mask)
- {
- MiiPhy *miiphy;
- int bit, oui, phyno, r, rmask;
- /*
- * Probe through mii for PHYs in mask;
- * return the mask of those found in the current probe.
- * If the PHY has not already been probed, update
- * the Mii information.
- */
- rmask = 0;
- for(phyno = 0; phyno < NMiiPhy; phyno++){
- bit = 1<<phyno;
- if(!(mask & bit))
- continue;
- if(mii->mask & bit){
- rmask |= bit;
- continue;
- }
- if(mii->mir(mii, phyno, Bmsr) == -1)
- continue;
- r = mii->mir(mii, phyno, Phyidr1);
- oui = (r & 0x3FFF)<<6;
- r = mii->mir(mii, phyno, Phyidr2);
- oui |= r>>10;
- if(oui == 0xFFFFF || oui == 0)
- continue;
- if((miiphy = malloc(sizeof(MiiPhy))) == nil)
- continue;
- miiphy->mii = mii;
- miiphy->oui = oui;
- miiphy->phyno = phyno;
- miiphy->anar = ~0;
- miiphy->fc = ~0;
- miiphy->mscr = ~0;
- mii->phy[phyno] = miiphy;
- if(mii->curphy == nil)
- mii->curphy = miiphy;
- mii->mask |= bit;
- mii->nphy++;
- rmask |= bit;
- }
- return rmask;
- }
- int
- miimir(Mii* mii, int r)
- {
- if(mii == nil || mii->ctlr == nil || mii->curphy == nil)
- return -1;
- return mii->mir(mii, mii->curphy->phyno, r);
- }
- int
- miimiw(Mii* mii, int r, int data)
- {
- if(mii == nil || mii->ctlr == nil || mii->curphy == nil)
- return -1;
- return mii->miw(mii, mii->curphy->phyno, r, data);
- }
- int
- miireset(Mii* mii)
- {
- int bmcr;
- if(mii == nil || mii->ctlr == nil || mii->curphy == nil)
- return -1;
- bmcr = mii->mir(mii, mii->curphy->phyno, Bmcr);
- bmcr |= BmcrR;
- mii->miw(mii, mii->curphy->phyno, Bmcr, bmcr);
- microdelay(1);
- return 0;
- }
- int
- miiane(Mii* mii, int a, int p, int e)
- {
- int anar, bmsr, mscr, r, phyno;
- if(mii == nil || mii->ctlr == nil || mii->curphy == nil)
- return -1;
- phyno = mii->curphy->phyno;
- bmsr = mii->mir(mii, phyno, Bmsr);
- if(!(bmsr & BmsrAna))
- return -1;
- if(a != ~0)
- anar = (AnaTXFD|AnaTXHD|Ana10FD|Ana10HD) & a;
- else if(mii->curphy->anar != ~0)
- anar = mii->curphy->anar;
- else{
- anar = mii->mir(mii, phyno, Anar);
- anar &= ~(AnaAP|AnaP|AnaT4|AnaTXFD|AnaTXHD|Ana10FD|Ana10HD);
- if(bmsr & Bmsr10THD)
- anar |= Ana10HD;
- if(bmsr & Bmsr10TFD)
- anar |= Ana10FD;
- if(bmsr & Bmsr100TXHD)
- anar |= AnaTXHD;
- if(bmsr & Bmsr100TXFD)
- anar |= AnaTXFD;
- }
- mii->curphy->anar = anar;
- if(p != ~0)
- anar |= (AnaAP|AnaP) & p;
- else if(mii->curphy->fc != ~0)
- anar |= mii->curphy->fc;
- mii->curphy->fc = (AnaAP|AnaP) & anar;
- if(bmsr & BmsrEs){
- mscr = mii->mir(mii, phyno, Mscr);
- mscr &= ~(Mscr1000TFD|Mscr1000THD);
- if(e != ~0)
- mscr |= (Mscr1000TFD|Mscr1000THD) & e;
- else if(mii->curphy->mscr != ~0)
- mscr = mii->curphy->mscr;
- else{
- r = mii->mir(mii, phyno, Esr);
- if(r & Esr1000THD)
- mscr |= Mscr1000THD;
- if(r & Esr1000TFD)
- mscr |= Mscr1000TFD;
- }
- mii->curphy->mscr = mscr;
- mii->miw(mii, phyno, Mscr, mscr);
- }
- mii->miw(mii, phyno, Anar, anar);
- r = mii->mir(mii, phyno, Bmcr);
- if(!(r & BmcrR)){
- r |= BmcrAne|BmcrRan;
- mii->miw(mii, phyno, Bmcr, r);
- }
- return 0;
- }
- int
- miistatus(Mii* mii)
- {
- MiiPhy *phy;
- int anlpar, bmsr, p, r, phyno;
- if(mii == nil || mii->ctlr == nil || mii->curphy == nil)
- return -1;
- phy = mii->curphy;
- phyno = phy->phyno;
- /*
- * Check Auto-Negotiation is complete and link is up.
- * (Read status twice as the Ls bit is sticky).
- */
- bmsr = mii->mir(mii, phyno, Bmsr);
- if(!(bmsr & (BmsrAnc|BmsrAna))) {
- // print("miistatus: auto-neg incomplete\n");
- return -1;
- }
- bmsr = mii->mir(mii, phyno, Bmsr);
- if(!(bmsr & BmsrLs)){
- // print("miistatus: link down\n");
- phy->link = 0;
- return -1;
- }
- phy->speed = phy->fd = phy->rfc = phy->tfc = 0;
- if(phy->mscr){
- r = mii->mir(mii, phyno, Mssr);
- if((phy->mscr & Mscr1000TFD) && (r & Mssr1000TFD)){
- phy->speed = 1000;
- phy->fd = 1;
- }
- else if((phy->mscr & Mscr1000THD) && (r & Mssr1000THD))
- phy->speed = 1000;
- }
- anlpar = mii->mir(mii, phyno, Anlpar);
- if(phy->speed == 0){
- r = phy->anar & anlpar;
- if(r & AnaTXFD){
- phy->speed = 100;
- phy->fd = 1;
- }
- else if(r & AnaTXHD)
- phy->speed = 100;
- else if(r & Ana10FD){
- phy->speed = 10;
- phy->fd = 1;
- }
- else if(r & Ana10HD)
- phy->speed = 10;
- }
- if(phy->speed == 0) {
- // print("miistatus: phy speed 0\n");
- return -1;
- }
- if(phy->fd){
- p = phy->fc;
- r = anlpar & (AnaAP|AnaP);
- if(p == AnaAP && r == (AnaAP|AnaP))
- phy->tfc = 1;
- else if(p == (AnaAP|AnaP) && r == AnaAP)
- phy->rfc = 1;
- else if((p & AnaP) && (r & AnaP))
- phy->rfc = phy->tfc = 1;
- }
- phy->link = 1;
- return 0;
- }
|