pm3386.c revision 178f171da7f0ea5cfc1c45932680c81b3a8a0bd6
115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek/* 215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Helper functions for the PM3386s on the Radisys ENP2611 315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Copyright (C) 2004, 2005 Lennert Buytenhek <buytenh@wantstofly.org> 415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Dedicated to Marija Kulikova. 515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * 615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * This program is free software; you can redistribute it and/or modify 715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * it under the terms of the GNU General Public License as published by 815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * the Free Software Foundation; either version 2 of the License, or 915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * (at your option) any later version. 1015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 1115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 1215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek#include <linux/config.h> 1315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek#include <linux/module.h> 1415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek#include <linux/delay.h> 1515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek#include <linux/netdevice.h> 1615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek#include <asm/io.h> 1715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 1815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek/* 1915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Read from register 'reg' of PM3386 device 'pm'. 2015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 2115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekstatic u16 pm3386_reg_read(int pm, int reg) 2215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 2315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek void *_reg; 2415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek u16 value; 2515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 2615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek _reg = (void *)ENP2611_PM3386_0_VIRT_BASE; 2715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek if (pm == 1) 2815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek _reg = (void *)ENP2611_PM3386_1_VIRT_BASE; 2915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 3015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek value = *((volatile u16 *)(_reg + (reg << 1))); 3115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 3215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek// printk(KERN_INFO "pm3386_reg_read(%d, %.3x) = %.8x\n", pm, reg, value); 3315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 3415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek return value; 3515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 3615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 3715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek/* 3815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Write to register 'reg' of PM3386 device 'pm', and perform 3915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * a readback from the identification register. 4015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 4115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekstatic void pm3386_reg_write(int pm, int reg, u16 value) 4215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 4315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek void *_reg; 4415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek u16 dummy; 4515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 4615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek// printk(KERN_INFO "pm3386_reg_write(%d, %.3x, %.8x)\n", pm, reg, value); 4715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 4815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek _reg = (void *)ENP2611_PM3386_0_VIRT_BASE; 4915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek if (pm == 1) 5015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek _reg = (void *)ENP2611_PM3386_1_VIRT_BASE; 5115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 5215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek *((volatile u16 *)(_reg + (reg << 1))) = value; 5315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 5415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek dummy = *((volatile u16 *)_reg); 5515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek __asm__ __volatile__("mov %0, %0" : "+r" (dummy)); 5615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 5715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 5815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek/* 5915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Read from port 'port' register 'reg', where the registers 6015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * for the different ports are 'spacing' registers apart. 6115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 6215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekstatic u16 pm3386_port_reg_read(int port, int _reg, int spacing) 6315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 6415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek int reg; 6515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 6615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek reg = _reg; 6715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek if (port & 1) 6815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek reg += spacing; 6915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 7015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek return pm3386_reg_read(port >> 1, reg); 7115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 7215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 7315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek/* 7415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Write to port 'port' register 'reg', where the registers 7515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * for the different ports are 'spacing' registers apart. 7615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 7715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekstatic void pm3386_port_reg_write(int port, int _reg, int spacing, u16 value) 7815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 7915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek int reg; 8015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 8115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek reg = _reg; 8215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek if (port & 1) 8315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek reg += spacing; 8415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 8515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_reg_write(port >> 1, reg, value); 8615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 8715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 8815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 8915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekvoid pm3386_reset(void) 9015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 9115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* @@@ Implement me. */ 9215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 9315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 9415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekstatic u16 swaph(u16 x) 9515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 9615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek return ((x << 8) | (x >> 8)) & 0xffff; 9715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 9815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 9915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekvoid pm3386_init_port(int port) 10015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 10115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek int pm = port >> 1; 10215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 10315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 10415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Work around ENP2611 bootloader programming MAC address 10515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * in reverse. 10615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 10715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek if (pm3386_port_reg_read(port, 0x30a, 0x100) == 0x0000 && 10815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek (pm3386_port_reg_read(port, 0x309, 0x100) & 0xff00) == 0x5000) { 10915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek u16 temp[3]; 11015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 11115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp[0] = pm3386_port_reg_read(port, 0x308, 0x100); 11215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp[1] = pm3386_port_reg_read(port, 0x309, 0x100); 11315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp[2] = pm3386_port_reg_read(port, 0x30a, 0x100); 11415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x308, 0x100, swaph(temp[2])); 11515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x309, 0x100, swaph(temp[1])); 11615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x30a, 0x100, swaph(temp[0])); 11715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek } 11815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 11915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 12015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Initialise narrowbanding mode. See application note 2010486 12115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * for more information. (@@@ We also need to issue a reset 12215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * when ROOL or DOOL are detected.) 12315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 12415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x708, 0x10, 0xd055); 12515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek udelay(500); 12615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x708, 0x10, 0x5055); 12715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 12815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 12915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * SPI-3 ingress block. Set 64 bytes SPI-3 burst size 13015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * towards SPI-3 bridge. 13115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 13215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x122, 0x20, 0x0002); 13315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 13415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 13515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Enable ingress protocol checking, and soft reset the 13615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * SPI-3 ingress block. 13715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 13815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_reg_write(pm, 0x103, 0x0003); 13915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek while (!(pm3386_reg_read(pm, 0x103) & 0x80)) 14015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek ; 14115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 14215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 14315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * SPI-3 egress block. Gather 12288 bytes of the current 14415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * packet in the TX fifo before initiating transmit on the 14515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * SERDES interface. (Prevents TX underflows.) 14615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 14715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x221, 0x20, 0x0007); 14815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 14915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 15015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Enforce odd parity from the SPI-3 bridge, and soft reset 15115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * the SPI-3 egress block. 15215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 15315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_reg_write(pm, 0x203, 0x000d & ~(4 << (port & 1))); 15415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek while ((pm3386_reg_read(pm, 0x203) & 0x000c) != 0x000c) 15515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek ; 15615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 15715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 15815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * EGMAC block. Set this channels to reject long preambles, 15915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * not send or transmit PAUSE frames, enable preamble checking, 16015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * disable frame length checking, enable FCS appending, enable 16115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * TX frame padding. 16215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 16315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x302, 0x100, 0x0113); 16415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 16515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 16615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Soft reset the EGMAC block. 16715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 16815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x301, 0x100, 0x8000); 16915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek udelay(10); 17015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x301, 0x100, 0x0000); 17115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek udelay(10); 17215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 17315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 17415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Auto-sense autonegotiation status. 17515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 17615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x306, 0x100, 0x0100); 17715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 17815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 17915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Allow reception of jumbo frames. 18015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 18115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x310, 0x100, 9018); 18215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 18315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 18415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Allow transmission of jumbo frames. 18515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 18615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x336, 0x100, 9018); 18715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 18815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* @@@ Should set 0x337/0x437 (RX forwarding threshold.) */ 18915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 19015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 19115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Set autonegotiation parameters to 'no PAUSE, full duplex.' 19215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 19315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x31c, 0x100, 0x0020); 19415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek udelay(10); 19515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 19615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 19715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Enable and restart autonegotiation. 19815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 19915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x318, 0x100, 0x0003); 20015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek udelay(1000); 20115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x318, 0x100, 0x0002); 20215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek udelay(10); 20315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 20415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 20515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekvoid pm3386_get_mac(int port, u8 *mac) 20615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 20715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek u16 temp; 20815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 20915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp = pm3386_port_reg_read(port, 0x308, 0x100); 21015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek mac[0] = temp & 0xff; 21115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek mac[1] = (temp >> 8) & 0xff; 21215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 21315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp = pm3386_port_reg_read(port, 0x309, 0x100); 21415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek mac[2] = temp & 0xff; 21515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek mac[3] = (temp >> 8) & 0xff; 21615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 21715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp = pm3386_port_reg_read(port, 0x30a, 0x100); 21815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek mac[4] = temp & 0xff; 21915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek mac[5] = (temp >> 8) & 0xff; 22015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 22115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 22215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekstatic u32 pm3386_get_stat(int port, u16 base) 22315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 22415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek u32 value; 22515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 22615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek value = pm3386_port_reg_read(port, base, 0x100); 22715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek value |= pm3386_port_reg_read(port, base + 1, 0x100) << 16; 22815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 22915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek return value; 23015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 23115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 23215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekvoid pm3386_get_stats(int port, struct net_device_stats *stats) 23315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 23415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* 23515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek * Snapshot statistics counters. 23615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek */ 23715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x500, 0x100, 0x0001); 23815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek while (pm3386_port_reg_read(port, 0x500, 0x100) & 0x0001) 23915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek ; 24015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 241178f171da7f0ea5cfc1c45932680c81b3a8a0bd6Lennert Buytenhek memset(stats, 0, sizeof(*stats)); 24215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 24315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek stats->rx_packets = pm3386_get_stat(port, 0x510); 24415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek stats->tx_packets = pm3386_get_stat(port, 0x590); 24515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek stats->rx_bytes = pm3386_get_stat(port, 0x514); 24615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek stats->tx_bytes = pm3386_get_stat(port, 0x594); 24715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek /* @@@ Add other stats. */ 24815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 24915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 25015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekint pm3386_is_link_up(int port) 25115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 25215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek u16 temp; 25315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 25415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp = pm3386_port_reg_read(port, 0x31a, 0x100); 25515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp = pm3386_port_reg_read(port, 0x31a, 0x100); 25615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 25715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek return !!(temp & 0x0002); 25815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 25915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 26015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekvoid pm3386_enable_rx(int port) 26115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 26215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek u16 temp; 26315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 26415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp = pm3386_port_reg_read(port, 0x303, 0x100); 26515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp |= 0x1000; 26615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x303, 0x100, temp); 26715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 26815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek udelay(10); 26915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 27015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 27115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekvoid pm3386_disable_rx(int port) 27215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 27315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek u16 temp; 27415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 27515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp = pm3386_port_reg_read(port, 0x303, 0x100); 27615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp &= 0xefff; 27715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x303, 0x100, temp); 27815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 27915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek udelay(10); 28015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 28115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 28215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekvoid pm3386_enable_tx(int port) 28315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 28415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek u16 temp; 28515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 28615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp = pm3386_port_reg_read(port, 0x303, 0x100); 28715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp |= 0x4000; 28815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x303, 0x100, temp); 28915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 29015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek udelay(10); 29115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 29215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 29315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhekvoid pm3386_disable_tx(int port) 29415d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek{ 29515d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek u16 temp; 29615d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 29715d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp = pm3386_port_reg_read(port, 0x303, 0x100); 29815d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek temp &= 0xbfff; 29915d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek pm3386_port_reg_write(port, 0x303, 0x100, temp); 30015d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 30115d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek udelay(10); 30215d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek} 30315d014d13149aedd76cbff1b5c3bbfe839391457Lennert Buytenhek 30415d014d13149aedd76cbff1b5c3bbfe839391457Lennert BuytenhekMODULE_LICENSE("GPL"); 305